CN112114588A - Balance car and control method thereof - Google Patents

Balance car and control method thereof Download PDF

Info

Publication number
CN112114588A
CN112114588A CN202010894262.2A CN202010894262A CN112114588A CN 112114588 A CN112114588 A CN 112114588A CN 202010894262 A CN202010894262 A CN 202010894262A CN 112114588 A CN112114588 A CN 112114588A
Authority
CN
China
Prior art keywords
balance car
control
determining
state
moment
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
CN202010894262.2A
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 University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
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 University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN202010894262.2A priority Critical patent/CN112114588A/en
Publication of CN112114588A publication Critical patent/CN112114588A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62JCYCLE SADDLES OR SEATS; AUXILIARY DEVICES OR ACCESSORIES SPECIALLY ADAPTED TO CYCLES AND NOT OTHERWISE PROVIDED FOR, e.g. ARTICLE CARRIERS OR CYCLE PROTECTORS
    • B62J45/00Electrical equipment arrangements specially adapted for use as accessories on cycles, not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62KCYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
    • B62K11/00Motorcycles, engine-assisted cycles or motor scooters with one or two wheels
    • B62K11/007Automatic balancing machines with single main ground engaging wheel or coaxial wheels supporting a rider

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

The invention discloses a balance car and a control method thereof, wherein the control method of the balance car comprises the following steps: acquiring input parameters of the balance car at the previous moment; acquiring state parameters of the balance car at the current moment; determining a control increment according to the target function and the state parameter of the balance car at the current moment; superposing the control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment; according to the method, the input parameter at the previous moment and the state parameter at the current moment are obtained, the possible track of the balance car under the future control input is predicted, and the extreme value solving method is used, so that the tracking error of the balance car can be effectively avoided, the limitation of the wheel rotating speed of the actual balance car can be considered, and the realizability is ensured.

Description

