advanceCurPos tested, internal speed changed to m/s
getpos complete, curPos now wp.copy()