#176 Correction of point transformation error

[manuelgitgomes]

These changes made the script work in my machine. However, some changes with the code were done, please review to check if you agree with the changes

The main changes were:

• Changes transformations from world2cam to cam2world
• Correct placement of camera's optical_frame