CN108248681A - 一种四轮独立驱动转向机器人的主从控制系统 - Google Patents
一种四轮独立驱动转向机器人的主从控制系统 Download PDFInfo
- Publication number
- CN108248681A CN108248681A CN201810041000.4A CN201810041000A CN108248681A CN 108248681 A CN108248681 A CN 108248681A CN 201810041000 A CN201810041000 A CN 201810041000A CN 108248681 A CN108248681 A CN 108248681A
- Authority
- CN
- China
- Prior art keywords
- wheel hub
- robot
- controller
- steering
- hub motors
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
- B62D6/001—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits the torque NOT being among the input parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J3/00—Manipulators of master-slave type, i.e. both controlling unit and controlled unit perform corresponding spatial movements
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
- B60L15/2009—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed for braking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
- B60L15/28—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed without contact making and breaking, e.g. using a transductor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/32—Control or regulation of multiple-unit electrically-propelled vehicles
- B60L15/38—Control or regulation of multiple-unit electrically-propelled vehicles with automatic control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D7/00—Steering linkage; Stub axles or their mountings
- B62D7/06—Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins
- B62D7/14—Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering
- B62D7/142—Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering specially adapted for particular vehicles, e.g. tractors, carts, earth-moving vehicles, trucks
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
- Y02T90/10—Technologies relating to charging of electric vehicles
- Y02T90/16—Information or communication technologies improving the operation of electric vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Power Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Robotics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种四轮独立驱动转向机器人的主从控制系统,用于解决现有技术中的移动机器人大多为两轮驱动转向机器人,转向较为不便,仅能应对较为简单的巡检任务,在面对电力系统复杂的检测环境时难以有效胜任巡检任务的技术问题。本发明中通过上位机和下位机的配合,根据预期的巡检路径规划分解得到机器人四个轮毂电机的期望转速和期望线加速度以及四个转向舵机的期望角度、期望角速度和期望角加速度并传输至对应的轮毂电机从控制器和转向舵机从控制器,最后由轮毂电机从控制器和转向舵机从控制器分别执行对各自对应的轮毂电机和转向舵机的控制,实现机器人的四轮独立驱动转向。
Description
技术领域
本发明涉及机器人技术领域,尤其涉及一种四轮独立驱动转向机器人的主从控制系统。
背景技术
随着经济的高速发展,电力系统规模不断扩大,对电力系统稳定性的要求不断提高。而现有人工巡检模式劳动强度大,检测质量分散,受恶劣天气干扰大,较难满足上述需要。随着机器人技术的出现,机器人能代替人工承担操作难度大、精度要求高的工作,机器人已经越来越多的为工业领域所关注。
目前的移动机器人大多为两轮驱动转向机器人,转向较为不便,仅能应对较为简单的巡检任务,在面对电力系统复杂的检测环境时难以有效胜任巡检任务。
发明内容
本发明提供了一种四轮独立驱动转向机器人的主从控制系统,解决了现有技术中的移动机器人大多为两轮驱动转向机器人,转向较为不便,仅能应对较为简单的巡检任务,在面对电力系统复杂的检测环境时难以有效胜任巡检任务的技术问题。
本发明提供的一种四轮独立驱动转向机器人的主从控制系统,包括:
上位机、下位机、四个轮毂电机从控制器和四个转向舵机从控制器;
所述上位机与所述下位机通讯连接,用于将根据路径规划计算获得的机器人的期望速度和期望转向角度发送至所述下位机;
所述下位机用于将所述期望速度按所述机器人的数学模型分解为四个轮毂电机对应的期望转速和期望线加速度,以及将所述期望转向角度按所述机器人的数学模型分解为四个转向舵机对应的期望角度、期望角速度和期望角加速度;
所述下位机与所述四个轮毂电机从控制器连接,用于将所述四个轮毂电机对应的期望转速和期望线加速度分别对应发送至所述四个轮毂电机从控制器,以便于所述四个轮毂电机从控制器分别控制对应的轮毂电机;
所述下位机与所述四个转向舵机从控制器连接,用于将四个转向舵机对应的期望角度、期望角速度和期望角加速度分别对应发送至所述四个转向舵机从控制器,以便于所述四个转向舵机从控制器分别控制对应的转向舵机。
本发明提供的一种四轮独立驱动转向机器人的主从控制系统,还包括至少一个霍尔传感器;
所述霍尔传感器的输入端与所述四个轮毂电机连接,所述霍尔传感器的输出端通过所述四个轮毂电机从控制器与所述下位机连接,用于将所述四个轮毂电机的实时转速和实时线加速度传输至所述下位机;
所述下位机还用于根据所述四个轮毂电机的实时转速和实时线加速度结合比例-积分-微分PID控制算法对所述四个轮毂电机的转速和线加速度进行控制调整。
优选地,所述四个轮毂电机从控制器包括脉冲宽度信号驱动电路和霍尔传感器接口电路;
所述四个轮毂电机从控制器通过脉冲宽度信号驱动电路驱动所述四个轮毂电机;
所述四个轮毂电机从控制器通过所述霍尔传感器接口电路与所述霍尔传感器连接。
本发明提供的一种四轮独立驱动转向机器人的主从控制系统,还包括至少一个编码器;
所述编码器的输入端与所述四个转向舵机连接,所述编码器的输出端与所述下位机连接,用于将所述四个转向舵机的实时角度、实时角速度和实时角加速度传输至所述下位机;
所述下位机还用于根据所述四个转向舵机的实时角度、实时角速度和实时角加速度结合PID控制算法对所述四个转向舵机的角度、角速度和角加速度进行控制调整。
优选地,所述四个转向舵机从控制器包括脉冲信号驱动电路和编码器接口电路;
所述四个转向舵机从控制器通过脉冲信号驱动电路驱动所述四个转向舵机;
所述四个转向舵机从控制器通过所述编码器接口电路与所述编码器连接。
优选地,所述下位机分别通过四个从控制器串口与所述四个轮毂电机从控制器连接,且所述下位机通过设定的不同的地址位标识对所述四个轮毂电机从控制器独立操作。
本发明提供的一种四轮独立驱动转向机器人的主从控制系统,还包括:超声波检测传感器,所述下位机与所述超声波检测传感器连接,用于接收所述超声波检测传感器的障碍检测数据并控制所述四个轮毂电机制动。
本发明提供的一种四轮独立驱动转向机器人的主从控制系统,还包括:红外检测传感器,所述下位机与所述红外检测传感器连接,用于接收所述红外检测传感器的凹坑检测数据并控制所述四个轮毂电机制动。
优选地,所述上位机为工控机,所述下位机为单片机主控制器。
优选地,所述主从控制系统安装于机器人的底盘上。
从以上技术方案可以看出,本发明具有以下优点:
本发明中采用了两级控制体系,分别为由上位机和下位机构成的主控制体系和由四个轮毂电机从控制器和四个转向舵机从控制器构成的从控制体系,通过上位机和下位机的配合,根据预期的巡检路径规划分解得到机器人四个轮毂电机的期望转速和期望线加速度以及四个转向舵机的期望角度、期望角速度和期望角加速度并传输至对应的轮毂电机从控制器和转向舵机从控制器,最后由轮毂电机从控制器和转向舵机从控制器分别执行对各自对应的轮毂电机和转向舵机的控制,本发明中通过设置了两级控制体系,并且使得主从控制体系之间分工明确,将整个机器人的速度和转向具体分解到各个轮毂电机和各个转向舵机,实现了机器人四个轮子的独立驱动和独立转向,能够使得机器人的驱动和转向更为灵活敏捷,令到机器人在复杂的检测环境时能够实现位姿微调以及原地转向,从而胜任电力系统中复杂环境的巡检任务。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其它的附图。
图1为本发明实施例提供的一种四轮独立驱动转向机器人的主从控制系统的结构示意图;
图2(a)为本发明实施例中提供的机器人实际运动过程中的一个轮毂电机速度响应曲线;
图2(b)为本发明实施例中提供的机器人实际运动过程中的另一个轮毂电机速度响应曲线;
图2(c)为本发明实施例中提供的机器人实际运动过程中的再一个轮毂电机速度响应曲线;
图2(d)为本发明实施例中提供的机器人实际运动过程中的又一个轮毂电机速度响应曲线;
图3为本发明实施例提供的一种四轮独立驱动转向机器人的主从控制系统的运动模式框架图。
具体实施方式
本发明实施例提供了一种四轮独立驱动转向机器人的主从控制系统,用于解决现有技术中的移动机器人大多为两轮驱动转向机器人,转向较为不便,仅能应对较为简单的巡检任务,在面对电力系统复杂的检测环境时难以有效胜任巡检任务的技术问题。
为使得本发明的发明目的、特征、优点能够更加的明显和易懂,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,下面所描述的实施例仅仅是本发明一部分实施例,而非全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
请参阅图1,图1为本发明实施例提供的一种四轮独立驱动转向机器人的主从控制系统的结构示意图。
本发明提供的一种四轮独立驱动转向机器人的主从控制系统,包括:
上位机、下位机、四个轮毂电机从控制器和四个转向舵机从控制器;
所述上位机与所述下位机通讯连接,用于将根据路径规划计算获得的机器人的期望速度和期望转向角度发送至所述下位机;所述下位机用于将所述期望速度按所述机器人的数学模型分解为四个轮毂电机对应的期望转速和期望线加速度,以及将所述期望转向角度按所述机器人的数学模型分解为四个转向舵机对应的期望角度、期望角速度和期望角加速度。所述下位机与所述四个轮毂电机从控制器连接,用于将所述四个轮毂电机对应的期望转速和期望线加速度分别对应发送至所述四个轮毂电机从控制器,以便于所述四个轮毂电机从控制器分别控制对应的轮毂电机。所述下位机与所述四个转向舵机从控制器连接,用于将四个转向舵机对应的期望角度、期望角速度和期望角加速度分别对应发送至所述四个转向舵机从控制器,以便于所述四个转向舵机从控制器分别控制对应的转向舵机。可以理解的是,本发明实施例中所提及的上位机和下位机均可以安装在底盘上,四个轮毂电机从控制器和四个转向舵机从控制器可以安装于底盘上或者安装于与其连接的一体轮毂电机上。需要注意的是,本发明实施例中所提及的四个轮毂电机从控制器和四个转向舵机从控制器分别与机器人的四个轮子连接,用于单独控制机器人的四个轮子的移动和转向。
具体的,本发明实施例中的上位机可以为工控机,下位机为采用STM32f407VET6芯片的单片机主控制器,该单片机主控制器有多个串口可供使用,由上位机进行机器人巡检路线的规划以及巡检过程中的导航,并且实现对机器人移动过程中的监控和运动的决策(即决定机器人是否移动以及如何移动)。上位机与下位机之间通过USB转RS232串口连接,在上位机将机器人的移动决策下传至下位机之后,由下位机根据机器人的具体实际数学模型将机器人在移动过程中的期望速度和期望转向角度进行分解,并具体分解到四个轮子中的轮毂电机和转向舵机中。另外,下位机与四个轮毂电机从控制器之间基于MODBUS-RTU通讯协议并通过RS485总线进行连接,下位机与四个转向舵机从控制器之间基于RS232串口通讯协议并通过RS485总线进行连接。此外,基于采用STM32f407VET6芯片的单片机主控制器的多串口,还可以通过接入无线遥控手柄对机器人的运动实现控制。
为了提高机器人移动中的精确度,以及实时对机器人移动过程中出现的移动偏差进行修正,本发明提供的一种四轮独立驱动转向机器人的主从控制系统,还包括至少一个霍尔传感器;所述霍尔传感器的输入端与所述四个轮毂电机连接,所述霍尔传感器的输出端通过所述四个轮毂电机从控制器与所述下位机连接,用于将所述四个轮毂电机的实时转速和实时线加速度传输至所述下位机;所述下位机还用于根据所述四个轮毂电机的实时转速和实时线加速度结合比例-积分-微分(proportion integral derivative,PID)控制算法对所述四个轮毂电机的转速和线加速度进行控制调整。具体的,可以在机器人中设置四个霍尔传感器,并分别与四个轮毂电机连接,实时将机器人移动过程中每个轮毂电机的实时转速和实时线加速度通过各自的轮毂电机从控制器返回至下位机中,实现机器人移动过程中的实时反馈。具体的,可以参阅图2(a)~图2(d),图2(a)为本发明实施例中提供的机器人实际运动过程中的一个轮毂电机速度响应曲线;图2(b)为本发明实施例中提供的机器人实际运动过程中的另一个轮毂电机速度响应曲线;图2(c)为本发明实施例中提供的机器人实际运动过程中的再一个轮毂电机速度响应曲线;图2(d)为本发明实施例中提供的机器人实际运动过程中的又一个轮毂电机速度响应曲线。由图可以看出,经过霍尔传感器的反馈调节,在扰动情况下,轮毂电机的速度响应收敛,并逐渐趋向稳定。
需要说明的是,所述四个轮毂电机从控制器还包括脉冲宽度信号驱动电路和霍尔传感器接口电路;所述四个轮毂电机从控制器通过脉冲宽度信号驱动电路驱动所述四个轮毂电机;所述四个轮毂电机从控制器通过所述霍尔传感器接口电路与所述霍尔传感器连接。
为了提高机器人移动中的精确度,以及实时对机器人移动过程中出现的转向偏差进行修正,本发明实施例中提供的一种四轮独立驱动转向机器人的主从控制系统,还包括至少一个编码器;
所述编码器的输入端与所述四个转向舵机连接,所述编码器的输出端与所述下位机连接,用于将所述四个转向舵机的实时角度、实时角速度和实时角加速度传输至所述下位机;所述下位机还用于根据所述四个转向舵机的实时角度、实时角速度和实时角加速度结合PID控制算法对所述四个转向舵机的角度、角速度和角加速度进行控制调整。
需要说明的是,所述四个转向舵机从控制器还包括脉冲信号驱动电路和编码器接口电路;所述四个转向舵机从控制器通过脉冲信号驱动电路驱动所述四个转向舵机;所述四个转向舵机从控制器通过所述编码器接口电路与所述编码器连接。
进一步地,所述下位机分别通过四个从控制器串口与所述四个轮毂电机从控制器连接,且所述下位机通过设定的不同的地址位标识对所述四个轮毂电机从控制器独立操作,即轮毂电机从控制器支持多站点通讯,多台轮毂电机从控制器并联后与主控制模块相连,下位机可以通过每台驱动器设定的不同的地址位标识来对每台轮毂电机从控制器进行独立操作。此外,从控制器串口属于对外连接口,为了避免引入外界干扰,可以用高速的光电耦合器进行隔离。
本发明提供的一种四轮独立驱动转向机器人的主从控制系统,还包括:超声波检测传感器,所述下位机与所述超声波检测传感器连接,用于接收所述超声波检测传感器的障碍检测数据并通过四个轮毂电机从控制器控制所述四个轮毂电机制动。超声波检测传感器可以安装在机器人的底盘或机器人的身体上,主要用于探测道路前方的障碍物,在超声波检测传感器检测到前方具有障碍物时,将障碍检测数据实时传输至下位机中,并由下位机进行紧急制动控制,避免机器人触障。
进一步地,由于电力巡检环境中有可能存在凹坑等较为恶劣的环境,本发明提供的一种四轮独立驱动转向机器人的主从控制系统,还包括:红外检测传感器,所述下位机与所述红外检测传感器连接,用于接收所述红外检测传感器的凹坑检测数据并控制所述四个轮毂电机制动。其中,红外检测传感器可以安装于机器人的底盘上,并实时检测斜前方的道路环境,在检测到前方有凹坑的情况下,实时将红外检测数据反馈至下位机中,由下位机通过四个轮毂电机从控制器控制所述四个轮毂电机制动。
以上为对本发明实施例提供的一种四轮独立驱动转向机器人的主从控制系统的结构的详细描述,以下将对基于本发明实施例提供的一种四轮独立驱动转向机器人的主从控制系统的机器人所能实现的运动模式进行详细的描述。
请参阅图3,图3为本发明实施例提供的一种四轮独立驱动转向机器人的主从控制系统的运动模式框架图。
基于本发明实施例提供的四轮独立驱动转向机器人的主从控制系统,机器人可以实现如下几种运动模式的切换。
1)原地转向模式
当在一些空间极为狭窄的地方如变电室、阀厅或机房等,并出于检测仪器仪表的需要,需要机器人进行调整位姿时,就需要机器人具有绕着自身的中心旋转的能力。具体的,可以通过本发明实施例提供的主从控制系统,控制机器人的四个轮子只进行转向运动,即控制四个轮毂电机和四个转向舵机配合运动,实现机器人原地转向。
2)两轮驱动两轮转向模式
在一些路况较好,运动空间较大,对灵活性要求不高的路径上,考虑到简化控制方式,减少电池电量的消耗,进一步提高巡检机器人的续航能力,可以将机器人的运动模式切换为两轮驱动两轮转向的运动控制方式。具体的,可以为两个前轮进行转向,两个后轮进行驱动,即在前进过程中,只需要控制两个前轮对应的转向舵机以及两个后轮对应的轮毂电机,从而简化了对机器人的控制。
3)四轮转向模式
在四轮转向模式中,机器人的后轮能在转弯时也能偏转一定角度,可抵消在转弯速度过快的情况下所导致的侧偏力,在偏高速转弯时切换为四轮转向模式,可保证巡检机器人运行的稳定性,避免侧滑等现象的产生;同时在一些空间狭小,运动环境较差的环境中,由于四轮转向模式的转弯半径是两轮驱动两轮转向模式的一半,切换为四轮转向模式还可以提高机动性以及转向的响应速度。
本发明中采用了两级控制体系,分别为由上位机和下位机构成的主控制体系和由四个轮毂电机从控制器和四个转向舵机从控制器构成的从控制体系,通过上位机和下位机的配合,根据预期的巡检路径规划分解得到机器人四个轮毂电机的期望转速和期望线加速度以及四个转向舵机的期望角度、期望角速度和期望角加速度并传输至对应的轮毂电机从控制器和转向舵机从控制器,最后由轮毂电机从控制器和转向舵机从控制器分别执行对各自对应的轮毂电机和转向舵机的控制,本发明中通过设置了两级控制体系,并且使得主从控制体系之间分工明确,将整个机器人的速度和转向具体分解到各个轮毂电机和各个转向舵机,实现了机器人四个轮子的独立驱动和独立转向,能够使得机器人的驱动和转向更为灵活敏捷,令到机器人在复杂的检测环境时能够实现位姿微调以及原地转向,从而胜任电力系统中复杂环境的巡检任务。
以上所述,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种四轮独立驱动转向机器人的主从控制系统,其特征在于,包括:
上位机、下位机、四个轮毂电机从控制器和四个转向舵机从控制器;
所述上位机与所述下位机通讯连接,用于将根据路径规划计算获得的机器人的期望速度和期望转向角度发送至所述下位机;
所述下位机用于将所述期望速度按所述机器人的数学模型分解为四个轮毂电机对应的期望转速和期望线加速度,以及将所述期望转向角度按所述机器人的数学模型分解为四个转向舵机对应的期望角度、期望角速度和期望角加速度;
所述下位机与所述四个轮毂电机从控制器连接,用于将所述四个轮毂电机对应的期望转速和期望线加速度分别对应发送至所述四个轮毂电机从控制器,以便于所述四个轮毂电机从控制器分别控制对应的轮毂电机;
所述下位机与所述四个转向舵机从控制器连接,用于将四个转向舵机对应的期望角度、期望角速度和期望角加速度分别对应发送至所述四个转向舵机从控制器,以便于所述四个转向舵机从控制器分别控制对应的转向舵机。
2.根据权利要求1所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,还包括至少一个霍尔传感器;
所述霍尔传感器的输入端与所述四个轮毂电机连接,所述霍尔传感器的输出端通过所述四个轮毂电机从控制器与所述下位机连接,用于将所述四个轮毂电机的实时转速和实时线加速度传输至所述下位机;
所述下位机还用于根据所述四个轮毂电机的实时转速和实时线加速度结合比例-积分-微分PID控制算法对所述四个轮毂电机的转速和线加速度进行控制调整。
3.根据权利要求2所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,所述四个轮毂电机从控制器包括脉冲宽度信号驱动电路和霍尔传感器接口电路;
所述四个轮毂电机从控制器通过脉冲宽度信号驱动电路驱动所述四个轮毂电机;
所述四个轮毂电机从控制器通过所述霍尔传感器接口电路与所述霍尔传感器连接。
4.根据权利要求1所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,还包括至少一个编码器;
所述编码器的输入端与所述四个转向舵机连接,所述编码器的输出端与所述下位机连接,用于将所述四个转向舵机的实时角度、实时角速度和实时角加速度传输至所述下位机;
所述下位机还用于根据所述四个转向舵机的实时角度、实时角速度和实时角加速度结合PID控制算法对所述四个转向舵机的角度、角速度和角加速度进行控制调整。
5.根据权利要求4所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,所述四个转向舵机从控制器包括脉冲信号驱动电路和编码器接口电路;
所述四个转向舵机从控制器通过脉冲信号驱动电路驱动所述四个转向舵机;
所述四个转向舵机从控制器通过所述编码器接口电路与所述编码器连接。
6.根据权利要求1所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,所述下位机分别通过四个从控制器串口与所述四个轮毂电机从控制器连接,且所述下位机通过设定的不同的地址位标识对所述四个轮毂电机从控制器独立操作。
7.根据权利要求1所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,还包括:超声波检测传感器,所述下位机与所述超声波检测传感器连接,用于接收所述超声波检测传感器的障碍检测数据并控制所述四个轮毂电机制动。
8.根据权利要求1所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,还包括:红外检测传感器,所述下位机与所述红外检测传感器连接,用于接收所述红外检测传感器的凹坑检测数据并控制所述四个轮毂电机制动。
9.根据权利要求1至8所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,所述上位机为工控机,所述下位机为单片机主控制器。
10.根据权利要求1至8所述的四轮独立驱动转向机器人的主从控制系统,其特征在于,所述主从控制系统安装于机器人的底盘上。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810041000.4A CN108248681A (zh) | 2018-01-16 | 2018-01-16 | 一种四轮独立驱动转向机器人的主从控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810041000.4A CN108248681A (zh) | 2018-01-16 | 2018-01-16 | 一种四轮独立驱动转向机器人的主从控制系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108248681A true CN108248681A (zh) | 2018-07-06 |
Family
ID=62741276
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810041000.4A Pending CN108248681A (zh) | 2018-01-16 | 2018-01-16 | 一种四轮独立驱动转向机器人的主从控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108248681A (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109656246A (zh) * | 2018-11-01 | 2019-04-19 | 广东电网有限责任公司 | 用于电测实验室仪表校验的agv小车驱动电路及其驱动方法 |
CN110244745A (zh) * | 2019-07-10 | 2019-09-17 | 北京思方技术开发有限公司 | 轮式机器人运动执行及外设控制系统 |
CN110509781A (zh) * | 2019-08-13 | 2019-11-29 | 深兰科技(上海)有限公司 | 一种控制移动设备行进的方法及装置 |
CN111114292A (zh) * | 2018-10-31 | 2020-05-08 | 深圳市优必选科技有限公司 | 一种静音机器的底盘结构 |
CN112171678A (zh) * | 2020-09-30 | 2021-01-05 | 中兴软件技术(济南)有限公司 | 一种机器人运动控制方法 |
CN113485366A (zh) * | 2021-08-05 | 2021-10-08 | 泰瑞数创科技(北京)有限公司 | 用于机器人的导航路径生成方法及装置 |
WO2021223169A1 (zh) * | 2020-05-07 | 2021-11-11 | 深圳市大疆创新科技有限公司 | 无人机的动力输出检测方法和设备 |
CN115847371A (zh) * | 2022-07-29 | 2023-03-28 | 以诺康医疗科技(苏州)有限公司 | 一种主从手机器人的控制方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101323328A (zh) * | 2008-07-02 | 2008-12-17 | 南京农业大学 | 一种农用智能移动机器人平台 |
CN202358160U (zh) * | 2011-12-02 | 2012-08-01 | 长安大学 | 一种电动汽车转向控制装置 |
DE102013214806A1 (de) * | 2013-03-19 | 2014-09-25 | Continental Teves Ag & Co. Ohg | Verfahren zum Betreiben eines Bremssystems |
CN105775168A (zh) * | 2016-03-29 | 2016-07-20 | 北京工业大学 | 四轮独立驱动巡视器运动控制系统 |
CN107505882A (zh) * | 2017-10-25 | 2017-12-22 | 卢俊 | 一种多轴运动控制器及控制方法 |
-
2018
- 2018-01-16 CN CN201810041000.4A patent/CN108248681A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101323328A (zh) * | 2008-07-02 | 2008-12-17 | 南京农业大学 | 一种农用智能移动机器人平台 |
CN202358160U (zh) * | 2011-12-02 | 2012-08-01 | 长安大学 | 一种电动汽车转向控制装置 |
DE102013214806A1 (de) * | 2013-03-19 | 2014-09-25 | Continental Teves Ag & Co. Ohg | Verfahren zum Betreiben eines Bremssystems |
CN105775168A (zh) * | 2016-03-29 | 2016-07-20 | 北京工业大学 | 四轮独立驱动巡视器运动控制系统 |
CN107505882A (zh) * | 2017-10-25 | 2017-12-22 | 卢俊 | 一种多轴运动控制器及控制方法 |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111114292A (zh) * | 2018-10-31 | 2020-05-08 | 深圳市优必选科技有限公司 | 一种静音机器的底盘结构 |
CN109656246A (zh) * | 2018-11-01 | 2019-04-19 | 广东电网有限责任公司 | 用于电测实验室仪表校验的agv小车驱动电路及其驱动方法 |
CN110244745A (zh) * | 2019-07-10 | 2019-09-17 | 北京思方技术开发有限公司 | 轮式机器人运动执行及外设控制系统 |
CN110509781A (zh) * | 2019-08-13 | 2019-11-29 | 深兰科技(上海)有限公司 | 一种控制移动设备行进的方法及装置 |
WO2021223169A1 (zh) * | 2020-05-07 | 2021-11-11 | 深圳市大疆创新科技有限公司 | 无人机的动力输出检测方法和设备 |
CN112171678A (zh) * | 2020-09-30 | 2021-01-05 | 中兴软件技术(济南)有限公司 | 一种机器人运动控制方法 |
CN113485366A (zh) * | 2021-08-05 | 2021-10-08 | 泰瑞数创科技(北京)有限公司 | 用于机器人的导航路径生成方法及装置 |
CN115847371A (zh) * | 2022-07-29 | 2023-03-28 | 以诺康医疗科技(苏州)有限公司 | 一种主从手机器人的控制方法及装置 |
CN115847371B (zh) * | 2022-07-29 | 2023-12-12 | 以诺康医疗科技(苏州)有限公司 | 一种主从手机器人的控制方法及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108248681A (zh) | 一种四轮独立驱动转向机器人的主从控制系统 | |
CN102941876B (zh) | 无人驾驶车辆转向系统及其控制方法 | |
CN102135766B (zh) | 自主作业林业机器人平台 | |
CN103963043B (zh) | 一种用于电站巡检和维修的智能机器人及其控制系统 | |
CN202267871U (zh) | 一种自动避障机器人平台 | |
CN106444754A (zh) | 一种轮式探测移动机器人控制系统及控制方法 | |
CN101639699B (zh) | 一种智能自动搜索跟踪高尔夫球车 | |
CN104932493A (zh) | 一种自主导航的移动机器人及其自主导航的方法 | |
CN105334853A (zh) | 双核高速四轮微微鼠冲刺控制器 | |
CN201237738Y (zh) | 一种智能自动搜索跟踪高尔夫球车 | |
CN206833250U (zh) | 一种基于激光雷达的无人驾驶侦查小车 | |
CN201799111U (zh) | 基于单片机的自主循迹模型车 | |
CN202838021U (zh) | 智能循迹遥控小车 | |
CN202947759U (zh) | 无线环境监测车 | |
CN110244718B (zh) | 一种可自动避障的巡视智能小车 | |
CN103472835A (zh) | 基于双核四轮微电脑鼠快速冲刺控制器 | |
CN105116897A (zh) | 双核高速四轮微微鼠全数字导航伺服控制器 | |
CN206664791U (zh) | 一种纵向两轮自平衡机器人及控制系统 | |
CN106274552B (zh) | 汽车控制系统 | |
CN201269998Y (zh) | 自动导引车光学导引式控制器 | |
CN210639464U (zh) | 一种差速控制的智能循迹避障小车 | |
CN209364633U (zh) | 一种自平衡式移动机器人 | |
CN203643838U (zh) | 基于双核四轮微电脑鼠及其快速冲刺控制器 | |
CN217533056U (zh) | 一种自主移动工业机器人用控制系统及其机器人 | |
CN113022286B (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: 20180706 |
|
RJ01 | Rejection of invention patent application after publication |