当前位置: 首页 > 专利查询>同济大学专利>正文

远程操纵系统用操纵反力模拟及控制系统技术方案

技术编号:11135186 阅读:125 留言:0更新日期:2015-03-12 11:29
本发明专利技术公开了一种远程操纵系统用操纵反力模拟及控制系统,包括操纵机构、位置传感器、力传感器、反力模拟机构、功率驱动、控制器,其特征在于:位置传感器和力传感器分别对操纵机构的当前操纵位移和操纵力进行检测,控制器接收位置传感器信号和力传感器信号,同时实现操纵反力的计算、反力模拟控制算法和指令力闭环控制,并将电压控制信号输出给功率驱动模块以实现对操纵反力的模拟。本发明专利技术在不基于远程操纵系统执行机构的前提下,通过对操纵机构反力模拟控制算法的设计,即可实现对包括任意幅值摩擦力在内的任意操纵反力的真实模拟。

【技术实现步骤摘要】

本专利技术属于机械操纵
,具体涉及远程操纵系统操纵反力模拟技术。
技术介绍
远程操纵系统正广泛应用于工业生产与日常生活领域,如远程手术、远程机器人操纵以及应用在汽车、飞机等交通工具上的线控技术等。远程操纵系统通常包含操纵机构以及执行机构,操纵机构作为与操纵人员直接互相作用的接口,其除了起到接收操纵人员的操纵指令作用外,还起到为操纵人员提供必要的操纵反力作用,以增强操纵人员的临场感觉。操纵机构内部通常装有位置传感器和力(力矩)传感器,以及用以提供操纵反力的反力模拟机构,反力模拟机构对反力模拟效果的好坏,将直接影响到操纵人员的操纵感觉;此外,反力模拟机构往往还要求操纵力特性有较好的可调节性,以满足操纵人员不同的操纵体验。现有远程操纵系统的操纵机构反力模拟方法主要有两种,一种是基于执行机构实际执行力(力矩)的方法,即通过对反力模拟的控制将实际执行机构的执行力(力矩)复现出来;另一种是基于模型的计算反力模拟方法,即将操纵机构的操纵位置作为模型的输入信号,将通过模型计算得到的反力(力矩)作为反力模拟机构的指令力(力矩)。第一种方法基于实际的执行机构,其对反力模拟的可调节性往往大打折扣,不能实现任意的操纵力特性模拟;而第二种方法所基于的系统模型中往往包含摩擦模型,对摩擦操纵反力进行模拟时,由于摩擦模型的非线性特性,常会带来操纵机构的力(力矩)抖动、系统振荡、系统响应速度慢等问题,给操纵人员的操纵体验带来负面影响。专利技术内容本专利技术的目的是提供一种能够不需要实际执行机构,仅利用反力模拟机构以及反力模拟控制算法,来实现对包括任意幅值摩擦力在内的任意操纵力特性的良好模拟。为了达到以上目的,本专利技术的技术方案是:一种远程操纵系统用操纵反力模拟及控制系统,包括操纵机构、位置传感器、速度传感器(亦可采用位置传感器信号微分等方式来替代)、力传感器、反力模拟机构、功率驱动、控制器。位置传感器和力传感器分别对操纵机构的当前操纵位移和操纵力进行检测,控制器接收位置传感器信号和力传感器信号,同时实现包括操纵反力的计算、反力模拟控制算法和指令力闭环控制的功能,并将电压控制信号输出给功率驱动模块以实现对操纵反力的模拟。控制器内部操纵力矩计算模块用以实现操纵力特性的计算功能,将操纵力特性分解为刚度项和摩擦项,并可通过对可调力特性参数进行修改实现任意形状的操纵力特性,通过接收到的操纵机构位置信号,输出操纵力的刚度项和摩擦项的计算值。其中,操纵力特性指操纵机构的操纵力与位置和速度的关系。可调操纵力特性根据距离操纵机构中间位置的远近可分为三个区域:区域1(操纵机构总体可操纵距离三分之一以内范围区域)、区域2(操纵机构总体可操纵距离三分之一至三分之二范围区域)和区域3(操纵机构总体可操纵距离三分之二以外范围区域);可调操纵力特性的计算主要包括分布在这三个区域的七个可调参数,通过对这七个参数的调整便可以实现任意的操纵力特性,这七个参数主要是:①区域1内的操纵力特性的比例值K1:表示区域1内操纵力矩相对于操纵位移的变化率,即操纵力矩对方向盘角度的偏导数值;②区域1内的操纵力特性的摩擦力值F1:表示区域1内操纵力矩中的摩擦力值,即操纵力矩值上限与下限值之差的一半;③区域2内的操纵力特性的比例值K2:表示区域2内操纵力矩相对于操纵位移的变化率,即操纵力矩对方向盘角度的偏导数值;④区域3内的操纵力特性的比例值K3:表示区域3内操纵力矩相对于操纵位移的变化率,即操纵力矩对方向盘角度的偏导数值;⑤区域3内的操纵力特性的摩擦力值F3:表示区域3内操纵力矩中的摩擦力值,即操纵力矩值上限与下限值之差的一半;⑥操纵机构远离中间位置过程中的转折位置x2:表示操纵机构逐渐远离中间位置而进入到区域3的一个转折位置;⑦操纵机构返回中间位置过程中的转折位置x1:表示操纵机构由远离中间位置的区域逐渐返回中间位置而进入区域1的一个转折位置。控制器内部的反力模拟控制算法模块的主要功能在于,其接收到操纵机构位置信号、力信号和设计操纵力信号值,在对系统稳定性能、扰动抑制性能和系统带宽性能进行分析的基础上,进行控制算法设计,并输出指令力值,实现对包括任意幅值摩擦操作反力在内的任意操纵力的模拟,主要包括基于摩擦力模型和鲁棒控制的方法(控制方案1)和基于扰动观测器和零速闭环的方法(控制方案2)。所述的控制方案1:通过在刚度项操纵力后加校正环节抑制操纵机构返回中位时产生的抖动现象;通过低通滤波或者其他滤波方法计算得到操纵机构位移速度;基于渐变型的摩擦力模型以及操纵机构位移速度信号得到期望操纵摩擦力值;通过鲁棒控制器解决摩擦力模型引起的力抖动、带宽响应以及系统稳定性的矛盾,将校正环节与鲁棒控制器的输出相加,作为最终的目标指令力值。所述的控制方案2:通过低通滤波或者其他滤波方法计算得到操纵机构位移速度;通过比例控制器对目标操纵机构位移速度进行零速控制;根据操纵机构位移速度和力传感器信号进行基于扰动观测器方法的力补偿计算;通过操纵机构位置信号,结合设计的操纵力特性,计算出反力模拟机构输出反力的上下限,并送入限幅环节;限幅环节的输出作为最终的目标指令力值。由于采用了以上技术方案,本专利技术的有益效果是:本专利技术在不基于远程操纵执行机构的前提下,通过对操纵机构的反力模拟机构以及反力模拟控制算法的设计,即可实现对包括任意幅值摩擦力在内的任意操纵反力的真实模拟,从而在降低系统成本的同时增加了反力模拟系统的灵活性和适用范围。附图说明图1是本专利技术实施例远程操纵系统用操纵反力模拟系统的结构示意图。图2是本专利技术实施例汽车线控转向系统方向盘操纵反力模拟系统的结构示意图。图3是任意可调操纵力特性原理图。图4是基于摩擦力模型和鲁棒控制的反力模拟控制算法框图。图5是加入校正环节前后的系统开环bode图。图6是基于操纵机构位移速度的渐变型摩擦力模型原理图。图7是广义被控对象搭建和鲁棒控制器求解框图。图8是基于扰动观测器和零速闭环控制的反力模拟控制算法框图。图9是基于扰动观测器和零速闭环控制的反力模拟控制算法的具体实现图。图10是系统模型发生摄动时对系统开环bode图影响的分析图。图11是由驾驶员操纵得到的方向盘转角信号图。图12是基于摩擦力模型和鲁棒控制得到的不同设计摩擦力幅值情况下方向盘操纵摩擦力矩模拟效果图。图13是基于扰动观测器和零速闭环控制得到的不同设计摩擦力幅值情况下方向盘操纵摩擦力矩模拟效果图。图14是基于摩擦力模型和鲁棒控制得到的本文档来自技高网...
远程操纵系统用操纵反力模拟及控制系统

