added fixes to LegIK and FK, added comments
Merge pull request #5 from pvieira3/master

Fix to Leg FK and IK