利索能及
我要发布
收藏
专利号: 2022104711331
申请人: 燕山大学
专利类型:发明专利
专利状态:已下证
更新日期:2026-06-16
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种冗余自由度遥操作机器人主‑从双向控制方法,其特征在于:

S1、主端三维力传感器测得主端机械手上主手力Fm,主手力Fm经过A/D转换器转换成数字信号再经过放大电路Km放大后输入至力调整器,力调整器对数字信号处理之后将处理后的数字信号输入到从端控制器,之后数字信号经过D/A转换器转换成电流信号输入给从端机械手的伺服电机进而驱动从端机械手运动;

S2、从端机械手的绝对值编码器测得从端机械手关节转角的角度值并经过A/D转换器转换后得到从端机械手关节位移qs,所述主端机械手的绝对值编码器测得的主端操纵手柄的转角经过A/D转换器转换和放大电路Km放大,再经过逆运动学计算得到主端机械手关节位移qm,所述主端机械手关节位移qm与从端机械手关节位移qs作差得到位差信号eq,所述位差信号eq经过从端控制器输出给D/A转换器后控制从端机械手伺服电机工作进而驱动从端机械手运动,所述位差信号eq经过归一化处理得到归一化位差eq′后输入到T‑S反馈增益中;

S3、归一化位差eq′经过T‑S反馈增益得到反馈增益Kef的数值,将归一化位差eq′与反馈增益Kef的乘积作为输入值输入到主端控制器中并输出,所述主端控制器的输出信号经过D/A转换器输入给主端机械手的伺服电机进而驱动主端机械手运动;

其中,位差信号eq归一化得到归一化位差eq′,归一化位差eq′的计算公式如下:

式中:eq′为归一化位差值;eqmin为最小位差值;eqmax为最大位差值;

所述归一化位差eq′论域上定义三个相互交叠的模糊子集:S、M、B;

所述T‑S反馈增益采用T‑S模糊映射,所述T‑S反馈增益的模糊映射的规则为:

①if(归一化位差is S)then(反馈增益Kef is 1.5);

②if(归一化位差is M)then(反馈增益Kef is 1.0);

③if(归一化位差is B)then(反馈增益Kef is 0.5)。

2.根据权利要求1所述的冗余自由度遥操作机器人主‑从双向控制方法,其特征在于:

所述模糊子集S和B采用高斯隶属度函数,设置参数分别为[0.075 0]和[0.075 1],所述模糊子集M采用梯形隶属度函数,设置参数为[0.06 0.16 0.84 0.94]。

3.根据权利要求1所述的冗余自由度遥操作机器人主‑从双向控制方法,其特征在于:

所述T‑S反馈增益模糊映射采用代数积‑加权平均判别法,得到T‑S型模糊反馈增益Kef的非线性化曲线,其中,Kef的值Z的计算公式如下:

式中:ω1为第一隶属度函数值;ω2为第二隶属度函数值;ω3为第三隶属度函数值;z1为第一隶属度函数值对应的反馈增益Kef值;z2为第二隶属度函数值对应的反馈增益Kef值;z3为第三隶属度函数值对应的反馈增益Kef值;z为最终输出的反馈增益Kef的值。

4.一种用于权利要求1所述的冗余自由度遥操作机器人主‑从双向控制方法的控制系统,其特征在于:其包括主端机械手、计算机控制单元和从端机械手,所述主端机械手具有两个相互垂直方向的转动自由度,所述主端机械手包括操纵手柄、三维力传感器、伺服电机和绝对值编码器,所述三维力传感器、伺服电机和绝对值编码器均安装在所述主端机械手的操作手柄,所述从端机械手的旋转关节具有四个转动自由度,所述从端机械手的旋转关节处固定安装有伺服电机和绝对值编码器,所述计算机控制单元包括相互通信连接的主端控制器、计算模块、T‑S反馈增益单元、力调整器和从端控制器;

所述三维力传感器的输出端借助于A/D转换器连接所述力调整器的输入端,所述主端机械手的绝对值编码器的输出端借助于A/D转换器连接所述计算模块的输入端,所述计算模块的输出端分别连接所述T‑S反馈增益单元和所述力调整器的输入端,所述力调整器的输出端连接所述从端控制器的输入端,所述从端控制器的输出端借助于D/A转换器连接所述从端机械手的伺服电机的输入端,所述T‑S反馈增益单元的输出端连接所述主端控制器的输入端,所述主端控制器的输出端借助于D/A转换器连接所述主端机械手的伺服电机的输入端。

5.根据权利要求4所述的控制系统,其特征在于:所述主端机械手的三维力传感器、伺服电机和绝对值编码器借助于安装框架进行安装。

6.根据权利要求4所述的控制系统,其特征在于:所述计算模块用于计算归一化位差eq′。