Adams管路机器人仿真

   管路机器人主要是根据管路管径的变化，调整支腿的姿态，使支腿时刻紧贴管内壁，然后实现前移。管理机器人的具体结构如下：

    如上图，机器人主要由前后各三个支腿组成，支腿边缘各有一个驱动轮，同时为了使支腿实现运动以适应管壁，在支腿侧边添加可伸缩斜支撑。

①支腿的建立

   首先在机器人body后侧建立一个倾斜的支腿(便于后面适应管径)，然后复 制、旋转120°建立三个同样的支腿，具体如下：

同理在前侧也建立3个倾斜的支腿，完成后如下所示：

②伸缩支撑的建立

在支腿和机器人主体之间建立两个连杆，具体如下图，同理也在其他支腿上建立斜支撑：

③驱动轮的建立

    和上文采用同样复 制旋转的方法在支腿边缘共建立六个驱动轮：

④约束副的建立

  如下所示，驱动轮与支腿之间建立旋转副，支腿与主体建立旋转副，两个伸缩支撑分别与支腿、主体建立球副，伸缩支撑之间建立移动副。

⑤驱动的建立

    在每个驱动轮上建立一个10s10圈的驱动函数（数值的大小可以根据需要设置）：

    首先建立不同管径管路的轮廓，然后基于轮廓进行旋转就可生成管路：

 然后在驱动轮与管路之间建立接触(接触中要添加摩擦，否则不会机器人不会前进)：

①被动调节

   被动调节的原理主要是通过添加具有预载的弹簧，在Preload处加一个负的载荷，表示弹簧此时被压缩，相当于在初始时刻弹簧压缩，驱动轮紧贴在管壁内径上：

经过仿真，仿真动画如下所示：

②主动调节

‍‍‍  主动调节的原理主要是应用PID控制，具体原理为：将上文中的弹簧换成单向力，然后建立PID控制force的大小。PID控制系统的输入为驱动轮轮心到机器人body中心的距离以及驱动轮轮心的速度：

‍‍‍

具体设置如下：

a.建立变量：

  建立P、I、D变量以及驱动轮轮心到机器人中心的距离(管径不同，这个距离不同)。

b.建立控制PID控制系统的输入及PID：

c.将PID控制作为单向力载荷的输入

经过仿真如下：

从上图可以看出，经过PID控制，驱动轮到达指定的距离与管壁接触。