re-added straight-line path planning to Robot.cpp