kinematics.py works, FKTest shows kinematics.py working in Openrave