CN106452204B - 智能扫雪机器人直线行走控制方法 - Google Patents
智能扫雪机器人直线行走控制方法 Download PDFInfo
- Publication number
- CN106452204B CN106452204B CN201610948096.3A CN201610948096A CN106452204B CN 106452204 B CN106452204 B CN 106452204B CN 201610948096 A CN201610948096 A CN 201610948096A CN 106452204 B CN106452204 B CN 106452204B
- Authority
- CN
- China
- Prior art keywords
- motor
- machines people
- speed
- snow grooming
- rotating speed
- 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
Links
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
- H02P5/50—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 by comparing electrical values representing the speeds
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明公开了一种智能扫雪机器人直线行走控制方法,包括:根据获得电枢电压ua,通过霍尔传感器测量电机的转速n,得到转速n与设定转速的误差,并根据自适应算法得到输出电压的值:ua=‑(kp1+Δkp1)E;以及根据输出电压的值控制电机的电枢电压改变电机的转速。本发明采用自适应PI控制方法对扫雪机器人的左右履带的驱动电机进行调速,让其两边履带驱动电机的速度相同,从而达到控制智能扫雪机器人直线行走的目的,实现了在电机粘滞摩擦系数、电势常数等部分参数未知的情况下,对PI参数进行自整定,以达到所需要的控制效果。
Description
技术领域
本发明涉及智能扫雪机器人技术领域,特别涉及一种智能扫雪机器人的行走控制方法。
背景技术
随着人们生活水平的不断提高,智能家用机器人的应用越来越广泛,而且具有非常广泛的市场前景,传统的扫雪方式主要是以人工控制半自动扫雪机进行,这种扫雪方式效率较低,对人身体的伤害较大,而且成本较高。智能扫雪机器人能够自主运行清扫房屋前的道路的某一区域,在降低成本的同时,大大提高了扫雪效率。
智能扫雪机器人采用的是直流电机驱动履带行走,控制智能扫雪机器人的行走是智能扫雪机器人能够自主运行的前提。根据直流电机的特征可知,通过改变直流电机的电压,即可改变电机的转速,使驱动扫雪机器人两边履带的电机的转速相同,从而能达到控制智能扫雪机器人直线行走的目的。但是,在实际操作中可能会存在电机部分参数未知的情况,如何在电机部分参数未知情况下控制扫雪机器人直线行走,是函待解决的一项技术难题。
发明内容
有鉴于此,本发明的目的是提供一种智能扫雪机器人直线行走控制方法,以实现在电机粘滞摩擦系数、电机电势常数未知的情况下,控制扫雪机器人直线行走。
本发明智能扫雪机器人直线行走控制方法,包括以下步骤:
1)根据:获得电枢电压ua,其中:ia为电枢电流,Ra为电枢回路电阻,la为电枢回路电感,e为电机电枢反电动势;其中e1=cen,ce为电机的电势常数,n为电机转速;
再结合方程:
TL=Cmial,Te=Cmia,其中:J为电机的转动惯量,λ为电机的粘滞摩擦系数,TL为电机的负载转矩,Te为电机的电磁转矩,Cm为电机的转矩常数,ial为对应于负载转矩的负载电流;
得到:
其中:J,Cm,Ra是已知参数;因为是有界的,所以令D(*)是一个干扰项,由于电机的粘滞摩擦系数λ和电势常数ce的值未知,所以令 F(*)为未知项,进而得到:其中,
2)通过霍尔传感器测量电机的转速n,得到转速n与设定转速的误差:e=n-n*,其中:n*是设定转速;
3)根据自适应算法得到并假设一个辅助函数:其中ε是设定的参数,令则有L(*)≤aφ,其中:φ=|n|+1,a=max{F,|H|};
根据自适应算法得到输出电压的值:ua=-(kp1+Δkp1)E,其中,kp1是自己设定的常数,取其中:是的估计值,C1是设定的常数;
4)根据输出电压的值:ua=-(kp1+Δkp1)E控制电机的电枢电压,改变电机的转速n,使驱动扫雪机器人两边履带的电机的转速相同。
本发明的有益效果:
本发明智能扫雪机器人直线行走控制方法,采用自适应PI控制方法对扫雪机器人的左右履带的驱动电机进行调速,让其两边履带驱动电机的速度相同,从而达到控制智能扫雪机器人直线行走的目的,实现了在电机粘滞摩擦系数、电势常数部分参数未知的情况下,对PI参数进行自整定,以达到所需要的控制效果。
附图说明
图1为直流电机的等效电路图。
具体实施方式
下面结合附图和实施例对本发明作进一步描述。
本实施例智能扫雪机器人直线行走控制方法,包括以下步骤:
1)根据:获得电枢电压ua,其中:ia为电枢电流,Ra为电枢回路电阻,la为电枢回路电感,e为电机电枢反电动势;其中e1=cen,ce为电机的电势常数,n为电机转速;
再结合方程:
TL=Cmial,Te=Cmia,其中:J为电机的转动惯量,λ为电机的粘滞摩擦系数,TL为电机的负载转矩,Te为电机的电磁转矩,Cm为电机的转矩常数,ial为对应于负载转矩的负载电流;
得到:
其中:J,Cm,Ra是已知参数;因为是有界的,所以令D(*)是一个干扰项,由于电机的粘滞摩擦系数λ和电势常数ce的值未知,所以令 F(*)为未知项,进而得到:其中,
2)通过霍尔传感器测量电机的转速n,得到转速n与设定转速的误差:e=n-n*,其中:n*是设定转速;
3)根据自适应算法得到并假设一个辅助函数:其中ε是设定的参数,令则有L(*)≤aφ,其中:φ=|n|+1,a=max{F,|H|};
根据自适应算法得到输出电压的值:ua=-(kp1+Δkp1)E,其中,kp1是自己设定的常数,取其中:是的估计值,C1是设定的常数;
4)根据输出电压的值:ua=-(kp1+Δkp1)E控制电机的电枢电压,改变电机的转速n,使驱动扫雪机器人两边履带的电机的转速相同。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (1)
1.智能扫雪机器人直线行走控制方法,其特征在于:包括以下步骤:
1)根据:获得电枢电压ua,其中:ia为电枢电流,Ra为电枢回路电阻,la为电枢回路电感,e1为电机电枢反电动势;其中e1=cen,ce为电机的电势常数,n为电机转速;
再结合方程:
TL=Cmial,Te=Cmia,其中:J为电机的转动惯量,λ为电机的粘滞摩擦系数,TL为电机的负载转矩,Te为电机的电磁转矩,Cm为电机的转矩常数,ial为对应于负载转矩的负载电流;
得到:其中:J,Cm,Ra是已知参数;因为是有界的,所以令D(*)是一个干扰项,由于电机的粘滞摩擦系数λ和电势常数ce的值未知,所以令 F(*)为未知项,进而得到:其中,
2)通过霍尔传感器测量电机的转速n,得到转速n与设定转速的误差:e=n-n*,其中:n*是设定转速;
3)根据自适应算法得到并假设一个辅助函数:其中ε是设定的参数,令则有L(*)≤aφ,其中:φ=|n|+1,a=max{F,|H|};
根据自适应算法得到输出电压的值:其中,kp1是自己设定的常数,取其中:是的估计值,C1是设定的常数,r是设定的常数;
4)根据输出电压的值:控制电机的电枢电压,改变电机的转速n,使驱动扫雪机器人两边履带的电机的转速相同。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610948096.3A CN106452204B (zh) | 2016-10-26 | 2016-10-26 | 智能扫雪机器人直线行走控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610948096.3A CN106452204B (zh) | 2016-10-26 | 2016-10-26 | 智能扫雪机器人直线行走控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106452204A CN106452204A (zh) | 2017-02-22 |
CN106452204B true CN106452204B (zh) | 2018-10-19 |
Family
ID=58177873
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610948096.3A Active CN106452204B (zh) | 2016-10-26 | 2016-10-26 | 智能扫雪机器人直线行走控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106452204B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7136122B2 (ja) * | 2017-12-05 | 2022-09-13 | 日本電産株式会社 | 移動体、および搬送ロボット |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101951209A (zh) * | 2010-07-14 | 2011-01-19 | 北京航空航天大学 | 一种直流电机的高精度正反转控制系统及控制方法 |
CN103036496A (zh) * | 2012-12-12 | 2013-04-10 | 西安理工大学 | 自适应反推控制的永磁同步电机dtc系统及其控制方法 |
CN105915142A (zh) * | 2016-04-18 | 2016-08-31 | 浙江大学 | 一种基于解耦自适应观测器的永磁同步电机转子位置和转速估算方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003175837A (ja) * | 2001-12-11 | 2003-06-24 | Nsk Ltd | 電動パワーステアリング装置の制御装置 |
-
2016
- 2016-10-26 CN CN201610948096.3A patent/CN106452204B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101951209A (zh) * | 2010-07-14 | 2011-01-19 | 北京航空航天大学 | 一种直流电机的高精度正反转控制系统及控制方法 |
CN103036496A (zh) * | 2012-12-12 | 2013-04-10 | 西安理工大学 | 自适应反推控制的永磁同步电机dtc系统及其控制方法 |
CN105915142A (zh) * | 2016-04-18 | 2016-08-31 | 浙江大学 | 一种基于解耦自适应观测器的永磁同步电机转子位置和转速估算方法 |
Non-Patent Citations (2)
Title |
---|
基于指令预处理的机器人平滑运动控制研究;贾梓筠 等;《控制工程》;20130131;第20卷(第1期);63-68 * |
永磁同步电机参数自动辨识方法;薛晓明 等;《微电机》;20160228;第49卷(第2期);74-77 * |
Also Published As
Publication number | Publication date |
---|---|
CN106452204A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103683982B (zh) | 一种宽范围交流电压输入的Buck结构稳压电源 | |
CN109116855B (zh) | 一种移动小车循迹控制方法及系统 | |
CN103303454B (zh) | 一种基于速度环换向的电动舵机装置及其控制方法 | |
CN106452204B (zh) | 智能扫雪机器人直线行走控制方法 | |
CN101277059B (zh) | 电力变换装置 | |
CN106549537A (zh) | 一种电子调速器、永磁同步电机组件以及无人飞行器 | |
CN104579036B (zh) | 双模式驱动方法及装置 | |
CN207664904U (zh) | 一种用于稳定有刷电机旋转速度的电路 | |
CN205018457U (zh) | 拉杆控制电动旅行箱 | |
CN205206702U (zh) | 一种智能百叶窗的电控模块 | |
CN103997260A (zh) | 一种直流电机多边独立驱动行走机构变速及差速控制系统 | |
CN107837497A (zh) | 负重可控的发电健身车系统,调节负重的方法及控制系统 | |
CN207010585U (zh) | 神经元pid自适应无刷直流电机控制系统 | |
CN204605563U (zh) | 四轮独立驱动的电动童车控制器 | |
CN108649852A (zh) | 一种改进电流环的永磁同步电机控制方法 | |
CN205283446U (zh) | 一种高精度步进电机控制器 | |
CN114161942A (zh) | 一种微型电动汽车用双驱轮边开关磁阻电机驱动系统及控制方法 | |
CN202407035U (zh) | 用于密集烤房控制器的风门开度控制装置 | |
CN207884526U (zh) | 一种卷帘门变频控制系统 | |
CN207753643U (zh) | 一种基于无位置传感器的直流无刷电机控制器 | |
CN108403380A (zh) | 一种基于能量回馈的康复运动器材控制系统及控制方法 | |
CN206016449U (zh) | 锁具电子离合器控制系统 | |
CN206364738U (zh) | 电机的调速驱动电路和风扇电机 | |
CN110053662A (zh) | 汽车电动助力转向系统及助力转向控制方法 | |
Ning et al. | Research on Hardware Controller of BLDC Motor Rehabilitation Robot Based on STM32 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |