Add limits to yaw rate, speed reference commands.

Limit commanded yaw rate between -2.0 to 2.0 rad/s. Limit commanded
speed to be withing valid range for fork controller gain schedule.