[GRASPth] Finding a correct starting position for the robot arm+hand. Fixing issue #3.
[GRASPth] Cleaning up run() function.