CN112874315A - Motion control method, device and equipment of balance car and storage medium - Google Patents

Motion control method, device and equipment of balance car and storage medium Download PDF

Info

Publication number
CN112874315A
CN112874315A CN202110045804.3A CN202110045804A CN112874315A CN 112874315 A CN112874315 A CN 112874315A CN 202110045804 A CN202110045804 A CN 202110045804A CN 112874315 A CN112874315 A CN 112874315A
Authority
CN
China
Prior art keywords
data
balance
parameter
preset
balance car
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.)
Granted
Application number
CN202110045804.3A
Other languages
Chinese (zh)
Other versions
CN112874315B (en
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.)
Shenzhen 3600 Smart Life Technology Co ltd
Original Assignee
Shenzhen Qihu Intelligent 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 Shenzhen Qihu Intelligent Technology Co ltd filed Critical Shenzhen Qihu Intelligent Technology Co ltd
Priority to CN202110045804.3A priority Critical patent/CN112874315B/en
Publication of CN112874315A publication Critical patent/CN112874315A/en
Application granted granted Critical
Publication of CN112874315B publication Critical patent/CN112874315B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • 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
    • 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
    • B60L2200/00—Type of vehicles
    • B60L2200/22—Microcars, e.g. golf cars
    • 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
    • B60L2220/00—Electrical machine types; Structures or applications thereof
    • B60L2220/40—Electrical machine applications
    • B60L2220/42—Electrical machine applications with use of more than one motor
    • 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
    • B60L2240/00—Control parameters of input or output; Target parameters
    • B60L2240/40—Drive Train control parameters
    • B60L2240/42—Drive Train control parameters related to electric machines
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Motorcycle And Bicycle Frame (AREA)

Abstract

The invention discloses a motion control method, a motion control device, equipment and a storage medium of a balance car, wherein the method comprises the following steps: acquiring current attitude information of the balance car under a preset road condition, and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information; fusing the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter; and driving a motor of the balance car according to the target balance parameters to realize motion control. Compared with the prior art, the left-right balance of the balance car needs to be realized by depending on the control of a body, the acquired first wheel balance parameter and the acquired second wheel balance parameter are subjected to fusion processing to obtain the target balance parameter, and then the motor of the balance car is driven according to the target balance parameter, so that the stable and accurate steering control of the balance car is realized, and the riding experience of a user is further improved.

Description

