Movatterモバイル変換


[0]ホーム

URL:


CN113859359A - Movement control method of light explosion-proof four-wheel eight-drive chassis - Google Patents

Movement control method of light explosion-proof four-wheel eight-drive chassis
Download PDF

Info

Publication number
CN113859359A
CN113859359ACN202111468406.9ACN202111468406ACN113859359ACN 113859359 ACN113859359 ACN 113859359ACN 202111468406 ACN202111468406 ACN 202111468406ACN 113859359 ACN113859359 ACN 113859359A
Authority
CN
China
Prior art keywords
walking
chassis
motor
steering
wheel
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
CN202111468406.9A
Other languages
Chinese (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.)
Nanjing Tetra Electronic Technology Co ltd
Original Assignee
Nanjing Tetra Electronic 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 Nanjing Tetra Electronic Technology Co ltdfiledCriticalNanjing Tetra Electronic Technology Co ltd
Priority to CN202111468406.9ApriorityCriticalpatent/CN113859359A/en
Publication of CN113859359ApublicationCriticalpatent/CN113859359A/en
Pendinglegal-statusCriticalCurrent

Links

Images

Classifications

Landscapes

Abstract

The invention discloses a movement control method of a light explosion-proof four-wheel eight-drive chassis, which is characterized in that a walking motor is respectively arranged at four walking wheel shafts of the chassis, a steering motor is respectively arranged at four walking wheel rotating shafts of the chassis, the four steering motors and the four walking motors are respectively hung on a first communication control bus and a second communication control bus and are controlled by a Micro Control Unit (MCU), and the steering mark zero, linear motion, in-situ rotation and lateral movement walking of the chassis are realized. The invention can realize the light explosion-proof chassis, also considers the flexibility of chassis motion control, simultaneously reduces the friction between wheels and the ground, and reduces the maintenance cost of the robot in the use process.

Description

