fixes in dynamixel id handling