Dynamixel rework

Reworked dynamixel to work with management class

Added dynamixel management, to route the packet to dynamixel

Modified Uart to retrieve all bytes from the ring in one shot