1. Fixed some bugs with how the firmata controller was starting up and shutting down. It was not quite closing things correctly and was causing some problems.
2. Added code to use the new firmata dynamixel commands to configure the servo and to monitor when the servo has stopped in an attempt to make the firmata code more reliable.