Modifications to help run on the main unit. Todo: better end-point
selection, selecting for free space around final target; low-pass
filtering speed; more testing.