Added render.py and copy to binary folder
Added writeFK to the test suite
Corrected inversion of manipToRob and RobToManip and QPSolver