Fix to support head joint information coming from both hubo-ach and dynamixel drivers