Revised turning and moving

Now only needs Turn and Forw. Comments are provided over all
subroutines. Needs to be tested. Old code is still present and should be
ignored.
Testing planner.
Merge branch 'master' into matt-planner