CN111747346A - 一种用于agv设备的托盘自平衡***及方法 - Google Patents
一种用于agv设备的托盘自平衡***及方法 Download PDFInfo
- Publication number
- CN111747346A CN111747346A CN202010517250.8A CN202010517250A CN111747346A CN 111747346 A CN111747346 A CN 111747346A CN 202010517250 A CN202010517250 A CN 202010517250A CN 111747346 A CN111747346 A CN 111747346A
- Authority
- CN
- China
- Prior art keywords
- tray
- assembly
- motor
- agv
- roll
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000005540 biological transmission Effects 0.000 claims abstract description 25
- 238000004364 calculation method Methods 0.000 claims abstract description 12
- 238000012545 processing Methods 0.000 claims abstract description 12
- 230000001133 acceleration Effects 0.000 claims description 12
- 230000000712 assembly Effects 0.000 claims description 7
- 238000000429 assembly Methods 0.000 claims description 7
- 238000012937 correction Methods 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 6
- 238000012544 monitoring process Methods 0.000 description 4
- 238000006073 displacement reaction Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000009347 mechanical transmission Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/07559—Stabilizing means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B66—HOISTING; LIFTING; HAULING
- B66F—HOISTING, LIFTING, HAULING OR PUSHING, NOT OTHERWISE PROVIDED FOR, e.g. DEVICES WHICH APPLY A LIFTING OR PUSHING FORCE DIRECTLY TO THE SURFACE OF A LOAD
- B66F9/00—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes
- B66F9/06—Devices for lifting or lowering bulky or heavy goods for loading or unloading purposes movable, with their loads, on wheels or the like, e.g. fork-lift trucks
- B66F9/075—Constructional features or details
- B66F9/0755—Position control; Position detectors
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Structural Engineering (AREA)
- Civil Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Geology (AREA)
- Mechanical Engineering (AREA)
- Motorcycle And Bicycle Frame (AREA)
Abstract
本发明公开一种用于AGV设备的托盘自平衡***及方法,所述***还包括托盘自平衡装置和运行于所述控制器的处理子***;所述托盘自平衡装置用于固定并活动调节所述托盘的水平,所述托盘自平衡装置包括传感组件、传动组件、支架组件,所述处理子***包括输入输出模块、计算模块和控制模块。利用本发明所公开的***和方法,AGV设备行走在斜坡或不平整路面时,可通过固定在托盘上的传感组件,可以实时感知托盘的位置偏移的微小变化,并及时通过控制器通知电机调整支架组件的位置和角度,从而使得载物托盘重新获得平衡。整个过程自动完成,降低AGV设备在不平整路面或者斜坡路面的搬运风险,使得搬运更加平稳。
Description
技术领域
本发明涉及智能机器人领域,更具体地说,涉及一种用于AGV设备的托盘自平衡***及方法。
背景技术
AGV设备是一种装备有电磁或光学等自动导引装置,能够沿规定的导引路径行驶,具有安全保护以及各种移载功能的运输车,工业应用中不需驾驶员的搬运车,以可充电之蓄电池为其动力来源。一般可通过电脑来控制其行进路线以及行为,或利用电磁轨道来设立其行进路线,电磁轨道黏贴於地板上,无人搬运车则依循电磁轨道所带来的讯息进行移动与动作。
目前,AGV设备在搬运物体时,对地面的要求比较高,原有固定物体的托盘必须依附于水平的地面才能实现搬运,当遇到斜坡或者不平整的地面时,AGV设备的平衡会出现问题,严重的会出现倾斜,从而导致物体移位或倾倒,特别在搬运非固态易形变物质时,更加容易导致货物的变形或损毁。
发明内容
为了解决现有AGV设备存在的上述问题,本发明提出一种用于AGV设备的托盘自平衡***,利用本发明提供的***,使得AGV设备搬运物体特别是搬运非固态易形变物质时,AGV设备的托盘自平衡***可以根据路面的倾斜情况,进行精确计算和调整托盘的角度,保证载物托盘表面的水平。
本发明提出的一种用于AGV设备的托盘自平衡***,所述AGV设备包括控制器、行走设备和托盘,所述控制器设于所述AGV设备本体里,用于控制所述行走设备的移动,所述托盘用于托举货物;其特征是:其特征是:所述***还包括托盘自平衡装置和运行于所述控制器的处理子***;所述托盘自平衡装置用于固定并活动调节所述托盘的水平,所述托盘自平衡装置包括传感组件、传动组件、支架组件,所述传感组件包括传感器,其中:所述传感组件固定于所述托盘上,用于实时采集所述托盘的位置状况,并向所述控制器实时传递所述托盘的位置信息;所述传动组件包括电机、齿轮组件,所述电机固定于AGV设备上,其输出轴通过齿轮组件连接到所述支架组件,用于控制所述支架组件的转动方向和高度;所述支架组件所述支架组件包括固定在AGV设备本体的连接件、可以调整高度的传动杆,以及与所述托盘连接的可以360度转动的万向球铰;所述处理子***包括输入输出模块、计算模块和控制模块,其中:所述输入输出模块用于信息的采集和控制指令的输出;所述计算模块用于计算获得托盘的位置和修正数据;所述的控制模块用于对处理数据并生成修正支架组件位置的控制指令。
优选的,所述传感组件还包括激光雷达仪,所述激光雷达仪固定于AGV设备上。
优选的,所述支架组件至少包括四根传动杆。
优选的,所述传动组件的数量和传动杆的数量相等,其中每个传动组件的输出轴通过机械传动组件连接到传动杆,优点是一个电机控制一根传动杆,实现精准控制。
优选的,所述的传感组件的数量和传动杆的数量相等,优点是实现传感器和传动杆的一对一监控。
优选的,所述传感组件为惯性传感器。
优选的,传动组件为AGV差速电机。
优选的,所述惯性传感器采集的数据包括:X轴加速度、Y轴加速度、Z轴角度、温度数据。
优选的,所述的计算模块用于计算电机调整的滚转角和俯仰角,其中使用的计算方法为:滚转角(x 轴)Roll=((RollH<<8)|RollL)/32768*180(°);俯仰角(y 轴)Pitch=((PitchH<<8)|PitchL)/32768*180(°);其中,RollH为惯性传感器采集到的X轴加速度高字节,RollL为惯性传感器采集到的X轴加速度低字节。PitchH为惯性传感器采集到的Y轴加速度高字节,PitchL为惯性传感器采集到的Y轴加速度低字节。
本发明还公开一种用于AGV设备的托盘自平衡方法,利用前述任何一种托盘自平衡***来完成,包括以下步骤:传感组件不断采集托盘的位置,并发送给所述控制器;所述控制器接收托盘的偏移数据,计算获得托盘的纠正参数,如果水平,则停止,如果不是水平,则产生调整指令发送给电机;电机执行调整指令,触发支架组件的传动杆扭动。
利用本发明所公开的***和方法, AGV设备行走在斜坡或不平整的地面时,通过固定在托盘上的传感组件,可以实时感知托盘的位置偏移的微小变化,并及时通过控制器通知电机调整支架组件的位置和角度,从而使得载物托盘重新获得平衡,整个过程都是通过AGV托盘自平衡***自动完成,使得AGV设备在不平整路面或者斜坡路面对货物特别是非固态易形变货物的风险降低,使得搬运更加平稳。
为了对本发明有更清楚全面的了解,下面结合附图,对本发明用于AGV设备的托盘自平衡***和方法的具体实施方式进行详细描述。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍。显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为一种实施例提供的一种用于AGV设备的托盘自平衡***的组成结构示意图。
图2为一种实施例的处理子***的组成示意图。
图3为一种实施例特提供的一种用于AGV设备的托盘自平衡方法的处理流程示意图。
图4为一种实施例中AGV设备的托盘自平衡***俯视示意图。
具体实施方式
以下参照附图,对本发明的实施方式和实施例进行详细说明。
请参阅图1,图1示出了一种用于AGV设备的托盘自平衡***的组成结构示意图,其中AGV设备包括AGV设备本体100、行走设备101、托盘102、控制器103,所述的托盘自平衡***包括托盘自平衡装置,所述装置包括传感组件、支架组件40、传动组件50。
传感组件包括多个传感器,在该实施例中,传感器具体包括惯性传感器301,传感组件还包括激光雷达仪302,惯性传感器301固定于载物的托盘102的表面,为了对托盘的位移更加敏感,通常惯性传感器固定于托盘的边缘。
进一步的,在该实施例中,包括四个传感器,分别固定于托盘102的上表面,托盘102通过可360度转动的万向球铰401固定在支架组件40上,在该实施例中,支架组件40还包括四根可以调整高度的传动杆402,实际实现中,根据载重量需要和不同的敏感度要求,可以有其他数量的传动杆组成的支架,支架组件40还通过齿轮组件502连接到电机501上,齿轮组件502和电机501组成传动组件50。
在本实施例中,电机501采用AGV差速电机,为了保证更加精准的控制,电机501和传感组件以及传动杆402的数量相等,传感组件分别固定于不同传动杆402邻近的托盘表面,不同传动杆402连接不同的电机501,传感组件和电机501统一连接到控制器103。
首先保证在水平路面上托盘102处于水平状态,AGV设备行走时,传感组件循环采集目标监控对象的位置数据,控制器103获得传感组件采集的数据,计算并监控路面信息和当前托盘的水平状态,当路面发现不平整,或者托盘的水平状态发生微小偏移,则立即计算得到电机501需要转动调整的角度,通过电机501驱动传动杆402,使得整个托盘恢复到水平状态。
请参阅图2,图2为一种实施例的处理子***20的组成结构示意图,如图所示,处理子***20包括控制模块201、输入输出模块202、计算模块203,其中,输入输出模块202用于信息的采集和控制指令的输出,与传感组件和传动组件500连接;计算模块203用于计算获得托盘的偏移数据,计算获得纠正参数;控制模块201用于生成修正支架组件位置的控制指令。
请参阅图3,图3为一种实施例特提供的一种用于AGV设备的托盘自平衡方法的处理流程示意图,具体包括步骤S11-S13:
步骤S11:传感组件循环采集监控目标的位置数据,并发送给所述控制器。
在该实施例中,开机后,传感组件循环采集监控目标的位置数据,并发送给所述控制器。传感组件包括激光雷达仪和传感器,激光雷达仪主要采集前方路面信息,传感器固定在托盘上采集托盘的微小偏移。传感器采集的数据包括:0x55 0x53 RollL RollH PitchLPitchH YawL YawH TL TH SUM。
步骤S12:控制器接收位置数据,计算获得托盘的水平状态,如果不是水平,则生成调整指令发送给电机。
控制器接收到监控目标的位置数据,通过计算获得托盘的水平位置,主要计算电机调整的滚转角(x 轴)ROLL和俯仰角(y 轴)Pitch,计算方法如下:
滚转角(x 轴)Roll=((RollH<<8)|RollL)/32768*180(°);
俯仰角(y 轴)Pitch=((PitchH<<8)|PitchL)/32768*180(°)。
步骤S13:电机根据调整指令,触发支架组件的传动杆做相应调整。
水平情况下,Roll和Pitch都是0°,四个电机位置也初始化为0。
如果Roll和Pitch不为0°,则需要进行调整,调整的方法请参阅图4的描述。
请参阅图4,为便于描述Roll和Pitch不为0°时AGV设备的电机如何进行调整,图4为一种实施例中AGV设备的托盘自平衡***俯视示意图,图中包括AGV设备本体100、以及四个电机分别是电机501-1、电机501-2、电机501-3、电机501-4,其中电机501-1、电机501-2位于前进方向的前排,电机501-3、电机501-4位于后排,下面结合图4根据Roll和Pitch的值,分三种情况说明如何通过调整电机来实现对托盘的调整。
情况一:当Pitch=0时,只需要调整Roll:
如果roll>0(上坡,托盘X轴正抬头),则需要后方电机501-3和4进行举升,使得roll=0。
如果roll<0 (下坡,托盘X轴负抬头),则需要前方电机501-1和501-2进行举升,使得roll=0。
情况二:当Roll=0时,只需要调整Pitch:
如果pitch>0(右翻滚,左侧偏高),则需右侧电机501-2和501-4进行举升,使得pitch=0。
如果pitch<0(左翻滚,右侧偏高),则需左侧电机501-1和501-3进行举升。使得pitch=0。
情况三:当Pitch和Roll均不等于0的情况,需调整Roll和Pitch:
如果roll>0&pitch>0,电机501-1不动,电机501-2、501-3、501-4进行相应举升。
如果roll>0&pitch<0,电机501-2不动,电机501-1、501-3、501-4进行相应举升。
如果roll<0&pitch>0,电机501-3不动,电机501-1、501-2、501-4进行相应举升。
如果roll<0&pitch<0,电机501-4不动,电机501-1、501-2、501-3进行相应举升。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (10)
1.一种用于AGV设备的托盘自平衡***,所述AGV设备包括控制器、行走设备和托盘,所述控制器设于所述AGV设备本体里,用于控制所述行走设备的移动,所述托盘用于托举货物,其特征是:所述***还包括托盘自平衡装置和运行于所述控制器的处理子***;所述托盘自平衡装置用于固定并活动调节所述托盘的水平,所述托盘自平衡装置包括传感组件、传动组件、支架组件,所述传感组件包括传感器,其中:所述传感组件固定于所述托盘上,用于实时采集所述托盘的位置状况,并向所述控制器实时传递所述托盘的位置信息;所述传动组件包括电机、齿轮组件,所述电机固定于AGV设备上,其输出轴通过齿轮组件连接到所述支架组件,用于控制所述支架组件的转动方向和高度;所述支架组件所述支架组件包括固定在AGV设备本体上的连接件、可以调整高度的传动杆,以及与所述托盘连接的可以360度转动的万向球铰;所述处理子***包括输入输出模块、计算模块和控制模块,其中:
所述输入输出模块用于信息的采集和控制指令的输出;所述计算模块用于计算获得托盘的位置和修正数据;所述的控制模块用于对处理数据并生成修正支架组件位置的控制指令。
2.如权利要求1所述的***,其特征在于,所述传感组件还包括激光雷达仪,所述激光雷达固定于AGV设备上。
3.如权利要求2所述的***,其特征在于,所述支架组件至少包括四根传动杆。
4.如权利要求2所述的***,其特征在于,所述传动组件的数量和传动杆的数量相等,其中每个传动组件的输出轴通过机械传动组件连接到传动杆。
5.如权利要求4所述的***,其特征在于所述的传感组件的数量和传动杆的数量相等。
6.如权利要求5所述的***,其特征在于,所述传感组件为惯性传感器。
7.如权利要求6所述的***,其特征在于,所述电机为AGV差速电机。
8.如权利要求7所述的***,其特征在于,所述惯性传感器采集的数据包括:X轴加速度、Y轴加速度、Z轴角度、温度数据。
9.如权利要求8中所述的***,其特征在于,所述的计算模块用于计算电机调整的滚转角和俯仰角,其中使用的计算方法为:
滚转角(x 轴)Roll=((RollH<<8)|RollL)/32768*180(°);
俯仰角(y 轴)Pitch=((PitchH<<8)|PitchL)/32768*180(°);
其中,RollH为惯性传感器采集到的X轴加速度高字节,RollL为惯性传感器采集到的X轴加速度低字节,PitchH为惯性传感器采集到的Y轴加速度高字节,PitchL为惯性传感器采集到的Y轴加速度低字节。
10.一种用于AGV设备的托盘自平衡方法,其特征在于,用于AGV设备的托盘自平衡***,所述的方法包括以下步骤:传感组件循环采集监控目标的位置数据,并发送给所述控制器;
所述控制器接收位置数据,计算获得托盘的水平状态,如果不是水平,则生成调整指令发送给电机;电机根据调整指令,触发支架组件的传动杆做相应调整。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010517250.8A CN111747346A (zh) | 2020-06-09 | 2020-06-09 | 一种用于agv设备的托盘自平衡***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010517250.8A CN111747346A (zh) | 2020-06-09 | 2020-06-09 | 一种用于agv设备的托盘自平衡***及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111747346A true CN111747346A (zh) | 2020-10-09 |
Family
ID=72675370
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010517250.8A Pending CN111747346A (zh) | 2020-06-09 | 2020-06-09 | 一种用于agv设备的托盘自平衡***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111747346A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114030538A (zh) * | 2021-11-05 | 2022-02-11 | 深圳优地科技有限公司 | 平衡装置、机器人及自平衡的调节方法 |
CN114132245A (zh) * | 2021-11-19 | 2022-03-04 | 江苏盟星智能科技有限公司 | 一种拖拽式agv智能无人搬运车挂载装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103029120A (zh) * | 2012-12-11 | 2013-04-10 | 燕山大学 | 一种折叠式静载平衡并联调姿平台 |
CN207917009U (zh) * | 2017-12-28 | 2018-09-28 | 广州赛特智能科技有限公司 | 一种自主调整爬坡平衡的agv机器人 |
CN213112402U (zh) * | 2020-06-09 | 2021-05-04 | 上海欣巴自动化科技股份有限公司 | 一种用于agv设备的托盘自平衡*** |
-
2020
- 2020-06-09 CN CN202010517250.8A patent/CN111747346A/zh active Pending
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103029120A (zh) * | 2012-12-11 | 2013-04-10 | 燕山大学 | 一种折叠式静载平衡并联调姿平台 |
CN207917009U (zh) * | 2017-12-28 | 2018-09-28 | 广州赛特智能科技有限公司 | 一种自主调整爬坡平衡的agv机器人 |
CN213112402U (zh) * | 2020-06-09 | 2021-05-04 | 上海欣巴自动化科技股份有限公司 | 一种用于agv设备的托盘自平衡*** |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114030538A (zh) * | 2021-11-05 | 2022-02-11 | 深圳优地科技有限公司 | 平衡装置、机器人及自平衡的调节方法 |
CN114132245A (zh) * | 2021-11-19 | 2022-03-04 | 江苏盟星智能科技有限公司 | 一种拖拽式agv智能无人搬运车挂载装置 |
CN114132245B (zh) * | 2021-11-19 | 2023-09-15 | 江苏盟星智能科技有限公司 | 一种拖拽式agv智能无人搬运车挂载装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN213112402U (zh) | 一种用于agv设备的托盘自平衡*** | |
CN111747346A (zh) | 一种用于agv设备的托盘自平衡***及方法 | |
CN110182511B (zh) | 一种智能仓储车的转向减速装置及转弯减速方法 | |
US9870002B1 (en) | Velocity control of position-controlled motor controllers | |
CN111497637B (zh) | 一种四舵轮agv的运动控制方法 | |
US20100206651A1 (en) | Robot apparatus and method of controlling the same, and computer program | |
EP2083340B1 (en) | Inverted type movable body and control method thereof | |
US10576617B1 (en) | Service robot having movable center of mass | |
CN109079738B (zh) | 一种自适应agv机器人及自适应导航方法 | |
CN107943019A (zh) | 物料搬运车辆的手柄位置感测***和方法 | |
CN209281249U (zh) | 一种带有障碍物避障装置的agv小车及*** | |
US11845415B2 (en) | AGV having dynamic safety zone | |
Cawood et al. | Navigation and locomotion of a low-cost Automated Guided Cart | |
EP3771955B1 (en) | Method and system for operating an autonomous mobile robot based on payload sensing | |
CN107272693A (zh) | 基于全向车与装配工位自动对接***及方法 | |
WO2023165174A1 (zh) | 构建机器人的控制器的方法、机器人的运动控制方法、装置以及机器人 | |
WO2022264673A1 (ja) | 走行システム | |
CN115328133A (zh) | 一种自带称重功能的激光测距无人搬运车控制*** | |
Bolanakis et al. | Automating loading and locking of new generation air-cargo containers | |
WO2022137746A1 (ja) | ロボット | |
JP7478092B2 (ja) | 荷役車両システム | |
WO2023165192A1 (zh) | 机器人控制方法、装置、机器人以及计算机可读存储介质 | |
JP7487990B1 (ja) | 搬送車の走行制御システム及び搬送車の走行制御方法 | |
CN221138389U (zh) | 一种仓库搬运自动引导车 | |
Capák et al. | Optimization of traction unit for low-cost automated guided vehicle |
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 |