Got dynamixel library working, added in more motor tests