CN110333652A - 车型巡检机器人的过弯控制方法 - Google Patents

车型巡检机器人的过弯控制方法 Download PDF

Info

Publication number
CN110333652A
CN110333652A CN201910335275.3A CN201910335275A CN110333652A CN 110333652 A CN110333652 A CN 110333652A CN 201910335275 A CN201910335275 A CN 201910335275A CN 110333652 A CN110333652 A CN 110333652A
Authority
CN
China
Prior art keywords
vehicle
crusing robot
speed
angle regulating
road
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.)
Pending
Application number
CN201910335275.3A
Other languages
English (en)
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.)
State Grid Xinjiang Electric Power Co Ltd Akesu Power Supply Co
State Grid Corp of China SGCC
Original Assignee
State Grid Xinjiang Electric Power Co Ltd Akesu Power Supply Co
State Grid Corp of China SGCC
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 State Grid Xinjiang Electric Power Co Ltd Akesu Power Supply Co, State Grid Corp of China SGCC filed Critical State Grid Xinjiang Electric Power Co Ltd Akesu Power Supply Co
Priority to CN201910335275.3A priority Critical patent/CN110333652A/zh
Publication of CN110333652A publication Critical patent/CN110333652A/zh
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00Automatic controllers
    • G05B11/01Automatic controllers electric
    • G05B11/36Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
    • G05B11/42Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明涉及一种巡检机器人控制技术领域,是一种车型巡检机器人的过弯控制方法,包括以下步骤:第一步获取当前位置下车型巡检机器人车身在跑道上的偏差量;第二步角度调节单元依据偏差量计算输出指令,并根据输出指令生成控制转向轮的PWM驱动信号;第三步速度调节单元依据角度调节单元的输出指令计算速度指令,并根据速度指令生成控制驱动轮的PWM驱动信号。本发明在不增设硬件设备的前提下,实现了角度调节单元的自适应控制,以及角度调节单元与速度调节单元之间的协调过弯控制,保证了车型巡检机器人在不同巡检路径弯道曲率下均能稳定过弯,抑制了车型巡检机器人的过弯侧滑现象。

Description

