Correct transformation from camera to robot.
Take into account new hardware configuration.
Merge branch 'vision-devel' into Milestone-3