CN107045353A - 全方位移动agv主控系统及其控制方法 - Google Patents
全方位移动agv主控系统及其控制方法 Download PDFInfo
- Publication number
- CN107045353A CN107045353A CN201710417211.9A CN201710417211A CN107045353A CN 107045353 A CN107045353 A CN 107045353A CN 201710417211 A CN201710417211 A CN 201710417211A CN 107045353 A CN107045353 A CN 107045353A
- Authority
- CN
- China
- Prior art keywords
- control
- agv
- microprocessor
- unit
- navigation
- 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 description 26
- 230000033001 locomotion Effects 0.000 claims abstract description 48
- 238000001514 detection method Methods 0.000 claims abstract description 26
- 238000004891 communication Methods 0.000 claims abstract description 22
- 230000001276 controlling effect Effects 0.000 claims abstract description 11
- 230000000875 corresponding effect Effects 0.000 claims abstract description 9
- 230000003993 interaction Effects 0.000 claims description 20
- 230000004888 barrier function Effects 0.000 claims description 11
- 230000036461 convulsion Effects 0.000 claims description 9
- 230000009471 action Effects 0.000 claims description 7
- 230000005856 abnormality Effects 0.000 claims description 6
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 claims description 6
- 229910052782 aluminium Inorganic materials 0.000 claims description 6
- 239000004411 aluminium Substances 0.000 claims description 6
- 230000007246 mechanism Effects 0.000 claims description 6
- 238000012544 monitoring process Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000005611 electricity Effects 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims 1
- 238000009434 installation Methods 0.000 claims 1
- 230000002452 interceptive effect Effects 0.000 claims 1
- 238000004519 manufacturing process Methods 0.000 description 3
- 239000012491 analyte Substances 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000012423 maintenance Methods 0.000 description 2
- 230000000386 athletic effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012790 confirmation Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000036039 immunity 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
- 238000012545 processing Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Abstract
本发明公开了一种全方位移动AGV主控系统，包括障碍物检测单元、视觉导航单元、4个无刷轮毂电机驱动单元、4个工业舵机转向单元、驱动轮电磁制动单元、远程通信模块、电源管理模块、微处理器、工控PC机和远程监控中心；工控PC机通过远程通信模块接收远程监控中心下达的AGV任务命令信息，并将其发送至微处理器；工控PC机还根据视觉导航单元采集的图像，计算出导航偏移量并转化为适当的转向控制量发送至微处理器；微处理器根据接收到的信息控制AGV执行相应动作，同时控制工业舵机转向单元调整各驱动轮运动方向，获取障碍物检测单元检测到的障碍物距离信息。本发明解决传统自主导航成本与稳定性相悖的问题。
Description
技术领域
本发明涉及一种适用于电子产品生产流水线中的全方位移动AGV，尤其涉及该AGV主控系统及其控制方法。
背景技术
AGV是(Automated Guided Vehicle)的简称，是指装备有电磁或光学自动导引装置的“自动导引运输车”，能够按规定的导引路径行驶，同时，具有安全保护及各种移载功能；
目前，AGV系统大多采用两轮差速驱动，导航方式主要分为有轨导航及自主导航，其中，自主导航方法主要以深度视觉和激光导航方式为主，基于深度视觉的自主导航成本较低，但存在动态干扰下的回环检测不稳定问题；而激光自主导航虽然稳定性较好，但大空间下的实施成本相对较高；
此外，目前工业环境中使用的AGV主控系统集成度相对较低，检测、驱动模块与控制模块相对分散，给现场快速维护、检修带来不便。
发明内容
本发明要解决的技术问题是提供一种全方位移动AGV主控系统，解决传统自主导航成本与稳定性相悖的问题。
为解决上述技术问题，本发明采取如下技术方案：全方位移动AGV主控系统，包括障碍物检测单元、视觉导航单元、无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元、远程通信模块、电源管理模块、微处理器、工控PC机、车载人机交互模块(触摸显示屏)、远程监控中心；所述的微处理器与障碍物检测单元、无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元、电源管理模块和工控PC机连接；所述的视觉导航单元与所述的工控PC机连接；所述的工控PC机还通过远程通信模块与所述的远程监控中心连接；
所述的障碍物检测单元用于检测AGV移动过程中遇到的障碍物信息，将检测到的信息上传至微处理器；
所述的视觉导航单元用于采集Apriltag导航标签图像，并将该图像传送至工控PC机；
所述的无刷轮毂电机驱动单元用于驱动AGV的轮毂电机；
所述的工业舵机转向单元用于控制AGV驱动轮的运动方向；
所述的驱动轮电磁制动单元用于控制与轮毂电机连接的电磁刹车机构，实现及时停车；
所述的电源管理模块主要检测电源电量、温度及各驱动模块的电压、电流信息，并将相关信息上传至微处理器，并最终通过485接口上传至工控PC机；
所述的工控PC机包括图像采集模块和无线通讯模块，所述的无线通讯模块与所述的远程监控中心连接，接收远程监控中心下达的AGV任务命令信息，并将任务命令解析发送至微处理器；所述的图像采集模块与所述的视觉导航单元连接，根据视觉导航单元采集的Apriltag导航标签图像，计算出导航偏移量并发送给微处理器，微处理器将导航偏移量转化为转向控制量；
微处理器根据接收到的工控PC机发送的信息控制AGV执行相应动作，同时，将接收的导航偏移量转化为转向控制量控制工业舵机转向单元调整各驱动轮运动方向；微处理器在控制AGV执行相应动作的同时实时获取障碍物检测单元检测到的障碍物距离信息，判断运动方向障碍物分布情况；当障碍物处于干扰AGV运动范围内时，发送控制信号至驱动轮电磁制动单元，并最终驱动与轮毂电机连接的电磁刹车机构产生闭合动作，从而实现及时停车。
进一步地，所述的微处理器主要包含运动控制模块、A\D采集模块和通信模块；所述的微处理器通过通信模块与所述的工控PC机连接，接收到的工控PC机发送的信息控制AGV执行相应动作；所述的运动控制模块控制工业舵机转向单元调整各驱动轮运动方向；A\D采集模块与所述的障碍物检测单元连接，实时获取障碍物检测单元检测到的障碍物距离信息；所述的A\D采集模块接收电源管理模块的信息，并将该信息上传至工控PC机。
进一步地，所述的无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元、电源管理模块和微处理器设置于主控箱体内；所述的主控箱体内设置有四层结构，从上至下依次为系统控制层、电源管理层、电源转换层和驱动层；所述的驱动层包括功率驱动板和铝散热片，铝散热片设置于功率驱动板的下方；所述的电源管理层内设置有电源管理模块；所述的无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元和微处理器设置于系统控制层。
进一步地，所述的主控箱体上设置有散热风扇。
本发明提供一种全方位移动AGV的控制方法，包括在线自主导航控制模式和离线手动运动控制模式；所述的在线自主导航控制模式和所述的手动运动控制模式可自由切换；常规在线自主导航控制模式下，AGV接收远程监控中心下达的运输任务，沿固定轨迹自主导航，当AGV产生脱离轨道、障碍急停等异常状态时， AGV自动执行紧急停车，并报远程监控中心，此时，可通过操作远程监控中心或车载人机交互界面的“手动控制”按钮，使得AGV进入手动运动控制模式；当AGV回归轨道，或其他异常状态解除时，可通过操作远程监控中心或车载人机交互界面的“自主导航”按钮，使得AGV切换至在线自主导航控制模式，继续执行未完成的运输任务；此外，当有其他非常规运输任务需要执行时，亦可通过远程监控中心或车载人机交互界面切换至手动运动控制模式。
进一步地，该控制方法具体如下：
首先将控制系统进行初始化，系统自检，是否运行正常，运行正常则启动该系统，然后选择在线自主导航控制模式或者手动控制模式；
当选择在线自主导航控制模式时，其控制方法如下：首先，远程监控中心通过远程网络通信模块给工控PC机下达任务；工控PC机将接收的任务信息解析，发送至微处理器，微处理器执行远程监控中心下达的任务，通过无刷轮毂电机驱动单元驱动轮毂电机，使AGV移动；
然后，工控PC机基于视觉导航单元采集Apriltag导航标签图像，获取标签中心与相机中心在轨道垂直方向的偏移量Δl(规定左偏时Δl为正，右偏时Δl为负)，该偏移量输入给微处理器，微处理器计算出转向控制量u(t)，计算方式为：(d t 为处理周期，k p 、k d 为调节参数)，经过微处理器控制工业舵机转向单元调整各驱动轮运动方向，从而实时改变机器人当前姿态，达到轨迹跟踪的目的；
在AGV移动过程中微处理器实时获取当前障碍物检测单元检测到的障碍物距离信息，判断运动方向障碍物分布情况，当障碍物处于干扰AGV运动范围内时，发送控制信号至微处理器，微处理器发送制动信息到驱动轮电磁制动单元，驱动与轮毂电机连接的电磁刹车机构产生闭合动作，AGV及时刹车，处于紧急停车状态，急停结束后，继续运行；当障碍物处于干扰AGV运动范围之外时，继续跟踪移动轨迹，直至AGV进入站点，结束任务；
当AGV需要转为手动运动控制模式时，其控制方法如下：
通过远程监控中心或车载人机交互界面下达急停命令，AGV车速降为0，四只电磁制动器迅速闭合，车辆保持稳定停止；此时，通过操作人机交互界面的“左转”、“右转”、“前进”、“后退”、“左横行”、“右横行”、“原地顺时针回转”、“原地逆时针回转”、“停止”操作按钮，可实现AGV手动模式下的姿态调整；通过人机交互界面的“速度”设定对话框，可实现AGV车速的实时调整。此外，还可通过设定“前进方向角”参数，使得AGV在不改变当前姿态的情况下，向设定方向直线移动。
进一步地，AGV运行状态下的微处理器将接收到的AGV速度、当前位置、障碍物距离、电压、电流、电池仓温度、控制箱温度信息实时上传至工控PC机，由工控PC机生成运行日志保存。
本发明的有益效果：本发明将检测单元、驱动单元和通信、运动控制单元集成为一体，在电子产品生产流水线中执行任务时，可通过快速更换主控系统的方式对AGV控制系统进行维护或检修，从而不影响产线正常运行。
本发明4只独立驱动转向系统，使得AGV运动姿态柔性化程度较高，狭小空间下运动更灵活；本发明基于Apriltag定位方式的视觉导航系统，解决了传统视觉轨迹跟踪抗干扰性较差的问题。
附图说明
为了更清晰地说明本发明实施例中的技术方案，下面将对实施例中所需要使用的附图简单地介绍，显而易见地，下面描述中的附图仅仅是本发明中记载的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为四轮全方位移动AGV主控系统结构图。
图2为四轮全方位移动AGV主控系统框图。
图3为四轮全方位移动AGV系统控制流程图。
具体实施方式
下面将通过具体实施方式对本发明的技术方案进行清楚、完整地描述。
如图2所示，本发明的全方位移动AGV主控系统，包括障碍物检测单元（超声波障碍物检测传感器15）、视觉导航单元（高清红外彩色摄像机17）、无刷轮毂电机驱动单元（左前无刷电机驱动器2、左后无刷电机驱动器4、右前无刷电机驱动器6、右后无刷电机驱动器8；左前无刷电机驱动器2驱动左前无刷轮毂电机3；左后无刷电机驱动器4驱动左后无刷轮毂电机3；右前无刷电机驱动器6驱动右前无刷轮毂电机6、右后无刷电机驱动器8驱动右后无刷轮毂电机9）、工业舵机转向单元（左前转向单元10、左后转向单元11、右前转向单元12、左后转向单元13）、驱动轮电磁制动单元16、远程网络通信模块19、电源管理模块14、微处理器1、工控PC机18、车载人机交互模块(触摸显示屏)、远程监控中心；所述的微处理器1与障碍物检测单元、无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元、电源管理模块14和工控PC机18连接；所述的视觉导航单元与所述的工控PC机连接；所述的工控PC机还通过远程网络通信模块19与所述的远程监控中心连接；障碍物检测单元用于检测AGV移动过程中遇到的障碍物信息，将检测到的信息上传至微处理器1；视觉导航单元用于采集Apriltag导航标签图像，并将该图像传送至工控PC机18；无刷轮毂电机驱动单元用于驱动AGV的轮毂电机；工业舵机转向单元用于控制AGV驱动轮的运动方向；驱动轮电磁制动单元用于控制与轮毂电机连接的驱动轮电磁制动单元，实现及时停车；
电源管理模块主要检测电源电量、温度及各驱动模块的电压、电流信息，并将相关信息上传至微处理器，并最终通过485接口上传至工控PC机；当整车电源系统温度、电源输出电流超出设定监测警戒阈值，微处理器可以控制电源管理模块迅速关闭大功率电源，工控PC可监测该关闭动作是否有效完成，若未有效完成，可发送相关控制命令至微处理器，直到相关动作有效完成，同时将故障信息上传远程监控中心；当各大功率驱动模块的电压、电流产生欠压、过压、过流等状态时，工控PC及微处理器可以控制电源管理模块迅速关闭相应驱动模块的电源，并监测该关闭动作是否有效完成，同时将故障信息上传远程监控中心；当电源电压低于设定最小工作电压阈值时，工控PC及微处理器将该能量报警信息上传至远程监控中心，提示监控人员需要给AGV充电，待远程监控中心确认信息后，能量报警信号解除。
工控PC机包括图像采集模块和无线通讯模块，所述的无线通讯模块与所述的远程监控中心连接，接收远程监控中心下达的AGV任务命令信息，并将任务命令解析发送至微处理器；所述的图像采集模块与所述的视觉导航单元连接，根据视觉导航单元采集的Apriltag导航标签图像，计算出导航偏移量并发送给微处理器，微处理器将导航偏移量转化为转向控制量。
微处理器主要包含运动控制模块、A\D采集模块和通信模块；所述的微处理器通过通信模块与所述的工控PC机连接，接收到的工控PC机发送的信息控制AGV执行相应动作；所述的运动控制模块控制工业舵机转向单元调整各驱动轮运动方向；A\D采集模块与所述的障碍物检测单元连接，实时获取障碍物检测单元检测到的障碍物距离信息，判断运动方向障碍物分布情况；当障碍物处于干扰AGV运动范围内时，发送控制信号至驱动轮电磁制动单元，并最终驱动与轮毂电机连接的电磁刹车机构产生闭合动作，从而实现及时停车；所述的A\D采集模块接收电源管理模块的信息，并将该信息上传至工控PC机。
如图1所示，本发明的无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元、电源管理模块和微处理器设置于主控箱体1内；所述的主控箱体内设置有四层结构，从上至下依次为系统控制层107、电源管理层106、电源转换层105和驱动层104；所述的驱动层104包括功率驱动板和铝散热片103，铝散热片103设置于功率驱动板的下方；所述的电源管理层内设置有电源管理模块；所述的无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元和微处理器设置于系统控制层。
本发明的主控箱体上设置有散热风扇102。
本发明提供一种全方位移动AGV的控制方法，包括在线自主导航控制模式和离线手动运动控制模式；所述的在线自主导航控制模式和所述的手动运动控制模式可自由切换，常规在线自主导航控制模式下，AGV接收远程监控中心下达的运输任务，沿固定轨迹自主导航，当AGV产生脱离轨道、障碍急停等异常状态时， AGV自动执行紧急停车，并报远程监控中心，此时，可通过操作远程监控中心或车载人机交互界面的“手动控制”按钮，使得AGV进入手动运动控制模式；当AGV回归轨道，或其他异常状态解除时，可通过操作远程监控中心或车载人机交互界面的“自主导航”按钮，使得AGV切换至在线自主导航控制模式，继续执行未完成的运输任务；此外，当有其他非常规运输任务需要执行时，亦可通过远程监控中心或车载人机交互界面切换至手动运动控制模式。
本发明的控制方法具体如下：首先将控制系统进行初始化，系统自检，是否运行正常，运行正常则启动该系统，然后选择在线自主导航控制模式或者手动控制模式；
当选择在线自主导航控制模式时，其控制方法如下：首先，远程监控中心通过远程网络通信模块给工控PC机下达任务；工控PC机将接收的任务信息解析，发送至微处理器，微处理器执行远程监控中心下达的任务，通过无刷轮毂电机驱动单元驱动轮毂电机，使AGV移动；
然后，工控PC机基于视觉导航单元采集Apriltag导航标签图像，取标签中心与相机中心在轨道垂直方向的偏移量Δl(规定左偏时Δl为正，右偏时Δl为负)，该偏移量输入给微处理器，微处理器计算出转向控制量u(t)，计算方式为：(d t 为处理周期，k p 、k d 为调节参数)，经过微处理器控制工业舵机转向单元调整各驱动轮运动方向，从而实时改变机器人当前姿态，达到轨迹跟踪的目的；
在AGV移动过程中微处理器实时获取当前障碍物检测单元检测到的障碍物距离信息，判断运动方向障碍物分布情况，当障碍物处于干扰AGV运动范围内时，发送控制信号至微处理器，微处理器发送制动信息到驱动轮电磁制动单元，驱动与轮毂电机连接的电磁刹车机构产生闭合动作，AGV及时刹车，处于紧急停车状态，急停结束后，继续运行；当障碍物处于干扰AGV运动范围之外时，继续跟踪移动轨迹，直至AGV进入站点，结束任务；
当AGV需要转为手动运动控制模式时，其控制方法如下：
通过远程监控中心或车载人机交互界面下达急停命令，AGV车速降为0，四只电磁制动器迅速闭合，车辆保持稳定停止；此时，通过操作人机交互界面的“左转”、“右转”、“前进”、“后退”、“左横行”、“右横行”、“原地顺时针回转”、“原地逆时针回转”、“停止”操作按钮，可实现AGV手动模式下的姿态调整；通过人机交互界面的“速度”设定对话框，可实现AGV车速的实时调整。此外，还可通过设定“前进方向角”参数，使得AGV在不改变当前姿态的情况下，向设定方向直线移动。
AGV运行状态下的微处理器将接收到的各数据实时上传至工控PC机，由工控PC机生成运行日志保存。
本发明的基于Apriltag定位方式的视觉导航系统如下：该视觉导航系统主要包括由同一Apriltag标签沿轨道方向排列组成的导航标签带、由不同Apriltag标签组成的站点标签、高清红外彩色摄像机、Apriltag标签信息识别与解码软件组成。系统正常运行状态下，高清红外彩色摄像机采集当前图像并上传至工控PC，Apriltag标签信息识别与解码软件识别当前图像中的Apriltag标签，并解码标签包含的站号信息、标签与摄像机中心的位姿信息；工控PC将当前识别的Apriltag标签与摄像机中心的位姿信息实时上传至微处理器，微处理器根据该信息执行自主导航下的位姿调整；工控PC将当前识别的Apriltag标签包含的站号信息实时上传至微处理器，微处理器根据该信息控制相应单元执行站点任务。
上面所述的实施例仅仅是本发明的优选实施方式进行描述，并非对本发明的构思和范围进行限定，在不脱离本发明设计构思的前提下，本领域中普通工程技术人员对本发明的技术方案作出的各种变型和改进均应落入本发明的保护范围，本发明的请求保护的技术内容，已经全部记载在技术要求书中。
Claims (7)
1.全方位移动AGV主控系统，其特征在于：包括障碍物检测单元、视觉导航单元、4个无刷轮毂电机驱动单元、4个工业舵机转向单元、驱动轮电磁制动单元、电源管理模块、微处理器、工控PC机、车载人机交互模块和远程监控中心；所述的微处理器与障碍物检测单元、无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元、电源管理模块和工控PC机连接；所述的视觉导航单元与所述的工控PC机连接；所述的工控PC机与所述的远程监控中心连接；
所述的障碍物检测单元用于检测AGV移动过程中遇到的障碍物信息，将检测到的信息上传至微处理器；
所述的视觉导航单元用于采集Apriltag导航标签图像，并将该图像传送至工控PC机；
所述的无刷轮毂电机驱动单元用于驱动AGV的轮毂电机；
所述的工业舵机转向单元用于控制AGV驱动轮的运动方向；
所述的驱动轮电磁制动单元用于控制与轮毂电机连接的电磁刹车机构，实现及时停车；
所述的电源管理模块主要检测电源电量、温度及各驱动模块的电压、电流信息，并将相关信息上传至微处理器，并最终上传至工控PC机；
所述的工控PC机包括图像采集模块和无线通讯模块，所述的无线通讯模块与所述的远程监控中心连接，接收远程监控中心下达的AGV任务命令信息，并将任务命令解析发送至微处理器；所述的图像采集模块与所述的视觉导航单元连接，根据视觉导航单元采集的Apriltag导航标签图像，计算出导航偏移量并发送给微处理器，微处理器将导航偏移量转化为转向控制量；
微处理器根据接收到的工控PC机发送的信息控制AGV执行相应动作，同时，调整各驱动轮运动方向；微处理器在控制AGV执行相应动作的同时实时获取障碍物检测单元检测到的障碍物距离信息，判断运动方向障碍物分布情况；当障碍物处于干扰AGV运动范围内时，发送控制信号至驱动轮电磁制动单元，并最终驱动与轮毂电机连接的电磁刹车机构产生闭合动作，从而实现及时停车。
2.根据权利要求1所述的全方位移动AGV主控系统，其特征在于：所述的微处理器主要包含运动控制模块、A\D采集模块和通信模块；所述的微处理器通过通信模块与所述的工控PC机连接，接收到的工控PC机发送的信息控制AGV执行相应动作；所述的运动控制模块控制工业舵机转向单元调整各驱动轮运动方向；A\D采集模块与所述的障碍物检测单元连接，实时获取障碍物检测单元检测到的障碍物距离信息；所述的A\D采集模块接收电源管理模块的信息，并将该信息上传至工控PC机。
3.根据权利要求1所述的全方位移动AGV主控系统，其特征在于：所述的无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元、电源管理模块和微处理器设置于主控箱体内；所述的主控箱体内设置有四层结构，从上至下依次为系统控制层、电源管理层、电源转换层和驱动层；所述的驱动层包括功率驱动板和铝散热片，铝散热片设置于功率驱动板的下方；所述的电源管理层内设置有电源管理模块；所述的无刷轮毂电机驱动单元、工业舵机转向单元、驱动轮电磁制动单元和微处理器设置于系统控制层。
4.根据权利要求3所述的全方位移动AGV主控系统，其特征在于：所述的主控箱体上设置有散热风扇。
5.全方位移动AGV的控制方法，其特征在于：包括在线自主导航控制模式和离线手动运动控制模式；所述的在线自主导航控制模式和所述的手动运动控制模式可自由切换，常规在线自主导航控制模式下，AGV接收远程监控中心下达的运输任务，沿固定轨迹自主导航，当AGV产生脱离轨道、障碍急停等异常状态时， AGV自动执行紧急停车，并报远程监控中心，此时，可通过操作远程监控中心或车载人机交互界面的“手动控制”按钮，使得AGV进入手动运动控制模式；当AGV回归轨道，或其他异常状态解除时，可通过操作远程监控中心或车载人机交互界面的“自主导航”按钮，使得AGV切换至在线自主导航控制模式，继续执行未完成的运输任务；此外，当有其他非常规运输任务需要执行时，亦可通过远程监控中心或车载人机交互界面切换至手动运动控制模式。
6.根据权利要求5所述的全方位移动AGV的控制方法，其特征在于：该控制方法具体如下：首先将控制系统进行初始化，系统自检，是否运行正常，运行正常则启动该系统，然后选择在线自主导航控制模式或者手动控制模式；
当选择在线自主导航控制模式时，其控制方法如下：首先，远程监控中心通过远程网络通信模块给工控PC机下达任务；工控PC机将接收的任务信息解析，发送至微处理器，微处理器执行远程监控中心下达的任务，通过无刷轮毂电机驱动单元驱动轮毂电机，使AGV移动；
然后，工控PC机基于视觉导航单元采集Apriltag导航标签图像，获取标签中心与相机
中心在轨道垂直方向的偏移量Δl，该偏移量输入给微处理器，微处理器计算出转向控制量u(t)，计算方式为：说明: 说明: 说明: 说明: D:\360安全浏览器下载\CPC安装程序\cases\inventions\b354e52d-e46c-4e5e-9ec5-23658c8f093c\new\100001\dest_path_image002.jpg，其中，dt为处理周期，kp、kd为调节参数，最终控
制工业舵机转向单元调整各驱动轮运动方向，从而实时改变机器人当前姿态，达到轨迹跟
踪的目的；
再然后，在AGV移动过程中微处理器实时获取当前障碍物检测单元检测到的障碍物距离信息，判断运动方向障碍物分布情况，当障碍物处于干扰AGV运动范围内时，发送控制信号至微处理器，微处理器发送制动信息到驱动轮电磁制动单元，驱动与轮毂电机连接的电磁刹车机构产生闭合动作，AGV及时刹车，处于紧急停车状态，急停结束后，继续运行；当障碍物处于干扰AGV运动范围之外时，继续跟踪移动轨迹，直至AGV进入站点，结束任务；
当AGV需要转为手动运动控制模式时，其控制方法如下：
通过远程监控中心或车载人机交互界面下达急停命令，AGV车速降为0，四只电磁制动器迅速闭合，车辆保持稳定停止；此时，通过操作人机交互界面的“左转”、“右转”、“前进”、“后退”、“左横行”、“右横行”、“原地顺时针回转”、“原地逆时针回转”、“停止”操作按钮，可实现AGV手动模式下的姿态调整；通过人机交互界面的“速度”设定对话框，可实现AGV车速的实时调整；还可通过设定“前进方向角”参数，使得AGV在不改变当前姿态的情况下，向设定方向直线移动。
7.根据权利要求5或6所述的全方位移动AGV的控制方法，其特征在于：AGV运行状态下的微处理器将接收到的AGV速度、当前位置、障碍物距离、电压、电流、电池仓温度、控制箱温度信息实时上传至工控PC机，由工控PC机生成运行日志保存。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710417211.9A CN107045353A (zh) | 2017-06-06 | 2017-06-06 | 全方位移动agv主控系统及其控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710417211.9A CN107045353A (zh) | 2017-06-06 | 2017-06-06 | 全方位移动agv主控系统及其控制方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN107045353A true CN107045353A (zh) | 2017-08-15 |
Family
ID=59546753
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710417211.9A Pending CN107045353A (zh) | 2017-06-06 | 2017-06-06 | 全方位移动agv主控系统及其控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107045353A (zh) |
Cited By (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107977002A (zh) * | 2017-11-24 | 2018-05-01 | 北京益康生活智能科技有限公司 | 一种手自一体的移动平台控制系统及方法 |
| CN109101981A (zh) * | 2018-07-19 | 2018-12-28 | 东南大学 | 一种街景场景下基于全局图像条纹码的回环检测方法 |
| CN109131630A (zh) * | 2018-08-28 | 2019-01-04 | 中科新松有限公司 | 一种复合机器人和复合机器人的控制方法 |
| CN109189073A (zh) * | 2018-09-28 | 2019-01-11 | 华南理工大学 | 一种基于apriltag定位的机器人及巡逻方法 |
| CN109500827A (zh) * | 2018-11-23 | 2019-03-22 | 北京中大科慧科技发展有限公司 | 机房智能巡检机器人 |
| CN110096055A (zh) * | 2019-03-28 | 2019-08-06 | 浙江科技学院 | 一种智能送餐导航方法及导航系统 |
| CN110262362A (zh) * | 2019-07-16 | 2019-09-20 | 上海快仓智能科技有限公司 | 一种agv工作温度监控方法、系统及装置 |
| CN110390833A (zh) * | 2019-06-03 | 2019-10-29 | 杭州电子科技大学 | 一种交通指示设施遮挡检测方法 |
| CN111397609A (zh) * | 2020-05-13 | 2020-07-10 | 广东星舆科技有限公司 | 路径规划方法、移动式机器及计算机可读介质 |
| CN111459133A (zh) * | 2020-03-20 | 2020-07-28 | 红云红河烟草(集团)有限责任公司 | 一种agv小车自动调试系统 |
| CN111452029A (zh) * | 2020-04-14 | 2020-07-28 | 山东乐普韦尔自动化技术有限公司 | 一种带电作业机器人控制系统及带电作业机器人 |
| CN111638718A (zh) * | 2020-06-09 | 2020-09-08 | 安徽意欧斯物流机器人有限公司 | 一种差速驱动agv控制系统 |
| CN112339882A (zh) * | 2020-10-10 | 2021-02-09 | 蓝普金睛（北京）科技有限公司 | 基于轮毂电机的agv移动平台系统及方法 |
| CN112631289A (zh) * | 2020-12-10 | 2021-04-09 | 中建材创新科技研究院有限公司 | 一种激光导航叉车的自动安全避障系统及方法 |
| CN112947410A (zh) * | 2021-01-26 | 2021-06-11 | 浙江亿控自动化设备有限公司 | 一种叉车运行启动控制方法 |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN202093392U (zh) * | 2011-05-19 | 2011-12-28 | 苏州市职业大学 | 一种agv系统的硬件平台 |
| CN203444333U (zh) * | 2013-08-13 | 2014-02-19 | 武汉理工大学 | 磁带导引agv小车中央控制系统 |
| CN205281258U (zh) * | 2015-12-31 | 2016-06-01 | 浙江同筑科技有限公司 | 基于arm的agv双层控制系统 |
| CN105892466A (zh) * | 2016-05-02 | 2016-08-24 | 合肥学院 | 一种基于uCOS的AGV控制系统 |
| CN206012764U (zh) * | 2016-08-19 | 2017-03-15 | 江苏力德尔电子信息技术有限公司 | 四轮驱动agv |
-
2017
- 2017-06-06 CN CN201710417211.9A patent/CN107045353A/zh active Pending
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN202093392U (zh) * | 2011-05-19 | 2011-12-28 | 苏州市职业大学 | 一种agv系统的硬件平台 |
| CN203444333U (zh) * | 2013-08-13 | 2014-02-19 | 武汉理工大学 | 磁带导引agv小车中央控制系统 |
| CN205281258U (zh) * | 2015-12-31 | 2016-06-01 | 浙江同筑科技有限公司 | 基于arm的agv双层控制系统 |
| CN105892466A (zh) * | 2016-05-02 | 2016-08-24 | 合肥学院 | 一种基于uCOS的AGV控制系统 |
| CN206012764U (zh) * | 2016-08-19 | 2017-03-15 | 江苏力德尔电子信息技术有限公司 | 四轮驱动agv |
Cited By (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107977002A (zh) * | 2017-11-24 | 2018-05-01 | 北京益康生活智能科技有限公司 | 一种手自一体的移动平台控制系统及方法 |
| CN109101981A (zh) * | 2018-07-19 | 2018-12-28 | 东南大学 | 一种街景场景下基于全局图像条纹码的回环检测方法 |
| CN109101981B (zh) * | 2018-07-19 | 2021-08-24 | 东南大学 | 一种街景场景下基于全局图像条纹码的回环检测方法 |
| CN109131630A (zh) * | 2018-08-28 | 2019-01-04 | 中科新松有限公司 | 一种复合机器人和复合机器人的控制方法 |
| CN109189073A (zh) * | 2018-09-28 | 2019-01-11 | 华南理工大学 | 一种基于apriltag定位的机器人及巡逻方法 |
| CN109500827A (zh) * | 2018-11-23 | 2019-03-22 | 北京中大科慧科技发展有限公司 | 机房智能巡检机器人 |
| CN110096055A (zh) * | 2019-03-28 | 2019-08-06 | 浙江科技学院 | 一种智能送餐导航方法及导航系统 |
| CN110390833B (zh) * | 2019-06-03 | 2020-12-29 | 杭州电子科技大学 | 一种交通指示设施遮挡检测方法 |
| CN110390833A (zh) * | 2019-06-03 | 2019-10-29 | 杭州电子科技大学 | 一种交通指示设施遮挡检测方法 |
| CN110262362A (zh) * | 2019-07-16 | 2019-09-20 | 上海快仓智能科技有限公司 | 一种agv工作温度监控方法、系统及装置 |
| CN111459133A (zh) * | 2020-03-20 | 2020-07-28 | 红云红河烟草(集团)有限责任公司 | 一种agv小车自动调试系统 |
| CN111452029A (zh) * | 2020-04-14 | 2020-07-28 | 山东乐普韦尔自动化技术有限公司 | 一种带电作业机器人控制系统及带电作业机器人 |
| CN111452029B (zh) * | 2020-04-14 | 2023-12-29 | 山东乐普韦尔自动化技术有限公司 | 一种带电作业机器人控制系统及带电作业机器人 |
| CN111397609A (zh) * | 2020-05-13 | 2020-07-10 | 广东星舆科技有限公司 | 路径规划方法、移动式机器及计算机可读介质 |
| CN111638718A (zh) * | 2020-06-09 | 2020-09-08 | 安徽意欧斯物流机器人有限公司 | 一种差速驱动agv控制系统 |
| CN112339882A (zh) * | 2020-10-10 | 2021-02-09 | 蓝普金睛（北京）科技有限公司 | 基于轮毂电机的agv移动平台系统及方法 |
| CN112631289A (zh) * | 2020-12-10 | 2021-04-09 | 中建材创新科技研究院有限公司 | 一种激光导航叉车的自动安全避障系统及方法 |
| CN112631289B (zh) * | 2020-12-10 | 2024-03-26 | 中建材创新科技研究院有限公司 | 一种激光导航叉车的自动安全避障系统及方法 |
| CN112947410A (zh) * | 2021-01-26 | 2021-06-11 | 浙江亿控自动化设备有限公司 | 一种叉车运行启动控制方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107045353A (zh) | 全方位移动agv主控系统及其控制方法 | |
| CN101954191B (zh) | 一种智能娱乐移动机器人 | |
| CN110989526B (zh) | 一种双agv协同运载控制系统及方法 | |
| Du et al. | Autonomous reverse parking system based on robust path generation and improved sliding mode control | |
| CN1331641C (zh) | 保安巡逻机器狗 | |
| CN107193283A (zh) | 一种自主导航的移动机器人及其操作方法 | |
| CN102887123B (zh) | 一种全线控电动汽车中央控制器及其控制方法 | |
| CN110409550A (zh) | 一种全自动作业地下采矿铲运机 | |
| CN205375196U (zh) | 用于风电场巡检的群组机器人控制装置 | |
| CN107329466A (zh) | 一种自动驾驶小型车 | |
| CN108519814A (zh) | 一种人机交互操作系统 | |
| CN103268111A (zh) | 一种网络化分布式多移动机器人系统 | |
| CN110155163A (zh) | 一种无人驾驶转向系统及车辆 | |
| CN106379441B (zh) | 自动导引运输车以及自动导引运输方法 | |
| CN108279681A (zh) | 一种两轮驱动型低速巡逻车系统及工作方法 | |
| CN106737563A (zh) | 一种轻型轨道机器人四驱运动控制系统及其方法 | |
| CN107719376B (zh) | 人机混合增强智能驾驶系统及电动汽车 | |
| CN109799833A (zh) | 一种两轮驱动低速无人驾驶巡逻车系统及工作方法 | |
| CN110091731A (zh) | 一种长距离重载车辆型agv控制系统 | |
| CN108172024A (zh) | 一种基于智能泊车的停车场管理系统 | |
| CN109799832A (zh) | 一种四轮驱动低速无人驾驶巡逻车系统及工作方法 | |
| CN108202325A (zh) | 自主作业林业机器人智能控制系统 | |
| CN106959692B (zh) | 一种基于无线物联网的超驰控制避障智能车及其控制方法 | |
| CN109799831A (zh) | 一种两轮驱动型快速巡逻车系统及工作方法 | |
| CN202147681U (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 | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170815 |
|
| RJ01 | Rejection of invention patent application after publication |