Improvements to 3point turn.
  - Simplified code
  - Improved motor code

Also tidied up debug to use environment variable