most recent version of direct kinematics
merge of our current state in forward kinematics and of angle calculation