updated testing based on Example 4.3
Merge branch 'master' of https://github.com/digwiz/C

Updated kinematics_test.c to include full solution to Example 4.3