车型巡检机器人的过弯控制方法
技术领域
本发明涉及一种巡检机器人控制技术领域,是一种车型巡检机器人的过弯控制方法。
背景技术
随着机器人的应用规模不断扩大,机器人代替人工的趋势也越加明显,车型巡检机器人以其体积小、智能化控制、效率高、可靠性高,减少人工带电作业安全隐患等优点,已成为变电站的无人值守、自动巡检的关键角色,在变电站中正在得到越加广泛的应用。
车型巡检机器人进行巡检时,在车型巡检机器人巡检路径的曲率变化范围较大的情况下,固定的车型巡检机器人舵机控制参数往往难以适应所有路况,而且舵机PID控制器的微分环节也极易引入噪声干扰,此外,在车型巡检机器人转弯时,如果车型巡检机器人的两个后驱电机没有采取差速控制措施,车型巡检机器人极容易发生侧滑现象。
现有针对车型巡检机器人在不同弯道曲率路况下的调整控制方法,多为通过对行驶路径进行优化,提出相应的路径平滑规划算法,以提高其稳定移动能力,或者车型机器人的后驱双电机的差速参数进行了优化整定;上述方法存在计算公式复杂,计算量大,也没有将后驱双电机的差速参数与舵机的转向控制相协调的问题,并且在更复杂的路况下车型机器人仍然存在噪声干扰、参数适应范围较窄的问题。
发明内容
本发明提供了一种车型巡检机器人的过弯控制方法,克服了上述现有技术之不足,其能有效解决现有车型巡检机器人的过弯控制方法中存在角度调节与速度调节不能相配合,造成过弯侧滑的问题。
本发明的技术方案是通过以下措施来实现的:一种车型巡检机器人的过弯控制方法,包括以下步骤:
第一步,根据跑道的中心值,获取当前位置下车型巡检机器人车身在跑道上的偏差量Road_error;
第二步,角度调节单元依据偏差量Road_error计算输出指令,并根据输出指令生成控制转向轮的PWM驱动信号,其中角度调节单元用于控制车型巡检机器人的转向轮;
第三步,速度调节单元依据角度调节单元的输出指令计算速度指令,并根据速度指令生成控制驱动轮的PWM驱动信号,其中速度调节单元用于控制车型巡检机器人的驱动轮。
下面是对上述发明技术方案的进一步优化或/和改进:
上述角度调节单元包括PID控制器,第二步中角度调节单元计算输出指令包括以下步骤:
(一)计算角度调节单元中PID控制器的比例系数Kp,计算公式如下:
Kp=Kp2+Kp1×(Road_error×Road_error)
其中,Kp1和Kp2分别为二次项系数和常数项;
(二)角度调节单元根据偏差量Road_error和比例系数Kp计算输出指令。
上述在角度调节单元根据偏差量Road_error和比例系数Kp计算输出指令时,在PID控制器的微分环节中附加一个一阶惯性控制环节,则角度调节单元通过下式计算输出指令;
其中,τi和τd1为PID控制器的积分时间常数和微分时间常数,τd2是微分控制环节中所附加的一阶惯性控制环节的时间常数。
上述第三步中速度调节单元依据角度调节单元的输出指令计算速度指令包括以下步骤:
(一)计算角度调节单元的输出指令的占空比duty;
(二)速度调节单元通过下式计算差速比例值Speed_error;
其中,dutymax为角度调节单元输出指令的占空比的最大值,Kf为差速系数;
(三)速度调节单元根据差速比例值Speed_error,计算速度指令。
上述速度调节单元包括内轮驱动电机和外轮驱动电机,则速度指令包括内轮驱动电机的速度指令Speed_in*和外轮驱动电机的速度指令Speed_out*,其计算公式如下:
其中,Speed_set是整个车型巡检机器人的设定速度。
上述S1中根据跑道的中心值,获取当前位置下车型巡检机器人车身在跑道上的偏差量Road_error包括以下步骤:
(一)获取前方跑道的左边沿信息Road_L和右边沿信息Road_R;
(二)根据下式计算车身当前所处位置信息Location;
(三)预先设置跑道的中心值Road_set;
(四)计算当前位置下车型巡检机器人车身的偏差量Road_error,计算公式如下:
Road_error=Location-Road_set。
上述角度调节单元可包括舵机及舵机控制***;速度调节单元可包括电机控制***和驱动电机组。
本发明在不增设硬件设备的前提下,角度调节单元根据当前位置下车型巡检机器人车身在跑道上的偏差量,自适应地改变自身的角度控制参数,同时速度调节单元通过角度调节单元的调整结果自适应的获取速度调节单元的差速指令,从而使角度调节单元和速度调节单元相互配合,保证车型巡检机器人在不同巡检路径弯道曲率下均能稳定过弯,抑制了车型巡检机器人的过弯侧滑现象。
附图说明
附图1为本发明实施例1的流程图。
附图2为本发明实施例1角度调节单元计算输出指令的流程图。
附图3为本发明实施例1速度调节单元计算速度指令的流程图。
附图4为本发明实施例1获取当前位置下车型巡检机器人车身在跑道上的偏差量的流程图。
附图5为本发明实施例2不加入一阶惯性控制的车型巡检机器人舵机PID控制器的响应曲线图。
附图6为本发明实施例2加入一阶惯性控制的车型巡检机器人舵机PID控制器的响应曲线图。
附图7为本发明实施例2不同路况下车型巡检机器人舵机PID控制器的比例系数在不同偏差量下的变化曲线图。
具体实施方式
本发明不受下述实施例的限制,可根据本发明的技术方案与实际情况来确定具体的实施方式。
下面结合实施例及附图对本发明作进一步描述:
实施例1:如附图1所示,该车型巡检机器人的过弯控制方法,包括以下步骤:
第一步,根据跑道的中心值(跑道中心线的位置),获取当前位置下车型巡检机器人车身在跑道上的偏差量Road_error;
第二步,角度调节单元依据偏差量Road_error计算输出指令,并根据输出指令生成控制转向轮的PWM驱动信号,其中角度调节单元用于控制车型巡检机器人的转向轮;
第三步,速度调节单元依据角度调节单元的输出指令计算速度指令,并根据速度指令生成控制驱动轮的PWM驱动信号,其中速度调节单元用于控制车型巡检机器人的驱动轮。
上述角度调节单元的输出指令可为脉冲信号,在计算得到输出指令后,角度调节单元对输出指令进行调制,生成对应控制转向轮的PWM驱动信号,从而控制车型巡检机器人转向轮的角度变化。
其中,角度调节单元可包括舵机及舵机控制***,用于控制车型巡检机器人转向轮的角度;车型巡检机器人的转向轮可为车型巡检机器人的左前轮和右前轮;在舵机控制***中可包括PID控制器;
上述计算出角度调节单元的输出指令后,速度调节单元能根据该输出指令计算得到与之相匹配的速度指令,并对速度指令进行调制生成对应控制驱动轮的PWM驱动信号,从而控制车型巡检机器人驱动轮的速度变化。
其中,速度调节单元可包括电机控制***和多个驱动电机,用于控制车型巡检机器人驱动轮的速度;驱动电机与驱动轮一一对应,若车型巡检机器人的驱动轮为左前轮和右前轮,则需由左前轮驱动电机和右前轮驱动电机。
本发明在不增设硬件设备的前提下,角度调节单元根据当前位置下车型巡检机器人车身在跑道上的偏差量,自适应地改变自身的角度控制参数,同时速度调节单元通过角度调节单元的调整结果自适应的获取速度调节单元的差速指令,从而使角度调节单元和速度调节单元相互配合,保证车型巡检机器人在不同巡检路径弯道曲率下均能稳定过弯,抑制了车型巡检机器人的过弯侧滑现象。
下面是对上述发明技术方案的进一步优化或/和改进:
如附图1、2所示,所述角度调节单元包括PID控制器,所述第二步中角度调节单元计算输出指令包括以下步骤:
(一)计算角度调节单元中PID控制器的比例系数Kp,计算公式如下:
Kp=Kp2+Kp1×(Road_error×Road_error)
其中,Kp1和Kp2分别为二次项系数和常数项;
(二)角度调节单元根据偏差量Road_error和比例系数Kp计算输出指令。
如附图1、2所示,所述在角度调节单元根据偏差量Road_error和比例系数Kp计算输出指令时,在PID控制器的微分环节中附加一个一阶惯性控制环节,则角度调节单元通过下式计算输出指令;
其中,τi和τd1为PID控制器的积分时间常数和微分时间常数,τd2是微分控制环节中所附加的一阶惯性控制环节的时间常数。
上述在PID控制器的微分环节引入了一阶惯性控制环节,能够提高角度调节单元的抗干扰性,从而角度调节单元实现精准的角度控制。
如附图1、3所示,所述第三步中速度调节单元依据角度调节单元的输出指令计算速度指令包括以下步骤:
(一)计算角度调节单元的输出指令的占空比duty(占空比是指在一个脉冲循环内,通电时间相对于总时间所占的比例);
(二)速度调节单元通过下式计算差速比例值Speed_error;
其中,dutymax为角度调节单元输出指令的占空比的最大值,Kf为差速系数;
(三)速度调节单元根据差速比例值Speed_error,计算速度指令。
如附图1、3所示,所述速度调节单元包括内轮驱动电机和外轮驱动电机,则速度指令包括内轮驱动电机的速度指令Speed_in*和外轮驱动电机的速度指令Speed_out*,其计算公式如下:
其中,Speed_set是整个车型巡检机器人的设定速度。
上述内轮驱动电机用于控制车型巡检机器人的内轮;外轮驱动电机用于控制车型巡检机器人的外轮。
如附图1、4所示,所述S1中根据跑道的中心值,获取当前位置下车型巡检机器人车身在跑道上的偏差量Road_error包括以下步骤:
(一)获取前方跑道的左边沿信息Road_L和右边沿信息Road_R;
(二)根据下式计算车身当前所处位置信息Location;
(三)预先设置跑道的中心值Road_set;
(四)计算当前位置下车型巡检机器人车身的偏差量Road_error,计算公式如下:
Road_error=Location-Road_set
如附图1所示,所述角度调节单元包括舵机及舵机控制***;所述速度调节单元包括电机控制***和驱动电机组。其中驱动电机组可包括多个驱动电机,驱动电机的个数需要与驱动轮的个数相对应。
实施例2:设置模拟赛道,赛道的宽度为50cm,使用本发明进行模拟仿真,结果及其分析如下所示:
舵机采用PID控制策略时,不在PID控制器的微分环节加入一阶惯性控制,则其响应结果如附图5所示,使用本发明的方法在PID控制器的微分环节加入一阶惯性控制,其响应结果如附图6所示。
附图5中,舵机在500ms后稳定在参考值附近,而附图6中,舵机在340ms时就已稳定在参考值附近;由此可以看出,PID控制器的微分环节会引入很大的噪声干扰,若在PID控制器的微分环节加入一阶惯性控制,则能抑制微分环节所带来的噪声干扰,从而响应速度得到极大提高。
舵机PID控制器的比例系数在不同偏差量下的变化情如附图7所示,有图可知,当偏差量的绝对值大于5时,随着偏差量的增大,比例系数也在非线性增加,以加快其响应速度以及对较大曲率弯道的适应性,当偏差量的绝对值小于5时,比例系数稳定在一个较小的固定值,以保证其稳定性。
以上技术特征构成了本发明的最佳实施例,其具有较强的适应性和最佳实施效果,可根据实际需要增减非必要的技术特征,来满足不同情况的需求。

