CN113507239B - 一种无物理刹车爬壁机器人用驱动***及方法 - Google Patents
一种无物理刹车爬壁机器人用驱动***及方法 Download PDFInfo
- Publication number
- CN113507239B CN113507239B CN202110804060.9A CN202110804060A CN113507239B CN 113507239 B CN113507239 B CN 113507239B CN 202110804060 A CN202110804060 A CN 202110804060A CN 113507239 B CN113507239 B CN 113507239B
- Authority
- CN
- China
- Prior art keywords
- module
- max
- robot
- current
- input
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 20
- 230000005484 gravity Effects 0.000 claims abstract description 11
- 238000004364 calculation method Methods 0.000 claims description 22
- 238000006243 chemical reaction Methods 0.000 claims description 12
- 230000009194 climbing Effects 0.000 claims description 8
- 238000001179 sorption measurement Methods 0.000 claims description 7
- 239000003638 chemical reducing agent Substances 0.000 claims description 6
- 230000033001 locomotion Effects 0.000 claims description 5
- 238000004458 analytical method Methods 0.000 claims description 4
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 230000002159 abnormal effect Effects 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000009471 action Effects 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 238000007789 sealing Methods 0.000 claims description 3
- 238000011105 stabilization Methods 0.000 claims description 2
- 238000006467 substitution reaction Methods 0.000 claims 1
- 239000003990 capacitor Substances 0.000 description 8
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 5
- 229910052744 lithium Inorganic materials 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 230000033228 biological regulation Effects 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000004146 energy storage Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000001105 regulatory effect Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/005—Arrangements for controlling doubly fed motors
-
- 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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/08—Arrangements for controlling the speed or torque of a single motor
-
- 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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/24—Arrangements for stopping
-
- 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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/28—Arrangements for controlling current
-
- 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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/30—Arrangements for controlling the direction of rotation
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提供了一种无物理刹车爬壁机器人用驱动***及方法，驱动***组成包括第一减法器、速度外环积分器、开/闭环控制切换模块、第二减法器、电流内环积分器、九轴IMU传感器、前馈补偿量估算模块、第一加法器、第三减法器、脉宽矢量调制模块、三相电压逆变器、无物理刹车BLDC模块、减速机及车轮模块、三相电流采集模块、模数转换与计算模块、光电编码器模块和转速估算模块。本发明采用设计的算法估计前馈重力补偿量，对给定开关频率PWM以及电机转向进行适时修正，进而解决了现有无物理刹车驱动***自稳定难的问题，通过引入的改进抗饱和算法改善了***鲁棒性差的问题。
Description
技术领域
发明涉及机器人控制领域，具体涉及一种无物理刹车爬壁机器人用驱动***及方法。
背景技术
负压吸附式爬壁机器人的动力***大多采用电机直驱方案，其电机和配套驱动***的性能直接决定了机器人的机动性能。车载的电池为整机供能，若采用交流电机提供动力，需要经过逆变器和DC-DC变换，中间损耗大，不利于机器人续航。
为此，应用直流无刷电机降低爬壁机器人制造成本并提高整体续航能力，是市场大势所趋。绝大多数的设计者通过加装物理刹车的方式防止静止时机器人滑移，不仅大大增加了机器人的重量，也对所需的驱动力和电池为代表的关键部件提出了更为苛刻的考验。现有的爬壁机器人用无物理刹车驱动***又存在稳定性差，在自稳定、换向过程中容易发生失滑的现象。
因此，亟需对现有技术进行改进。
发明内容
针对搭载直流无刷电机提供动能的爬壁机器人驱动***，本发明提供了一种无物理刹车爬壁机器人用驱动***，通过设计的算法估计前馈重力补偿量，对给定开关频率PWM以及电机转向进行适时修正，通过引入的改进抗饱和算法改善了***鲁棒性差的问题。
本发明解决其技术问题所采用的技术方案是：
一种无物理刹车爬壁机器人用驱动***：包括第一减法器、速度外环积分器、开/闭环控制切换模块、第二减法器、电流内环积分器、九轴IMU传感器、前馈补偿量估算模块、第一加法器、第三减法器、脉宽矢量调制模块、三相电压逆变器、无物理刹车BLDC模块、减速机及车轮模块、三相电流采集模块、模数转换与计算模块、光电编码器模块和转速估算模块；
主控***将设定的目标转速
输入第一减法器中；
第一减法器计算得到目标转速
和实际转速
的差值Δω输入到速度外环积分器中；
速度外环积分器根据差值Δω进行比例积分计算得到闭环q轴电流
输入到开/闭环控制切换模块中；
速度外环积分器计算得到闭环q轴电流
输入到开/闭环控制切换模块中；
开/闭环控制切换模块通过计算当前无物理刹车BLDC模块的最大扭矩Tmax得到阈值电流Imax，根据设定的开环q轴电流
闭环q轴电流
无物理刹车BLDC模块实时功率和相电流以及实际转角
计算得到q轴电流设定值
并输入到第二减法器中；
第二减法器计算设定q轴电流值
与实际电流值iq的差值Δiq输入到电流内环积分器中；
电流内环积分器根据差值Δiq进行比例积分计算得到控制目标的给定空间电压矢量幅值u0输入到第一加法器中；
九轴IMU传感器用于测算机器人行驶夹角θ并输入到前馈补偿量估算模块中；
前馈补偿量估算模块根据输入的行驶夹角θ和机器人尺寸、重量信息计算需要补偿的前置量up+输入到第一加法器中，计算当前无物理刹车BLDC模块的最大负载功率Pmax和最大扭矩Tmax输入到开/闭环控制切换模块中；
第一加法器对需要补偿的前置量up+和电压矢量幅值u0作和得到输出的空间电压矢量的幅值Uref输入到第三减法器中；
第三减法器根据输入的空间电压矢量幅值Uref计算和最大幅值umax差值的占比输入到改进型抗饱和器，改进型抗饱和器用于调节和输出最终的空间电压矢量幅值Uref到脉宽矢量调制模块中；
脉宽矢量调制模块根据输入的空间电压矢量幅值Uref和无物理刹车BLDC模块的实际转角
计算得到六路调制PWM，并将其输入到三相电压逆变器中，当电刹车无法支持机器人自稳或匀速下移时，脉宽矢量调制模块会调节输出新的六路调制PWM，改变电机的转向，反转产生制动力矩；
三相电压逆变器产生最终的驱动电流输入到无物理刹车BLDC模块中；
无物理刹车BLDC模块以对应的转速转向带动减速机及车轮模块的运动，使得爬壁机器人在壁面上完成各种运动；
三相电流采集模块采集得到对应的三相电流iA、iB和iC输入到模数转换与计算模块中；
模数转换与计算模块根据测得的三相电流iA、iB和iC计算得到实际q轴电流值输入到第二减法器中；
光电编码器模块测量无物理刹车BLDC模块的实际转角
输入到开/闭环控制切换模块、前馈补偿量估算模块、脉宽矢量调制模块和转速估算模块中；
转速估算模块根据输入的无物理刹车BLDC模块实际转角
计算得到实时转速
并输入到第一减法器中。
本发明还提供了一种无物理刹车爬壁机器人用驱动方法，其中开/闭环控制切换模块的实现方法，包括如下步骤：
第一步：根据输入的最大扭矩Tmax计算得到阈值电流Imax；
第二步：对无物理刹车BLDC模块的实时功率P和相电流I进行计算；
第三步：根据实时功率P、相电流I和最大负载功率Pmax、阈值电流Imax的比较，判断进一步的工作模式；
状态1：机器人正常启动阶段(实时功率P≤Pmax,实时相电流I≤Imax，电机运行圈数≤10)，进入速度开环控制模式，开/闭环控制切换模块输出设定的q轴开环小电流
运行稳定后(实时功率P≤Pmax,实时相电流I≤Imax，电机运行圈数＞10)，进入速度闭环控制模式，开/闭环控制切换模块输出计算得到的q轴闭环电流
状态2：不正常启动阶段(不满足实时功率P≤Pmax且实时相电流I≤Imax时)，进一步判断情况，当实时功率P≤Pmax且相电流I＞Imax时，进行***过流模式，自动发送锁存命令停机报警，当实时功率P＞Pmax且相电流I≤Imax时，进入堵转运行模式，如果堵转时间t＜tmax，重新估算无物理刹车BLDC模块的实时功率P和相电流I，如果堵转时间t≥tmax，则进行堵转停机报警。
所述前馈补偿量估算模块的实现方法，包括如下步骤：
第一步：根据公式(1)和(2)得到无物理刹车BLDC模块的最大负载功率Pmax和最大扭矩Tmax输入到开/闭环控制切换模块中；
式中n为无物理刹车BLDC模块的实时转速，m0为机器人总重量，g为重力加速度，r为车轮外半径；
第二步：计算前置反馈系数Kθ，根据光电编码器模块测得的无物理刹车BLDC模块实时转角
代入公式(3)计算得到前置反馈系数Kθ，当机器人准备下移、转向或者自稳定时进行前馈补偿，否则不进行前馈补偿；
第三步：根据达朗贝尔虚功原理，建立机器人以任意姿态直线运动时的力平衡方程；
式中N1、N2、N3、N4分别为壁面对车轮1、2、3、4的反作用力，Fp1为负压所产生的贴紧力，Ffyo为爬壁机器人驱动摩擦力，Ff3为墙壁对密封裙的摩擦力，G为机器人受到的重力，-Ma为虚构的惯性力；
得到作用的负压吸附力满足公式(5)；
式中μ1、μ2分别为左驱动轮系和右驱动轮系的摩擦系数，恒定不变；
在公式(5)分别代入机器人几何尺寸参数H(重心离壁面高度)、L(机器人长度)和B(宽度)，得到满足条件的最小负压吸附力为：
第四步：根据试验测得的负压-转速的数学模型(公式(7))，结合力学分析结果，代入公式(8)；
Fp1(x)＝p1n2+p2n+p3 (7)
式中p1、p2、p3分别为不同的常系数；
求解得到转速n；
结合前面得到的前置反馈系数Kθ代入公式(10)，得到前置量up+；
式中Kf为转速和空间矢量电压幅值间的比例系数。
作为对本发明一种无物理刹车爬壁机器人用驱动方法的改进：空间电压矢量幅值Uref积分抗饱和器的实现方法，包括以下步骤：
第一步：定义积分饱和深度δu＝(Uref-umax)/umax×100％，设定阀值常数β；
第二步：求算补偿系数，当0＜δu＝(Uref-umax)/umax×100％≤β时，即饱和深度在阀值以内，采用传统反计算跟踪补偿算法给电流内环积分器一个负反馈补偿(Kc×(δu-β))，使饱和深度δu降低至0；
当δu＝(Uref-umax)/umax×100％＞β时，空间电压矢量幅值Uref处于深度饱和状态，此时应调整补偿系数Kc，使饱和深度δu降低至阀值常数β，那么Uref＝(1+β)×umax，则有如下关系；
可得到补偿系数Kc；
式中Kp为常系数；
由于积分时间常数Ti极小，KpTiδu-Tiumax(1+β)＜＜Kpδu，故上式可简化为：
第三步：确定最终输出Uref，补偿系数Kc的调节规则为：
确定空间电压矢量幅值Uref抗积分饱和补偿后的最终输出；
本发明的有益效果主要表现在：
(1)利用设计的算法估计出装置的重力补偿量，通过前置反馈的方法对电机控制的给定开关频率PWM进行适时修正，在不增加物理刹车机构的前提下，解决了现有无物理刹车驱动***自稳定难的问题，保证了爬壁机器人在壁面工作的安全性；
(2)由于爬壁机器人在壁面下移时，开关控制量会因为***的误差的积分累加作用无限增大，超出执行器的执行阈值，故引入了改进的抗饱和算法，在临界区改变误差的方向，使得控制量逐步减小，从而退出饱和区，改善其动态响应性能；
(3)当机器人的质量超过电刹车能响应的稳定范围值时，算法会自动改变电机的转向，反转产生制动力矩，从而实现下移过程的平滑控制，降低了整体驱动***的硬件成本，可以搭载更多检测设备，提高了续航能力和应用上限。
附图说明
图1是本发明无物理刹车爬壁机器人用驱动***的***框图。
图2是无物理刹车爬壁机器人用单电机驱动电路的简化示意图。
图3是无物理刹车爬壁机器人用驱动方法和软件流程图。
图4是任意姿态机器人运动状态受力分析的示意图。
图5是实验测得的负压与转速关系和拟合曲线的示意图。
具体实施方式
下面结合具体实施例对本发明作进一步描述。
实施例1，一种无物理刹车爬壁机器人用驱动***，如图1所示，包括第一减法器(1)、速度外环积分器(2)、开/闭环控制切换模块(3)、第二减法器(4)、电流内环积分器(5)、九轴IMU传感器(6)、前馈补偿量估算模块(7)、第一加法器(8)、第三减法器(9)、脉宽矢量调制模块(10)、三相电压逆变器(11)、无物理刹车BLDC模块(12)、减速机及车轮模块(13)、三相电流采集模块(14)、模数转换与计算模块(15)、光电编码器模块(16)和转速估算模块(17)；
主控***将设定的目标转速
输入第一减法器(1)中；
第一减法器(1)计算得到目标转速
和实际转速
的差值Δω输入到速度外环积分器(2)中；
速度外环积分器(2)根据差值Δω进行比例积分计算得到闭环q轴电流
输入到开/闭环控制切换模块(3)中；
开/闭环控制切换模块(3)通过计算当前无物理刹车BLDC模块(12)的最大扭矩Tmax得到阈值电流Imax，根据设定的开环q轴电流
闭环q轴电流
无物理刹车BLDC模块(12)实时功率和相电流以及实际转角
计算得到q轴电流设定值
并输入到第二减法器(4)中；
第二减法器(4)计算设定q轴电流值
与实际电流值iq的差值Δiq输入到电流内环积分器(5)中；
电流内环积分器(5)根据差值Δiq进行比例积分计算得到控制目标的给定空间电压矢量幅值u0输入到第一加法器(8)中；
九轴IMU传感器(6)用于测算机器人行驶夹角θ并输入到前馈补偿量估算模块(7)中；
前馈补偿量估算模块(7)根据输入的行驶夹角θ和机器人尺寸、重量信息计算需要补偿的前置量up+输入到第一加法器(8)中，计算当前无物理刹车BLDC模块(12)的最大负载功率Pmax和最大扭矩Tmax输入到开/闭环控制切换模块(3)中；
第一加法器(8)对需要补偿的前置量up+和电压矢量幅值u0作和得到输出的空间电压矢量的幅值Uref输入到第三减法器(9)中；
第三减法器(9)根据输入的空间电压矢量幅值Uref计算和最大幅值umax差值的占比输入到改进型抗饱和器，改进型抗饱和器用于调节和输出最终的空间电压矢量幅值Uref到脉宽矢量调制模块(10)中；
脉宽矢量调制模块(10)根据输入的空间电压矢量幅值Uref和无物理刹车BLDC模块(12)的实际转角
计算得到六路调制PWM，并将其输入到三相电压逆变器(11)中，当电刹车无法支持机器人自稳或匀速下移时，脉宽矢量调制模块(10)会调节输出新的六路调制PWM，改变电机的转向，反转产生制动力矩；
三相电压逆变器(11)产生最终的驱动电流输入到无物理刹车BLDC模块(12)中；
无物理刹车BLDC模块(12)以对应的转速转向带动减速机及车轮模块(13)的运动，使得爬壁机器人在壁面上完成各种运动；
三相电流采集模块(14)采集得到对应的三相电流iA、iB和iC输入到模数转换与计算模块(15)中；
模数转换与计算模块(15)根据测得的三相电流iA、iB和iC计算得到实际q轴电流值输入到第二减法器(4)中；
光电编码器模块(16)测量无物理刹车BLDC模块(12)的实际转角
输入到开/闭环控制切换模块(3)、前馈补偿量估算模块(7)、脉宽矢量调制模块(10)和转速估算模块(17)中；
转速估算模块(17)根据输入的无物理刹车BLDC模块(12)实际转角
计算得到实时转速
并输入到第一减法器(1)中。
无物理刹车爬壁机器人用单电机驱动电路如图2所示，其组成包括机载36V锂电池电源(21)，控制电路(22)，比较电路(23)，参考电压24V(24)，开关管(25)，续流二极管(26)，电感器(27)、电容(28)和三相电压逆变器(11)；
36V锂电池电源(21)输入到降压回路中去，控制电路(22)用于控制开关(25)的通断来切断/接入36V锂电池电源(21)，比较电路(23)根据参考电压24V(24)和输入电压的大小的比较产生开关的控制信号，当输入电压低于24V时，切断36V锂电池电源(21)的输入。当开关管(25)导通时，储能电感器(27)充电，由36V锂电池电源(21)提供的电流为电容(28)充电。电容(28)维持着输出电压，当续流二极管(26)不工作时，开关管(25)的工作频率很高，因此可以将电感器(27)和电容(28)组成LC滤波电路。当开关管(25)断开的时候，储能电感器(27)通过续流二极管(26)放电。电感器(27)在自身电压高于电容(28)时为电容(28)充电。电容(28)维持着输出电压，随着电容(28)自身电荷量的减小，输出电压也会逐渐降低。三相电压逆变器(11)根据脉宽矢量调制模块(10)输入的PWM信号和输入电流信号，调制后输出驱动电机的三相电流iA、iB和iC。
开/闭环控制切换模块(3)的实现方法如图3所示，包括如下步骤：
第一步：根据输入的最大扭矩Tmax计算得到阈值电流Imax；
第二步：对无物理刹车BLDC模块(12)的实时功率P和相电流I进行计算；
第三步：根据实时功率P、相电流I和最大负载功率Pmax、阈值电流Imax的比较，判断进一步的工作模式；
状态1：机器人正常启动阶段(实时功率P≤Pmax,实时相电流I≤Imax，电机运行圈数≤10)，进入速度开环控制模式，开/闭环控制切换模块(3)输出设定的q轴开环小电流
运行稳定后(实时功率P≤Pmax,实时相电流I≤Imax，电机运行圈数＞10)，进入速度闭环控制模式，开/闭环控制切换模块(3)输出计算得到的q轴闭环电流
状态2：不正常启动阶段(不满足实时功率P≤Pmax且实时相电流I≤Imax时)，进一步判断情况，当实时功率P≤Pmax且相电流I＞Imax时，进行***过流模式，自动发送锁存命令停机报警，当实时功率P＞Pmax且相电流I≤Imax时，进入堵转运行模式，如果堵转时间t＜tmax，重新估算无物理刹车BLDC模块(12)的实时功率P和相电流I，如果堵转时间t≥tmax，则进行堵转停机报警。
前馈补偿量估算模块(8)的实现方法如图3所示，包括如下步骤：
第一步：根据公式(1)和(2)得到无物理刹车BLDC模块(12)的最大负载功率Pmax和最大扭矩Tmax输入到开/闭环控制切换模块(3)中；
式中n为无物理刹车BLDC模块(12)的实时转速，m0为机器人总重量，g为重力加速度，r为车轮外半径；
第二步：计算前置反馈系数Kθ，根据光电编码器模块(16)测得的无物理刹车BLDC模块(12)实时转角
代入公式(3)计算得到前置反馈系数Kθ，当机器人准备下移、转向或者自稳定时进行前馈补偿，否则不进行前馈补偿；
第三步：根据达朗贝尔虚功原理，建立机器人以任意姿态直线运动时(如图4所示)的力平衡方程；
式中N1、N2、N3、N4分别为壁面对车轮1、2、3、4的反作用力，Fp1为负压所产生的贴紧力，Ffyo为爬壁机器人驱动摩擦力，Ff3为墙壁对密封裙的摩擦力，G为机器人受到的重力，-Ma为虚构的惯性力；
得到作用的负压吸附力满足公式(5)；
式中μ1、μ2分别为左驱动轮系和右驱动轮系的摩擦系数，恒定不变；
在公式(5)分别代入机器人几何尺寸参数H(重心离壁面高度)、L(机器人长度)和B(宽度)，得到满足条件的最小负压吸附力为：
第四步：根据试验测得的负压-转速的数学模型(如图5和公式(7)所示)，结合力学分析结果，代入公式(8)；
Fp1(x)＝p1n2+p2n+p3 (7)
式中p1、p2、p3分别为不同的常系数；
求解得到转速n；
结合前面得到的前置反馈系数Kθ代入公式(10)，得到前置量up+；
式中Kf为转速和空间矢量电压幅值间的比例系数。
空间电压矢量幅值Uref抗饱和的实现方法如图3所示，包括如下步骤：
第一步：定义积分饱和深度δu＝(Uref-umax)/umax×100％，设定阀值常数β；
第二步：求算补偿系数，当0＜δu＝(Uref-umax)/umax×100％≤β时，即饱和深度在阀值以内，采用传统反计算跟踪补偿算法给电流内环积分器一个负反馈补偿(Kc×(δu-β))，使饱和深度δu降低至0；
当δu＝(Uref-umax)/umax×100％＞β时，空间电压矢量幅值Uref处于深度饱和状态，此时应调整补偿系数Kc，使饱和深度δu降低至阀值常数β，那么Uref＝(1+β)×umax，则有如下关系；
可得到补偿系数Kc；
式中Kp为常系数；
由于积分时间常数Ti极小，KpTiδu-Tiumax(1+β)＜＜Kpδu，故上式可简化为：
第三步：确定最终输出Uref，补偿系数Kc的调节规则为：
确定空间电压矢量幅值Uref抗积分饱和补偿后的最终输出；
最后，还需要注意的是，以上列举的仅是本发明的若干个具体实施例。显然，本发明不限于以上实施例，还可以有许多变形。本领域的普通技术人员能从本发明公开的内容直接导出或联想到的所有变形，均应认为是本发明的保护范围。
Claims (4)
1.一种无物理刹车爬壁机器人用驱动***，其特征在于：包括第一减法器(1)、速度外环积分器(2)、开/闭环控制切换模块(3)、第二减法器(4)、电流内环积分器(5)、九轴IMU传感器(6)、前馈补偿量估算模块(7)、第一加法器(8)、第三减法器(9)、脉宽矢量调制模块(10)、三相电压逆变器(11)、无物理刹车BLDC模块(12)、减速机及车轮模块(13)、三相电流采集模块(14)、模数转换与计算模块(15)、光电编码器模块(16)和转速估算模块(17)；
主控***将设定的目标转速
输入第一减法器(1)中；
第一减法器(1)计算得到目标转速
和实际转速
的差值Δω输入到速度外环积分器(2)中；
速度外环积分器(2)根据差值Δω进行比例积分计算得到闭环q轴电流
输入到开/闭环控制切换模块(3)中；
开/闭环控制切换模块(3)通过计算当前无物理刹车BLDC模块(12)的最大扭矩Tmax得到阈值电流Imax，根据设定的开环q轴电流
闭环q轴电流
无物理刹车BLDC模块(12)实时功率和相电流以及实际转角
计算得到q轴电流设定值
并输入到第二减法器(4)中；
第二减法器(4)计算设定q轴电流值
与实际电流值iq的差值Δiq输入到电流内环积分器(5)中；
电流内环积分器(5)根据差值Δiq进行比例积分计算得到控制目标的给定空间电压矢量幅值u0输入到第一加法器(8)中；
九轴IMU传感器(6)用于测算机器人行驶夹角θ并输入到前馈补偿量估算模块(7)中；
前馈补偿量估算模块(7)根据输入的行驶夹角θ和机器人尺寸、重量信息计算需要补偿的前置量up+输入到第一加法器(8)中，计算当前无物理刹车BLDC模块(12)的最大负载功率Pmax和最大扭矩Tmax输入到开/闭环控制切换模块(3)中；
第一加法器(8)对需要补偿的前置量up+和电压矢量幅值u0作和得到输出的空间电压矢量的幅值Uref输入到第三减法器(9)中；
第三减法器(9)根据输入的空间电压矢量幅值Uref计算和最大幅值umax差值的占比输入到改进型抗饱和器，改进型抗饱和器用于调节和输出最终的空间电压矢量幅值Uref到脉宽矢量调制模块(10)中；
脉宽矢量调制模块(10)根据输入的空间电压矢量幅值Uref和无物理刹车BLDC模块(12)的实际转角
计算得到六路调制PWM，并将其输入到三相电压逆变器(11)中，当电刹车无法支持机器人自稳或匀速下移时，脉宽矢量调制模块(10)会调节输出新的六路调制PWM，改变电机的转向，反转产生制动力矩；
三相电压逆变器(11)产生最终的驱动电流输入到无物理刹车BLDC模块(12)中；
无物理刹车BLDC模块(12)以对应的转速转向带动减速机及车轮模块(13)的运动，使得爬壁机器人在壁面上完成各种运动；
三相电流采集模块(14)采集得到对应的三相电流iA、iB和iC输入到模数转换与计算模块(15)中；
模数转换与计算模块(15)根据测得的三相电流iA、iB和iC计算得到实际q轴电流值输入到第二减法器(4)中；
光电编码器模块(16)测量无物理刹车BLDC模块(12)的实际转角
输入到开/闭环控制切换模块(3)、前馈补偿量估算模块(7)、脉宽矢量调制模块(10)和转速估算模块(17)中；
转速估算模块(17)根据输入的无物理刹车BLDC模块(12)实际转角
计算得到实时转速
并输入到第一减法器(1)中。
2.利用权利要求1所述驱动***的无物理刹车爬壁机器人用驱动方法其特征在于：开/闭环控制切换模块(3)的实现方法如下；
第一步：根据输入的最大扭矩Tmax计算得到阈值电流Imax；
第二步：对无物理刹车BLDC模块(12)的实时功率P和相电流I进行计算；
第三步：根据实时功率P、相电流I和最大负载功率Pmax、阈值电流Imax的比较，判断进一步的工作模式；
状态1：机器人正常启动阶段，进入速度开环控制模式，开/闭环控制切换模块(3)输出设定的q轴开环小电流
运行稳定后，进入速度闭环控制模式，开/闭环控制切换模块(3)输出计算得到的q轴闭环电流
状态2：不正常启动阶段，进一步判断情况，当实时功率P≤Pmax且相电流I＞Imax时，进行***过流模式，自动发送锁存命令停机报警，当实时功率P＞Pmax且相电流I≤Imax时，进入堵转运行模式，如果堵转时间t＜tmax，重新估算无物理刹车BLDC模块(12)的实时功率P和相电流I，如果堵转时间t≥tmax，则进行堵转停机报警。
3.根据权利要求2所述的一种无物理刹车爬壁机器人用驱动方法，其特征在于：前馈补偿量估算模块(7)的实现方法如下；
第一步：根据公式(1)和(2)得到无物理刹车BLDC模块(12)的最大负载功率Pmax和最大扭矩Tmax输入到开/闭环控制切换模块(3)中；
式中n为无物理刹车BLDC模块(12)的实时转速，m0为机器人总重量，g为重力加速度，r为车轮外半径；
第二步：计算前置反馈系数Kθ，根据光电编码器模块(16)测得的无物理刹车BLDC模块(12)实时转角
代入公式(3)计算得到前置反馈系数Kθ，当机器人准备下移、转向或者自稳定时进行前馈补偿，否则不进行前馈补偿；
第三步：根据达朗贝尔虚功原理，建立机器人以任意姿态直线运动时的力平衡方程；
式中N1、N2、N3、N4分别为壁面对车轮1、2、3、4的反作用力，Fp1为负压所产生的贴紧力，Ffyo为爬壁机器人驱动摩擦力，Ff3为墙壁对密封裙的摩擦力，G为机器人受到的重力，-Ma为虚构的惯性力，H为机器人重心离壁面的高度，L为机器人长度，B为机器人宽度；
得到作用的负压吸附力满足公式(5)；
式中μ1、μ2分别为左驱动轮系和右驱动轮系的摩擦系数，恒定不变；
在公式(5)分别代入参数H、L和B，得到满足条件的最小负压吸附力为：
第四步：根据试验测得的负压-转速数学模型，结合力学分析结果，代入公式(8)；
Fp1(x)＝p1n2+p2n+p3 (7)
式中p1、p2、p3分别为不同的常系数；
求解得到转速n；
结合前面得到的前置反馈系数Kθ代入公式(10)，得到前置量up+；
式中Kf为转速和空间矢量电压幅值间的比例系数。
4.根据权利要求2所述的一种无物理刹车爬壁机器人用驱动方法，其特征在于：速度闭环控制模式中加入了改进型抗饱和器；
式中Kc为补偿系数，δu为积分饱和度，β为阀值常数，Kp为常系数，umax为最大幅值，s为虚变量，Ti为积分时间常数；
第三减法器(9)求得积分饱和度δu＝(Uref-umax)/umax×100％，通过公式(11)的补偿系数Kc的调节规则，代入公式(12)确定空间电压矢量幅值Uref抗积分饱和补偿后的最终输出。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110804060.9A CN113507239B (zh) | 2021-07-16 | 2021-07-16 | 一种无物理刹车爬壁机器人用驱动***及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110804060.9A CN113507239B (zh) | 2021-07-16 | 2021-07-16 | 一种无物理刹车爬壁机器人用驱动***及方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113507239A CN113507239A (zh) | 2021-10-15 |
| CN113507239B true CN113507239B (zh) | 2022-05-27 |
Family
ID=78013490
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110804060.9A Expired - Fee Related CN113507239B (zh) | 2021-07-16 | 2021-07-16 | 一种无物理刹车爬壁机器人用驱动***及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113507239B (zh) |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2018099187A1 (zh) * | 2016-11-30 | 2018-06-07 | 广东美的制冷设备有限公司 | 一种电机驱动***的控制方法、控制装置和变频空调器 |
| WO2019106729A1 (ja) * | 2017-11-28 | 2019-06-06 | 日産自動車株式会社 | 電動機の制御方法、及び電動機の制御装置 |
| CN111355260A (zh) * | 2020-02-11 | 2020-06-30 | 北京科诺伟业科技股份有限公司 | 一种全功率变速可逆式抽水蓄能机组变流器功率控制方法 |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| BR112018076680A2 (pt) * | 2016-07-20 | 2019-04-02 | Nsk Ltd. | dispositivo de direção elétrica |
| GB201617387D0 (en) * | 2016-10-13 | 2016-11-30 | Trw Automotive Gmbh | Control system for electric motor circuit |
-
2021
- 2021-07-16 CN CN202110804060.9A patent/CN113507239B/zh not_active Expired - Fee Related
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2018099187A1 (zh) * | 2016-11-30 | 2018-06-07 | 广东美的制冷设备有限公司 | 一种电机驱动***的控制方法、控制装置和变频空调器 |
| WO2019106729A1 (ja) * | 2017-11-28 | 2019-06-06 | 日産自動車株式会社 | 電動機の制御方法、及び電動機の制御装置 |
| CN111355260A (zh) * | 2020-02-11 | 2020-06-30 | 北京科诺伟业科技股份有限公司 | 一种全功率变速可逆式抽水蓄能机组变流器功率控制方法 |
Non-Patent Citations (3)
| Title |
|---|
| Umesh Kumar Soni ; Ramesh Kumar Tripathi.Four quadrant torque ripple free operation of BLDC motor by virtual hall signal transitions at phase back EMF ZDPs.《2017 IEEE PES Asia-Pacific Power and Energy Engineering Conference (APPEEC)》.2017, * |
| 刹车***半物理仿真平台伺服控制***研究;丁宇;《中国优秀硕士学位论文电子期刊 工程科技Ⅱ辑》;20130215(第02期);全文 * |
| 基于扩张状态观测器负载转矩补偿的永磁同步电机全速范围无位置传感器控制;吴春等;《电工技术学报》;20201231;全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113507239A (zh) | 2021-10-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Chaoui et al. | Adaptive interval type-2 fuzzy logic control for PMSM drives with a modified reference frame | |
| US9315114B2 (en) | Device for controlling electric vehicle and method of controlling electric vehicle | |
| JP6402783B2 (ja) | 電動車両の制御装置および電動車両の制御方法 | |
| WO2016189670A1 (ja) | 電動車両の制御装置および電動車両の制御方法 | |
| Lin et al. | Digital signal processor-based probabilistic fuzzy neural network control of in-wheel motor drive for light electric vehicle | |
| CN1809956A (zh) | 用于ac电机的位置无传感器控制算法 | |
| JPWO2015105077A1 (ja) | 電動車両の制御装置および電動車両の制御方法 | |
| CN111173678A (zh) | 一种rbf神经网络俯仰干扰补偿的风力机舱悬浮控制方法 | |
| WO2005093943A1 (ja) | 永久磁石式同期モータの制御装置 | |
| WO2018020679A1 (ja) | 車両の制御方法および制御装置 | |
| CN111769773B (zh) | 无储能设备参与的变频器电压暂降耐受能力提升方法 | |
| Wang et al. | Antirollback control for gearless elevator traction machines adopting offset-free model predictive control strategy | |
| CN112039390A (zh) | 基于负载转矩观测的永磁同步电机滑模控制方法 | |
| CN113507239B (zh) | 一种无物理刹车爬壁机器人用驱动***及方法 | |
| CN109617482B (zh) | 永磁同步电机的l2滑模控制方法 | |
| CN112104279B (zh) | 一种基于非线性终端滑模算法的轮毂电机控制方法 | |
| KR101841769B1 (ko) | 적응형 백스테핑 제어기를 이용한 차량의 ｅｐｓ의 유도전동기 제어 시스템 및 방법 | |
| CN115378325A (zh) | 基于动态权重因子的smpmsm驱动***直接速度复合控制方法 | |
| VK et al. | Online Adaptive Gain for Passivity-Based Control for Sensorless BLDC Motor Coupled With DC Motor for EV Application | |
| Wang et al. | Design on sliding mode controller with adaptive fuzzy compensation for switched reluctance motor drive systems | |
| Ghogare et al. | Speed Control for Brushless DC motor driven vehicle using Disturbance Observer | |
| Defoort et al. | Integral sliding mode antisway control of an underactuated overhead crane system | |
| CN114844404A (zh) | 一种永磁同步电机滑模控制方法 | |
| CN112039389A (zh) | 矿用牵引永磁同步电机驱动控制方法 | |
| JP2001169403A (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 | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20220527 |