Fix joint names and orders to match with grizzly Drive.msg