Clean shutdown exception handling
Move dynamixel_control initialization to main