testing out speed calc from position for api use

this may work for api calls like, rotateTo() or rtz()