Refactor action control

[michalvavrecka]

Look at the robot.py and find unused methods for arm control (velocity drive, torque driven etc.). Try to make these method work on reach task. Train and test on reach task and report results. If the methods work, update readme, configs etc.