Balance car and control method thereof
Technical Field
The invention relates to the technical field of balance cars, in particular to a balance car and a control method thereof.
Background
At present, most of traditional two-wheeled balance vehicles adjust the movement track according to the body posture or the gravity center position of a driver, the planning of future movement is lacked, errors of 'understanding' the intention of the driver are easily caused, the track of the two-wheeled balance vehicle deviates from the ideal value of the driver, and the two-wheeled balance vehicle cannot well run according to the preset track of the driver.
Disclosure of Invention
The invention provides a balance car with small error and a control method thereof, aiming at solving the problem that the existing balance car is easy to deviate from a preset track.
In order to achieve the above object, an aspect of the present invention provides a control method of a balance car, including:
acquiring input parameters of the balance car at the previous moment; wherein the input parameters comprise a left wheel rotation speed and a right wheel rotation speed;
acquiring state parameters of the balance car at the current moment; wherein the state parameters comprise a course angle, a left wheel and right wheel distance, a left wheel radius and a right wheel radius;
determining a control increment according to the target function and the state parameter of the balance car at the current moment;
and superposing the control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment.
Optionally, the objective function is shown as (1),
Figure RE-GDA0002749374240000011
wherein minJ represents the minimization objective function, NpTo predict the time domain, NcTo control the time domain, yt+itFor the predicted i-th system output state, χr(i) For an ideal trajectory of reference, Δ ut+itFor the required control input increment, Q and R are corresponding weight matrixes;
optionally, the determining a control increment according to the objective function and the state parameter of the balance car at the current time further includes:
determining a state equation of the balance vehicle according to the left wheel rotating speed and the right wheel rotating speed of the balance vehicle at the current moment; wherein the state equation is shown in (2),
Figure RE-GDA0002749374240000012
determining an output equation of the balance car according to the state equation of the balance car; wherein the output method is shown as (3),
Figure RE-GDA0002749374240000013
wherein:
Figure RE-GDA0002749374240000025
Figure RE-GDA0002749374240000021
Δu=uk-uk-1
0i×jan all-zero matrix representing i rows and j columns; i isiRepresenting an identity matrix of order i, alphak+1=[χk+1,uk]TT is sampling time;
determining a control increment according to the reference track, the output equation and the output predicted value at the next moment; wherein the output predicted value at the next moment is shown as (4),
Figure RE-GDA0002749374240000022
wherein:
Y=[yt+1|t yt+2|t … yt+Np|t]T
Figure RE-GDA0002749374240000023
Figure RE-GDA0002749374240000024
optionally, the determining a control increment according to the reference trajectory and the predicted output value of the system at the next time further includes:
determining a state predicted value at the next moment according to the reference track;
determining an output predicted value at the next moment according to the state predicted value and the output equation;
and determining a control increment according to the output predicted value and the objective function.
Optionally, the step of superposing the control increment and the input parameter of the balance car at the previous time to obtain the input parameter of the balance car at the current time further includes:
determining a series of future control increments according to the objective function, the control increment constraint and the control quantity constraint; wherein the control increment constraint is Deltaumin≤Δut+i|t≤Δumax i=0,1,...,NcThe controlled variable is constrained to umin≤ut+i|t≤umaxi=1,...,Nc
Taking a first term of a vector in the series of control increments as an actual control increment;
and superposing the actual control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment.
On the other hand, the invention also provides a balance car, which is characterized by comprising:
the first acquisition unit is used for acquiring input parameters of the balance car at the previous moment; wherein the input parameters comprise a left wheel rotation speed and a right wheel rotation speed;
the second acquisition unit is used for acquiring the state parameters of the balance car at the current moment; wherein the state parameters comprise a course angle, a left wheel and right wheel distance, a left wheel radius, a right wheel radius, a left wheel rotating speed and a right wheel rotating speed;
the determining unit is used for determining a control increment according to the target function and the state parameter of the balance car at the current moment;
and the superposition unit is used for superposing the control increment and the input parameters of the balance car at the previous moment to obtain the input parameters of the balance car at the current moment.
In the above balance car, optionally, the objective function is as shown in (1),
Figure RE-GDA0002749374240000031
wherein minJ represents the minimization objective function, NpTo predict the time domain, NcTo control the time domain, yt+i|tFor the predicted i-th system output state, χr(i) For an ideal trajectory of reference, Δ ut+i|tFor the required control input increment, Q and R are corresponding weight matrixes;
in the above balance vehicle, optionally, the determining a control increment according to the objective function and the state parameter of the balance vehicle at the current time further includes:
determining a state equation of the balance vehicle according to the left wheel rotating speed and the right wheel rotating speed of the balance vehicle at the current moment; wherein the state equation is shown in (2),
Figure RE-GDA0002749374240000032
determining an output equation of the balance car according to the state equation of the balance car; wherein the output method is shown as (3),
Figure RE-GDA0002749374240000033
wherein:
Figure RE-GDA0002749374240000034
Figure RE-GDA0002749374240000035
Δu=uk-uk-1
0i×jan all-zero matrix representing i rows and j columns; i isiRepresenting an identity matrix of order i, alphak+1=[χk+1,uk]TT is sampling time;
determining a control increment according to the reference track, the output equation and the output predicted value at the next moment; wherein the output predicted value at the next moment is shown as (4),
Figure RE-GDA0002749374240000041
wherein:
Y=[yt+1|t yt+2|t … yt+Np|t]T
Figure RE-GDA0002749374240000042
Figure RE-GDA0002749374240000043
in the above balance vehicle, optionally, the determining a control increment according to the reference trajectory and the predicted output value of the system at the next time further includes:
determining a state predicted value at the next moment according to the reference track;
determining an output predicted value at the next moment according to the state predicted value and the output equation;
and determining a control increment according to the output predicted value and the objective function.
In the above balance car, optionally, the superimposing the control increment and the input parameter of the balance car at the previous time to obtain the input parameter of the balance car at the current time further includes:
determining a series of future control increments according to the objective function, the control increment constraint and the control quantity constraint; wherein the control increment constraint is Deltaumin≤Δut+i|t≤Δumax i=0,1,...,NcThe controlled variable is constrained to umin≤ut+i|t≤umaxi=1,...,Nc
Taking a first term of a vector in the series of control increments as an actual control increment;
and superposing the actual control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment.
Compared with the prior art, the invention has the beneficial effects that: according to the method, the input parameter at the previous moment and the state parameter at the current moment are obtained, the possible track of the balance car under the future control input is predicted, and the extreme value solving method is used, so that the tracking error of the balance car can be effectively avoided, the limitation of the wheel rotating speed of the actual balance car can be considered, and the realizability is ensured.
Drawings
FIG. 1 is a flow chart of a balance vehicle control method of the present invention;
FIG. 2 is a diagram for analyzing the motion state of the balance vehicle according to the present invention;
fig. 3 is a structural view of the balance car of the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
As used in this application and the appended claims, the terms "a," "an," "the," and/or "the" are not intended to be inclusive in the singular, but rather are intended to be inclusive in the plural unless the context clearly dictates otherwise. In general, the terms "comprises" and "comprising" merely indicate that steps and elements are included which are explicitly identified, that the steps and elements do not form an exclusive list, and that a method or apparatus may include other steps or elements.
The relative arrangement of the components and steps, the numerical expressions, and numerical values set forth in these embodiments do not limit the scope of the present application unless specifically stated otherwise. Meanwhile, it should be understood that the sizes of the respective portions shown in the drawings are not drawn in an actual proportional relationship for the convenience of description. Techniques, methods, and apparatus known to those of ordinary skill in the relevant art may not be discussed in detail but are intended to be part of the specification where appropriate. In all examples shown and discussed herein, any particular value should be construed as merely illustrative, and not limiting. Thus, other examples of the exemplary embodiments may have different values. It should be noted that: like reference numbers and letters refer to like items in the following figures, and thus, once an item is defined in one figure, further discussion thereof is not required in subsequent figures.
Referring to fig. 1 and 2, the present embodiment provides a control method of a balance car, including the steps of:
s10: acquiring input parameters of the balance car at the previous moment;
specifically, the input parameters of the balance car at a moment are acquired, and the input parameters comprise the rotating speed of the left wheel and the rotating speed of the right wheel.
S20: acquiring state parameters of the balance car at the current moment; wherein the state parameters comprise a course angle, a left wheel and right wheel distance, a left wheel radius, a right wheel radius, a left wheel rotating speed and a right wheel rotating speed;
s30: determining a control increment according to the target function and the state parameter of the balance car at the current moment;
specifically, the spatial position of the two-wheel balance car is described by a transverse position x, a longitudinal position y and a course angle theta, the distance between the left wheel and the right wheel of the balance car is L, the radius of the wheels is R, and the speed and the rotating speed of the left wheel are VlAnd ωlIndicating, the wheel speed and rotational speed of the right wheel by VrAnd ωrRepresents;
the relationship between the wheel speed and the rotating speed of the left wheel and the right wheel of the two-wheel balance vehicle is as follows:
Figure RE-GDA0002749374240000051
the speed at the mass center of the two-wheeled balance car is as follows:
Figure RE-GDA0002749374240000052
and the relation between the space position and the vehicle speed at the position of the mass center of the two-wheel balance vehicle is as follows:
Figure RE-GDA0002749374240000061
in the formula (I), the compound is shown in the specification,
Figure RE-GDA0002749374240000062
the speed of the mass center of the balance car along the direction of the x axis is obtained,
Figure RE-GDA0002749374240000063
the speed of the mass center of the balance car along the y-axis direction is shown, V is the speed of the mass center of the balance car, and theta is a course angle.
The left wheel and the right wheel of the two-wheel balance vehicle relative to the instantaneous rotation center O1The rotational angular velocity of (a) is:
Figure RE-GDA0002749374240000064
in the formula IlIndicating the distance of the left wheel from the instantaneous centre of rotation,/rIndicating the distance of the right wheel from the instantaneous center of rotation.
The following steps are provided:
ll-lr=L (5)
wherein L is the distance between the left and right wheels.
The course angular speed of the two-wheeled balance car can be solved according to the formulas (4) and (5) as follows:
Figure RE-GDA0002749374240000065
therefore, x ═ x, y, θ are selected]TAs the system state of the two-wheeled balance vehicle, the left and right wheel rotation speed u ═ ωlr]TAs system input, the system equation of the two-wheel balance vehicle is as follows:
Figure RE-GDA0002749374240000066
the abbreviation is:
Figure RE-GDA0002749374240000067
wherein f () is a nonlinear state transfer function;
linearizing equation (8) to obtain:
Figure RE-GDA0002749374240000068
wherein:
Figure RE-GDA0002749374240000069
Figure RE-GDA0002749374240000071
then discretizing the formula (9), and setting the sampling time as T, the discrete state equation is as follows:
Figure RE-GDA0002749374240000072
wherein:
Figure RE-GDA0002749374240000073
Figure RE-GDA0002749374240000074
selecting a new state alphak+1=[χk+1,uk]TConstructing a new state equation about the two-wheeled balance vehicle according to the formula (12):
Figure RE-GDA0002749374240000075
the output is the position and the course angle [ x, y, theta ] of the two-wheeled balance car]TThus, an output equation is constructed as:
Figure RE-GDA0002749374240000076
wherein:
Figure RE-GDA0002749374240000077
Figure RE-GDA0002749374240000078
Δu=uk-uk-1 (19)
note: 0i×jAn all-zero matrix representing i rows and j columns; i isiRepresenting an identity matrix with the order i;
the planned reference track is chi in the track tracking control of the two-wheeled balance carr(k)=[xr(k),yr(k),θr(k)]TPredicting the state of the kth step in the future at the current time t is recorded as alphat+k|tThus in the current state αtAnd future NcPossible control input in step
Figure RE-GDA0002749374240000081
Next, future Np(Np≥Nc) The state prediction value of the system in the step is as follows:
Figure RE-GDA0002749374240000082
Figure RE-GDA0002749374240000083
……
Figure RE-GDA0002749374240000084
according to the formulas (16), (20), (21) and (22), the future N of the two-wheeled balance vehicle can be obtainedp(Np≥Nc) The output prediction value of the intra-step system is as follows:
Figure RE-GDA0002749374240000085
wherein:
Y=[yt+1|t yt+2|t … yt+Np|t]T (24)
Figure RE-GDA0002749374240000086
Figure RE-GDA0002749374240000087
by establishing the following objective function:
Figure RE-GDA0002749374240000088
wherein minJ represents the minimization objective function, NpTo predict the time domain, NcTo control the time domain, yt+i|tFor the predicted i-th system output state, χr(i) For an ideal trajectory of reference, Δ ut+i|tFor the required control input increment, Q and R are the corresponding weight matrices.
S40: superposing the control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment;
specifically, consider a control increment constraint and a control quantity constraint:
Δumin≤Δut+i|t≤Δumax i=0,1,...,Nc (28)
umin≤ut+i|t≤umax i=1,...,Nc (29)
by solving the extremum problem of equation (27) with a computer, a future possible series of control increments can be obtained:
Figure RE-GDA0002749374240000091
taking the first term of the vector in the formula (30) as the actual control increment, and according to the control input u of the previous stept-1And obtaining the actual control input of the current two-wheel balance vehicle:
Figure RE-GDA0002749374240000092
and when the vehicle enters the next sampling moment, repeating the process and continuously solving the control quantity of the rotating speed of the left wheel and the right wheel.
The control method can effectively avoid the tracking error of the balance car by predicting the possible track of the future balance car under the control input and applying the method of extreme value solution, and can also consider the limitation of the wheel rotating speed of the actual balance car and ensure the realizability.
In some other embodiments, the present invention provides a balance vehicle, as shown in fig. 3, the balance vehicle includes a first obtaining unit 10, a second obtaining unit 20, a determining unit 30 and a superimposing unit 40, wherein the first obtaining unit is configured to obtain the left wheel rotation speed and the right wheel rotation speed at a time on the balance vehicle, and the input parameters include the left wheel rotation speed and the right wheel rotation speed.
The second obtaining unit 20 is configured to obtain a state parameter of the balance car at the current time; wherein the state parameters comprise a course angle, a left wheel and right wheel distance, a left wheel radius, a right wheel radius, a left wheel rotating speed and a right wheel rotating speed;
the determining unit 30 is configured to determine the control increment according to the objective function and the state parameter of the balance car at the current time, where the specific determining method is described in detail in step S30, and is not described again in this embodiment.
The superimposing unit 40 is configured to superimpose the control increment determined by the determining unit 30 and the input parameter of the balance car at the previous time obtained by the first obtaining unit 10 to obtain the input parameter of the balance car at the current time, and please refer to step S40 in the above embodiment of the balance car control method for a specific superimposing method and step, which is not described in detail in this embodiment.
The above description is only an 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 performed by the present specification and drawings, or directly or indirectly applied to other related technical fields, are included in the scope of the present invention.

