Add tests

[ckampm]

So far, this project does not contain tests. Note that the functionality of the motor driver is tested in the MotorDriverCard project. For most variables, setting a value and checking the according readback value should suffice.

[ckampm]

Added a minimal test which covers a simple movement and calibration (SIMPLE_MODE only). Not complete yet.