CN112520581B - 一种提高轮胎式起重机大车运动控制精度的方法及系统 - Google Patents

一种提高轮胎式起重机大车运动控制精度的方法及系统 Download PDF

Info

Publication number
CN112520581B
CN112520581B CN202011398743.0A CN202011398743A CN112520581B CN 112520581 B CN112520581 B CN 112520581B CN 202011398743 A CN202011398743 A CN 202011398743A CN 112520581 B CN112520581 B CN 112520581B
Authority
CN
China
Prior art keywords
cart
speed
given
actual
target position
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
CN202011398743.0A
Other languages
English (en)
Other versions
CN112520581A (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.)
Shanghai Yumo Information Technology Co ltd
Original Assignee
Shanghai Yumo Information Technology Co ltd
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 Shanghai Yumo Information Technology Co ltd filed Critical Shanghai Yumo Information Technology Co ltd
Priority to CN202011398743.0A priority Critical patent/CN112520581B/zh
Publication of CN112520581A publication Critical patent/CN112520581A/zh
Application granted granted Critical
Publication of CN112520581B publication Critical patent/CN112520581B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66CCRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C13/00Other constructional features or details
    • B66C13/18Control systems or devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66CCRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C9/00Travelling gear incorporated in or fitted to trolleys or cranes
    • B66C9/14Trolley or crane travel drives
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Control And Safety Of Cranes (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种提高轮胎式起重机大车运动控制精度的方法及系统,包括以下步骤:获取大车距离目标位置的剩余位移,根据所述剩余位移设定大车的期望速度;获取所述大车的实际速度,结合所述大车的期望速度得到所述大车的速度给定;所述大车的速度给定、所述大车的实际速度以及所述大车的期望速度的关系满足以下条件:当所述实际速度大于所述期望速度的A倍数时,所述大车的速度给定为0,当所述实际速度小于所述大车期望速度的B倍数时,所述大车的速度给定为1。本发明提供的提高轮胎式起重机大车运动控制精度的方法及系统,根据实际速度和期望速度的倍数关系对大车速度给定0或1,从而基于开关量控制的PID调节算法实现控制精度。

Description

一种提高轮胎式起重机大车运动控制精度的方法及系统
技术领域
本发明涉及起重机大车运动控制领域,尤其涉及一种提高轮胎式起重机大车运动控制精度的方法及系统。
背景技术
港口作业是指船舶进出港口进行调度、装卸货物、排除障碍等作业。港口作业基本上是以拖车、铲车、吊机等大型流动、固定机械等吊装系统为主要工具进行的。在港口的轮式起重机的运动控制中,由于系统的大滞后特性,大车的控制精度难以达到2cm以内。系统的大车电气特性具体表现为:在控制大车运动的电气设计中,由于存在继电器、接触器等导致系统存在大滞后特性的电气设备,使得系统在控制大车运动过程中出现“指令已发出,执行机构尚未动作;指令已停止,执行机构尚未停止”的现象,这会导致即使大车在最低速的控制模式下也难以实现大车控制精度达到2cm以内的目标。
因此有必要提供一种提高轮胎式起重机大车运动控制精度的方法,可以提高起重机大车运动控制的精度。
发明内容
本发明所要解决的技术问题是提供提高轮胎式起重机大车运动控制精度的方法,根据实际速度和期望速度的倍数关系对大车速度给定1或0,从而基于开关量控制的PID调节算法实现控制精度。
本发明为解决上述技术问题而采用的技术方案是提供一种提高轮胎式起重机大车运动控制精度的方法,包括以下步骤:
获取大车距离目标位置的剩余位移,根据所述剩余位移设定大车的期望速度;
获取所述大车的实际速度,结合所述大车的期望速度得到所述大车的速度给定;
所述大车的速度给定、所述大车的实际速度以及所述大车的期望速度的关系满足以下条件:
其中,Vin是所述大车的速度给定,V0是所述大车的实际速度,Vr是所述大车的期望速度,当所述实际速度V0大于所述期望速度Vr的A倍数时,所述大车的速度给定Vin为0,当所述实际速度V0小于所述大车期望速度Vr的B倍数时,所述大车的速度给定Vin为1。
优选地,所述根据所述剩余位移设定大车的期望速度通过以下公式计算得出:
Vr=P×S0+I×S0+D×(S0-S1)
其中,Vr是所述大车的期望速度,S0是所述大车距离目标位置的剩余位移,S1是所述大车上一时刻距离目标位置的剩余位移,P是比例参数,I是积分参数,D是微分参数。
优选地,所述积分参数I的值设置为0,所述公式简化为:
Vr=P×S0+D×(S0-S1)
优选地,所述A的数值范围是105%-115%,所述B的数值范围是85%-95%。
优选地,当大车到达目标位置时,所述大车的速度给定为0,控制结束。
本发明为解决上述技术问题而还采用的技术方案是提供一种提高轮胎式起重机大车运动控制精度的系统,包括:期望速度设置模块,其用于获取大车距离目标位置的剩余位移,根据所述剩余位移设定大车的期望速度;
大车速度获取模块,其用于获取所述大车的实际速度,结合所述大车的期望速度得到所述大车的速度给定;
大车速度控制模块,其用于控制所述大车的速度给定,所述大车的速度给定、所述大车的实际速度以及所述大车的期望速度的关系满足以下条件:
其中,Vin是所述大车的速度给定,V0是所述大车的实际速度,Vr是所述大车的期望速度,当所述实际速度V0大于所述期望速度Vr的A倍数时,所述大车的速度给定Vin为0,当所述实际速度V0小于所述大车期望速度Vr的B倍数时,所述大车的速度给定Vin为1。
优选地,所述根据所述剩余位移设定大车的期望速度通过以下公式计算得出:
Vr=P×S0+I×S0+D×(S0-S1)
其中,Vr是所述大车的期望速度,S0是所述大车距离目标位置的剩余位移,S1是所述大车上一时刻距离目标位置的剩余位移,P是比例参数,I是积分参数,D是微分参数。
优选地,所述积分参数r的值设置为0,所述公式简化为:
Vr=P×S0+D×(S0-S1)
优选地,所述A的数值范围是105%-115%,所述B的数值范围是85%-95%。
优选地,当大车到达目标位置时,所述大车的速度给定为0,控制结束。
本发明对比现有技术有如下的有益效果:本发明提供的提高轮胎式起重机大车运动控制精度的方法及系统,根据大车距离目标位置的剩余位移设定大车的期望速度,根据大车的实际速度,结合大车的期望速度给到大车的速度给定,根据实际速度和期望速度的倍数关系对大车速度给定0或1,一旦实际速度和期望速度满足预设的倍数关系,则快速调整大车速度给定为0或1,从而基于开关量控制的PID调节算法实现控制精度,该算法特别高效且运算量低,在实际测试中,该算法实现的控制精度可以达到1.5cm,解决了现有技术中大车定位控制精度无法达到2cm以内的问题。
附图说明
图1为本发明实施例中提高轮胎式起重机大车运动控制精度的方法的流程图;
图2为本发明实施例中提高轮胎式起重机大车运动控制精度的系统的模块图;
图3为本发明实施例中提高轮胎式起重机大车运动控制精度的方法的速度位置曲线示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的描述。
在以下描述中,为了提供本发明的透彻理解,阐述了很多具体的细节。然而,本发明可以在没有这些具体的细节的情况下实践,这对本领域普通该技术人员来说将是显而易见的。因此,具体的细节阐述仅仅是示例性的,具体的细节可以由奔放的精神和范围而变化并且仍被认为是在本发明的精神和范围内。
本实施例中的吊装系统可用于港口物流,所述吊装系统包括起重机,所述起重机包括但不限于轮胎吊、跨运车以及堆高车,下文以轮胎吊为例来说明本发明的吊装系统的自动纠偏控制方法的工作原理。
现在参看图1,图1是本发明实施例中提高轮胎式起重机大车运动控制精度的方法的流程。一种提高轮胎式起重机大车运动控制精度的方法,包括以下步骤:
S101:获取大车距离目标位置的剩余位移,根据所述剩余位移设定大车的期望速度;
S102:获取所述大车的实际速度,结合所述大车的期望速度得到所述大车的速度给定;
S103:所述大车的速度给定、所述大车的实际速度以及所述大车的期望速度的关系满足以下条件:
其中,Vin是所述大车的速度给定,V0是所述大车的实际速度,Vr是所述大车的期望速度,当所述实际速度V0大于所述期望速度Vr的A倍数时,所述大车的速度给定Vin为0,当所述实际速度V0小于所述大车期望速度Vr的B倍数时,所述大车的速度给定Vin为1。大车的实际速度通过速度传感器来获取,速度传感器可以包括磁电式车速传感器、霍尔式车速传感器或光电式车速传感器。
在具体实施中,所述根据所述剩余位移设定大车的期望速度通过以下公式计算得出:
Vr=P×S0+I×S0+D×(S0-S1)
其中,Vr是所述大车的期望速度,S0是所述大车距离目标位置的剩余位移,S1是所述大车上一时刻距离目标位置的剩余位移,P是比例参数,I是积分参数,D是微分参数。大车距离目标位置的剩余位移通过设定目标位置的坐标以及大车当前的实际坐标位置来获取。
进一步地,所述积分参数I的值设置为0,所述公式简化为:
Vr=P×S0+D×(S0-S1)
在具体实施中,所述A的数值范围是105%-115%,所述B的数值范围是85%-95%。也就是说,当所述实际速度V0大于所述期望速度Vr的105%-115%倍数时,所述大车的速度给定Vin为0,当所述实际速度V0小于所述大车期望速度Vr的85%-95%倍数时,所述大车的速度给定Vin为1。
最后,当大车到达目标位置时,所述大车的速度给定为0,控制结束。
现在参看图2,图2是本发明实施例中提高轮胎式起重机大车运动控制精度的系统的模块图。一种提高轮胎式起重机大车运动控制精度的系统,包括:期望速度设置模块201,其用于获取大车距离目标位置的剩余位移,根据所述剩余位移设定大车的期望速度;大车速度获取模块202,其用于获取所述大车的实际速度,结合所述大车的期望速度得到所述大车的速度给定;大车速度控制模块203,其用于控制所述大车的速度给定,所述大车的速度给定、所述大车的实际速度以及所述大车的期望速度的关系满足以下条件:
其中,Vin是所述大车的速度给定,V0是所述大车的实际速度,Vr是所述大车的期望速度,当所述实际速度V0大于所述期望速度Vr的A倍数时,所述大车的速度给定Vin为0,当所述实际速度V0小于所述大车期望速度Vr的B倍数时,所述大车的速度给定Vin为1。大车的实际速度通过速度传感器来获取,速度传感器可以包括磁电式车速传感器、霍尔式车速传感器或光电式车速传感器。
在具体实施中,所述根据所述剩余位移设定大车的期望速度通过以下公式计算得出:
Vr=P×S0+I×S0+D×(S0-S1)
其中,Vr是所述大车的期望速度,S0是所述大车距离目标位置的剩余位移,S1是所述大车上一时刻距离目标位置的剩余位移,P是比例参数,I是积分参数,D是微分参数。大车距离目标位置的剩余位移通过设定目标位置的坐标以及大车当前的实际坐标位置来获取。
进一步地,所述积分参数I的值设置为0,所述公式简化为:
Vr=P×S0+D×(S0-S1)
在具体实施中,所述A的数值范围是105%-115%,所述B的数值范围是85%-95%。也就是说,当所述实际速度V0大于所述期望速度Vr的105%-115%倍数时,所述大车的速度给定Vin为0,当所述实际速度V0小于所述大车期望速度Vr的85%-95%倍数时,所述大车的速度给定Vin为1。
最后,当大车到达目标位置时,所述大车的速度给定为0,控制结束。
现在参看图3,图3是本发明实施例中提高轮胎式起重机大车运动控制精度的方法的速度位置曲线示意图。图3的上图为大车速度曲线示意图,下图为大车位置曲线示意图。在具体实施中,获取大车距离目标位置的剩余位移之后,根据剩余位移设定大车的期望速度为2.0cm/s,通过速度传感器获取大车的实际速度,当实际速度到达2.0cm/s并超过2.1cm/s后,速度给定变为0,当实际速度低于1.9cm/s时,速度给定再次给1,如此根据大车的实际速度和期望速度的关系值,速度给定在1和0之间切换,直到当大车到达目标位置时,大车的速度给定为0,控制结束。
综上,本实施例提供的提高轮胎式起重机大车运动控制精度的方法及系统,根据大车距离目标位置的剩余位移设定大车的期望速度,根据大车的实际速度,结合大车的期望速度给到大车的速度给定,根据实际速度和期望速度的倍数关系对大车速度给定0或1,一旦实际速度和期望速度满足预设的倍数关系,则快速调整大车速度给定为0或1,从而基于开关量控制的PID调节算法实现控制精度,该算法特别高效且运算量低,在实际测试中,该算法实现的控制精度可以达到1.5cm,解决了现有技术中大车定位控制精度无法达到2cm以内的问题。
虽然本发明已以较佳实施例揭示如上,然其并非用以限定本发明,任何本领域技术人员,在不脱离本发明的精神和范围内,当可作些许的修改和完善,因此本发明的保护范围当以权利要求书所界定的为准。

Claims (6)

1.一种提高轮胎式起重机大车运动控制精度的方法,其特征在于,包括以下步骤:
获取大车距离目标位置的剩余位移,根据所述剩余位移设定大车的期望速度;
获取所述大车的实际速度,结合所述大车的期望速度得到所述大车的速度给定;
所述大车的速度给定、所述大车的实际速度以及所述大车的期望速度的关系满足以下条件:
其中,是所述大车的速度给定,/>是所述大车的实际速度,/>是所述大车的期望速度,当所述实际速度/>大于所述期望速度/>的A倍数时,所述大车的速度给定/>为0,当所述实际速度/>小于所述大车期望速度/>的B倍数时,所述大车的速度给定/>为1;
所述根据所述剩余位移设定大车的期望速度通过以下公式计算得出:
其中,是所述大车的期望速度,/>是所述大车距离目标位置的剩余位移,/>是所述大车上一时刻距离目标位置的剩余位移,/>是比例参数,/>是积分参数,/>是微分参数;
当大车到达目标位置时,所述大车的速度给定为0,控制结束。
2.根据权利要求1所述的提高轮胎式起重机大车运动控制精度的方法,其特征在于,所述积分参数的值设置为0,所述公式简化为:
3.根据权利要求1所述的提高轮胎式起重机大车运动控制精度的方法,其特征在于,所述A的数值范围是105%-115%,所述B的数值范围是85%-95%。
4.一种提高轮胎式起重机大车运动控制精度的系统,其特征在于,包括:
大车期望速度设置模块,其用于获取大车距离目标位置的剩余位移,根据所述剩余位移设定大车的期望速度;
大车速度获取模块,其用于获取所述大车的实际速度,结合所述大车的期望速度得到所述大车的速度给定;
所述大车的速度给定、所述大车的实际速度以及所述大车的期望速度的关系满足以下条件:
其中,是所述大车的速度给定,/>是所述大车的实际速度,/>是所述大车的期望速度,当所述实际速度/>大于所述期望速度/>的A倍数时,所述大车的速度给定/>为0,当所述实际速度/>小于所述大车期望速度/>的B倍数时,所述大车的速度给定/>为1;
所述根据所述剩余位移设定大车的期望速度通过以下公式计算得出:
其中,是所述大车的期望速度,/>是所述大车距离目标位置的剩余位移,/>是所述大车上一时刻距离目标位置的剩余位移,/>是比例参数,/>是积分参数,/>是微分参数;
当大车到达目标位置时,所述大车的速度给定为0,控制结束。
5.根据权利要求4所述的提高轮胎式起重机大车运动控制精度的系统,其特征在于,所述积分参数的值设置为0,所述公式简化为:
6.根据权利要求4所述的提高轮胎式起重机大车运动控制精度的系统,其特征在于,所述A的数值范围是105%-115%,所述B的数值范围是85%-95%。
CN202011398743.0A 2020-12-04 2020-12-04 一种提高轮胎式起重机大车运动控制精度的方法及系统 Active CN112520581B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011398743.0A CN112520581B (zh) 2020-12-04 2020-12-04 一种提高轮胎式起重机大车运动控制精度的方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011398743.0A CN112520581B (zh) 2020-12-04 2020-12-04 一种提高轮胎式起重机大车运动控制精度的方法及系统

Publications (2)

Publication Number Publication Date
CN112520581A CN112520581A (zh) 2021-03-19
CN112520581B true CN112520581B (zh) 2023-09-05

Family

ID=74997285

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011398743.0A Active CN112520581B (zh) 2020-12-04 2020-12-04 一种提高轮胎式起重机大车运动控制精度的方法及系统

Country Status (1)

Country Link
CN (1) CN112520581B (zh)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IT1017443B (it) * 1973-07-30 1977-07-20 Bendix Corp Impianto di regolazione automatica di velocita particolarmente per automobili
CN1347818A (zh) * 2000-10-03 2002-05-08 株式会社小松制作所 工作车辆的速度控制装置及其控制方法
CN101049889A (zh) * 2007-05-08 2007-10-10 上海港机重工有限公司 起重装卸设备的作业机构的减速控制方法及装置
CN104140045A (zh) * 2014-06-30 2014-11-12 徐州重型机械有限公司 一种起重机及其重力下落控制方法、控制系统
CN106915315A (zh) * 2017-03-24 2017-07-04 潍柴动力股份有限公司 一种自动互锁的控制方法及装置
WO2018126967A1 (zh) * 2017-01-03 2018-07-12 北京京东尚科信息技术有限公司 穿梭车速度规划控制方法、装置及穿梭车
EP3431435A1 (fr) * 2017-07-17 2019-01-23 Manitou Bf Commande d'une machine de manutention
CN111381493A (zh) * 2020-04-30 2020-07-07 中山大学 一种基于模糊控制与pid控制的无人驾驶车辆速度控制方法
CN111923908A (zh) * 2020-08-18 2020-11-13 哈尔滨理工大学 一种融合稳定性的智能汽车路径跟踪控制方法
CN112010175A (zh) * 2020-07-09 2020-12-01 太原重工股份有限公司 起重机多轴联动防摇控制方法和控制系统

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
IT1017443B (it) * 1973-07-30 1977-07-20 Bendix Corp Impianto di regolazione automatica di velocita particolarmente per automobili
CN1347818A (zh) * 2000-10-03 2002-05-08 株式会社小松制作所 工作车辆的速度控制装置及其控制方法
CN101049889A (zh) * 2007-05-08 2007-10-10 上海港机重工有限公司 起重装卸设备的作业机构的减速控制方法及装置
CN104140045A (zh) * 2014-06-30 2014-11-12 徐州重型机械有限公司 一种起重机及其重力下落控制方法、控制系统
WO2018126967A1 (zh) * 2017-01-03 2018-07-12 北京京东尚科信息技术有限公司 穿梭车速度规划控制方法、装置及穿梭车
CN106915315A (zh) * 2017-03-24 2017-07-04 潍柴动力股份有限公司 一种自动互锁的控制方法及装置
EP3431435A1 (fr) * 2017-07-17 2019-01-23 Manitou Bf Commande d'une machine de manutention
CN111381493A (zh) * 2020-04-30 2020-07-07 中山大学 一种基于模糊控制与pid控制的无人驾驶车辆速度控制方法
CN112010175A (zh) * 2020-07-09 2020-12-01 太原重工股份有限公司 起重机多轴联动防摇控制方法和控制系统
CN111923908A (zh) * 2020-08-18 2020-11-13 哈尔滨理工大学 一种融合稳定性的智能汽车路径跟踪控制方法

Also Published As

Publication number Publication date
CN112520581A (zh) 2021-03-19

Similar Documents

Publication Publication Date Title
CN108132641B (zh) 码垛机的控制方法及系统、电动汽车换电控制方法及系统
EP3568374B1 (en) Traction speed recovery based on steer wheel dynamic
CN109828577A (zh) 无人驾驶集装箱卡车相对自动化场桥高精度定位停车方法
CN108516505B (zh) 叉车工作安全控制装置与控制方法
US20190002251A1 (en) Crane And Method For Controlling Same
CN112357836B (zh) 一种液压货叉的自动对准控制方法及装置
CN112520581B (zh) 一种提高轮胎式起重机大车运动控制精度的方法及系统
US11400975B2 (en) High speed straight ahead tiller desensitization
CN110497962B (zh) 一种跨运车容积伺服一体化电液转向系统及其控制方法
US9533864B2 (en) Vehicle control systems and methods
KR101666638B1 (ko) Pwm 신호를 이용한 무인 지게차 장치
CN105446335A (zh) 一种行车定位控制系统及控制方法
CN110775890B (zh) 一种堆高机工作装置作业姿态自动调整控制方法及系统
CN102312462A (zh) 一种装载机动态负荷传感控制系统
CN114195045B (zh) 一种无人叉车的自动叉取方法
CN211857290U (zh) 一种具有机械臂的智能小车系统
CN110885006B (zh) 一种起重机工作装置作业姿态自动调整控制方法及系统
RU2426660C2 (ru) Способ управления многоприводной электрической трансмиссией многоосной колесной машины
CN110885039B (zh) 一种叉车工作装置作业姿态自动调整控制方法及系统
CN109501856B (zh) 极限转向控制方法及装置
CN109665468A (zh) 叉车式agv货叉升降速度控制方法和装置
CN113060649B (zh) 一种基于双编码器进行定位的方法及系统
CN113697729B (zh) 一种叉车横移旋转联动控制方法及控制系统
CN110342405B (zh) 一种集装箱跨运车起升机构精确定位的控制方法
CN110803625B (zh) 一种正面吊工作装置作业姿态自动调整控制方法及系统

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