Motion control method, device and equipment of balance car and storage medium
Technical Field
The invention relates to the technical field of balance cars, in particular to a method, a device, equipment and a storage medium for controlling the motion of a balance car.
Background
Motion control is a key technology in the research content of the balance car, the motion of the existing self-balance car product is mainly realized by the control of a carrier (human), and the forward and backward movement is realized by changing the gravity center distribution of the whole self-balance car by forward tilting or backward tilting of an operator, so that the existing balance car cannot realize stable and accurate steering control.
The above is only for the purpose of assisting understanding of the technical aspects of the present invention, and does not represent an admission that the above is prior art.
Disclosure of Invention
The invention mainly aims to provide a motion control method, a motion control device, motion control equipment and a storage medium of a balance car, and aims to solve the technical problem of how to realize stable and accurate steering control of the balance car.
In order to achieve the above object, the present invention provides a motion control method of a balance car, including:
acquiring current attitude information of a balance car under a preset road condition, and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information;
fusing the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter;
and driving a motor of the balance car according to the target balance parameter so as to realize motion control.
Optionally, the step of obtaining current posture information of the balance car under the preset road condition includes:
acquiring first data of an acceleration sensor in a balance car and second data of a gyroscope under a preset road condition;
obtaining a real-time angular velocity value according to the first data, and obtaining an angular value according to the second data;
and determining the current attitude information of the balance car according to the real-time angular velocity value and the angular value.
Optionally, before the step of obtaining the real-time angular velocity value according to the first data, the method further includes:
acquiring a first data type corresponding to the first data;
judging whether the first data type meets a preset angular velocity type condition or not;
and when the first data type meets the preset angular velocity type condition, executing the step of obtaining the real-time angular velocity value according to the first data.
Optionally, before the step of obtaining the first data type corresponding to the first data, the method further includes:
acquiring a first data storage capacity corresponding to the first data;
judging whether the first data storage quantity meets a preset data storage condition or not;
and when the first data storage capacity meets the preset data storage condition, executing the step of acquiring the first data type corresponding to the first data.
Optionally, before the step of obtaining the angle value according to the second data, the method further includes:
acquiring a second data type corresponding to the second data;
judging whether the second data type meets a preset angle type condition or not;
and when the second data type meets the preset angle type condition, executing the step of obtaining the angle value according to the second data.
Optionally, before the step of obtaining the second data type corresponding to the second data, the method further includes:
acquiring a second data storage capacity corresponding to the second data;
judging whether the second data storage quantity meets a preset data storage condition or not;
and when the second data storage quantity meets the preset data storage condition, executing the step of acquiring a second data type corresponding to the second data.
Optionally, the step of obtaining a real-time angular velocity value according to the first data includes:
determining the angular speed of the balance car according to the first data;
performing integral processing on the angular velocity to obtain an output attitude dip angle, an attitude dip angle deviation and a noise value;
and determining a real-time angular velocity value according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value.
Optionally, the step of determining a real-time angular velocity value according to the output attitude inclination, the attitude inclination deviation, and the noise value includes:
calculating a real-time angular velocity value through a preset angular velocity formula according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value;
the preset angular velocity formula is as follows:
Figure BDA0002896636270000031
in the formula, Y1(t) is the output attitude dip angle, Y2(t) is the attitude dip angle deviation, w (t) is the noise value, y1(t) is an estimate of the Kalman filter, y2(t) deviation value of Kalman filter, ugyroAnd (t) is a real-time angular velocity value.
Optionally, obtaining a measurement noise value from the second data;
calculating an angle value through a preset angle formula according to the measurement noise value, the estimated value of the Kalman filter and the deviation value of the Kalman filter;
the preset angle formula is as follows:
Figure BDA0002896636270000032
where v (t) is a measurement noise value and z (t) is an angle value.
Optionally, the step of determining a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the current attitude information includes:
analyzing the current attitude information to obtain the running state of the balance car;
and determining a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the running state.
Optionally, the step of determining a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the driving state includes:
searching a corresponding sample wheel balance parameter from a preset driving state mapping relation table according to the driving state;
determining a first sample wheel balance parameter and a second sample wheel balance parameter according to the sample wheel balance parameter;
the preset driving state mapping relation table comprises a corresponding relation between a driving state and a sample wheel balance parameter.
Optionally, the step of performing fusion processing on the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter includes:
determining a first motor output value according to the first wheel balance parameter, and determining a second motor output value according to the first motor output value and the second wheel balance parameter;
and carrying out fusion processing on the first motor output value and the second motor output value to obtain a target balance parameter.
In order to achieve the above object, the present invention further provides a motion control device for a balance vehicle, including:
the acquisition module is used for acquiring current attitude information of the balance car under a preset road condition and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information;
the processing module is used for carrying out fusion processing on the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter;
and the control module is used for driving a motor of the balance car according to the target balance parameters so as to realize motion control.
Optionally, the obtaining module is further configured to obtain first data of an acceleration sensor in the balance car and second data of a gyroscope under a preset road condition;
the acquisition module is further used for acquiring a real-time angular velocity value according to the first data and acquiring an angular value according to the second data;
the acquisition module is further used for determining the current attitude information of the balance car according to the real-time angular velocity value and the angular value.
Optionally, the obtaining module is further configured to determine an angular velocity of the balance car according to the first data;
the acquisition module is further used for carrying out integral processing on the angular velocity to obtain an output attitude dip angle, an attitude dip angle deviation and a noise value;
the acquisition module is further configured to determine a real-time angular velocity value according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value.
Optionally, the obtaining module is further configured to analyze the current attitude information to obtain a driving state of the balance car;
the acquisition module is further used for determining a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the running state.
Optionally, the obtaining module is further configured to search a corresponding sample wheel balance parameter from a preset driving state mapping relation table according to the driving state;
the acquisition module is further used for determining a first sample wheel balance parameter and a second sample wheel balance parameter according to the sample wheel balance parameter;
the obtaining module is further configured to obtain a corresponding relationship between a driving state and a sample wheel balance parameter in the preset driving state mapping relationship table.
Optionally, the processing module is further configured to determine a first motor output value according to the first wheel balance parameter, and determine a second motor output value according to the first motor output value and the second wheel balance parameter;
and the processing module is also used for carrying out fusion processing on the first motor output value and the second motor output value to obtain a target balance parameter.
Further, to achieve the above object, the present invention also proposes a motion control apparatus of a balance car, the apparatus including: the system comprises a memory, a processor and a motion control program of the balance car, wherein the motion control program of the balance car is stored on the memory and can run on the processor, and the motion control program of the balance car is configured to realize the steps of the motion control method of the balance car.
In addition, in order to achieve the above object, the present invention further provides a storage medium having a motion control program of the balance car stored thereon, wherein the motion control program of the balance car realizes the steps of the motion control method of the balance car as described above when executed by a processor.
The method comprises the steps of firstly obtaining current attitude information of the balance car under a preset road condition, determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information, then carrying out fusion processing on the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter, and then driving a motor of the balance car according to the target balance parameter to realize motion control. Compared with the prior art, the left-right balance of the balance car needs to be realized by depending on the control of a body, the acquired first wheel balance parameter and the acquired second wheel balance parameter are subjected to fusion processing to obtain the target balance parameter, and then the motor of the balance car is driven according to the target balance parameter, so that the stable and accurate steering control of the balance car is realized, and the riding experience of a user is further improved.
Drawings
Fig. 1 is a schematic structural diagram of a motion control device of a balance car in a hardware operating environment according to an embodiment of the present invention;
FIG. 2 is a schematic flow chart of a motion control method of a balance car according to a first embodiment of the present invention;
FIG. 3 is a schematic flow chart of a motion control method for a balance vehicle according to a second embodiment of the present invention;
FIG. 4 is a schematic flow chart of a motion control method for a balance vehicle according to a third embodiment of the present invention;
fig. 5 is a block diagram showing the configuration of the motion control device of the balance car according to the first embodiment of the present invention.
The implementation, functional features and advantages of the objects of the present invention will be further explained with reference to the accompanying drawings.
Detailed Description
It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention.
Referring to fig. 1, fig. 1 is a schematic structural diagram of a motion control device of a balance car in a hardware operating environment according to an embodiment of the present invention.
As shown in fig. 1, the motion control apparatus of the balance car may include: a processor 1001, such as a Central Processing Unit (CPU), a communication bus 1002, a user interface 1003, a network interface 1004, and a memory 1005. Wherein a communication bus 1002 is used to enable connective communication between these components. The user interface 1003 may include a Display screen (Display), an input unit such as a Keyboard (Keyboard), and the optional user interface 1003 may also include a standard wired interface, a wireless interface. The network interface 1004 may optionally include a standard wired interface, a wireless interface (e.g., a wireless FIdelity (WI-FI) interface). The Memory 1005 may be a Random Access Memory (RAM) Memory, or may be a Non-Volatile Memory (NVM), such as a disk Memory. The memory 1005 may alternatively be a storage device separate from the processor 1001.
Those skilled in the art will appreciate that the configuration shown in FIG. 1 does not constitute a limitation of the motion control apparatus of the balance car and may include more or fewer components than shown, or some components in combination, or a different arrangement of components.
As shown in fig. 1, a memory 1005, which is a storage medium, may include therein an operating system, a data storage module, a network communication module, a user interface module, and a motion control program of the balance car.
In the motion control apparatus of the balance car shown in fig. 1, the network interface 1004 is mainly used for data communication with a network server; the user interface 1003 is mainly used for data interaction with a user; the processor 1001 and the memory 1005 in the motion control apparatus of the balance vehicle of the present invention may be provided in the motion control apparatus of the balance vehicle, and the motion control apparatus of the balance vehicle calls the motion control program of the balance vehicle stored in the memory 1005 through the processor 1001 and executes the motion control method of the balance vehicle provided by the embodiment of the present invention.
An embodiment of the present invention provides a motion control method for a balance car, and referring to fig. 2, fig. 2 is a schematic flow diagram of a first embodiment of the motion control method for the balance car according to the present invention.
In this embodiment, the motion control method of the balance car includes the following steps:
step S10: the method comprises the steps of obtaining current attitude information of the balance car under a preset road condition, and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information.
It is easy to understand that the executing body of the embodiment may be a motion control device of the balance car with functions of data processing, network communication, program operation, and the like, or may be other computer devices with similar functions, and the embodiment is not limited.
The preset road condition may be various road surfaces on which the user rides the balance car, may be an uphill road condition, may also be a downhill road condition, and the like, and the present embodiment is not limited.
It can be understood that the current attitude information of the balance car may be a real-time angular velocity value, an angle value, and the like of the balance car, and the step of obtaining the current attitude information of the balance car under the preset road condition may be obtaining first data of an acceleration sensor in the balance car under the preset road condition and second data of a gyroscope, obtaining the real-time angular velocity value according to the first data, obtaining the angle value according to the second data, and determining the current attitude information, and the like of the balance car according to the real-time angular velocity value and the angle value.
It should be noted that, in the present embodiment, the gyroscope and the acceleration sensor inside the two-wheel two-side control system of the balance vehicle are used to detect the change of the vehicle body attitude, that is, the two-wheel two-side control system of the balance vehicle collects respective attitude information through the high-precision 6-axis attitude sensor, and uses the servo control system to accurately drive the motor to perform corresponding adjustment, so as to maintain the balance of the system.
The first data may be a single angular velocity or multiple angular velocities acquired by using an acceleration sensor in the balance car, and the second data may be a single angle value or multiple angle values acquired by using a gyroscope in the balance car, which is not limited in this embodiment.
In order to obtain accurate first data, before the step of obtaining the real-time angular velocity value according to the first data, a first data type corresponding to the first data is also required to be obtained, whether the first data type meets a preset angular velocity type condition or not is then judged, and when the first data type meets the preset angular velocity type condition, the real-time angular velocity value and the like are obtained according to the first data.
The first data type may be understood as a type corresponding to an angular velocity value, and the preset angular velocity type condition may be a type corresponding to an angular velocity, and the present embodiment is not limited thereto.
Assuming that a first data type corresponding to the acquired first data is an A type and the condition of the preset angular velocity type is the A type, then judging whether the A type of the first data type is consistent with the A type of the preset angular velocity, and when the A type of the first data type is consistent with the A type of the preset angular velocity, obtaining a real-time angular velocity value and the like according to the first data.
Before the step of obtaining the first data type corresponding to the first data, a first data storage amount corresponding to the first data is also required to be obtained, whether the first data storage amount meets a preset data storage condition is judged, and when the first data storage amount meets the preset data storage condition, the first data type corresponding to the first data is obtained.
The first data storage amount may be understood as a storage size corresponding to a single angular velocity or a plurality of angular velocities, and the like, and the preset data storage condition may be set by a user in a self-defined manner, may be 5kb, may also be 5M, and the like, and this embodiment is not limited.
If the first data storage amount corresponding to the acquired first data is 5kb and the preset data storage condition is 5kb, judging whether the first data storage amount is consistent with a preset data storage threshold value, and acquiring a first data type corresponding to the first data when the first data storage amount is consistent with the preset data storage threshold value.
Further, in order to accurately obtain the angle value, before the step of obtaining the angle value according to the second data, a second data type corresponding to the second data needs to be obtained, and then it is determined whether the second data type meets a preset angle type condition, and when the second data type meets the preset angle type condition, the angle value is obtained according to the second data, and the like.
The second data type may be understood as a type corresponding to an angle value, and the preset angular velocity type condition may be a type corresponding to an angle, and the present embodiment is not limited thereto.
And if the second data type corresponding to the acquired second data is a B type and the preset angle type condition is the B type, judging whether the second data type B is consistent with the preset angle type B, and acquiring an angle value and the like according to the second data when the second data type B is consistent with the preset angle type B.
Before the step of obtaining the second data type corresponding to the second data, a second data storage amount corresponding to the second data is also required to be obtained, whether the second data storage amount meets a preset data storage condition is judged, and when the second data storage amount meets the preset data storage condition, the second data type corresponding to the second data is obtained, and the like.
The second data storage amount may be understood as a storage size corresponding to a single angle value or a plurality of angle values, and the like, and the preset data storage condition may be set by a user in a self-defined manner, may be 8kb, may also be 6M, and the like, and this embodiment is not limited.
And if the second data storage amount corresponding to the acquired second data is 6M and the preset data storage condition is 6M, judging whether the second data storage amount is consistent with a preset data storage threshold value, and acquiring a second data type corresponding to the second data when the second data storage amount is consistent with the preset data storage threshold value.
The step of obtaining the real-time angular velocity value according to the first data may be determining an angular velocity of the balance car according to the first data, then performing integration processing on the angular velocity to obtain an output attitude inclination angle, an attitude inclination angle deviation and a noise value, and finally determining the real-time angular velocity value according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value.
The real-time angular velocity value is determined according to the output attitude inclination angle, the deviation of the attitude inclination angle and the noise value, and the real-time angular velocity value is calculated through a preset angular velocity formula according to the output attitude inclination angle, the deviation of the attitude inclination angle and the noise value;
the preset angular velocity formula is:
Figure BDA0002896636270000091
in the formula, Y1(t) is the output attitude dip angle, Y2(t) is the attitude dip angle deviation, w (t) is the noise value, y1(t) is an estimate of the Kalman filter, y2(t) deviation value of Kalman filter, ugyroAnd (t) is a real-time angular velocity value.
The preset angular velocity formula can be a state formula in the Kalman filter which is required to be subjected to integral processing when the acceleration sensor is used for solving the attitude angle, and can be constructed according to the characteristic of the acceleration sensor.
The method for obtaining the angle value according to the second data may be that a measurement noise value is obtained according to the second data, and then the angle value is calculated through a preset angle formula according to the measurement noise value, the estimation value of the kalman filter and the deviation value of the kalman filter;
the preset angle formula is as follows:
Figure BDA0002896636270000092
where v (t) is a measurement noise value and z (t) is an angle value.
The accelerometer can detect acceleration components on each axis of the space rectangular coordinate system during movement, namely a space vector of current movement can be obtained, and the current attitude angle of the direction can be obtained by calculating the included angle between any axis and the space vector.
The step of determining the first wheel balance parameter and the second wheel balance parameter of the balance car according to the current attitude information may be to analyze the current attitude information to obtain a running state of the balance car, and then determine the first wheel balance parameter and the second wheel balance parameter of the balance car according to the running state.
The method for determining the first wheel balance parameter and the second wheel balance parameter of the balance vehicle according to the driving state may be that a corresponding sample wheel balance parameter is searched from a preset driving state mapping relation table according to the driving state, then the first sample wheel balance parameter and the second sample wheel balance parameter are determined according to the sample wheel balance parameter, then the preset driving state mapping relation table includes a corresponding relation between the driving state and the sample wheel balance parameter, and a plurality of driving states and a plurality of sample wheel balance parameters and the like exist in the preset driving state mapping relation table.
The first wheel balance parameter may be a parameter required for balancing a left wheel of the vehicle, and the like, and the second wheel balance parameter may be a parameter required for balancing a right wheel of the vehicle, and the like, and this embodiment is not limited.
The driving state may be an acceleration state, a pause state, a steering state, etc., and the embodiment is not limited thereto.
Step S20: and carrying out fusion processing on the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter.
The first wheel balance parameter and the second wheel balance parameter are subjected to fusion processing, and the target balance parameter is obtained by determining a first motor output value according to the first wheel balance parameter, determining a second motor output value according to the first motor output value and the second wheel balance parameter, and then performing fusion processing on the first motor output value and the second motor output value to obtain the target balance parameter and the like.
The manner of determining the first motor output value according to the first wheel balance parameter may be to convert the first wheel balance parameter to obtain a corresponding first motor output value, or to calculate a first motor output value required for respective balance through a balance control algorithm, or the like.
The step of obtaining the output value of the second motor may be that the two-side control system performs communication and data exchange at a high frequency of 500HZ to obtain the output value of the second motor required by the control calculation of the other side, or may determine the output value of the second motor according to the output value of the first motor and the balance parameter of the second wheel, and the like, which is not limited in this embodiment.
In specific implementation, the first motor output value and the second motor output value need to be fused through a self-adaptive algorithm to obtain a final output motor value, namely a target balance parameter and the like.
It should be noted that the control algorithm of the balance car is more intelligent than the prior art. The parameters are optimized and matched according to different loads, different riding pavements and riding at different speeds. The method comprises the steps of collecting parameters such as angles, angular speeds, running speeds, current currents and voltages in real time, intelligently identifying the current riding state through multi-sensor data fusion, calculating optimal parameters, achieving better riding experience and the like.
Step S30: and driving a motor of the balance car according to the target balance parameter so as to realize motion control.
It should be understood that the obtained target balance parameters drive the motor of the balance car to realize motion control, and besides, the steering damping control algorithm can be customized for the balance car, so that stable and accurate steering control is realized. The balance car is more stable and smooth to ride. Under different loads and different speeds, the steering damping algorithm calculates the currently most appropriate compensation coefficient according to real-time dynamic voltage, current and speed, then obtains steering control outputs on two sides respectively through damping filtering calculation, and further drives a motor of the balance car according to the steering control outputs on the two sides so as to realize motion control and the like.
In this embodiment, first, current posture information of the balance car under a preset road condition is obtained, a first wheel balance parameter and a second wheel balance parameter of the balance car are determined according to the current posture information, then the first wheel balance parameter and the second wheel balance parameter are subjected to fusion processing to obtain a target balance parameter, and then a motor of the balance car is driven according to the target balance parameter to realize motion control. Compare in prior art, need rely on the control of health to realize the balance car control balance, and this embodiment fuses the processing to the first wheel balance parameter and the second wheel balance parameter that acquire, obtains the target balance parameter, later according to the motor of target balance parameter drive balance car, has realized the steady and accurate steering control of balance car, and then has improved user's the experience of riding.
Referring to fig. 3, fig. 3 is a schematic flow chart of a motion control method of a balance car according to a second embodiment of the present invention.
Based on the first embodiment, in this embodiment, the step S10 further includes:
step S101: acquiring first data of a gyroscope and second data of an acceleration sensor in the balance car under a preset road condition.
The preset road condition may be various road surfaces on which the user rides the balance car, may be an uphill road condition, may also be a downhill road condition, and the like, and the present embodiment is not limited.
It can be understood that the current attitude information of the balance car may be a real-time angular velocity value, an angle value, and the like of the balance car, and the step of obtaining the current attitude information of the balance car under the preset road condition may be obtaining first data of an acceleration sensor in the balance car under the preset road condition and second data of a gyroscope, obtaining the real-time angular velocity value according to the first data, obtaining the angle value according to the second data, and determining the current attitude information, and the like of the balance car according to the real-time angular velocity value and the angle value.
It should be noted that, in the present embodiment, the gyroscope and the acceleration sensor inside the two-wheel two-side control system of the balance vehicle are used to detect the change of the vehicle body attitude, that is, the two-wheel two-side control system of the balance vehicle collects respective attitude information through the high-precision 6-axis attitude sensor, and uses the servo control system to accurately drive the motor to perform corresponding adjustment, so as to maintain the balance of the system.
The first data may be a single angular velocity or multiple angular velocities acquired by using an acceleration sensor in the balance car, and the second data may be a single angle value or multiple angle values acquired by using a gyroscope in the balance car, which is not limited in this embodiment.
Step S102: and obtaining a real-time angular velocity value according to the first data, and obtaining an angular value according to the second data.
In order to obtain accurate first data, before the step of obtaining the real-time angular velocity value according to the first data, a first data type corresponding to the first data is also required to be obtained, whether the first data type meets a preset angular velocity type condition or not is then judged, and when the first data type meets the preset angular velocity type condition, the real-time angular velocity value and the like are obtained according to the first data.
The first data type may be understood as a type corresponding to an angular velocity value, and the preset angular velocity type condition may be a type corresponding to an angular velocity, and the present embodiment is not limited thereto.
Assuming that a first data type corresponding to the acquired first data is an A type and the condition of the preset angular velocity type is the A type, then judging whether the A type of the first data type is consistent with the A type of the preset angular velocity, and when the A type of the first data type is consistent with the A type of the preset angular velocity, obtaining a real-time angular velocity value and the like according to the first data.
Before the step of obtaining the first data type corresponding to the first data, a first data storage amount corresponding to the first data is also required to be obtained, whether the first data storage amount meets a preset data storage condition is judged, and when the first data storage amount meets the preset data storage condition, the first data type corresponding to the first data is obtained.
The first data storage amount may be understood as a storage size corresponding to a single angular velocity or a plurality of angular velocities, and the like, and the preset data storage condition may be set by a user in a self-defined manner, may be 5kb, may also be 5M, and the like, and this embodiment is not limited.
If the first data storage amount corresponding to the acquired first data is 5kb and the preset data storage condition is 5kb, judging whether the first data storage amount is consistent with a preset data storage threshold value, and acquiring a first data type corresponding to the first data when the first data storage amount is consistent with the preset data storage threshold value.
Further, in order to accurately obtain the angle value, before the step of obtaining the angle value according to the second data, a second data type corresponding to the second data needs to be obtained, and then it is determined whether the second data type meets a preset angle type condition, and when the second data type meets the preset angle type condition, the angle value is obtained according to the second data, and the like.
The second data type may be understood as a type corresponding to an angle value, and the preset angular velocity type condition may be a type corresponding to an angle, and the present embodiment is not limited thereto.
And if the second data type corresponding to the acquired second data is a B type and the preset angle type condition is the B type, judging whether the second data type B is consistent with the preset angle type B, and acquiring an angle value and the like according to the second data when the second data type B is consistent with the preset angle type B.
Before the step of obtaining the second data type corresponding to the second data, a second data storage amount corresponding to the second data is also required to be obtained, whether the second data storage amount meets a preset data storage condition is judged, and when the second data storage amount meets the preset data storage condition, the second data type corresponding to the second data is obtained, and the like.
The second data storage amount may be understood as a storage size corresponding to a single angle value or a plurality of angle values, and the like, and the preset data storage condition may be set by a user in a self-defined manner, may be 8kb, may also be 6M, and the like, and this embodiment is not limited.
And if the second data storage amount corresponding to the acquired second data is 6M and the preset data storage condition is 6M, judging whether the second data storage amount is consistent with a preset data storage threshold value, and acquiring a second data type corresponding to the second data when the second data storage amount is consistent with the preset data storage threshold value.
The step of obtaining the real-time angular velocity value according to the first data may be determining an angular velocity of the balance car according to the first data, then performing integration processing on the angular velocity to obtain an output attitude inclination angle, an attitude inclination angle deviation and a noise value, and finally determining the real-time angular velocity value according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value.
The real-time angular velocity value may be determined according to the output attitude inclination angle, the deviation of the attitude inclination angle, and the noise value by calculating the real-time angular velocity value according to a preset angular velocity formula according to the output attitude inclination angle, the deviation of the attitude inclination angle, and the noise value.
The preset angular velocity formula can be a state formula in the Kalman filter which is required to be subjected to integral processing when the acceleration sensor is used for solving the attitude angle, and can be constructed according to the characteristic of the acceleration sensor.
The manner of obtaining the angle value according to the second data may be to obtain a measurement noise value according to the second data, and then calculate the angle value according to the measurement noise value, the estimation value of the kalman filter, and the deviation value of the kalman filter by a preset angle formula.
The accelerometer can detect acceleration components on each axis of the space rectangular coordinate system during movement, namely a space vector of current movement can be obtained, and the current attitude angle of the direction can be obtained by calculating the included angle between any axis and the space vector.
Step S103: determining the current attitude information of the balance vehicle according to the real-time angular velocity value and the angular value, and determining a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the current attitude information.
The step of determining the first wheel balance parameter and the second wheel balance parameter of the balance car according to the current attitude information may be to analyze the current attitude information to obtain a running state of the balance car, and then determine the first wheel balance parameter and the second wheel balance parameter of the balance car according to the running state.
The method for determining the first wheel balance parameter and the second wheel balance parameter of the balance vehicle according to the driving state may be that a corresponding sample wheel balance parameter is searched from a preset driving state mapping relation table according to the driving state, then the first sample wheel balance parameter and the second sample wheel balance parameter are determined according to the sample wheel balance parameter, then the preset driving state mapping relation table includes a corresponding relation between the driving state and the sample wheel balance parameter, and a plurality of driving states and a plurality of sample wheel balance parameters and the like exist in the preset driving state mapping relation table.
The first wheel balance parameter may be a parameter required for balancing a left wheel of the vehicle, and the like, and the second wheel balance parameter may be a parameter required for balancing a right wheel of the vehicle, and the like, and this embodiment is not limited.
The driving state may be an acceleration state, a pause state, a steering state, etc., and the embodiment is not limited thereto.
In the implementation, first data of an acceleration sensor and second data of a gyroscope in a balance car under a preset road condition are firstly acquired, then a real-time angular velocity value is acquired according to the first data, an angle value is acquired according to the second data, and finally current attitude information of the balance car is determined according to the real-time angular velocity value and the angle value, so that accurate attitude information of the balance car is acquired.
Referring to fig. 4, fig. 4 is a schematic flow chart of a motion control method of a balance car according to a third embodiment of the present invention.
Based on the first embodiment, in this embodiment, the step S20 further includes:
step S201: and determining a first motor output value according to the first wheel balance parameter, and determining a second motor output value according to the first motor output value and the second wheel balance parameter.
The manner of determining the first motor output value according to the first wheel balance parameter may be to convert the first wheel balance parameter to obtain a corresponding first motor output value, or to calculate a first motor output value required for respective balance through a balance control algorithm, or the like.
The step of obtaining the output value of the second motor may be that the two-side control system performs communication and data exchange at a high frequency of 500HZ to obtain the output value of the second motor required by the control calculation of the other side, or may determine the output value of the second motor according to the output value of the first motor and the balance parameter of the second wheel, and the like, which is not limited in this embodiment.
Step S202: and carrying out fusion processing on the first motor output value and the second motor output value to obtain a target balance parameter.
In specific implementation, the first motor output value and the second motor output value need to be fused through a self-adaptive algorithm to obtain a final output motor value, namely a target balance parameter and the like.
It should be noted that the control algorithm of the balance car is more intelligent than the prior art. The parameters are optimized and matched according to different loads, different riding pavements and riding at different speeds. The method comprises the steps of collecting parameters such as angles, angular speeds, running speeds, current currents and voltages in real time, intelligently identifying the current riding state through multi-sensor data fusion, calculating optimal parameters, achieving better riding experience and the like.
In this embodiment, first motor output value is determined according to a first wheel balance parameter, second motor output value is determined according to the first motor output value and a second wheel balance parameter, and then the first motor output value and the second motor output value are fused to obtain a target balance parameter, so that an accurate target balance parameter is obtained, and stable and accurate steering control of the balance car is realized.
Referring to fig. 5, fig. 5 is a block diagram illustrating a motion control apparatus of a balance car according to a first embodiment of the present invention.
As shown in fig. 5, a motion control device for a balance car according to an embodiment of the present invention includes:
the acquiring module 5001 is configured to acquire current attitude information of a balance car under a preset road condition, and determine a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information;
a processing module 5002, configured to perform fusion processing on the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter;
and the control module 5003 is used for driving a motor of the balance car according to the target balance parameter so as to realize motion control.
In this embodiment, first, current posture information of the balance car under a preset road condition is obtained, a first wheel balance parameter and a second wheel balance parameter of the balance car are determined according to the current posture information, then the first wheel balance parameter and the second wheel balance parameter are subjected to fusion processing to obtain a target balance parameter, and then a motor of the balance car is driven according to the target balance parameter to realize motion control. Compare in prior art, need rely on the control of health to realize the balance car control balance, and this embodiment fuses the processing to the first wheel balance parameter and the second wheel balance parameter that acquire, obtains the target balance parameter, later according to the motor of target balance parameter drive balance car, has realized the steady and accurate steering control of balance car, and then has improved user's the experience of riding.
Further, the obtaining module 5001 is further configured to obtain first data of an acceleration sensor in the balance car and second data of a gyroscope under a preset road condition;
the obtaining module 5001 is further configured to obtain a real-time angular velocity value according to the first data, and obtain an angular value according to the second data;
the obtaining module 5001 is further configured to determine current attitude information of the balance car according to the real-time angular velocity value and the angle value.
Further, the obtaining module 5001 is further configured to obtain a first data type corresponding to the first data;
the obtaining module 5001 is further configured to determine whether the first data type meets a preset angular velocity type condition;
the obtaining module 5001 is further configured to execute the operation of obtaining the real-time angular velocity value according to the first data when the first data type meets the preset angular velocity type condition.
Further, the obtaining module 5001 is further configured to obtain a first data storage amount corresponding to the first data;
the obtaining module 5001 is further configured to determine whether the first data storage amount meets a preset data storage condition;
the obtaining module 5001 is further configured to execute the operation of obtaining the first data type corresponding to the first data when the first data storage amount meets the preset data storage condition.
Further, the obtaining module 5001 is further configured to obtain a second data type corresponding to the second data;
the obtaining module 5001 is further configured to determine whether the second data type meets a preset angle type condition;
the obtaining module 5001 is further configured to execute the operation of obtaining the angle value according to the second data when the second data type meets the preset angle type condition.
Further, the obtaining module 5001 is further configured to obtain a second data storage amount corresponding to the second data;
the obtaining module 5001 is further configured to determine whether the second data storage amount meets a preset data storage condition;
the obtaining module 5001 is further configured to execute the operation of obtaining the second data type corresponding to the second data when the second data storage amount meets the preset data storage condition.
Further, the obtaining module 5001 is further configured to determine an angular velocity of the balance car according to the first data;
the obtaining module 5001 is further configured to perform integration processing on the angular velocity to obtain an output attitude inclination angle, an attitude inclination angle deviation, and a noise value;
the obtaining module 5001 is further configured to determine a real-time angular velocity value according to the output attitude tilt angle, the attitude tilt angle deviation, and the noise value.
Further, the obtaining module 5001 is further configured to calculate a real-time angular velocity value according to the output attitude inclination angle, the attitude inclination angle deviation, and the noise value by using a preset angular velocity formula;
the preset angular velocity formula is as follows:
Figure BDA0002896636270000171
in the formula, Y1(t) is the output attitude dip angle, Y2(t) is the attitude dip angle deviation, w (t) is the noise value, y1(t) is an estimate of the Kalman filter, y2(t) deviation value of Kalman filter, ugyroAnd (t) is a real-time angular velocity value.
Further, the obtaining module 5001 is further configured to obtain a measurement noise value according to the second data;
the obtaining module 5001 is further configured to calculate an angle value according to the measurement noise value, the estimated value of the kalman filter, and the deviation value of the kalman filter by using a preset angle formula;
the preset angle formula is as follows:
Figure BDA0002896636270000172
where v (t) is a measurement noise value and z (t) is an angle value.
Further, the obtaining module 5001 is further configured to analyze the current attitude information to obtain a driving state of the balance car;
the obtaining module 5001 is further configured to determine a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the driving state.
Further, the obtaining module 5001 is further configured to search a corresponding sample wheel balance parameter from a preset driving state mapping relationship table according to the driving state;
the obtaining module 5001 is further configured to determine a first sample wheel balance parameter and a second sample wheel balance parameter according to the sample wheel balance parameter;
the obtaining module 5001 is further configured to obtain a corresponding relationship between a driving state and a sample wheel balance parameter in the preset driving state mapping relationship table.
Further, the processing module 5002 is further configured to determine a first motor output value according to the first wheel balance parameter, and determine a second motor output value according to the first motor output value and the second wheel balance parameter;
the processing module 5002 is further configured to perform fusion processing on the first motor output value and the second motor output value to obtain a target balance parameter.
Other embodiments or specific implementation manners of the motion control device of the balance car of the present invention may refer to the above method embodiments, and are not described herein again.
It should be noted that, in this document, the terms "comprises," "comprising," or any other variation thereof, are intended to cover a non-exclusive inclusion, such that a process, method, article, or system that comprises a list of elements does not include only those elements but may include other elements not expressly listed or inherent to such process, method, article, or system. Without further limitation, an element defined by the phrase "comprising an … …" does not exclude the presence of other like elements in a process, method, article, or system that comprises the element.
The above-mentioned serial numbers of the embodiments of the present invention are merely for description and do not represent the merits of the embodiments.
Through the above description of the embodiments, those skilled in the art will clearly understand that the method of the above embodiments can be implemented by software plus a necessary general hardware platform, and certainly can also be implemented by hardware, but in many cases, the former is a better implementation manner. Based on such understanding, the technical solutions of the present invention may be embodied in the form of a software product, which is stored in a storage medium (e.g., a rom/ram, a magnetic disk, an optical disk) and includes instructions for enabling a terminal device (e.g., a mobile phone, a computer, a server, an air conditioner, or a network device) to execute the method according to the embodiments of the present invention.
The above description is only a preferred embodiment of the present invention, and not intended to limit the scope of the present invention, and all modifications of equivalent structures and equivalent processes, which are made by using the contents of the present specification and the accompanying drawings, or directly or indirectly applied to other related technical fields, are included in the scope of the present invention.
The invention discloses A1 and a motion control method of a balance car, which comprises the following steps:
acquiring current attitude information of a balance car under a preset road condition, and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information;
fusing the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter;
and driving a motor of the balance car according to the target balance parameter so as to realize motion control.
A2, the method of claim a1, wherein the step of obtaining the current posture information of the balance car under the preset road conditions comprises:
acquiring first data of an acceleration sensor in a balance car and second data of a gyroscope under a preset road condition;
obtaining a real-time angular velocity value according to the first data, and obtaining an angular value according to the second data;
and determining the current attitude information of the balance car according to the real-time angular velocity value and the angular value.
A3, the method of claim a2, further comprising, before the step of obtaining a real-time angular velocity value from the first data:
acquiring a first data type corresponding to the first data;
judging whether the first data type meets a preset angular velocity type condition or not;
and when the first data type meets the preset angular velocity type condition, executing the step of obtaining the real-time angular velocity value according to the first data.
A4, the method of claim A3, the step of obtaining the first data type corresponding to the first data further comprising:
acquiring a first data storage capacity corresponding to the first data;
judging whether the first data storage quantity meets a preset data storage condition or not;
and when the first data storage capacity meets the preset data storage condition, executing the step of acquiring the first data type corresponding to the first data.
A5, the method of claim a2, the step of obtaining an angle value from the second data being preceded by the step of:
acquiring a second data type corresponding to the second data;
judging whether the second data type meets a preset angle type condition or not;
and when the second data type meets the preset angle type condition, executing the step of obtaining the angle value according to the second data.
A6, the method of claim a5, further comprising, before the step of obtaining the second data type corresponding to the second data:
acquiring a second data storage capacity corresponding to the second data;
judging whether the second data storage quantity meets a preset data storage condition or not;
and when the second data storage quantity meets the preset data storage condition, executing the step of acquiring a second data type corresponding to the second data.
A7, the method of any one of claims a2-a6, the step of obtaining a real-time angular velocity value from the first data comprising:
determining the angular speed of the balance car according to the first data;
performing integral processing on the angular velocity to obtain an output attitude dip angle, an attitude dip angle deviation and a noise value;
and determining a real-time angular velocity value according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value.
A8, the method of claim a7, the step of determining a real-time angular velocity value based on the output attitude dip, the attitude dip bias and the noise value, comprising:
calculating a real-time angular velocity value through a preset angular velocity formula according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value;
the preset angular velocity formula is as follows:
Figure BDA0002896636270000211
in the formula, Y1(t) is the output attitude dip angle, Y2(t) is the attitude dip angle deviation, w (t) is the noise value, y1(t) is an estimate of the Kalman filter, y2(t) deviation value of Kalman filter, ugyroAnd (t) is a real-time angular velocity value.
A9, the method of claim A8, the step of obtaining an angle value from the second data, comprising:
acquiring a measurement noise value according to the second data;
calculating an angle value through a preset angle formula according to the measurement noise value, the estimated value of the Kalman filter and the deviation value of the Kalman filter;
the preset angle formula is as follows:
Figure BDA0002896636270000212
where v (t) is a measurement noise value and z (t) is an angle value.
A10, the method of claim A1, the step of determining first and second wheel balancing parameters of the balancing vehicle from the current attitude information comprising:
analyzing the current attitude information to obtain the running state of the balance car;
and determining a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the running state.
A11, the method of claim a10, the step of determining a first wheel balancing parameter and a second wheel balancing parameter of the balancing vehicle according to the driving conditions, comprising:
searching a corresponding sample wheel balance parameter from a preset driving state mapping relation table according to the driving state;
determining a first sample wheel balance parameter and a second sample wheel balance parameter according to the sample wheel balance parameter;
the preset driving state mapping relation table comprises a corresponding relation between a driving state and a sample wheel balance parameter.
A12, the method of claim a1, the step of fusing the first wheel balancing parameter and the second wheel balancing parameter to obtain a target balancing parameter, comprising:
determining a first motor output value according to the first wheel balance parameter, and determining a second motor output value according to the first motor output value and the second wheel balance parameter;
and carrying out fusion processing on the first motor output value and the second motor output value to obtain a target balance parameter.
The invention also discloses B13 and a motion control device of the balance car, the motion control device of the balance car comprises:
the acquisition module is used for acquiring current attitude information of the balance car under a preset road condition and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information;
the processing module is used for carrying out fusion processing on the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter;
and the control module is used for driving a motor of the balance car according to the target balance parameters so as to realize motion control.
B14, the device according to claim B13, wherein the obtaining module is further configured to obtain first data of an acceleration sensor and second data of a gyroscope in the balance car under a preset road condition;
the acquisition module is further used for acquiring a real-time angular velocity value according to the first data and acquiring an angular value according to the second data;
the acquisition module is further used for determining the current attitude information of the balance car according to the real-time angular velocity value and the angular value.
B15, the apparatus of claim B14, the obtaining module further for determining an angular velocity of the balance car from the first data;
the acquisition module is further used for carrying out integral processing on the angular velocity to obtain an output attitude dip angle, an attitude dip angle deviation and a noise value;
the acquisition module is further configured to determine a real-time angular velocity value according to the output attitude inclination angle, the attitude inclination angle deviation and the noise value.
B16, the device of claim B13, the obtaining module is further configured to analyze the current attitude information to obtain a driving state of the balance car;
the acquisition module is further used for determining a first wheel balance parameter and a second wheel balance parameter of the balance vehicle according to the running state.
B17, the apparatus according to claim B16, the obtaining module is further configured to look up corresponding sample wheel balance parameters from a preset driving state mapping table according to the driving state;
the acquisition module is further used for determining a first sample wheel balance parameter and a second sample wheel balance parameter according to the sample wheel balance parameter;
the obtaining module is further configured to obtain a corresponding relationship between a driving state and a sample wheel balance parameter in the preset driving state mapping relationship table.
B18, the apparatus of claim B13, the processing module further configured to determine a first motor output value based on the first wheel balancing parameter and a second motor output value based on the first motor output value and the second wheel balancing parameter;
and the processing module is also used for carrying out fusion processing on the first motor output value and the second motor output value to obtain a target balance parameter.
The invention also discloses C19, a motion control device of the balance car, which comprises: the system comprises a memory, a processor and a motion control program of the balance car, wherein the motion control program of the balance car is stored on the memory and can run on the processor, and the motion control program of the balance car is configured to realize the steps of the motion control method of the balance car.
The invention also discloses D20 and a storage medium, wherein the storage medium stores a motion control program of the balance car, and the motion control program of the balance car realizes the steps of the motion control method of the balance car when being executed by a processor.

