Fix here: https://github.com/willowgarage/ros_control/pull/65