Added a function to truncate data from find_time_shift results and test.
The walking simple control solver seems to be working, just needs polish.
Made the test example a bit more robust.
Updated documentation.
Docstring errors.
Added a walking data class.