【技术实现步骤摘要】
一种基于速度控制模式的机器人伺服力矩控制方法
本专利技术属于机器人控制技术，具体涉及一种基于速度控制模式的机器人伺服力矩控制方法。
技术介绍
现有的伺服系统中实现力矩控制的方式一般是单独设计力矩控制环路，在力矩控制环路中附加力矩传感器，如图1所示，通过跟踪给定的力矩指令完成力矩控制。使用力矩传感器测量伺服电机输出的力矩大小，采用负反馈与力矩给定比较，将控制误差输入力矩控制器运算生产电机控制量，从而实现伺服系统力矩稳态无误差控制。单独设计力矩控制环路不仅增加了开发时间，同时附加的力矩传感器也增加了机器人的成本。概言之，现有技术对伺服电机的输出力矩的控制是设计单独的力矩控制环路。有鉴于现有技术对伺服电机力矩的控制存在设计开发周期长、成本相对较高的问题，本专利技术提供一种成本相对较低的基于速度控制模式的机器人伺服力矩控制方法，从而实现伺服电机的恒力矩输出。
技术实现思路
本专利技术意在提供一种基于速度控制模式的机器人伺服力矩控制方法，以解决现有技术中存在的不足，本专利技术要解决的技术问题通过以下技术方案来实现。...
【技术保护点】
1.一种基于速度控制模式的机器人伺服力矩控制方法，包括速度控制系统环路，其特征在于：通过在速度控制系统环路的PI控制器后增加一个可调节阈值的饱和器，当PI控制器输出的控制量达到饱和器上、下限阈值时，速度控制模式进入恒力矩控制模式从而实现伺服电机的恒力矩输出。/n
【技术特征摘要】
1.一种基于速度控制模式的机器人伺服力矩控制方法，包括速度控制系统环路，其特征在于：通过在速度控制系统环路的PI控制器后增加一个可调节阈值的饱和器，当PI控制器输出的控制量达到饱和器上、下限阈值时，速度控制模式进入恒力矩控制模式从而实现伺服电机的恒力矩输出。
2.根据权利要求1所述的方法，其特征在于：将饱和器的阈值大小设定为跟随期望给定力矩值的变化而变化，定义伺服电机顺时针转动为正，逆时针转动为负，速度控制系统的速度给定值和饱和器阈值的设置满足以下关系：
其中Tup和Tdown分别为饱和器的上、下限阈值，Wset为速度控制系统的速度给定值，T*和|Wlimit|分别为用户期望给定的力矩值和速度边界限定值，|Wlimit|是防止伺服电机飞车的最大速度值，Tlimit是当伺服电机出现飞车时能及时实现转速控制的反向控制力矩值，Tlimit不受饱和器的限制；其中的问号为条件运算符，表示根据问号前的条件表达式选择冒号两...
【专利技术属性】
技术研发人员：杨跞，袁小敏，程小猛，陈宏伟，许楠，
申请(专利权)人：中科新松有限公司，
类型：发明
国别省市：上海;31
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。