Merge pull request #1 from twiniars/master

Motor and joint spline interpolation
Merge pull request #2 from twiniars/master

forward and inverse kinematics
FT sensor fix.
FR sensor fix.
unused files deleted