Movement control method of light explosion-proof four-wheel eight-drive chassis
Technical Field
The invention belongs to the field of mobile control methods, and particularly relates to a mobile control method of a light explosion-proof four-wheel eight-drive chassis.
Background
The existing robot chassis applied to an explosion-proof scene generally adopts the mobile control modes of four-wheel differential, two-wheel differential, front-wheel drive rear-wheel steering and rear-wheel drive front-wheel steering, and the control drive modes enable the small size and the flexibility to be incompatible.
The existing two-wheel differential and four-wheel differential mode has small turning radius and lacks functions of transverse and lateral movement, so the method is not flexible enough in a narrow use environment; the front wheel and rear wheel steering mode is comprehensive in function, but large in turning radius, and is not suitable for narrow space scenes.
In addition, motor equipment needs to be subjected to explosion-proof treatment in an explosion-proof use scene, so an explosion-proof chassis designed in a traditional direct-current brushless servo motor and separated driver mode is generally heavier, and wheels are seriously abraded when the chassis is heavier by adopting a four-wheel differential drive control mode.
Disclosure of Invention
The purpose of the invention is as follows: the invention aims to solve the defects in the prior art and provides a movement control method of a light explosion-proof four-wheel eight-drive chassis.
The technical scheme is as follows: the invention discloses a movement control method of a light explosion-proof four-wheel eight-drive chassis, which is characterized in that a walking motor is respectively arranged at four walking wheel shafts of the chassis, a steering motor is respectively arranged at four walking wheel rotating shafts of the chassis, the four steering motors and the four walking motors are respectively hung on a first communication control bus and a second communication control bus and are controlled by a Micro Control Unit (MCU), and the specific control method comprises the following steps:
when the chassis is powered on, the steering motor drives the travelling wheels to steer and mark zero, so that the four travelling wheels are all in vertical positions when the chassis is started;
when chassis forward control is executed, the micro control unit MCU uniformly executes a forward speed instruction through a second communication control bus of the walking motor: the two walking motors arranged on the left side and the right side have the same rotating speed, and the two walking motors arranged on the left side and the right side have opposite rotating speeds, so that the rotating directions of the walking motors on the left side and the right side are opposite;
when the chassis backing control is executed, the micro control unit MCU uniformly executes a backing speed instruction through a second communication control bus of the walking motor: the two walking motors arranged on the left side and the right side have the same rotating speed, and the two walking motors arranged on the left side and the right side have opposite rotating speeds, so that the rotating directions of the two walking motors on the left side and the right side are opposite;
when the chassis pivot rotation control is executed, the micro control unit MCU firstly uniformly executes a steering absolute angle control instruction through a first communication control bus of the steering motor: the two steering motors arranged at diagonal positions have the same rotation angle, the steering motors arranged at different diagonal positions have opposite rotation angles, and then when the rotation angles of the steering motors are in place, differential walking speed instructions are issued uniformly through a second communication control bus of the walking motors;
when chassis lateral movement walking control is executed, the micro control unit MCU firstly controls each steering motor to rotate to a horizontal angle position, and then uniformly issues a differential walking speed control instruction through a second communication control bus of the walking motors.
Further, the specific method for the steering zeroing comprises the following steps: detecting the state of a zero-marking optocoupler after the chassis is powered on, and controlling a steering motor to rotate forward to find the position of the optocoupler when the optocoupler is shielded; when the optocoupler is not shielded, the steering motor is controlled to rotate reversely to find the shielded position of the optocoupler. In the process of marking zero of the steering motor, the micro control unit MCU continuously inquires the coding value of each motor through the corresponding CAN bus, when the motor rotates to the state of the optocoupler and is changed, the motor enters a system to interrupt and record the current coding value of the motor, and the coding value is set as the zero point of the motor until the zero marking is finished.
Furthermore, the walking motor adopts an integrated direct-current brushless servo motor to provide rotating power for the walking wheel; the steering motor adopts a servo steering motor and provides steering power for the traveling wheels.
Furthermore, the micro control unit MCU comprises a microprocessor, and a power module, a communication protocol module, a CAN bus module and an I/O module which are controlled by the microprocessor, wherein the first communication control bus and the second communication control bus are respectively connected with the CAN bus module, the power module supplies power to other modules, and the I/O module is used for realizing zero marking limit and emergency stop of the travelling wheel; the MCU microcontroller respectively keeps communication with the steering motor and the walking motor through the communication protocol module and issues control motor control instructions; and meanwhile, the I/O state of the steering motor, the walking motor and the I/O module is transferred to an upper computer through a communication protocol module.
The invention also discloses a computer storage medium, wherein a movement control program of the light explosion-proof four-wheel eight-drive chassis is stored in the computer storage medium, and the program executes the movement control method of the light explosion-proof four-wheel eight-drive chassis when being executed.
Has the advantages that: compared with the prior art, the invention has the following advantages:
(1) compared with the existing separated driving mode, the invention uses the integrated direct-current brushless servo motor and the servo steering engine, reduces the total weight of the chassis after explosion-proof treatment, and ensures that the chassis has smaller volume and more stable bus control.
(2) The invention has simple control procedures by using front-wheel drive and rear-wheel drive steering or four-wheel and two-wheel differential speed, small number of used total motors and simple whole circuit, but the actual motion control effect is more flexible.
(3) Under the condition that the battery capacity is unchanged, the light chassis can drive for a longer distance, the electric energy is saved, the chassis can use 36V batteries, and the continuous running distance of the robot can exceed 70KM by using 40Ah batteries.
(4) The four-wheel eight-wheel-drive chassis structure increases omnidirectional movement control and is more suitable for narrow space.
(5) The turning radius of the robot is optimized, the abrasion of tires is reduced to the maximum extent, and the maintenance cost of the chassis is reduced.
In conclusion, the invention is an omnidirectional chassis movement control method, which can plan the optimal driving route of the chassis and save the movement control task time.
Drawings
FIG. 1 is a diagram of a chassis control system hardware design architecture;
FIG. 2 is a schematic diagram of the zero motion control of the present invention;
FIG. 3 is a schematic view of the linear motion control of the present invention;
FIG. 4 is a schematic diagram illustrating in-situ rotational motion control according to the present invention;
FIG. 5 is a schematic illustration of lateral movement control according to the present invention;
FIG. 6 is a schematic diagram of optimized optimal path planning in the present invention;
FIG. 7 is a flow chart of an embodiment of a direction indicator zero;
FIG. 8 is a flow chart of an embodiment of an in-situ rotation process.
Detailed Description
The technical solution of the present invention is described in detail below, but the scope of the present invention is not limited to the embodiments.
As shown in fig. 1, in the movement control method of the light explosion-proof four-wheel eight-wheel drive chassis according to this embodiment, a traveling motor is installed at each of four traveling wheel shafts of the chassis, a steering motor is installed at each of four traveling wheel rotating shafts of the chassis, and the four steering motors and the four traveling motors are respectively mounted on a first communication control bus and a second communication control bus and controlled by a micro control unit MCU (e.g., UCOS-STM32F 407). The walking motor adopts an integrated direct-current brushless servo motor and provides rotating power for the walking wheel; the steering motor adopts a servo steering motor and provides steering power for the traveling wheels.
The micro control unit MCU comprises a microprocessor, and a power module, a communication protocol module, a CAN bus module and an I/O module which are controlled by the microprocessor, wherein a first communication control bus and a second communication control bus are respectively connected with the CAN bus module; the MCU microcontroller respectively keeps communication with the steering motor and the walking motor through the communication protocol module and issues control motor control instructions; and meanwhile, the I/O state of the steering motor, the walking motor and the I/O module is transferred to an upper computer through a communication protocol module.
The specific control method comprises the following steps:
as shown in fig. 2 and 7, when the chassis is powered on, the steering motor drives the traveling wheels to perform steering zero marking first, so that the four traveling wheels are all in vertical positions when the chassis is started; the specific method for marking the steering zero comprises the following steps: detecting the state of a zero-marking optocoupler after the chassis is powered on, and controlling a steering motor to rotate forward to find the position of the optocoupler when the optocoupler is shielded; when the optocoupler is not shielded, the steering motor is controlled to rotate reversely to find the shielded position of the optocoupler. In the process of marking zero of the steering motor, the micro control unit MCU continuously inquires each motor coding value through the corresponding CAN bus, when the motor rotates to the optical coupler state and is changed, the system is interrupted to record the current motor coding value, and the coding value is set as the motor zero until the zero marking is finished.
As shown in fig. 3, when chassis forward control is executed, the MCU uniformly executes a forward speed command through the second communication control bus of the traveling motor: the two walking motors arranged on the same side are same in rotating speed, and the two walking motors arranged on the different sides are opposite in rotating speed.
When the chassis backing control is executed, the micro control unit MCU uniformly executes a backing speed instruction through a second communication control bus of the walking motor: the rotating speeds of the two walking motors arranged on the left side and the right side are the same, and the rotating speeds of the two walking motors arranged on the left side and the right side are opposite.
As shown in fig. 4 and 8, when performing chassis pivot rotation control, the MCU first uniformly executes a steering absolute angle control command through the first communication control bus of the steering motor: the two steering motors arranged at diagonal positions have the same rotation angle, the steering motors arranged at different diagonal positions have opposite rotation angles, and then when the rotation angles of the steering motors are in place, differential walking speed instructions are issued uniformly through a second communication control bus of the walking motors.
As shown in fig. 5, when chassis side-shifting walking control is performed, the MCU first controls the steering motors to rotate to a horizontal angle, and then issues a differential walking speed control command through the second communication control bus of the walking motors.
As shown in fig. 6, in the present embodiment,
when the target point is positioned in the 45-degree direction of the whole chassis, the steering motor can be controlled to rotate to the 45-degree direction, and then the walking motor is driven to move to the target position in the 45-degree direction. .
According to the embodiment, the turning radius of the explosion-proof chassis controlled by the four-wheel eight-drive chassis movement control method can be smaller than 800mm, the width of the chassis is smaller than 700mm, and the explosion-proof chassis is suitable for use scenes in narrow spaces. The weight of the explosion-proof chassis is less than 80KG, low friction in practical application also helps to stabilize the tire and increase the driving safety, the power supply module supplies power, and the whole weight is reduced, so that the single driving mileage can reach 5000KM, the energy is saved, the environment is protected, and the cruising ability is strong.

