create functions
Add Test Framework for new methods
initial implementation of motion formulas
Initial working version of distance