【技术保护点】
一种远程操纵系统用操纵反力模拟及控制系统,包括操纵机构、位置传感器、力传感器、反力模拟机构、功率驱动、控制器,其特征在于:位置传感器和力传感器分别对操纵机构的当前操纵位移和操纵力进行检测,控制器接收位置传感器信号和力传感器信号,同时实现操纵反力的计算、反力模拟控制算法和指令力闭环控制,并将电压控制信号输出给功率驱动模块以实现对操纵反力的模拟。

【技术特征摘要】
1.一种远程操纵系统用操纵反力模拟及控制系统,包括操纵机构、位置传感器、力传感
器、反力模拟机构、功率驱动、控制器,其特征在于:位置传感器和力传感器分别对操纵机构
的当前操纵位移和操纵力进行检测,控制器接收位置传感器信号和力传感器信号,同时实现操
纵反力的计算、反力模拟控制算法和指令力闭环控制,并将电压控制信号输出给功率驱动模块
以实现对操纵反力的模拟。
2.根据权利要求1所述的远程操纵系统用操纵反力模拟及控制系统,其特征在于:所述
控制器的操纵反力的计算包括:将操纵力特性分解为刚度项和摩擦项,并可通过对可调操纵力
特性的参数进行修改实现任意形状的操纵力特性,通过接收到的操纵机构位置信号,输出操纵
力的刚度项和摩擦项的计算值;其中,操纵力特性指操纵机构的操纵力与位置的关系。
3.根据权利要求2所述的远程操纵系统用操纵反力模拟及控制系统,其特征在于:所述
可调操纵力特性的参数是指:可调操纵力特性根据距离操纵机构中间位置的远近可分为三个区
域:区域(1)、区域(2)和区域(3);
其中:区域(1)是操纵机构总体可操纵距离三分之一以内范围区域;区域(2)是指操纵
机构总体可操纵距离三分之一至三分之二范围区域;区域(3)是指操纵机构总体可操纵距离
三分之二以外范围区域;
可调操纵力特性的计算包括分布在这三个区域的七个可调参数,通过对这七个参数的调整
便可以实现任意的操纵力特性。
4.根据权利要求3所述的远程操纵系统用操纵反力模拟及控制系统,其特征在于:所述
七个参数包括:
①区域(1)内的操纵力特性的比例值K1:表示区域(1)内操纵力矩相对于操纵位移的
变化率,即操纵力矩对方向盘角度的偏导数值;
②区域(1)内的操纵力特性的摩擦力值F1:表示区域(1)内操纵力矩中的摩擦力值,即
操纵力矩值上限与下限值之差的一半;
③区域(2)内的操纵力特性的比例值K2:表示区域(2)内操纵力矩相对于操纵位移的
变化率,即操纵力矩对方向盘角度的偏导数值;
④区域(3)内的操...

【专利技术属性】
技术研发人员:陈慧李琪
申请(专利权)人:同济大学
类型:发明
国别省市:上海;31

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1