CN110995066B - 一种用于游乐设施轨道检测装置的双伺服电机控制方法 - Google Patents

一种用于游乐设施轨道检测装置的双伺服电机控制方法 Download PDF

Info

Publication number
CN110995066B
CN110995066B CN201911331182.XA CN201911331182A CN110995066B CN 110995066 B CN110995066 B CN 110995066B CN 201911331182 A CN201911331182 A CN 201911331182A CN 110995066 B CN110995066 B CN 110995066B
Authority
CN
China
Prior art keywords
servo motor
current feedback
value
control
servo
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201911331182.XA
Other languages
English (en)
Other versions
CN110995066A (zh
Inventor
宋伟科
沈功田
李加申
张琨
李璟
景阳
崔宏伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
China Special Equipment Inspection and Research Institute
Original Assignee
China Special Equipment Inspection and Research Institute
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by China Special Equipment Inspection and Research Institute filed Critical China Special Equipment Inspection and Research Institute
Priority to CN201911331182.XA priority Critical patent/CN110995066B/zh
Publication of CN110995066A publication Critical patent/CN110995066A/zh
Application granted granted Critical
Publication of CN110995066B publication Critical patent/CN110995066B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
    • H02P5/46—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Control Of Multiple Motors (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

本发明公开了一种用于游乐设施轨道检测装置的双伺服电机控制方法，使用两部电机分别驱动左右两侧的驱动轮，其中伺服电机一为主、伺服电机二为从，伺服电机二工作在扭矩模式下，根据伺服电机一的电流反馈值来调整伺服电机二的输出扭矩，使二者的电流反馈值接近，从而确保二者工作状态相近，避免二者之间出现较近的情况，结构简单、响应速度快、可靠性高、灵活性好，能有效、稳定地控制游乐设施轨道检测装置的行走，更好地实现游乐设施轨道检测装置对轨道的全面检测。

Description

一种用于游乐设施轨道检测装置的双伺服电机控制方法
技术领域
本发明涉及一种伺服电机的控制方法，尤其是一种控制游乐设施轨道检测装置中的双伺服电机的方法。
背景技术
游乐设施轨道检测装置通过在沿设施轨道行走的车辆上搭载摄像头、超声波测厚仪、涡流探伤仪等检测仪器，实现对游乐设施轨道的宏观检测、壁厚检测和裂纹检测等功能。
游乐设施轨道通常为并行的两组，车辆的左右驱动轮分别沿对应侧的轨道行走。传统的电机驱动控制方法应用到该类轨道车辆上，存在以下问题：无论是左右驱动轮由同一电机经过差速传动机构进行驱动，还是分别由两部电机独立驱动，都存在两侧车轮相互较劲的问题——即左右车轮与轨道间的相对运动状态不一致，最终导致车辆行走不稳定、甚至无法正常行走的情况出现，严重影响检测工作的进行。
发明内容
本发明提出了一种用于游乐设施轨道检测装置的双伺服电机控制方法，其目的是：确保左右驱动轮与轨道间的相对运动状态一致，避免相互较劲的现象出现。
本发明技术方案如下：
一种用于游乐设施轨道检测装置的双伺服电机控制方法，使用伺服电机一与伺服电机二分别控制驱动轮一与驱动轮二转动，并将伺服电机二设置为扭矩控制模式；
控制伺服电机一转动，并获取伺服电机一的电流反馈值，依据伺服电机一的电流反馈值对伺服电机二施行扭矩控制。
作为本方法的进一步改进：对伺服电机二施行扭矩控制时，还要实时获取伺服电机二的电流反馈值，并求取伺服电机一与伺服电机二的电流反馈值的差值，再依据该差值控制伺服电机二的输出扭矩，控制目标为伺服电机一与伺服电机二的电流反馈值相等。
作为本方法的进一步改进：通过PID算法对伺服电机二的输出扭矩进行控制。
作为本方法的进一步改进：设伺服电机一与伺服电机二的电流反馈值的差值e=I1-I2，I1为伺服电机一的电流反馈值，I2为伺服电机二的电流反馈值，当e>0时，PID算法中的比例系数Kp根据e的大小调整——e值越小则Kp越小，以降低系统静态误差，减弱波动。
作为本方法的进一步改进：当e<0时，通过PID算法中的积分环节，降低系统静态误差。
作为本方法的进一步改进：所述伺服电机一工作于速度控制模式。
相对于现有技术，本发明具有以下有益效果：（1）本发明使用两部电机分别驱动左右两侧的驱动轮，其中伺服电机一为主、伺服电机二为从，伺服电机二工作在扭矩模式下，根据伺服电机一的电流反馈值来调整伺服电机二的输出扭矩，使二者的电流反馈值接近，从而确保二者工作状态相近，避免二者之间出现较近的情况，确保车辆稳定运行，框架结构简单、灵活；（2）采用PID算法，依据伺服电机一和二的电流反馈值之差对伺服电机二进行控制，响应速度快、可靠性高、灵活性好；（3）当e>0时，PID算法中的比例系数Kp根据e的大小调整，e值越小则Kp越小，从而在伺服电机二的扭矩接近伺服电机一时，减缓伺服电机二的输出扭矩提升速度，降低系统静态误差，减弱波动；（4）PID算法中的积分环节可以进一步有效消除比例调节所带来的静态偏差。
附图说明
图1为双伺服电机控制系统的结构示意图。
图2为本控制方法的流程示意图。
具体实施方式
下面结合附图详细说明本发明的技术方案：
一种用于游乐设施轨道检测装置的双伺服电机控制方法，采用如图1所示的控制系统来控制游乐设施轨道检测装置车辆的行走。
该控制系统包括人机交互模块、地面核心控制器、无线控制模块、车载核心控制器、现场总线模块、伺服驱动器一、伺服电机一、编码器一、同步带一、驱动轮一、伺服驱动器二、伺服电机二、编码器二、同步带二和驱动轮二。
操作人员通过所述人机交互模块控制所述地面核心控制器，所述地面核心控制器通过所述无线控制模块将控制指令传输给所述车载核心控制器，所述车载核心控制器通过所述现场总线模块将数据传输给所述伺服驱动器一和所述伺服驱动器二。
所述伺服驱动器一控制所述伺服电机一，所述伺服电机一输出轴通过同步带一带动驱动轮一转动，所述编码器一用于检测所述伺服电机一的转速。同时，所述伺服驱动器一将所述伺服电机一的实时电流反馈值通过所述现场总线模块反馈给所述车载核心控制器。
所述伺服驱动器二控制所述伺服电机二，所述伺服电机二输出轴通过同步带二带动驱动轮二转动，所述编码器二用于检测所述伺服电机二的转速。同时，所述伺服驱动器二将所述伺服电机二的实时电流反馈值通过所述现场总线模块反馈给所述车载核心控制器。
本实施例中，所述人机交互模块是型号为CC-10的触摸屏；所述地面核心控制器的型号为2080-LC20-20QBB；所述无线控制模块的型号为WLAN 5100和WLAN 1100；所述车载核心控制器的型号为1769-L16ER；所述现场总线模块的型号为1734-232ASC；所述伺服驱动器的型号为DCPC-048-50-OP-E；所述伺服电机的型号为D110M-0600 30B-E。
基于上述控制系统的控制方法，核心在于：所述伺服电机一工作于速度控制模式，伺服电机二工作于扭矩控制模式，依据伺服电机一的电流反馈值对伺服电机二施行扭矩控制。
如图2，通过所述人机交互模块设置所述伺服电机一的初始速度，伺服电机一转动，且车载核心控制器将伺服电机一的电流反馈值写入伺服驱动器二，使伺服电机二以该设定的初始电流值运行。开始运行后，所述车载核心控制器实时读取所述伺服电机一和伺服电机二的电流反馈值，求取伺服电机一与伺服电机二的电流反馈值的差值，再依据该差值通过PID算法求得伺服电机二的控制量，将控制量赋值至伺服驱动器二，实现伺服电机二的扭矩控制。PID算法的控制目标为伺服电机一与伺服电机二的电流反馈值相等，即两部电机的输出扭矩基本接近，使二者工作状态相近，从而避免相互较劲的情况。
具体的，设伺服电机一与伺服电机二的电流反馈值的差值e=I1-I2，I1为伺服电机一的电流反馈值，I2为伺服电机二的电流反馈值。伺服驱动器二中的PID模块以e为输入，输出0-10V模拟量控制伺服电机二的扭矩。当e>0时，PID算法中的比例系数Kp会根据e的大小调整——e值越小则Kp越小，从而在伺服电机二的扭矩接近伺服电机一时，减缓伺服电机二的输出扭矩提升速度，以降低系统静态误差，减弱波动。另一方面，通过PID算法中的积分环节，可以进一步消除比例调节所带来的静态偏差。
具体工作步骤如下：
（1）操作人员通过人机交互模块输入伺服电机一的运行速度，并选择前进或后退功能，地面核心控制器写入控制指令，并通过无线控制模块传输给车载核心控制器，进而将此数据通过现场总线模块写入伺服驱动器一；
（2）操作人员通过人机交互模块按下启动按钮，伺服电机一以设定方向及速度开始运行；
（3）伺服驱动器一将伺服电机一的初始电流反馈值通过现场总线模块反馈给车载核心控制器，车载核心控制器通过计算将电流值变换为电压值输出到伺服驱动器二，伺服驱动器二将其转换为电流值控制伺服电机二启动运行；对伺服电机二进行初始电流值赋值的目的是：避免直接采用PID控制导致伺服电机二的控制量瞬间增大引起系统振荡，完成两台电机的起步运行后，再过渡到PID控制阶段；
（4）运行过程中，车载核心控制器根据伺服电机一和伺服电机二的电流反馈差值，通过PID调节实时计算伺服电机二的控制量，并赋值到伺服驱动器二，调整伺服电机二的输出扭矩及加速度。当伺服电机二的电流反馈值接近所述伺服电机一时，调整扭矩增加速率（Kp），避免伺服电机二的扭矩超过伺服电机一，当伺服电机二的扭矩超出伺服电机一时，通过积分调节降低偏差，确保伺服电机一和伺服电机二的扭矩值接近，最终避免发生较劲现象；
（5）游乐设施轨道检测装置实现稳定行走，对轨道全面检测，检测完成后，操作人员通过人机交互模块按下停止按钮，伺服电机一和伺服电机二停止运行，游乐设施轨道检测装置停机。
以上所述，仅为本发明的具体实施方式，熟悉本领域的技术人员在本发明揭露的范围内，可轻易想到的变化，都应涵盖在发明的保护范围之内。

Claims (2)

1.一种用于游乐设施轨道检测装置的双伺服电机控制方法，其特征在于：使用伺服电机一与伺服电机二分别控制驱动轮一与驱动轮二转动，并将伺服电机二设置为扭矩控制模式；
控制伺服电机一转动，并获取伺服电机一的电流反馈值，依据伺服电机一的电流反馈值对伺服电机二施行扭矩控制；
对伺服电机二施行扭矩控制时，还要实时获取伺服电机二的电流反馈值，并求取伺服电机一与伺服电机二的电流反馈值的差值，再依据该差值控制伺服电机二的输出扭矩，控制目标为伺服电机一与伺服电机二的电流反馈值相等；
通过PID算法对伺服电机二的输出扭矩进行控制；
设伺服电机一与伺服电机二的电流反馈值的差值e=I1-I2，I1为伺服电机一的电流反馈值，I2为伺服电机二的电流反馈值；当e>0时，PID算法中的比例系数Kp根据e的大小调整——e值越小则Kp越小，以降低系统静态误差，减弱波动；当e<0时，通过PID算法中的积分环节，降低系统静态误差。
2.如权利要求1所述的用于游乐设施轨道检测装置的双伺服电机控制方法，其特征在于：所述伺服电机一工作于速度控制模式。
CN201911331182.XA 2019-12-21 2019-12-21 一种用于游乐设施轨道检测装置的双伺服电机控制方法 Active CN110995066B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911331182.XA CN110995066B (zh) 2019-12-21 2019-12-21 一种用于游乐设施轨道检测装置的双伺服电机控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911331182.XA CN110995066B (zh) 2019-12-21 2019-12-21 一种用于游乐设施轨道检测装置的双伺服电机控制方法

Publications (2)

Publication Number Publication Date
CN110995066A CN110995066A (zh) 2020-04-10
CN110995066B true CN110995066B (zh) 2021-04-13

Family

ID=70073926

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911331182.XA Active CN110995066B (zh) 2019-12-21 2019-12-21 一种用于游乐设施轨道检测装置的双伺服电机控制方法

Country Status (1)

Country Link
CN (1) CN110995066B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112986819A (zh) * 2021-02-23 2021-06-18 山西太钢不锈钢股份有限公司 一种判断多伺服电机驱动一台设备各电机状态的方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102510120A (zh) * 2011-11-23 2012-06-20 中国科学院电工研究所 一种基于虚拟阻抗的微网逆变器电压电流双环下垂控制方法
CN103929103A (zh) * 2014-04-04 2014-07-16 烟台鲁宝钢管有限责任公司 一种大功率直流电机双并驱动的可控硅整流装置
CN104827458A (zh) * 2015-04-28 2015-08-12 山东鲁能智能技术有限公司 一种机械臂力觉临场感的主从遥操作控制系统及方法
CN105429540A (zh) * 2015-12-08 2016-03-23 南京埃斯顿自动控制技术有限公司 一种基于模型跟踪控制的交流伺服电机振动抑制方法
CN108233823A (zh) * 2018-01-23 2018-06-29 南京理工大学 一种耦合控制结构下多电机伺服驱动系统的容错比例协调控制方法
CN208602482U (zh) * 2018-08-22 2019-03-15 中国特种设备检测研究院 一种沿游乐设施轨道主动行走的轨道检测装置

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101782758B (zh) * 2010-03-19 2011-11-23 东华大学 一种纤维生产线上多级牵伸环节的智能协同控制器及其方法
CN101826830A (zh) * 2010-03-29 2010-09-08 陕西蒲白三通有限公司 带式输送机四机驱动功率平衡系统及功率平衡方法
CN102364866A (zh) * 2011-11-17 2012-02-29 河海大学 一种光伏发电系统的最大功率点跟踪方法
JP6287756B2 (ja) * 2014-10-24 2018-03-07 株式会社デンソー モータ制御装置
CN104391444B (zh) * 2014-12-10 2016-09-07 福州大学 一种基于离散系统改进单神经元的pid整定方法
CN104617824A (zh) * 2014-12-29 2015-05-13 深圳市轴心自控技术有限公司 双伺服电机同步的控制方法及系统
CN107277959A (zh) * 2017-06-27 2017-10-20 天津掌心众联科技有限公司 一种基于pid控制的电磁加热系统及方法
CN107678276B (zh) * 2017-08-15 2020-07-14 北京航天控制仪器研究所 一种基于转台控制的自适应复合控制方法
CN109986173B (zh) * 2019-04-16 2021-08-06 深圳市麦格米特焊接技术有限公司 一种双电机协同控制方法、装置、电机控制器和送丝系统

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102510120A (zh) * 2011-11-23 2012-06-20 中国科学院电工研究所 一种基于虚拟阻抗的微网逆变器电压电流双环下垂控制方法
CN103929103A (zh) * 2014-04-04 2014-07-16 烟台鲁宝钢管有限责任公司 一种大功率直流电机双并驱动的可控硅整流装置
CN104827458A (zh) * 2015-04-28 2015-08-12 山东鲁能智能技术有限公司 一种机械臂力觉临场感的主从遥操作控制系统及方法
CN105429540A (zh) * 2015-12-08 2016-03-23 南京埃斯顿自动控制技术有限公司 一种基于模型跟踪控制的交流伺服电机振动抑制方法
CN108233823A (zh) * 2018-01-23 2018-06-29 南京理工大学 一种耦合控制结构下多电机伺服驱动系统的容错比例协调控制方法
CN208602482U (zh) * 2018-08-22 2019-03-15 中国特种设备检测研究院 一种沿游乐设施轨道主动行走的轨道检测装置

Also Published As

Publication number Publication date
CN110995066A (zh) 2020-04-10

Similar Documents

Publication Publication Date Title
CN106184199B (zh) 分布式控制电动汽车稳定性的集成控制方法
CN106227189B (zh) 一种双轴驱动电动汽车硬件在环测试系统同步控制方法
CN104160617B (zh) 电动机控制装置
CN108189038A (zh) 一种实用的工业六轴机械臂直线运动轨迹规划方法及系统
CN201646432U (zh) 一种电动汽车的运动控制器
CN107187446A (zh) 电动车辆的巡航控制方法及装置
CN102904521A (zh) 具有同时推定惯量、摩擦和弹性的功能的电动机控制装置
CN109765485B (zh) 基于转矩控制模式下的电机制动测试系统及方法
CN103076752B (zh) 舵机控制器、舵机控制方法以及控制系统
CN110995066B (zh) 一种用于游乐设施轨道检测装置的双伺服电机控制方法
CN101499755A (zh) 一种直流电机速度pid控制系统及其控制方法
CN102152767B (zh) 全方位移动平台
CN109795343A (zh) 一种基于轮边分布式电动汽车的联合控制方法及其装置
CN106335807B (zh) 一种纸箱印刷机送纸机构的控制方法
CN105034853A (zh) 一种减小电动汽车定速巡航速度波动的控制系统及方法
CN106394560A (zh) 一种轮毂驱动电动汽车底盘协调控制系统
CN103345195A (zh) 双捻机中钢帘线的独立控制方法及系统
CN108275033A (zh) 纯电动汽车防溜坡控制装置及其控制方法
CN108776432B (zh) 基于网络的机场跑道检测机器人预测控制方法
WO2024120045A1 (zh) 一种交流传动机车的速度控制方法
CN211685387U (zh) 一种具有扫查功能的爬壁机器人的控制系统
CN111705859B (zh) 推土机转向控制方法和系统
CN106143263B (zh) 驱动控制系统和集装箱和/或车辆检查载车
CN106608202A (zh) 一种电动汽车行驶协调智能控制方法及系统
JP2012507404A (ja) スクリュープレス用二重加力ラム駆動装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant