Base version of firmware that includes servo control and test suite.