Claims (10)

1. A motion control method of a balance car is characterized by comprising the following steps:
acquiring current attitude information of a balance car under a preset road condition, and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information;
fusing the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter;
and driving a motor of the balance car according to the target balance parameter so as to realize motion control.
2. The method as claimed in claim 1, wherein the step of obtaining the current attitude information of the balance car under the preset road condition comprises:
acquiring first data of an acceleration sensor in a balance car and second data of a gyroscope under a preset road condition;
obtaining a real-time angular velocity value according to the first data, and obtaining an angular value according to the second data;
and determining the current attitude information of the balance car according to the real-time angular velocity value and the angular value.
3. The method of claim 2, wherein said step of obtaining a real-time angular velocity value from said first data is preceded by the step of:
acquiring a first data type corresponding to the first data;
judging whether the first data type meets a preset angular velocity type condition or not;
and when the first data type meets the preset angular velocity type condition, executing the step of obtaining the real-time angular velocity value according to the first data.
4. The method of claim 3, wherein the step of obtaining the first data type corresponding to the first data is preceded by the step of:
acquiring a first data storage capacity corresponding to the first data;
judging whether the first data storage quantity meets a preset data storage condition or not;
and when the first data storage capacity meets the preset data storage condition, executing the step of acquiring the first data type corresponding to the first data.
5. The method of claim 2, wherein the step of obtaining an angle value from the second data is preceded by:
acquiring a second data type corresponding to the second data;
judging whether the second data type meets a preset angle type condition or not;
and when the second data type meets the preset angle type condition, executing the step of obtaining the angle value according to the second data.
6. The method of claim 5, wherein the step of obtaining the second data type corresponding to the second data is preceded by the step of:
acquiring a second data storage capacity corresponding to the second data;
judging whether the second data storage quantity meets a preset data storage condition or not;
and when the second data storage quantity meets the preset data storage condition, executing the step of acquiring a second data type corresponding to the second data.
7. The method of claim 1, wherein the step of fusing the first wheel balancing parameter and the second wheel balancing parameter to obtain a target balancing parameter comprises:
determining a first motor output value according to the first wheel balance parameter, and determining a second motor output value according to the first motor output value and the second wheel balance parameter;
and carrying out fusion processing on the first motor output value and the second motor output value to obtain a target balance parameter.
8. A motion control device of a balance car, characterized by comprising:
the acquisition module is used for acquiring current attitude information of the balance car under a preset road condition and determining a first wheel balance parameter and a second wheel balance parameter of the balance car according to the current attitude information;
the processing module is used for carrying out fusion processing on the first wheel balance parameter and the second wheel balance parameter to obtain a target balance parameter;
and the control module is used for driving a motor of the balance car according to the target balance parameters so as to realize motion control.
9. A motion control apparatus of a balance car, characterized in that the apparatus comprises: a memory, a processor and a motion control program of a balancing vehicle stored on the memory and executable on the processor, the motion control program of the balancing vehicle being configured to implement the steps of the motion control method of the balancing vehicle as claimed in any one of claims 1 to 7.
10. A storage medium on which a motion control program of a balance car is stored, the motion control program of the balance car realizing the steps of the motion control method of the balance car according to any one of claims 1 to 7 when executed by a processor.
CN202110045804.3A 2021-01-13 2021-01-13 Motion control method, device and equipment of balance car and storage medium Active CN112874315B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110045804.3A CN112874315B (en) 2021-01-13 2021-01-13 Motion control method, device and equipment of balance car and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110045804.3A CN112874315B (en) 2021-01-13 2021-01-13 Motion control method, device and equipment of balance car and storage medium

