Changed dynamixel speed, wrong joint names and added joint states for
head joints [ci skip]