Claims (10)

1. A control method of a balance car is characterized by comprising the following steps:
acquiring input parameters of the balance car at the previous moment; wherein the input parameters comprise a left wheel rotation speed and a right wheel rotation speed;
acquiring state parameters of the balance car at the current moment; wherein the state parameters comprise a course angle, a left wheel and right wheel distance, a left wheel radius and a right wheel radius;
determining a control increment according to the target function and the state parameter of the balance car at the current moment;
and superposing the control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment.
2. The control method according to claim 1, characterized in that: the objective function is shown as (1),
Figure FDA0002657929570000011
wherein minJ represents the minimization objective function, NpTo predict the time domain, NcTo control the time domain, yt+i|tFor the predicted i-th system output state, χr(i) For an ideal trajectory of reference, Δ ut+i|tFor the required control input increment, Q and R are corresponding weight matrixes;
3. the control method according to claim 1, wherein the determining a control increment according to the objective function and the state parameter of the balance car at the current moment further comprises:
determining a state equation of the balance vehicle according to the left wheel rotating speed and the right wheel rotating speed of the balance vehicle at the current moment; wherein the state equation is shown in (2),
Figure FDA0002657929570000012
determining an output equation of the balance car according to the state equation of the balance car; wherein the output method is shown as (3),
Figure FDA0002657929570000013
wherein:
Figure FDA0002657929570000014
Figure FDA0002657929570000015
Δu=uk-uk-1
0i×jan all-zero matrix representing i rows and j columns; i isiRepresenting an identity matrix of order i, alphak+1=[χk+1,uk]TT is sampling time;
determining a control increment according to the reference track, the output equation and the output predicted value at the next moment; wherein the output predicted value at the next moment is shown as (4),
Figure FDA0002657929570000021
wherein:
Y=[yt+1|t yt+2|t…yt+Np|t]T
Figure FDA0002657929570000022
Figure FDA0002657929570000023
4. the control method according to claim 2 or 3, wherein the determining of the control increment according to the reference track and the output predicted value of the system at the next moment further comprises:
determining a state predicted value at the next moment according to the reference track;
determining an output predicted value at the next moment according to the state predicted value and the output equation;
and determining a control increment according to the output predicted value and the objective function.
5. The control method according to claim 4, wherein the step of superposing the control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment further comprises the following steps:
determining a series of future control increments according to the objective function, the control increment constraint and the control quantity constraint; wherein the control increment constraint is Deltaumin≤Δut+i|t≤Δumax i=0,1,...,NcThe controlled variable is constrained to umin≤ut+i|t≤umax i=1,...,Nc
Taking a first term of a vector in the series of control increments as an actual control increment;
and superposing the actual control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment.
6. A balance car, characterized by comprising:
the first acquisition unit is used for acquiring input parameters of the balance car at the previous moment; wherein the input parameters comprise a left wheel rotation speed and a right wheel rotation speed;
the second acquisition unit is used for acquiring the state parameters of the balance car at the current moment; wherein the state parameters comprise a course angle, a left wheel and right wheel distance, a left wheel radius, a right wheel radius, a left wheel rotating speed and a right wheel rotating speed;
the determining unit is used for determining a control increment according to the target function and the state parameter of the balance car at the current moment;
and the superposition unit is used for superposing the control increment and the input parameters of the balance car at the previous moment to obtain the input parameters of the balance car at the current moment.
7. The balance car of claim 6, wherein: the objective function is shown as (1),
Figure FDA0002657929570000031
wherein minJ represents the minimization objective function, NpTo predict the time domain, NcTo control the time domain, yt+i|tFor the predicted i-th system output state, χr(i) For an ideal trajectory of reference, Δ ut+i|tFor the required control input increment, Q and R are corresponding weight matrixes;
8. the balance car of claim 6, wherein the determining a control increment based on the objective function and a state parameter of the balance car at the current time further comprises:
determining a state equation of the balance vehicle according to the left wheel rotating speed and the right wheel rotating speed of the balance vehicle at the current moment; wherein the state equation is shown in (2),
Figure FDA0002657929570000032
determining an output equation of the balance car according to the state equation of the balance car; wherein the output method is shown as (3),
Figure FDA0002657929570000033
wherein:
Figure FDA0002657929570000034
Figure FDA0002657929570000035
Δu=uk-uk-1
0i×jan all-zero matrix representing i rows and j columns; i isiRepresenting an identity matrix of order i, alphak+1=[χk+1,uk]TT is sampling time;
determining a control increment according to the reference track, the output equation and the output predicted value at the next moment; wherein the output predicted value at the next moment is shown as (4),
Figure FDA0002657929570000041
wherein:
Y=[yt+1|t yt+2|t…yt+Np|t]T
Figure FDA0002657929570000042
Figure FDA0002657929570000043
9. the balance car of claim 7 or 8, wherein the determining of the control increment according to the reference track and the output predicted value of the system at the next moment further comprises:
determining a state predicted value at the next moment according to the reference track;
determining an output predicted value at the next moment according to the state predicted value and the output equation;
and determining a control increment according to the output predicted value and the objective function.
10. The balance car of claim 9, wherein the superimposing the control increment and the input parameter of the balance car at the previous moment obtains the input parameter of the balance car at the current moment, further comprising: determining a series of future control increments according to the objective function, the control increment constraint and the control quantity constraint;
wherein the control increment constraint is Deltaumin≤Δut+i|t≤Δumax i=0,1,...,NcThe controlled variable is constrained to umin≤ut+i|t≤umax i=1,...,Nc
Taking a first term of a vector in the series of control increments as an actual control increment;
and superposing the actual control increment and the input parameter of the balance car at the previous moment to obtain the input parameter of the balance car at the current moment.
CN202010894262.2A 2020-08-31 2020-08-31 Balance car and control method thereof Pending CN112114588A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010894262.2A CN112114588A (en) 2020-08-31 2020-08-31 Balance car and control method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010894262.2A CN112114588A (en) 2020-08-31 2020-08-31 Balance car and control method thereof