Publications (2)

Publication Number Publication Date
CN112874315A true CN112874315A (en) 2021-06-01
CN112874315B CN112874315B (en) 2022-11-04

Family

ID=76045854

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110045804.3A Active CN112874315B (en) 2021-01-13 2021-01-13 Motion control method, device and equipment of balance car and storage medium

Country Status (1)

Country Link
CN (1) CN112874315B (en)

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070067085A1 (en) * 2005-09-19 2007-03-22 Ford Global Technologies Llc Integrated vehicle control system using dynamically determined vehicle conditions
CN102141814A (en) * 2010-12-09 2011-08-03 北京理工大学 Balance control method, balance control device and robot
CN103019093A (en) * 2011-09-26 2013-04-03 东莞易步机器人有限公司 Obtaining method of fusion angle of sensor for two-wheeled vehicle
CN105501356A (en) * 2016-01-15 2016-04-20 厉学战 Two-wheel balance car
US20160245842A1 (en) * 2015-02-20 2016-08-25 Seiko Epson Corporation Measurement apparatus, measurement method, and measurement system
CN107543546A (en) * 2016-06-28 2018-01-05 沈阳新松机器人自动化股份有限公司 A kind of attitude algorithm method and device of six axis movement sensors
DE102016116327A1 (en) * 2016-09-01 2018-03-01 Sandro Suess Speed limit for a self-balancing vehicle
CN108121334A (en) * 2016-11-28 2018-06-05 沈阳新松机器人自动化股份有限公司 A kind of self-balance robot motion control method and device
CN109992327A (en) * 2017-12-29 2019-07-09 深圳市优必选科技有限公司 A kind of control method of robot, robot and storage medium
CN110334141A (en) * 2019-05-30 2019-10-15 平安科技（深圳）有限公司 Method, apparatus, computer equipment and the storage medium of data conversion
CN209765335U (en) * 2019-03-12 2019-12-10 黄山学院 Two-wheeled self-balancing mobile robot control system
CN110653814A (en) * 2018-06-29 2020-01-07 深圳市优必选科技有限公司 Robot control method, robot and device with storage function

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070067085A1 (en) * 2005-09-19 2007-03-22 Ford Global Technologies Llc Integrated vehicle control system using dynamically determined vehicle conditions
CN102141814A (en) * 2010-12-09 2011-08-03 北京理工大学 Balance control method, balance control device and robot
CN103019093A (en) * 2011-09-26 2013-04-03 东莞易步机器人有限公司 Obtaining method of fusion angle of sensor for two-wheeled vehicle
US20160245842A1 (en) * 2015-02-20 2016-08-25 Seiko Epson Corporation Measurement apparatus, measurement method, and measurement system
CN105501356A (en) * 2016-01-15 2016-04-20 厉学战 Two-wheel balance car
CN107543546A (en) * 2016-06-28 2018-01-05 沈阳新松机器人自动化股份有限公司 A kind of attitude algorithm method and device of six axis movement sensors
DE102016116327A1 (en) * 2016-09-01 2018-03-01 Sandro Suess Speed limit for a self-balancing vehicle
CN108121334A (en) * 2016-11-28 2018-06-05 沈阳新松机器人自动化股份有限公司 A kind of self-balance robot motion control method and device
CN109992327A (en) * 2017-12-29 2019-07-09 深圳市优必选科技有限公司 A kind of control method of robot, robot and storage medium
CN110653814A (en) * 2018-06-29 2020-01-07 深圳市优必选科技有限公司 Robot control method, robot and device with storage function
CN209765335U (en) * 2019-03-12 2019-12-10 黄山学院 Two-wheeled self-balancing mobile robot control system
CN110334141A (en) * 2019-05-30 2019-10-15 平安科技（深圳）有限公司 Method, apparatus, computer equipment and the storage medium of data conversion