Claims (5)

4. The movement control method of a light explosion-proof four-wheel eight-drive chassis according to claim 1, characterized in that: the micro control unit MCU comprises a microprocessor, and a power module, a communication protocol module, a CAN bus module and an I/O module which are controlled by the microprocessor, wherein the first communication control bus and the second communication control bus are respectively connected with the CAN bus module, the power module supplies power for other modules, and the zero marking limit and the emergency stop of the travelling wheel are realized through the I/O module; the MCU microcontroller respectively keeps communication with the steering motor and the walking motor through the communication protocol module and issues control motor control instructions; and meanwhile, the I/O state of the steering motor, the walking motor and the I/O module is transferred to an upper computer through a communication protocol module.
CN202111468406.9A2021-12-032021-12-03Movement control method of light explosion-proof four-wheel eight-drive chassisPendingCN113859359A (en)

Priority Applications (1)

Application NumberPriority DateFiling DateTitle
CN202111468406.9ACN113859359A (en)2021-12-032021-12-03Movement control method of light explosion-proof four-wheel eight-drive chassis

Applications Claiming Priority (1)

Application NumberPriority DateFiling DateTitle
CN202111468406.9ACN113859359A (en)2021-12-032021-12-03Movement control method of light explosion-proof four-wheel eight-drive chassis

Publications (1)

Publication NumberPublication Date
CN113859359Atrue CN113859359A (en)2021-12-31

Family

ID=78985830

Family Applications (1)

Application NumberTitlePriority DateFiling Date
CN202111468406.9APendingCN113859359A (en)2021-12-032021-12-03Movement control method of light explosion-proof four-wheel eight-drive chassis

