GitHub TRO Arxiv YouTube Bilibili Website ROS 3. 问题陈述 3.1 机器人运动学 3.2 机器人模型 可以将机器人本体看成一个紧凑的凸集,初始状态用锥不等式表示为 C={x∈Rn∣Gx⪯Kh}\mathbb{C} = \left\{ \bm{x} \in \mathbb{R} ^n \mid \bm{Gx} \preceq_{\mathcal{K}}\bm{h} \right\} C={x∈Rn∣Gx⪯Kh} 具体解释请参考OBCA 由于机器人在不断运动,因此给定状态st\bm{s}_tst,第ttt帧的占用空间表示为凸紧集Zt\mathbb{Z}_tZt Zt(st)={Rt(st)x+tt(st)∣x∈C}\mathbb{Z}_t(\bm{s}_t) = \left\{ \bm{R}_t(\bm{s}_t)\bm{x} + \bm{t}_t(\bm{s}_t) \mid \bm{x} \in \mathbb{C} \right\} Zt(st)={Rt(st)x+tt(st)∣x∈C} 本质上是对C\mathbb{C}C进行旋转和平移 5