The direct kinematics equation can be written in joint space form: