1. fixed a bug where it the processing of sysex data was sometimes trying to do it when the data buffer was empty. This was causing a crash.
2. Added arbotixfirmata commmands to set and get registers directly on a Dynamixel servo.