got everything working
Add a simple servo test
increase speed
Merge branch '2014'