Dynamixelcontroller tested and working!