Claims (8)

1.一种车型巡检机器人的过弯控制方法,其特征在于包括以下步骤:
第一步,根据跑道的中心值,获取当前位置下车型巡检机器人车身在跑道上的偏差量Road_error;
第二步,角度调节单元依据偏差量Road_error计算输出指令,并根据输出指令生成控制转向轮的PWM驱动信号,其中角度调节单元用于控制车型巡检机器人的转向轮;
第三步,速度调节单元依据角度调节单元的输出指令计算速度指令,并根据速度指令生成控制驱动轮的PWM驱动信号,其中速度调节单元用于控制车型巡检机器人的驱动轮。
2.根据权利要求1所述的车型巡检机器人的过弯控制方法,其特征在于所述角度调节单元包括PID控制器,所述第二步中角度调节单元计算输出指令包括以下步骤:
(一)计算角度调节单元中PID控制器的比例系数Kp,计算公式如下:
Kp=Kp2+Kp1×(Road_error×Road_error)
其中,Kp1和Kp2分别为二次项系数和常数项;
(二)角度调节单元根据偏差量Road_error和比例系数Kp计算输出指令。
3.根据权利要求2所述的车型巡检机器人的过弯控制方法,其特征在于所述在角度调节单元根据偏差量Road_error和比例系数Kp计算输出指令时,在PID控制器的微分环节中附加一个一阶惯性控制环节,则角度调节单元通过下式计算输出指令;
其中,τi和τd1为PID控制器的积分时间常数和微分时间常数,τd2是微分控制环节中所附加的一阶惯性控制环节的时间常数。
4.根据权利要求1所述的车型巡检机器人的过弯控制方法,其特征在于所述第三步中速度调节单元依据角度调节单元的输出指令计算速度指令包括以下步骤:
(一)计算角度调节单元的输出指令的占空比duty;
(二)速度调节单元通过下式计算差速比例值Speed_error;
其中,dutymax为角度调节单元输出指令的占空比的最大值,Kf为差速系数;
(三)速度调节单元根据差速比例值Speed_error,计算速度指令。
5.根据权利要求4所述的车型巡检机器人的过弯控制方法,其特征在于所述速度调节单元包括内轮驱动电机和外轮驱动电机,则速度指令包括内轮驱动电机的速度指令Speed_in*和外轮驱动电机的速度指令Speed_out*,其计算公式如下:
其中,Speed_set是整个车型巡检机器人的设定速度。
6.根据权利要求1至5中任意一项所述的车型巡检机器人的过弯控制方法,其特征在于所述S1中根据跑道的中心值,获取当前位置下车型巡检机器人车身在跑道上的偏差量Road_error包括以下步骤:
(一)获取前方跑道的左边沿信息Road_L和右边沿信息Road_R;
(二)根据下式计算车身当前所处位置信息Location;
(三)预先设置跑道的中心值Road_set;
(四)计算当前位置下车型巡检机器人车身的偏差量Road_error,计算公式如下:
Road_error=Location-Road_set。
7.根据权利要求1至5中任意一项所述的车型巡检机器人的过弯控制方法,其特征在于所述角度调节单元包括舵机及舵机控制***;所述速度调节单元包括电机控制***和驱动电机组。
8.根据权利要求6中任意一项所述的车型巡检机器人的过弯控制方法,其特征在于所述角度调节单元包括舵机及舵机控制***;所述速度调节单元包括电机控制***和驱动电机组。
CN201910335275.3A 2019-04-24 2019-04-24 车型巡检机器人的过弯控制方法 Pending CN110333652A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910335275.3A CN110333652A (zh) 2019-04-24 2019-04-24 车型巡检机器人的过弯控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910335275.3A CN110333652A (zh) 2019-04-24 2019-04-24 车型巡检机器人的过弯控制方法

