Motor Controller Position and Velocity commands fix. Head Trajectory Orocos Component.