设置位姿四元数

设置位姿中的姿态（用四元数表示），可以使用第二个端口输入的参考位姿，或参数中设置的四元数。

通用的位姿四元数设置步骤，如果参考位姿列表中包含多个位姿，则只有第一个位姿的四元数会用于设置。