Also Published As

Publication number Publication date
CN112874315B (en) 2022-11-04

Similar Documents

Publication Publication Date Title
Liao et al. An adaptive approach to real-time estimation of vehicle sideslip, road bank angles, and sensor bias
CN112109515A (en) Storage medium, and method and device for controlling vehicle active suspension
JP2012229011A (en) Continuous calculation of vehicle center gravity
CN110096051B (en) Method and device for generating vehicle control command
Larey et al. Multiple inertial measurement units–an empirical study
CN114132312B (en) Vehicle speed limiting method, system, equipment and computer readable storage medium
CN111572551A (en) Course angle calculation method, device, equipment and storage medium under parking condition
CN112622876B (en) Vehicle centroid position determination method, device, equipment and storage medium
CN112874315B (en) Motion control method, device and equipment of balance car and storage medium
CN112046491B (en) Method and device for estimating cornering stiffness of wheel, vehicle and readable storage medium
CN108773378B (en) Automobile running speed real-time estimation method and device based on mobile terminal
CN108931986A (en) A kind of two wheels automobile self-balancing control method, device and storage medium
CN109506674A (en) A kind of bearing calibration of acceleration and device
CN117091592A (en) Gesture resolving method, gesture resolving device, and computer storage medium
KR102635657B1 (en) Segway Robot Based on Reinforcement Learning and Its Method for Motion Control
CN115123194A (en) Vehicle control method, device, equipment and storage medium
CN116088538A (en) Vehicle track information generation method, device, equipment and computer readable medium
CN113927585B (en) Robot balance control method and device, readable storage medium and robot
CN111337051B (en) Method and device for calibrating forward axis of vehicle accelerometer
CN113778106A (en) Wheeled robot energy-saving track planning method, planning equipment and readable storage medium
CN112632803A (en) Tracking control method and device, electronic equipment and storage medium
Chang et al. Reinforcement learning-based two-wheel robot control
CN114407890B (en) Lane keeping method, system, apparatus and computer readable storage medium
CN116653976A (en) Road adhesion coefficient estimation method, device, medium and electronic equipment
Wenzel et al. Hybrid genetic algorithms/extended kalman filter approach for vehicle state and parameter estimation

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
CP03 Change of name, title or address

Address after: 518000, 3rd Floor, Building A2, Nanshan Zhiyuan, No. 1001 Xueyuan Avenue, Changyuan Community, Taoyuan Street, Nanshan District, Shenzhen, Guangdong Province

Patentee after: Shenzhen 3600 Smart Life Technology Co.,Ltd.

Country or region after: China

Address before: 518000 Room 201, building A, No. 1, Qian Wan Road, Qianhai Shenzhen Hong Kong cooperation zone, Shenzhen, Guangdong (Shenzhen Qianhai business secretary Co., Ltd.)

Patentee before: SHENZHEN QIHU INTELLIGENT TECHNOLOGY CO.,LTD.

Country or region before: China