Finished reorganization
Added simple Pos objects with tests
Added paths for linear/circular/parabolic motion; added tests for paths