Determine variables for angle control from kinematics (RKI)

Dependencies:   Matrix

Revision:
1:11b728aa0077
Parent:
0:00721d3e1cf7