Added error logging to dynamixel_hardware_interface, re-factored clam_block_manipulation