fix double threading, add blocking to servos
Merge branch 'master' of github.com:uh-nmb/robotActionController