need to do pr2 kinematics myself
have IK in python
added fk to remove dependency on openrave
all that is left for fadbad is fadbad-pr2-system