Publications (1)

Publication Number Publication Date
CN110333652A true CN110333652A (zh) 2019-10-15

Family

ID=68139931

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910335275.3A Pending CN110333652A (zh) 2019-04-24 2019-04-24 车型巡检机器人的过弯控制方法

Country Status (1)

Country Link
CN (1) CN110333652A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113885544A (zh) * 2021-10-12 2022-01-04 中科开创(广州)智能科技发展有限公司 杆塔巡检机器人的控制方法、装置和计算机设备
CN117055639A (zh) * 2023-09-04 2023-11-14 珠海习坎智能科技有限公司 一种隧道巡检机器人自适应控速方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104181922A (zh) * 2014-07-21 2014-12-03 南京航空航天大学 主动扫描式跟踪导引装置、自动导引车及导引控制方法
CN104859661A (zh) * 2015-05-14 2015-08-26 上海理工大学 车辆过弯时间优化算法
CN104890529A (zh) * 2015-06-29 2015-09-09 河南工业大学 一种代步电动汽车
CN208007139U (zh) * 2018-04-07 2018-10-26 吉林大学 一种多适应性轮足切换移动平台

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104181922A (zh) * 2014-07-21 2014-12-03 南京航空航天大学 主动扫描式跟踪导引装置、自动导引车及导引控制方法
CN104859661A (zh) * 2015-05-14 2015-08-26 上海理工大学 车辆过弯时间优化算法
CN104890529A (zh) * 2015-06-29 2015-09-09 河南工业大学 一种代步电动汽车
CN208007139U (zh) * 2018-04-07 2018-10-26 吉林大学 一种多适应性轮足切换移动平台

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
张涛 等: "双后驱智能车控制算法与优化策略研究", 《控制工程》 *
李军 等: "一种高性能PID控制器的研究与工程应用", 《广东电力》 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113885544A (zh) * 2021-10-12 2022-01-04 中科开创(广州)智能科技发展有限公司 杆塔巡检机器人的控制方法、装置和计算机设备
CN117055639A (zh) * 2023-09-04 2023-11-14 珠海习坎智能科技有限公司 一种隧道巡检机器人自适应控速方法
CN117055639B (zh) * 2023-09-04 2024-03-29 珠海习坎智能科技有限公司 一种隧道巡检机器人自适应控速方法

