add README.md
initial files
merge in cleanups
Merge branch 'feature/kinematics' into develop