Add copyright info
Fix modifying wrong state object
Remove unused fields
Add skeleton servo control
Tidy up speed control related code