Publications (1)

Publication Number Publication Date
CN112114588A true CN112114588A (en) 2020-12-22

Family

ID=73804976

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010894262.2A Pending CN112114588A (en) 2020-08-31 2020-08-31 Balance car and control method thereof

Country Status (1)

Country Link
CN (1) CN112114588A (en)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150012179A1 (en) * 2013-07-04 2015-01-08 Fuji Jukogyo Kabushiki Kaisha Driving assist controller for vehicle
CN106379409A (en) * 2016-09-27 2017-02-08 南京航空航天大学 Angle-controllable power differential omnidirectional wheel, and control method and omnidirectional moving platform thereof
CN108958246A (en) * 2018-06-29 2018-12-07 长安大学 Trajectory Tracking Control method of the unmanned vehicle in U-Turn scene
CN109799814A (en) * 2018-12-29 2019-05-24 中国北方车辆研究所 Crawler belt vehicle contrail tracker design method based on kinematics model
CN110286683A (en) * 2019-07-15 2019-09-27 北京科技大学 A kind of autonomous running path tracking control method of caterpillar mobile robot
CN110362084A (en) * 2019-07-22 2019-10-22 东南大学 A kind of vehicle route tracing control method based on ant group algorithm
CN111273551A (en) * 2020-03-12 2020-06-12 山东大学 Double-steering wheel automatic guided vehicle trajectory tracking control method and system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150012179A1 (en) * 2013-07-04 2015-01-08 Fuji Jukogyo Kabushiki Kaisha Driving assist controller for vehicle
CN106379409A (en) * 2016-09-27 2017-02-08 南京航空航天大学 Angle-controllable power differential omnidirectional wheel, and control method and omnidirectional moving platform thereof
CN108958246A (en) * 2018-06-29 2018-12-07 长安大学 Trajectory Tracking Control method of the unmanned vehicle in U-Turn scene
CN109799814A (en) * 2018-12-29 2019-05-24 中国北方车辆研究所 Crawler belt vehicle contrail tracker design method based on kinematics model
CN110286683A (en) * 2019-07-15 2019-09-27 北京科技大学 A kind of autonomous running path tracking control method of caterpillar mobile robot
CN110362084A (en) * 2019-07-22 2019-10-22 东南大学 A kind of vehicle route tracing control method based on ant group algorithm
CN111273551A (en) * 2020-03-12 2020-06-12 山东大学 Double-steering wheel automatic guided vehicle trajectory tracking control method and system

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
安聪: "两轮自平衡车轨迹跟踪控制关键技术研究", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 *
尤波 等: "基于模型预测控制的轮式移动机器人轨迹规划", 《系统仿真学报》 *
朱欣华 等: "基于位置约束的两轮驱动机器人路径跟踪控制方法", 《中国惯性技术学报》 *
李金良 等: "基于模型预测控制的无人驾驶汽车的轨迹跟踪", 《汽车工程师》 *

