Fixing position effort controller pid command args

This should fix the problems described in https://github.com/ros-controls/ros_controllers/pull/20 and https://github.com/ros-controls/ros_controllers/pull/16