Issue200

Rearrange the order of the sp5 service calls
from ARM -> LUMBAR -> GRIPPER
to LUMBAR -> GRIPPER -> ARM