Add do_move method

This method takes in a distance and time, and calculates a list of smaller distances that limit the acceleration of pacbot.

Response to this trello post

I'm pretty new to C/C++, so although it seems to compile, it might not work.