《机器人技术报告》由会员分享，可在线阅读，更多相关《机器人技术报告（8页珍藏版）》请在金锄头文库上搜索。
1、第1章简介主从微创手术机器人的控制部分主要由控制台系统、操作臀系统、主操作 手、从操作手等构成。手术时外科医师可坐在远离手术台的控制台前，借助三 维视觉，双手控制主操作手，手部动作传达到机械臀及手术器械，完成手术操 作。这种主从控制的工作方式增加了操作的精确性和平稳性。控制系统结构图如下:临场力信.号输出淮波从手逆运动学模型主手正运动学模型空间映射空间映射.LLlUlUfll JlIlljIU.Ull llUllllllUllIllll从手正运动学模型.I反愤输入信号滤波力反慷输入滤波.下面是达芬奇Si控制台系统，有计算机硬件及软件，其计算机硬件包括45 个奔腾处理器，并留有扩展槽以备进一步升
2、级。左侧面板项石恻面板控制台下图是达芬奇Si臀系统图，它具有三个固定于可移动基座的机械臂，底座 通过线缆和高可靠性航空插头与控制台相连。中心机械臂是持镜臂，负责握持 摄像机系统，其余机械臂是持械臂，负责握持特制外科手术器械。每个机械臂 具有一系列多位置关节和可旋转的末端关节与套管相连，这样在安装时易于摆 位，并保证可达手术要求的运动空间。臂系统助力推午第2章 主从操作手的构成和运动控制2.1主操作手的构成和运动控制主操作手是医生直接操纵的部分，主要由两方面功能，第一是提供整个系 统的输入信号，控制从操作手的动作；第二传递力反馈信息，给医生提供手术 工具末端的力感受，提高手术的质量。主操作手分为
3、左右两只，对应着医生的 左右手。每只主操作手由七个自由度组成，且均为转动关节。主操作手采用串联结构，具有较大的工作空间和高度的灵活性。主操作手 在所有方向上可实现自由独立运动，允许对器械和摄像机进行直观控制。主操作手是由两套结构相同的关节式操作臂构成，各转动关节配有相对式 数字编码器，数字编码器能发出正交的编码脉冲，脉冲的速度与转动速度成正 比。位置关节上装有力矩电机，能在系统初始化时提供位置控制，保证系统上 电原点，在系统正常运行时切换为电流模式，提供临场力感觉。机器人从操作 手各关节采用伺服电机驱动。由于主操作臂和从操作臂在系统设计时为满足末 端工具的体积指标，在结构上是异构型映射，故对控
4、制器的数据运算功能提供 了较高的要求。主手从外部接受力信号，经过码盘采集，在主操作臂控制器内进行输入信 号滤波，完成主手正运动学模型计算得到主操作臂末端空间位姿，传入从控制 器由位置，经速度，电流闭环完成位置控制。力反馈部分在从操作臂上的应变 片采集放大得到力信息，综合位置信息共同控制主操作臂的力感觉输出。针对主从手应用不同，主从手安装的执行器件和传感反馈器件也有差别。 直流电机在从操作臂主要提供位置控制功能，在主臂还是力反馈的执行器。多 圈电位器是用来测量关节旋转的角度值，相对式码盘是测关节运动的相对值， 无励磁刹车是通过机械固联为末端提供稳定的支撑，限位开关有两个作用，能 提供系统的初始点
5、并且可以对系统进行保护，在收到电气限位信号时电机应停 止该方向的运动执行命令保证机械结构安全。2.2从操作手的构成和运动控制从操作手包括被动部分和主动部分。2.2.1从操作手的被动部分从操作手的被动部分，主要用于手术前对机器人进行快速定位。从操作臂 的整个被动部分由一个调节机器人高度的滑动关节，和5个转动关节组成，共六 个自由度。其中滑动关节由交流伺服电机驱动，由专门控制单元实现。转动关 节处装配有无励磁刹车和电位器，两者为同轴装配，分别用于锁死关节和提供 关节的角度信息。同时为了降低支架对扭矩的要求，在输入轴及无励磁刹车之 间加入增速机。从操作手的被动部分动作原理为：正常状态下，各关节锁死；
6、需要进行调 整时，医生通过开关量（按钮）的控制，使被动支架各关节通电，被动部分关节 内的无励磁刹车松开，通过手动进行调整；此外，手术机器人的控制器除需要 主动环节各关节的位置外，还需要各被动关节的位置量，用以实现立体视觉， 因此在各被动关节内都装有电位器来记录各关节的绝对位置信息。2.2.2从操作手的主动部分从操作手的主动部分由大臂部分和小臂部分组成。操作系统的大臂部分主要 是为了确定手术工具末端的位置。大臂部分由三个自由度组成，分别由控制大 臂偏转角度的旋转关节，控制前后伸缩的滑动关节，以及控制上下滑动的关节 组成。关节处安装有驱动电机，需要工作于速度模式，以实时跟随主操作于末 端的位置。同
7、时在各个关节安装多圈电位器，用于读取初始的大臂各关节角。 为了安全考虑，在关节的机械限位处，安装接近开关，防止关节运动超出合理 范围。小臂部分由小手支撑体和小手工具组成。小手部分是直接进入病患体内进 行手术工作的实体。它是完成医生手术动作的关键部分，手术中诸如切割，缝 合等动作都与其密切相关，直接决定着手术的成败和质量。小手部分具有四个自由度，分别是腕关节的俯仰，腕关节摇摆，工具末端 （如剪子）的摇摆，还有工具末端的开合。四个自由度由四个电机驱动完成整个 运动需求。电机和自由度之间存在耦合，需要解耦完成。第3章主从微创手术机器人双向控制方法3.1引言基于对主从机器人控制系统的动力学分析，研究了
8、借助力觉临场感技术实 现主从医疗机器人遥操作的控制理论和设计方法。在力和运动的双向控制中采 用了新型控制方案，从理论上分析了该方案的可行性，显示了临场感技术在增 强人机交互能力方面的优越性。力临场感技术是交互技术的核心。它一方面将本地操作者的位置和运动信 息作为控制指令传递给远地的机器人，另一方面将远地机器人感知到的环境信 息以及机器人和环境的相互作用信息实时地反馈给本地操作者，使操作者产生 身临其境的感觉，机器人仿佛是操作者肢体在远地的延伸，从而操作者能够真 实地感受到机器人和环境地交互状态，正确地决策，有效地控制机器人完成复 杂的任务。将力觉临场感技术应用于主从式医疗机器人是目前的研究热点
9、之 一，它通过力觉、触觉的实时反馈，使操作者产生身临其境的感觉，从而提高 手术的成功率，缩短手术时间。双向控制是指主手和从手间的运动和力觉信息的交互反馈控制，早期的遥 控机器人系统采用双向位置反馈来实现力觉临场感。基于传感器技术的提高， 使我们能够采用高性能的腕力传感器实现主从手间的双向力觉反馈，为采用更 先进的控制方法进一步提高遥操作性能提供了基础。3.2现有力反馈双向控制方法力觉临场感操作医疗机器人系统的结构，如图1所示。它由操作者、主操 作手（简称主手）、通讯环节、从操作手（简称从手）和环境构成。操作者的 任务和动作指令通过主机械手、通讯环节和机械手作用于环境，而环境对从机 械手的作用及
10、环境信息则经过上述环节反向传输到操作者手部。通常采用双向 力反馈遥操作系统实现力觉临场感。国内外学者对于各类型的控制方法进行了 研究。目前常用的控制方法主要包括：位置伺服型、力反馈型、力反馈伺服 型、力一位置综合型等。各种控制方法分别采用主从手两侧位置和力信息的不 同组合，构成不同的控制算法，从而实现从手对主手位置的跟随，并对主手驱 动机构的力进行控制，实现力觉反馈。研究表明，适当的控制方法可以有效地 抑制系统内动力学干扰。操作者X、通讯环节从操作臂环境AA*4此4秩图1力觉临场感系统的构成位置伺服型通过主、从手的位置偏差进行力觉传递，不需要力检测装置， 结构简单。但是，如果不补偿惯性力和摩擦
11、力，对于自重、摩擦力较大的主 手，偏差信号将不精确。因此，不适于重负荷、大功率操作机。力反馈型将从手上的力/力矩直接反馈给主手，适合于重负荷，大功率场 合。但是，当从手自重很大，即使在从手没有负载的情况下，对主手的操作很 困难，容易造成操作者疲劳。力反馈伺服型在从手启动的同时，主手也根据自 重产生的惯性力矩开始运转。因此，在从手没有负载时，主手感觉不到从手惯 性力矩的反作用，主手操作较轻松自如。力一位置综合型能较好反映从手受力情况，当外负载不变时，反馈力随位 置偏差的减小而减小。主手反馈力能反映从手端力的变化。但是，当从手自重 很大，存在力反馈型同样的问题。3.3新型双向力反馈控制系统的动力学
12、模型在上述分析的基础上，采用邓乐等提出的一种新的控制方法来设计医疗机 器人主从双向控制系统，如图2所示。该方法主要特征是从手由主、从手之间 的力偏差和位置偏差控制，主手由二者的力偏差控制，既保证从手的控制精 度，又提高了操作系统的安全性。图2新型双向控制方法下面根据该方法的工作原理，建立双向力反馈系统的动力学模型。主手的动力学方程和控制策略为：rm=Kf（-F）式中：Fo操作者施加给主手的操纵力向量；Fm一主手臂上力传感器所受的力向量；Fs一从手臂上力传感器所受的力向量；T m驱动主手的力向量；Mm主手质量矩阵；Bm一主手阻尼矩阵；Xm主手位置向量；Kf一力增益矩阵。从手的动力学方程和控制策略
13、为：了产矽+.Cm-AJ 十Kg-X（4）式中：Fe从手与环境之间的作用力向量；T s驱动从手的力向量；Ms从 手质量矩阵；Bs从手阻尼矩阵；Xs从手位置向量；Kv一速度增益矩阵；Kp 位置增益矩阵。对于环境有：E= WeFK+KnE+R】)(6)式中：Me一环境质量矩阵；Be一环境阻尼矩阵；Xe一环境位置向量；Ke一环境刚度矩阵。对于通讯环节，假设T1为前向传输时延，T2为反向时延，则有:xs（i）=xf（-r）+Xm（h）-）（7）不仍 fG-rp （s）式中：Gx一位置控制器运算函数；Gf力控制器运算函数。对于上述这种控制策略，当从手自由运动时，系统为开环位置控制，当接 触病人开始手术操
14、作时，力控制环闭合。考虑主从侧都采用简便有效的PID控 制，当采用积分控制时，相当于在复平面S 的左半平面加入一个实极点，虽然 可以改善力反馈的稳态精度，但降低了系统的稳态裕度，鲁棒性差，对机器人 的非线性动力学特性更为敏感，易产生超调和振荡，不利于操作者的临场感。 对于比例控制，加大比例增益可以减小稳态误差，改善系统性能，增加系统的 带宽，加快系统的响应速度，减小了过渡过程时间，随着比例增益的提高，两 条根轨迹将进入盾平面的正半平面，系统将失稳。因此，选择适当的控制器 增益，就是在系统响应性能和稳定性之间的折衷。物体的刚度的变化也对系统 的稳定性和性能具有明显的影响，过高的物体刚度也会使系统
15、变得不稳定。微 分控制能够预测偏差，产生超前的校正作用，它有助于减少超调，克服振荡， 使系统趣于稳定，并能加快系统的动作速度，减少调整时间，从而改善系统的 动态性能，但由于存在传感器噪声，微分作用不宜过大。通过以上分析，这里 采用PD控制。以上从理论上分析了新型主从双向控制方法应用在医疗机器人中的可行 性，建立并分析了这种控制方法的动力学模型。通过分析得出控制方法的各个 参数、主从手的结构参数以及时延的大小之间存在互相制约的关系。在主手结 构已经确定的情况下，通过对PD控制器参数的合理配置可以获得理想的透明 性。3.4主从手坐标变换主手的结构与从手相对应，自由度数目和运动耦合方式相同；但是，由于 主从手之间运动比率的存在，不能直接通过主手各关节的运动参数信号来控制 从手的各个关节的运动量，必须经过坐标变换后才能正确控制。下面根据主从 手各关节的对应关系和运动范围来建立这个变换矩阵。主从手的自由度和运动 形式相同，所以建立的坐标系也相同。主手关节参数可表示为A = 9；,砖,9；,妇从手关节参数可表示为B =印冉，S&F式中,，.，?.分别代表从手的3个转动参数；土：代表轴向平动参数；分别代表主手的3个转动参数；4；:代表轴向平动参数。通过设
