Create framework for modeling control system behavior

[greghaynes]

It would be extremely useful to model the control system behaviour using the actual control firmware. This should be doable especially with a functional testing framework.

The idea is to essentially start with a predefined state, write routines to generate sensor values (with given error distributions) based on that sate, feed sensor values into control code, read motor outputs, update model state and repeat.