Similar Documents

Publication Publication Date Title
CN110022109B (zh) 转矩-电流神经网络模型srm转矩脉动控制方法与***
US8395345B2 (en) Valve control device
CN102582600B (zh) 基于线控制动***的制动力实时调节方法及调节装置
CN103895832A (zh) 一种船舶电伺服鳍、翼鳍减横摇智能矢量控制方法
CN110333652A (zh) 车型巡检机器人的过弯控制方法
CN111173678B (zh) 一种rbf神经网络俯仰干扰补偿的风力机舱悬浮控制方法
CN112918550A (zh) 一种无人驾驶汽车主动转向***的控制方法及控制***
CN104554255A (zh) 四轮全驱电动汽车底盘主动安全集成控制***动态解耦方法
US7150263B2 (en) Engine speed control apparatus; engine system, vehicle and engine generator each having the engine speed control apparatus; and engine speed control method
CN110729941A (zh) 内置式永磁同步电机的控制方法
CN113183957A (zh) 车辆控制方法、装置、设备及自动驾驶车辆
WO2015139420A1 (zh) 一种开关磁阻电机速度与加速度双闭环控制方法
CN115535066A (zh) 一种高度可调的线控转向***路感模拟装置
CN113090461B (zh) 基于滑模神经网络模型预测的低风速垂直轴风力机悬浮控制方法
CN109217756A (zh) 基于混合人工神经网络参考自适应异步电机矢量控制方法
KR101841769B1 (ko) 적응형 백스테핑 제어기를 이용한 차량의 eps의 유도전동기 제어 시스템 및 방법
CN114859886B (zh) 基于自适应伸缩因子的变论域模糊控制agv纠偏方法
CN108267970B (zh) 基于Smith模型和单神经元PID的时滞转子主动平衡控制***及其方法
CN113765449B (zh) 基于双Sigmod神经网络电感模型的SRM磁链控制***与方法
JP5299256B2 (ja) 車両用左右駆動力調整装置の制御装置
CN114520610A (zh) 伺服驱动器的电机参数自学习模糊控制方法
JP4092456B2 (ja) 制動制御装置
Stork et al. Adaptive control system for autonomous vehicle path following
Salem Mechatronics motion control design of electric machines for desired deadbeat response specifications, supported and verified by new matlab built-in function and simulink model
Huang et al. Cascade optimization control of unmanned vehicle path tracking under harsh driving conditions

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
RJ01 Rejection of invention patent application after publication
RJ01 Rejection of invention patent application after publication

Application publication date: 20191015