Added option to specify required direction in rotationBetweenbBearings
Implementing straightline move logic (WIP)
Implemented straightline move logic