Forward Kinematics and texture generating

And fixing directories