Added freedrive mode functionality to ROS#573

MMT-Testbench wants to merge 1 commit intoUniversalRobots:masterUniversalRobots/Universal_Robots_ROS_Driver:masterfrom

MMT-Testbench:masterMMT-Testbench/Universal_Robots_ROS_Driver:masterCopy head branch name to clipboard