Country Status (1)

CountryLink
CN (1)CN113859359A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
CN116811997A (en)*2023-08-022023-09-29国广顺能(上海)能源科技有限公司Four-wheel eight-wheel-drive chassis platform

Citations (6)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
CN205668589U (en)*2016-05-112016-11-02姚连涛A kind of variable-angle actuating device, vehicle chassis
CN107433975A (en)*2016-05-272017-12-05比亚迪股份有限公司 Vehicle, vehicle steering system and centering control device and method thereof
CN208420695U (en)*2018-05-162019-01-22博尔仪器仪表(天津)股份有限公司A kind of sample cell mobile platform of near-infrared spectrometers
US10392007B1 (en)*2015-03-262019-08-27Hydro-Gear Limited PartnershipStability control system
CN112009269A (en)*2020-10-202020-12-01山东华龙农业装备股份有限公司Control system of all-dimensional driving mechanism of scissor maintenance operation device
CN113147890A (en)*2021-04-272021-07-23苏州邦弘智能科技有限公司Four-wheel steering robot

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
US10392007B1 (en)*2015-03-262019-08-27Hydro-Gear Limited PartnershipStability control system
CN205668589U (en)*2016-05-112016-11-02姚连涛A kind of variable-angle actuating device, vehicle chassis
CN107433975A (en)*2016-05-272017-12-05比亚迪股份有限公司 Vehicle, vehicle steering system and centering control device and method thereof
CN208420695U (en)*2018-05-162019-01-22博尔仪器仪表(天津)股份有限公司A kind of sample cell mobile platform of near-infrared spectrometers
CN112009269A (en)*2020-10-202020-12-01山东华龙农业装备股份有限公司Control system of all-dimensional driving mechanism of scissor maintenance operation device
CN113147890A (en)*2021-04-272021-07-23苏州邦弘智能科技有限公司Four-wheel steering robot

Cited By (2)

* Cited by examiner, † Cited by third party
Publication numberPriority datePublication dateAssigneeTitle
CN116811997A (en)*2023-08-022023-09-29国广顺能(上海)能源科技有限公司Four-wheel eight-wheel-drive chassis platform
CN116811997B (en)*2023-08-022024-04-12国广顺能(上海)能源科技有限公司Four-wheel eight-wheel-drive chassis platform

Similar Documents

PublicationPublication DateTitle
US8091658B2 (en)Wheel arrangement for a four-wheeled vehicle
CN103332236B (en)A kind of mobile device of robot
CN109263717B (en)Multi-mode steer-by-wire automobile and steering control method thereof
CN107878170B (en)Mechanical and automatically controlled steering is concentrated and the combined vehicle chassis architecture of independent electric drive
KR101311226B1 (en)A multi-shaft steering apparatus for controlling individual wheel
CN110949497A (en)Unmanned platform car that all-wheel 360 degrees turned to
CN217022649U (en)4-wheel steering chassis suitable for inspection robot
CN207173274U (en)Bi-motor four-wheel driven electric vehicle and electric vehicle control system
CN202827710U (en)Novel four-wheel steering system controlled by four servos
CN113859359A (en)Movement control method of light explosion-proof four-wheel eight-drive chassis
CN111002841B (en) Vehicle drive control system and method based on real-time operating conditions
CN103892969A (en)Four-wheel individual driving mechanism for electric wheelchair
CN211809955U (en)Independent suspension type steering wheel mechanism
EP1905675B1 (en)Wheel arrangement for a four-wheeled vehicle
CN216805645U (en)Differential steering six-wheel chassis
CN103770663A (en)Electronic-gyroscope-autostabilization multi-wheel full-driving electric car
CN213442756U (en)Front-drive type platform carrying tractor
CN109228885A (en)A kind of electric car electronic differential calculation method
CN203749716U (en)Four-wheel independent driving mechanism for electric wheelchair
CN112339882A (en)AGV moving platform system and method based on hub motor
CN202728499U (en)Double-drive dinuclear electro-tricycle
CN209381995U (en)A kind of differential control system
CN208278195U (en)A kind of intelligence ground creeping vehicle
JP4305781B2 (en) Travel control device, travel vehicle equipped with the same, and travel control method
CN202966522U (en)Dual-drive dual-control system electro-tricycle

Legal Events

DateCodeTitleDescription
PB01Publication
PB01Publication
SE01Entry into force of request for substantive examination
SE01Entry into force of request for substantive examination
RJ01Rejection of invention patent application after publication

Application publication date:20211231

RJ01Rejection of invention patent application after publication

[8]ページ先頭

©2009-2025 Movatter.jp