Position controller

Added support for position - position controller.
Tested it with gazebo hardware interface (pull request https://github.com/ros-simulation/gazebo_ros_pkgs/pull/135) and works fine.