added to string to test output
added readability test
added a higher order function we might need later
Merge branch 'dev' into motor_controller
Merge branch 'dev' into navigation
Merge branch 'motor_controller' into dev