Got the prismatic firmata dynamixel code working in simulation.
Refacored the DynamixelUSB servo stuff to be simpler and pushed more into base classes.