from queue q to this

from kStart to k

coordinate system MCS to

system csSrc to MCS at

system MCS to

CommandingFB POINTER TO SMC

POINTER TO SMC

TO Trj

: discrete movement to a

opposite to the flange