Improved logic for (un)folding tools in mode 4&6

- should now work with most standard machinery except for Amazone
Condor, which will not start driving after unfolding
- closes #78
added fold_move_direction to mode 6