Similar Documents

Publication Publication Date Title
CN109472418B (en) Maneuvering target state prediction optimization method based on Kalman filtering
CN109249397B (en) Six-degree-of-freedom robot dynamics parameter identification method and system
CN107380254A (en) The electric power steering predicted using system mode is controlled
Yang et al. Path following predictive control for autonomous vehicles subject to uncertain tire-ground adhesion and varied road curvature
Shen et al. Adaptive PID formation control of nonholonomic robots without leader's velocity information
Ercan et al. Modeling, identification, and predictive control of a driver steering assistance system
CN106597017A (en) UAV angular acceleration estimation method and apparatus based on extended Kalman filtering
Zhang et al. Autonomous drift cornering with mixed open-loop and closed-loop control
Zhao et al. Individual auxiliary and fault-tolerant control of steer-by-wire system considering different drivers steering characteristics
Kim et al. Path tracking for a skid-steer vehicle using model predictive control with on-line sparse gaussian process
Yang et al. A linear time-varying MPC method for vehicle path-following assistance based on steering torque
Rosenfelder et al. Model predictive control of non-holonomic systems: Beyond differential-drive vehicles
Bascetta et al. LFT-based identification of lateral vehicle dynamics
CN112114588A (en) Balance car and control method thereof
Sahoo et al. Design and development of a heading angle controller for an unmanned ground vehicle
CN112577512A (en) State quantity error determination method based on wheel speed fusion and vehicle-mounted terminal
CN112577513A (en) State quantity error determination method and vehicle-mounted terminal
Su et al. Artificial steering feel for teleoperated road vehicle with disturbance observer
Antunes et al. Implementation and testing of a sideslip estimation for a formula student prototype
Bascetta et al. A simple and reliable technique to design kinematic-based sideslip estimators
Huang et al. Determination of motor torque for power-assist electric bicycles using observer-based sensor fusion
Khasawneh et al. Modeling, parameter identification, and steering angle control of electric power steering for trajectory following in autonomous vehicles
CN106017482B (en) A kind of spatial operation relative orbit control error calculation method based on no mark recursion
CN114995137A (en) Rope-driven parallel robot control method based on deep reinforcement learning
Ploeg et al. Position control of a wheeled mobile robot including tire behavior

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
RJ01 Rejection of invention patent application after publication

Application publication date: 20201222

RJ01 Rejection of invention patent application after publication