CN102378715A - Vehicle - Google Patents
Vehicle Download PDFInfo
- Publication number
- CN102378715A CN102378715A CN2010800151656A CN201080015165A CN102378715A CN 102378715 A CN102378715 A CN 102378715A CN 2010800151656 A CN2010800151656 A CN 2010800151656A CN 201080015165 A CN201080015165 A CN 201080015165A CN 102378715 A CN102378715 A CN 102378715A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- weight portion
- active weight
- mentioned
- car body
- 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
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/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
- B60L7/00—Electrodynamic brake systems for vehicles in general
- B60L7/24—Electrodynamic brake systems for vehicles in general with additional mechanical or electromagnetic braking
- B60L7/26—Controlling the braking effect
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62K—CYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
- B62K11/00—Motorcycles, engine-assisted cycles or motor scooters with one or two wheels
- B62K11/007—Automatic balancing machines with single main ground engaging wheel or coaxial wheels supporting a rider
-
- 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/16—Single-axle vehicles
-
- 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/34—Wheel chairs
-
- 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/10—Vehicle control parameters
- B60L2240/12—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
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/10—Vehicle control parameters
- B60L2240/14—Acceleration
-
- 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/10—Vehicle control parameters
- B60L2240/26—Vehicle weight
-
- 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
- B60L2260/00—Operating Modes
- B60L2260/20—Drive modes; Transition between modes
- B60L2260/34—Stabilising upright position of vehicles, e.g. of single axle vehicles
-
- 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/64—Electric machine technologies in electromobility
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- 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)
- Mechanical Engineering (AREA)
- Power Engineering (AREA)
- Transportation (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Motorcycle And Bicycle Frame (AREA)
Abstract
Provided is a vehicle wherein even when an active weight portion is fixed at a position that greatly deviates from a neutral position, the highest possible motion performance can be secured and adequate safety can be ensured by reducing the vehicle acceleration and vehicle deceleration limit values when the active weight portion is fixed, the vehicle being able to be used user-friendlily, safely, and comfortably. Specifically provided is a vehicle comprising a drive wheel (12) which is rotatably attached to a vehicle body, an active weight portion which is movably attached to the vehicle body, an active weight portion brake which fixes the active weight portion to the vehicle body, and a vehicle control device which controls the posture of the vehicle body by controlling the drive torque to be applied to the drive wheel (12) and the position of the active weight portion, wherein when the active weight portion is fixed to the vehicle body, the vehicle control device makes the vehicle acceleration and vehicle deceleration limit values lower than the vehicle acceleration and vehicle deceleration immediately before the active weight portion is fixed to the vehicle body.
Description
Technical field
The present invention relates to a kind of vehicle that utilizes the attitude control of inverted pendulum.
Background technology
In the past, the technology of the vehicle of the relevant attitude control that utilizes inverted pendulum has been proposed.For example; Thereby changing, the attitude that has proposed to have 2 drive wheels of configuration on coaxial, occupant's center of gravity is moved the car body that causes carries out the vehicle that perception drives; On one side the attitude of the car body on the single drive wheel that is installed in sphere-like is controlled the technology (for example, with reference to patent documentation 1) of the vehicle that moves etc. on one side.
At this moment, through moving forward and backward the active weight portion as weight equalizer, the control of standing upside down, moving vehicle.
[patent documentation 1] Japanese Patent Laid is opened the 2004-129435 communique
But, in the vehicle in above-mentioned past, sometimes need be through fixing active weight portion, move freely to prevent this active weight portion, thereby hinder the control of standing upside down.For example, when the actuator that moves active weight portion occurs need making the drg action when unusual, fixing active weight portion.At this moment, might can not guarantee safety and traveling comfort.
Because active weight portion is fixing, the essence limit of the acceleration and deceleration performance of vehicle can reduce.That is, because because of the mobile range variation that fixedly causes center of gravity of active weight portion,, can not keep the handstand attitude of car body sometimes if the same when applying driving torque in order to carry out acceleration and deceleration with just often.At this moment, might be able to not fully guarantee safety.
Also have, because of the difference of the fixed position of active weight portion, the reduction amount of the limit of acceleration capability and deceleration performance is understood different.For example, when the portion of taking is fixed on position very on the front, compare with acceleration capability, deceleration performance can decline to a great extent, and might make road-holding property worsen owing to unsuitable manipulation.At this moment, can not fully guarantee safety and road-holding property.
If under these conditions, make vehicle forced stopping, keeping out of the way the action etc. of going of the outer or curb of road when then might be able to not be implemented in very, thereby bring the problem of safety and comfort feature in order to guarantee safety.
The present invention is for the problem in the vehicle that solves the above-mentioned past; A kind of vehicle of easy to use and safety and comfort is provided; The vehicle acceleration when reducing fixing active weight portion and the limits value of vehicle deceleration; Even, also can guarantee exercise performance as much as possible, and can guarantee sufficient safety when active weight portion is fixed on the position away from center position.
Summary of the invention
Therefore; In vehicle of the present invention; Thereby the active weight portion that has the drive wheel that is installed on the car body and can rotates, is mounted movably with respect to above-mentioned car body, active weight portion's drg of will this active weight portion fixing with respect to car body and control the controller of vehicle that the attitude of above-mentioned car body is controlled for the position of driving torque of giving above-mentioned drive wheel and above-mentioned active weight portion; This controller of vehicle when having carried out fixedly with respect to car body above-mentioned active weight portion, the limits value that makes vehicle acceleration and vehicle deceleration with will active weight portion be carried out timer-operated admittedly vehicle acceleration with respect to car body and compare minimizing with vehicle deceleration.
In other the vehicle of the present invention, above-mentioned controller of vehicle also make to the limits value of the expected value of vehicle acceleration and vehicle deceleration with will active weight portion be compared minimizing with respect to the expected value that car body carries out timer-operated admittedly vehicle acceleration and vehicle deceleration.
In in addition other the vehicle of the present invention, above-mentioned controller of vehicle is confirmed the reduction of above-mentioned limits value also according to the fixed position of above-mentioned active weight portion.
In in addition other the vehicle of the present invention; Above-mentioned controller of vehicle is also according to the distance from movable territory leading edge to the above-mentioned fixed position of above-mentioned active weight portion; Confirm the reduction of the limits value of vehicle acceleration; According to distance, confirm the reduction of the limits value of vehicle deceleration from movable territory trailing edge to the above-mentioned fixed position of above-mentioned active weight portion.
In in addition other the vehicle of the present invention, above-mentioned controller of vehicle further reduces the limits value of vehicle acceleration also according to the limits value of vehicle deceleration.
In in addition other the vehicle of the present invention, above-mentioned controller of vehicle is also revised the limits value of vehicle acceleration, so that it is less than the limits value of vehicle deceleration.
In in addition other the vehicle of the present invention, above-mentioned controller of vehicle reduces the limits value of drive wheel rotational angular velocity also according to the limits value of vehicle deceleration.
In in addition other the vehicle of the present invention, above-mentioned controller of vehicle also according to the fixed position of above-mentioned active weight portion, is revised target car body leaning angle.
The invention effect
Structure one of according to the present invention even be fixed on the position of significantly departing from center position when active weight portion, also can be guaranteed exercise performance as much as possible, can guarantee sufficient safety.
Two structure according to the present invention can be in the scope of the attitude that can keep vehicle, the target setting value.
According to the present invention three with the present invention's four structure, the limit of the acceleration and deceleration performance of the reality that can have according to vehicle under the present situation is confirmed limits value, can in safe range, bring into play the performance of vehicle to greatest extent.
Based on the present invention five with the present invention's six structure, can limit suitable peak acceleration with respect to the maximum deceleration of present situation, can not bring inharmonious sense to the occupant, can guarantee safety and maneuverability.
Seven structure according to the present invention can limit suitable maximum speed with respect to the maximum deceleration of present situation, can not bring inharmonious sense to the occupant, can guarantee safety and road-holding property.
Eight structure according to the present invention even be fixed on the position of significantly departing from center position when active weight portion, also can be guaranteed safety and road-holding property.
Description of drawings
Fig. 1 is the skeleton diagram that the attitude of the vehicle of expression the 1st embodiment of the present invention changes.
Fig. 2 is the block scheme of structure of the Vehicular system of expression the 1st embodiment of the present invention.
Fig. 3 is the diagram of circuit of action of the vehicle control and treatment of expression the 1st embodiment of the present invention.
Fig. 4 is the diagram of circuit of the action of going usually of expression the 1st embodiment of the present invention and attitude control and treatment.
Fig. 5 is the diagram of circuit of the action of going very much of expression the 1st embodiment of the present invention and attitude control and treatment.
Fig. 6 is the skeleton diagram that the attitude of the vehicle of expression the 2nd embodiment of the present invention changes.
Fig. 7 is the block scheme of structure of the Vehicular system of expression the 2nd embodiment of the present invention.
Fig. 8 is the diagram of circuit of action of the vehicle control and treatment of expression the 2nd embodiment of the present invention.
Fig. 9 is the diagram of circuit of the control of braking processing action of expression the 2nd embodiment of the present invention.
Figure 10 is the block scheme of structure of the Vehicular system of expression the 3rd embodiment of the present invention.
Figure 11 is the diagram of circuit of the control of braking processing action of expression the 3rd embodiment of the present invention.
Embodiment
Below, with reference to accompanying drawing, specify embodiment of the present invention.
Fig. 1 is the skeleton diagram that the attitude of the vehicle of expression the 1st embodiment of the present invention changes.Fig. 2 is the block scheme of structure of the Vehicular system of expression the 1st embodiment of the present invention.In addition, in Fig. 1,, (b) be the quiescence after the acceleration end of a period (a) in giving it the gun.
In Fig. 1,10 is the vehicle of this embodiment, has body 11, drive wheel 12, the support sector 13 of car body and the portion of taking 14 of carrying occupant 15.Above-mentioned vehicle 10 tilts before and after can making car body.And, the same with the attitude control of inverted pendulum, the attitude of car body is controlled.In example shown in Figure 1, vehicle 10 can march forward along right-hand, draws back along left.
Above-mentioned drive wheel 12 can be supported with respect to the support sector 13 as a car body part rotationally, through being activated as the CD-ROM drive motor 52 that drives actuator.In addition, the axle of drive wheel 12 extends along the direction vertical with the drawing of Fig. 1, and drive wheel 12 is that rotate at the center with this axle.Also have, above-mentioned drive wheel 12 can be an odd number, also can be plural number.When being plural number, on coaxial, dispose side by side.In this embodiment, explain that drive wheel 12 has 2 situation.At this moment, the CD-ROM drive motor 52 of each drive wheel 12 through separately is activated independently.In addition, as driving actuator, for example can adopt HM Hydraulic Motor, explosive motor etc., the situation as the CD-ROM drive motor 52 of electro-motor is adopted in explanation here.
Also have, receive the support from the below of support sector 13, be positioned at the top of drive wheel 12 as the body 11 of the part of car body.And the portion of taking 14 that brings into play the effect of active weight portion is installed on the body 11, can go forward side by side relatively with respect to body 11 along the fore-and-aft direction of vehicle 10, in other words, can relatively move along the tangential direction of car body slewing circle.
Here, active weight portion has quality to a certain degree, green phase for body 11 go forward side by side, promptly, move forward and backward, can carry out the center-of-gravity position of vehicle 10 actively compensating.And,, also can be to be installed on the body 11 the peripheral machine that battery etc. has weight and the device that it can be gone forward side by side if portion 14 might not be taken by active weight portion.Also can be that weight parts with special uses such as weight, hammer (bob-weight), balancing devicees are installed on the body 11 and the device that it can be gone forward side by side.Also have the peripheral machine and the special-purpose weight member that also can use the portion of taking 14 simultaneously, have weight.
In this embodiment, for convenience of description, the situation that the portion of taking 14 that for example clear occupant 15 takes plays a role as active weight portion; But occupant 15 might not take in the portion of taking 14; For example, when vehicle 10 utilizes remote manipulation to handle, can in the portion of taking 14, not take occupant 15; Also can replace occupant 15, and carry goods.Above-mentioned to take the seat that uses in portion 14 and the automobiles such as manned vehicle, city motor bus the same, steps on portion, seat surface portion, back-rest and headrest by foot and constitute, and via the travel mechanism of expression not among the figure, is installed on the body 11.
Also have; Above-mentioned travel mechanism has the linear moving mechanism of low resistance such as line slideway device and as the active weight portion motor 62 of active weight portion actuator; Utilize this active weight portion motor 62 to drive and take portion 14, follow and sail direction and move forward and backward with respect to body 11.In addition, as active weight portion actuator, also can use for example HM Hydraulic Motor, linear motor etc., the situation of the active weight portion motor 62 of electric rotary motor is adopted in explanation here.
The line slideway device has the guide rail that for example is installed on the body 11, be installed in the portion of taking 14 along the chassis of guide rail slippage and be in guide rail and the chassis between the rolling body of spin, roller etc.And, on the left and right sides face of guide rail, be formed with the track mortise of 2 linearities along its length.Also have, the cross section on chassis forms the コ word shape, in its 2 side surface part inside in opposite directions, forms 2 track mortises respectively in opposite directions with the track mortise of guide rail.Rolling body is assembled between the track mortise, is accompanied by the linear relative movement on guide rail and chassis, in the inner rolling of track mortise.In addition, on the chassis, be formed with the return path that connects track mortise two ends, rolling body is circulating motion in track mortise and return path.
Also have, the line slideway device has the active weight portion drg 63 as the brake equipment of the action that stops this line slideway device.This active weight portion drg 63 hopes it is the device of release when electric power is supplied with, for example, and the magnet stopper of non-excitation actuating type.Resemble vehicle 10 need not take the action of portion 14 when stopping the time, utilize active weight portion drg 63, the chassis is fixed on the guide rail, thereby keeps body 11 and take the relative position relation of portion 14.And, when needs move, remove active weight portion drg 63, make the reference position of body 11 sides and the distance of taking between the reference position of portion's 14 sides is controlled at specified value.
Dispose the input media 30 as target motoring condition deriving means on above-mentioned next door of taking portion 14, input media 30 has joystick 31.Occupant 15 handles vehicle 10 through the joystick 31 as operating control is operated, that is, acceleration, deceleration, turning, the original place of input vehicle 10 rotated, stopped, the driving instruction of braking etc.In addition, so long as can let occupant 15 operate the device of input driving instruction, also can replace joystick 31, and adopt other device, for example, devices such as pedal, bearing circle, roller, touch-screen, button are used as target motoring condition deriving means.
In addition, when vehicle 10 is handled through remote control, also can replace above-mentioned joystick 31, and the receiving device of driving instruction that will be through wired or wireless reception remote controller is as target motoring condition deriving means.Also have; When vehicle 10 goes according to predetermined driving instruction data automatically; Can replace above-mentioned joystick 31, with the data reading mechanisms that reads the driving instruction data in the storage mediums such as being stored in semiconductor memory, hard disk as target motoring condition deriving means.
Also have, as shown in Figure 2, Vehicular system has controller of vehicle 20.This controller of vehicle 20 has master control ECU (Electronic Control Unit) 21, drive wheel control ECU22 and the active control ECU23 of weight portion.Above-mentioned master control ECU21, drive wheel control ECU22 and the active control ECU23 of weight portion are the computer systems that has storing mechanisms such as arithmetical organs such as CPU, MPU, disk, semiconductor memory, input and output interfaces etc., the action of each one of vehicle 10 is controlled; For example be arranged on the body 11, but also can be arranged on support sector 13 or take in the portion 14.Also have, above-mentioned master control ECU21, drive wheel control ECU22 and the active control ECU23 of weight portion can be the difference independent structures, also can be incorporate structures.
And master control ECU21 controls ECU22, driving wheel sensor 51 and CD-ROM drive motor 52 with drive wheel, plays a role as the part of the drive wheel control system 50 that the action of drive wheel 12 is controlled.Above-mentioned driving wheel sensor 51 is made up of magslip, coder etc., and the effect of performance drive wheel rotary state determinator detects the drive wheel pivot angle and/or the rotational angular velocity of the rotary state of expression drive wheel 12, and is sent to master control ECU21.Also have, this master control ECU21 transmits the driving torque command value to drive wheel control ECU22, and this drive wheel control ECU22 supplies with the input voltage of the driving torque command value that is equivalent to be received to CD-ROM drive motor 52.Then, this CD-ROM drive motor 52 applies driving torque according to input voltage to drive wheel 12, and like this, performance drives the effect of actuator.
Master control ECU21 is with the control ECU23 of active weight portion, active weight portion sensor 61, active weight portion motor 62 and active weight portion drg 63, and the part of the active weight portion control system of controlling as the action of active weight portion promptly being taken portion 14 60 plays a role.Above-mentioned active weight portion sensor 61 is made up of coder etc., brings into play the effect of active weight portion mobile status determinator, detects active weight location and/or moving velocity that the mobile status of portion 14 is taken in expression, and is sent to master control ECU21.Also have, this master control ECU21 transmits active weight portion thrust command value to the active weight control ECU23 of portion, and this active weight control ECU23 of portion then supplies with the input voltage of the active weight portion thrust command value that is equivalent to be received to active weight portion motor 62.Also have, master control ECU21 supplies with operation voltages to active weight portion drg 63.And above-mentioned active weight portion motor 62 applies to the portion of taking 14 according to input voltage and makes the portion of the taking 14 mobile thrust of going forward side by side, and like this, brings into play the effect of active weight portion actuator.Also have, the effect of above-mentioned active weight portion drg 63 performance brake gears according to operation voltage, will be taken portion 14 and remain on respect to body 11 irremovable states.
In addition; In this embodiment; From master control ECU21 to active weight portion drg 63 direct input action voltages; But also can transmit the braking maneuver signal to the control ECU23 of active weight portion, and give operation voltage to active weight portion drg 63 by the active weight control ECU23 of portion by master control ECU21.
In addition; Master control ECU21 controls ECU22, the control ECU23 of active weight portion, tilting of car body sensor 41, CD-ROM drive motor 52, active weight portion motor 62 and active weight portion drg 63 with drive wheel, plays a role as the part of the car body control system 40 that the attitude of car body is controlled.Above-mentioned tilting of car body sensor 41 is made up of acceleration pick-up, gyro sensor etc.; The effect of performance tilting of car body state estimating mechanism; Detect the tilting of car body angle and/or the leaning angle speed of the heeling condition of expression car body, and be sent to master control ECU21.Also have, this master control ECU21 transmits the driving torque command value to drive wheel control ECU22, transmits active weight portion thrust command value to the active weight control ECU23 of portion.
In addition, each sensor also can be the device that obtains the plurality of states amount.For example,, acceleration pick-up and gyro sensor be can use simultaneously, tilting of car body angle and tilting of car body cireular frequency confirmed according to the measured value of the two as tilting of car body sensor 41.
Also have, from view of function, controller of vehicle 20 has the vehicle acceleration limiting mechanism of limiting vehicle acceleration/accel and vehicle deceleration and revises the acceleration limit value correction mechanism of the limits value of vehicle acceleration and vehicle deceleration.
Through utilizing above-mentioned controller of vehicle 20 to carry out attitude control, vehicle 10 shown in Fig. 1 (a), quickens under the state that has forwards moved the portion of taking 14 when giving it the gun.And if active weight portion motor 62 occurs unusually in giving it the gun, promptly actuator occurs unusually, and active weight portion drg 63 is moved.Like this, after quickening end, in order to keep the handstand attitude of car body, shown in Fig. 1 (b), the tilted rearward car body.
Like this, when utilizing active weight portion drg 63 to fix the portion 14 of taking, but because the momentum of body gravity reduces, acceleration capability and deceleration performance reduce simultaneously.Also have, when utilizing specified value restriction tilting of car body angle, but compare with center of gravity momentum forwards, but rearward center of gravity momentum significantly reduce, its result compares deceleration performance with acceleration capability and significantly reduces.
Here, in the present embodiment, when having fixed the portion 14 of taking, reduce the limits value of vehicle acceleration and vehicle deceleration.
Then, specify the action of the vehicle 10 of said structure.The summary of vehicle control and treatment at first, is described.
Fig. 3 is the diagram of circuit of action of the vehicle control and treatment of expression the 1st embodiment of the present invention.
Whether normally in the vehicle control and treatment, controller of vehicle 20 at first carries out motor is normally judged, judge motor (step S1).At this moment, judge whether active weight portion motor 62 can produce thrust.Specifically, the active control ECU23 of weight portion has motor diagnosis mechanism, when active weight portion motor 62 can not produce thrust, promptly be diagnosed as when unusual, transmits the signal of regulation to master control ECU21.If this master control ECU21 receives this signal, then judge the motor mal.
When judging motor just often, controller of vehicle 20 carries out drg and removes (step S2).At this moment, remove active weight portion drg 63, the portion of taking 14 as active weight portion can be moved.Specifically, master control ECU21 is to active weight portion drg 63 input action voltages.
Then, controller of vehicle 20 goes and attitude control and treatment (step S3) usually, suitably move take portion 14 on one side, keep the attitude of car body on one side, and realize finishing the vehicle control and treatment by the driving instruction from occupant 15.In addition, time gap according to the rules (for example, per 100 [μ s]), this vehicle control and treatment is carried out in circulation.
On the other hand, judge whether motor is normal, when appearance was unusual, controller of vehicle 20 carried out drg action (step S4).At this moment, make 63 actions of active weight portion drg, the fixing portion of taking 14 on car body as active weight portion.Specifically, master control ECU21 stops the drg 63 input action voltages to active weight portion.
Then, controller of vehicle 20 goes and attitude control and treatment (step S5) very much, under the state of having fixed the portion of taking 14, keeps the attitude of car body, realizes the driving instruction from occupant 15, finishes the vehicle control and treatment.
Then, explain go usually with the attitude control and treatment.
Fig. 4 is the diagram of circuit of the action of going usually of expression the 1st embodiment of the present invention and attitude control and treatment.
In this embodiment, symbolic representation quantity of state and parameter below utilizing.
θ
w: drive wheel pivot angle [rad]
θ
1: tilting of car body angle (vertical axis benchmark) [rad]
λ
S: take location (active weight location) [m]
G: acceleration due to gravity [m/s
2]
R
w: drive wheel ground connection radius [m]
m
S: take portion's quality (active weight portion quality: comprise carrying object) [kg]
Go usually with the attitude control and treatment in, master control ECU21 at first obtains each quantity of state (step S3-1) from sensor.Specifically, obtain drive wheel pivot angle θ from driving wheel sensor 51
WOr rotational angular velocity
Obtain tilting of car body angle θ from tilting of car body sensor 41
1Or leaning angle speed
Obtain from active weight portion sensor 61 and to take location λ as active weight location
SPerhaps as the portion of the taking moving velocity of active weight portion moving velocity
Then, master control ECU21 calculates remaining quantity of state (step S3-2).At this moment, the quantity of state that is obtained is carried out time diffusion or time integral, calculate remaining quantity of state.For example, the quantity of state when acquisition is drive wheel pivot angle θ
W, tilting of car body angle θ
1With take location λ
SThe time, through it is carried out time diffusion, can obtain rotational angular velocity
Leaning angle speed
With take portion's moving velocity
Also having, is rotational angular velocity if work as the quantity of state that is obtained
Leaning angle speed
With take portion's moving velocity
The time, through it is carried out time integral, can obtain drive wheel pivot angle θ
W, tilting of car body angle θ
1With take location λ
S
Then, master control ECU21 obtains occupant 15 manipulation operations amount (step S3-3).During driving instructions such as acceleration, deceleration, turning, the original place that at this moment, obtains occupant 15 input vehicles 10 rotated, stopped, braking to the operational ton of joystick 31.
Then, master control ECU21 confirms the expected value (step S3-4) of vehicle acceleration based on the operational ton of the joystick that obtains 31.The value that for example, will be directly proportional with the operational ton of the fore-and-aft direction of joystick 31 is as the expected value of front and back vehicle acceleration.
Then, master control ECU21 revises (step S3-5) to the expected value of vehicle acceleration.Specifically, the formula below utilizing is revised.
[formula 1]
is the value of confirming according to the operational ton of joystick 31 for the vehicle acceleration expected value before revising.
Also has α
Max, ABe vehicle acceleration limits value, α
Max, DBe the vehicle deceleration limits value, obtain by following formula respectively.
α
Max,A=α
Max,A,O
α
Max,D=α
Max,D,O
In addition, α
Max, A, OBe standard vehicle acceleration limit value, α
Max, D, OBe standard vehicle deceleration/decel limits value, obtain by following formula respectively.
[formula 2]
Here,
Also has θ
1, Max, fBe allowable angle of inclination forwards, λ
S, Max, fFor from the reference position of the portion of taking 14 to the distance of movable territory leading edge, θ
1, Max, rBe rearward allowable angle of inclination, λ
S, Max, rFor from the reference position of the portion of taking 14 to the distance of movable territory trailing edge.
Like this, utilize vehicle acceleration limits value and vehicle deceleration limits value, the expected value of vehicle acceleration is revised.Specifically, make during correction the expected value of vehicle acceleration below the vehicle acceleration limits value and more than the vehicle deceleration limits value.And, when the expected value of vehicle acceleration when the vehicle acceleration limits value is above, with the expected value of vehicle acceleration limits value as vehicle acceleration.When the expected value of vehicle acceleration when the vehicle deceleration limits value is following, with the expected value of vehicle deceleration limits value as vehicle acceleration.
In addition, vehicle acceleration limits value and vehicle deceleration limits value are the definite specified value of mechanics parameter that utilizes vehicle 10.And, the limit that can utilize the center of gravity of car body to move to keep handstand state, be that the limit of attitude control is as each limits value.Like this, in the scope of the handstand attitude that can keep car body, set the expected value of vehicle acceleration.
Then, master control ECU21 calculates the expected value (step S3-6) of drive wheel rotational angular velocity according to the expected value of vehicle acceleration.For example, the expected value of vehicle acceleration is carried out time integral, divided by the drive wheel ground connection radius of regulation, income value is as the expected value of drive wheel rotational angular velocity again.
Then, master control ECU21 revises (step S3-7) to the expected value of drive wheel rotational angular velocity.Specifically, utilize following formula to revise.
[formula 3]
is the determined value of time integral of utilizing the expected value of drive wheel pivot angle acceleration/accel for the expected value of the drive wheel rotational angular velocity before revising.Also have;
is drive wheel rotational angular velocity limits value;
in addition,
is standard drive wheel rotational angular velocity limits value (specified value).
Like this, utilize drive wheel rotational angular velocity limits value, the expected value of drive wheel rotational angular velocity is revised.Specifically, revise, make drive wheel rotational angular velocity expected value below drive wheel rotational angular velocity limits value.And, when drive wheel rotational angular velocity expected value when drive wheel rotational angular velocity limits value is above, with drive wheel rotational angular velocity limits value as drive wheel rotational angular velocity expected value.In addition, drive wheel rotational angular velocity limits value is made as specified value.
In addition, when the drive wheel rotational angular velocity is revised, when the 1st row or the 3rd of formula is gone condition above promptly satisfying,, the vehicle acceleration expected value is modified to 0 for conformability satisfied and the vehicle acceleration expected value.
Also have, for the purpose of simplifying the description for the purpose of, in this embodiment, only stop and the situation of advancing is illustrated for vehicle 10, for the situation that vehicle 10 is retreated, also can introduce same control, obtain same effect.
Then, master control ECU21 confirms tilting of car body angle and the expected value (step S3-8) of taking location.Specifically,, utilize following formula, confirm to take the expected value of location according to the expected value of vehicle acceleration and the expected value of car speed.
[formula 4]
Also have,, utilize following formula, confirm the expected value at tilting of car body angle according to the expected value of vehicle acceleration and the expected value of car speed.
[formula 5]
Be basic tilting of car body angle expected value,
Also has θ
S, Max, fAnd θ
S, Max, rBe the tilting of car body angle scaled value of the movable end position of the portion of taking,
Like this, consider that the escort vehicle acceleration/accel acts on force of inertia and CD-ROM drive motor counter torque on the car body, confirm tilting of car body angle and the expected value of taking location.And the center of gravity of moving body is offset these tilting of car body torques with the effect that utilizes gravity.Specifically, when vehicle 10 quickens, forwards move the portion of taking 14 and/or inclined forward car body.On the other hand, when vehicle 10 slows down, rearward move the portion of taking 14 and/or tilted rearward car body.Also have,, begin the car body that tilts when the portion of taking moves when reaching the limit of.
Like this, for small acceleration and deceleration, the tilting of car body before and after no longer including, thus improved occupant 15 ride quality.Also have,,, reduced the variation in the visual field for occupant 15 even when running at high speed to a certain degree, also can be kept upright state.
In addition, in the present embodiment, when low acceleration and/or when running at a low speed, only move the portion of taking and deal with, but also can utilize tilting of car body to deal with the part of this tilting of car body torque or all.Through the inclination car body, power that can the fore-and-aft direction of attenuative effect on occupant 15.
Then, master control ECU21 calculates remaining expected value (step S3-9), that is, through each expected value is carried out time diffusion or time integral, the expected value that calculates drive wheel pivot angle, tilting of car body cireular frequency respectively and take portion's moving velocity.
Then, master control ECU21 confirms the feedforward output (step S3-10) of each actuator.Specifically, the formula below utilizing is confirmed the feedforward output of CD-ROM drive motor 52.
[formula 6]
Like this, through applying driving torque, offset the force of inertia that mechanical model is inferred, thereby can improve the precision of control.
Also have, the formula below utilizing is confirmed the feedforward output of active weight portion motor 62.
[formula 7]
Like this, through applied thrust, offset gravity and force of inertia that mechanical model is inferred, thereby can improve the precision of control.
Like this, in this embodiment,, can realize more high-precision control, but also can omit feedforward output through giving theoretic feedforward output.At this moment,, be accompanied by constant error, can give value indirectly near feedforward output through feedback output.Also have, above-mentioned constant error can reduce through adopting storage gain.
Then, master control ECU21 confirms the feedback output (step S3-11) of each actuator.Specifically, the formula below utilizing is confirmed the feedback output of CD-ROM drive motor 52.
[formula 8]
In addition, the formula below utilizing is confirmed the feedback output of active weight portion motor 62.
[formula 9]
Here, each feedback gain K
*Value for example be redefined for the value of optimal regulator.In addition, also can import the nonlinear Feedback Control of sliding-modes control etc.Also have, as more simply control, also can be with except K
W2, K
W3And K
S5Outside gain in severally be set at 0.And,, also can adopt storage gain in order to eliminate constant error.
At last, master control ECU21 gives command value (step S3-12) to each key element control system.At this moment, master control ECU21 will feedover that output is exported with feedback and as command value, send to drive wheel control ECU22 and the active control ECU23 of weight portion.
Then, explain go very much with the attitude control and treatment.
Fig. 5 is the diagram of circuit of the action of going very much of expression the 1st embodiment of the present invention and attitude control and treatment.
Go very much with the attitude control and treatment in, master control ECU21 at first obtains each quantity of state (step S5-1) from sensor.Specifically, obtain drive wheel pivot angle θ from driving wheel sensor 51
WOr rotational angular velocity
Obtain tilting of car body angle θ from tilting of car body sensor 41
1Or leaning angle speed
In addition; In this embodiment; After the action of active weight portion drg 63, no longer obtain, upgrade and take the location measured value, control based on the location of taking before the action of active weight portion 63; But also can be also preceding the same after 63 actions of active weight portion drg with action, obtain and take location.Like this, even, also can suitably control owing to the fault of active weight portion drg 63 etc. has moved the portion of taking 14.
Then, master control ECU21 calculates remaining quantity of state (step S5-2).At this moment, the quantity of state that is obtained is carried out time diffusion or time integral, calculate remaining quantity of state.For example, the quantity of state when acquisition is drive wheel pivot angle θ
WWith tilting of car body angle θ
1The time, through it is carried out time diffusion, can obtain rotational angular velocity
With leaning angle speed
Also having, is rotational angular velocity if work as the quantity of state that is obtained
With leaning angle speed
The time, through it is carried out time integral, can obtain drive wheel pivot angle θ
WWith tilting of car body angle θ
1
Then, master control ECU21 obtains occupant 15 manipulation operations amount (step S5-3).During driving instructions such as acceleration, deceleration, turning, the original place that at this moment, obtains occupant 15 input vehicles 10 rotated, stopped, braking to the operational ton of joystick 31.
Then, master control ECU21 confirms the expected value (step S5-4) of vehicle acceleration based on the operational ton of the joystick that obtains 31.The value that for example, will be directly proportional with the operational ton of the direction forwards, backwards of joystick 31 is as the expected value of front and back vehicle acceleration.
Then, master control ECU21 revises (step S5-5) to the expected value of vehicle acceleration.Specifically, after carrying out 1 correction, utilize its result, carry out 2 times and revise.At first, the formula below utilizing carries out 1 correction of the expected value of vehicle acceleration.
[formula 10]
is 1 revised vehicle acceleration expected value, is to revise the value that obtains according to the fixed position of taking portion 14.
Also has α
Max, ABe vehicle acceleration limits value, α
Max, DBe the vehicle deceleration limits value, obtain by following formula respectively.
[formula 11]
In addition, α
Max, A, OBe standard vehicle acceleration limit value, α
Max, D, OBe standard vehicle deceleration/decel limits value, Δ α
MaxFor the maximum reduction of vehicle acceleration limits value, obtain by following formula respectively.
[formula 12]
Also has θ
1, Max, fBe allowable angle of inclination forwards, λ
S, Max, fFor from the reference position of the portion of taking 14 to the distance of movable territory leading edge, θ
1, Max, rBe rearward allowable angle of inclination, λ
S, Max, rFor from the reference position of the portion of taking 14 to the distance of movable territory trailing edge.In addition, λ
S, Max, LIt is the portion's of taking movable territory total length.
λ
S,Max,L=λ
S,Max,f+λ
S,Max,r
Like this, when 63 actions of active weight portion drg, reduce the limits value of vehicle acceleration and vehicle deceleration.At first, according to the fixed position of the portion of taking 14, confirm the reduction of vehicle acceleration limits value and vehicle deceleration limits value.
Specifically, according to the amount that is directly proportional with distance till movable territory leading edge to the fixed position of the portion of taking 14, reduce the vehicle acceleration limits value.In addition, when movable territory leading edge is fixed in the portion of taking 14, then do not change the vehicle acceleration limits value.Also have, when movable territory trailing edge is fixed in the portion of taking 14, then reduce the vehicle acceleration limits value according to maximum reduction.
Also have, the amount according to being directly proportional with distance till movable territory trailing edge to the fixed position of the portion of taking 14 reduces the vehicle deceleration limits value.In addition, when movable territory leading edge is fixed in the portion of taking 14, then reduce the vehicle deceleration limits value according to maximum reduction.Also have, when movable territory trailing edge is fixed in the portion of taking 14, then do not change the vehicle deceleration limits value.
Like this; Fixed position based on the portion of taking 14; Limits value is revised; Thereby the limit of the actual acceleration and deceleration performance that can be had according to the vehicle 10 of present situation is carried out the correction of limits value, even when active weight portion motor 62 faults, also can in safe range, bring into play to maximum limit the performance of vehicle 10.
Also have,, confirm the slip or the reduction of limits value based on mechanical model.Specifically, consider the effect that can utilize gravity offset the acceleration and deceleration of escort vehicle 10 and act on the limit of force of inertia and CD-ROM drive motor counter torque on the car body, promptly, the mobile limit of the body gravity of present situation, confirm the reduction of limits value.
Like this, owing to considered the limit of the acceleration and deceleration in the control of car body attitude exactly, thus can further realize higher safety and rideability.
Also have, in this embodiment, utilize linear function to confirm limits value, but also can adopt tighter nonlinear function to confirm.At this moment, also can utilize it to confirm with nonlinear function as mapping relations.
Also have, in this embodiment, the car body when measured occupant 15 or carrying object carry or take the weight or the center-of-gravity position of portion 14 is revised limits value.But also can limits value be revised according to the weight or the center-of-gravity position of occupant 15 or carrying object.For example, have the lift-launch weight sensor,, confirm car body or take weight or the value of center-of-gravity position and the correction of limits value of portion 14 based on its measured value.
Then, the formula below master control ECU21 utilizes carries out 2 times to the expected value of vehicle acceleration and revises.
[formula 13]
[formula 14]
is the vehicle acceleration limits value;
is the vehicle deceleration limits value, obtained by following formula respectively.
Like this, according to the vehicle deceleration limits value, further reduce the vehicle acceleration limits value.That is, the vehicle deceleration limits value is revised, made the vehicle acceleration limits value less than the vehicle deceleration limits value.Specifically; Value to the solid timer-operated vehicle acceleration limit of the portion of taking is revised, so that the vehicle acceleration limit of the solid timer-operated vehicle acceleration limit of the portion of taking when liberating less than the portion of taking with the ratio of vehicle deceleration limits value and the ratio of vehicle deceleration limits value.Like this, be modified to proper proportion, be absorbed in the state that can not brake after can reliably preventing for example to quicken through peak acceleration and maximum deceleration with vehicle 10, constrained motion performance excessively not, thus guarantee safety and road-holding property.
In addition, in this embodiment, limits value being revised, so that acceleration capability and deceleration performance reach the ratio of regulation, but can be purpose to ensure MIN deceleration performance also.For example, also can work as the vehicle deceleration limits value in the threshold value of regulation when following, be 0 to forbid quickening through making the vehicle acceleration limits value, just can not go once more as long as vehicle 10 stops once the back.Like this, can further improve safety.
Then, master control ECU21 calculates the expected value (step S5-6) of drive wheel rotational angular velocity according to the expected value of vehicle acceleration.For example, the expected value of vehicle acceleration is carried out time integral, divided by the drive wheel ground connection radius of regulation, income value is as the expected value of drive wheel rotational angular velocity again.
Then, master control ECU21 revises (step S5-7) to the expected value of drive wheel rotational angular velocity.Specifically, utilize following formula to revise.
[formula 15]
Also has L
0Be high speed stopping distance standard value,
Like this, according to the vehicle deceleration limits value, reduce drive wheel rotational angular velocity limits value.That is, drive wheel rotational angular velocity limits value is revised, so that the minimum stopping distance under the maximum speed becomes below the predetermined restricted value.Specifically, the value of drive wheel rotational angular velocity limits value is revised, so that the portion of taking is when the minimum stopping distance under the maximum speed becomes the portion's of taking liberation fixedly the time below the minimum stopping distance under the maximum speed.Like this, be modified to the speed of the deceleration and stopping performance that meets present situation, be absorbed in the state that can not brake after can reliably preventing for example to quicken through maximum speed with vehicle 10, constrained motion performance excessively not, thus guarantee safety and road-holding property.
In addition, in this embodiment, limits value being revised, so that stopping distance reaches the scope of regulation, but can be purpose to ensure MIN deceleration performance also.For example, also can work as the vehicle deceleration limits value in the threshold value of regulation when following, be 0 to forbid going through making drive wheel rotational angular velocity limits value, and vehicle 10 is stopped.
Then, master control ECU21 confirms the expected value (step S5-8) at tilting of car body angle.Specifically,, utilize following formula, confirm the expected value at tilting of car body angle according to the expected value of vehicle acceleration and the expected value of car speed.
[formula 16]
Like this, according to the expected value and the fixed position of taking portion 14 of vehicle acceleration, confirm the expected value at tilting of car body angle.At first, according to the expected value of vehicle acceleration, confirm the expected value at tilting of car body angle.Specifically; Tilting of car body angle expected value is revised; So that for for the necessary body gravity amount of movement of the expected value of corresponding vehicle acceleration, the center of gravity that tilting of car body causes when utilizing the portion of taking fixedly moves and compensates the part that the mobile center of gravity amount of movement of bearing of portion 14 is taken when movable by the portion of taking.
Also have,, tilting of car body angle expected value is revised according to the fixed position of the portion of taking 14.Specifically, tilting of car body angle expected value is revised, let car body tilt extraly, follow the out-of-position gravitational torque of the reference position of leaving the portion of taking 14 with counteracting to an opposite side of the offset direction of the portion of taking 14.
Then, master control ECU21 calculates remaining expected value (step S5-9),, through each expected value is carried out time diffusion or time integral, calculates the expected value of drive wheel pivot angle and tilting of car body cireular frequency respectively that is.
Then, master control ECU21 confirms the feedforward output (step S5-10) of each actuator.Specifically, the same with the situation of going usually with the attitude control and treatment, the formula that utilizes the step S3-10 of Fig. 4 to adopt is confirmed the feedforward output of CD-ROM drive motor 52.
Then, master control ECU21 confirms the feedback output (step S5-11) of each actuator.Specifically, the formula below utilizing is confirmed the feedback output of CD-ROM drive motor 52.
[formula 17]
Here, each feedback gain K
*Value for based on the solid determined values of timer-operated mechanical model of the portion of taking 14, for example be redefined for the value of optimal regulator.
Also have, in the present embodiment, in the time of when the portion of taking 14 movable and fixedly, adopt the value of different feedback oscillators, but also can under two conditions, adopt identical value.Like this, control program is simplified in the inharmonious sense in the time of can alleviating the portion of taking 14 fixedly moment follows control to switch simultaneously.
At last, master control ECU21 gives command value (step S5-12) to the key element control system.At this moment, master control ECU21 will feedover that output is exported with feedback and as command value, send to drive wheel control ECU22.
Like this, in this embodiment, when having fixed the portion 14 of taking, reduce the limits value of vehicle acceleration and vehicle deceleration.Specifically, minimizing is to the limits value of the expected value of vehicle acceleration and vehicle deceleration.That is, restriction is according to the expected value of determined vehicle acceleration of the operational ton of joystick 31 and vehicle deceleration.Also have,, confirm the minimizing value of each limits value according to the fixed position of the portion of taking 14.At this moment, will multiply by proportionality coefficient from the distance till movable territory leading edge to the fixed position of the portion of taking 14 and the value that obtains, as the reduction of the limits value of vehicle acceleration.Also have, will multiply by proportionality coefficient from the distance till movable territory trailing edge to the fixed position of the portion of taking 14 and the value that obtains, as the reduction of the limits value of vehicle deceleration.
In addition, according to the vehicle deceleration limits value, further reduce the vehicle acceleration limits value.That is, revise, make the vehicle acceleration limits value less than the vehicle deceleration limits value.Specifically; Limits value to the solid timer-operated vehicle acceleration of the portion of taking is revised, so that the ratio of the limits value of the ratio of the limits value of the solid timer-operated vehicle acceleration of the portion of taking and the limits value of vehicle deceleration vehicle acceleration when movable less than the portion of taking and the limits value of vehicle deceleration.In addition, according to the vehicle deceleration limits value, reduce the limits value of drive wheel rotational angular velocity.That is, the value of the limits value of the solid timer-operated drive wheel rotational angular velocity of the portion of taking is revised so that the portion of taking fixedly the time stopping distance under the maximum speed in the portion of taking when movable below the stopping distance under the maximum speed.Also have,, target car body leaning angle is revised according to the fixed position of the portion of taking 14.At this moment, the coordinate values of the fixed position of the portion of taking 14 multiply by negative coefficient and the value that obtains, as the correction of target car body leaning angle.
Like this; Even following the unusual of active weight portion motor 62; Take portion 14 when stopping and being fixed, also can guarantee exercise performance and safety fully, the handstand type vehicle 10 that can provide convenience comfortable as much as possible in the position of significantly departing from center position.
Then, the of the present invention the 2nd and the 3rd embodiment is described.
In " background technology " explanation before vehicle in, when active weight portion is in the position of significantly departing from reference position (center of gravity of vehicle is in through the position on the plumb bob vertical of drive wheel earth point), utilize the drg action to fix sometimes.For example, when the brish acceleration of vehicle, though need be to the significantly mobile active weight of vehicle front portion; If but make the drg action this moment; Then irrelevant with the acceleration and deceleration of vehicle, active weight portion always is in the place ahead, therefore can not ensure sufficient safety and traveling comfort.In order to keep the balance of car body, need keep car body bevelled state significantly backward always, thereby might bring unplessantness displeasure and uneasy sense to the occupant.Also have, but the center of gravity momentum of vehicle, be that the acceleration capability or the deceleration performance of vehicle is very limited, also can occur the situation that to quicken or to slow down sometimes.
The of the present invention the 2nd and the purpose of the 3rd embodiment be; Provide a kind of vehicle to solve the above-mentioned problem points of vehicle in the past; Even under following situation, promptly predict near the direction of target location mobile the time, when the moving direction projecting body of the moving direction of the active weight of prediction portion under the situation of having removed drg through the brake off device; Make active weight portion the position of significantly departing from center position stop and situation about being fixed under; Also can be through letting the attitude of car body revert to proper state automatically, eliminate the unplessantness displeasure that tilting of car body brings to the occupant and the reduction of uneasy sense and maneuvering performance, and can use easily and safely.
At first, the 2nd embodiment is described.In addition, the structure identical with the 1st embodiment adopts same-sign, its explanation of Therefore, omited.Also have,, omit its explanation for action identical and identical effect with above-mentioned the 1st embodiment.
Fig. 6 is the skeleton diagram that the attitude of the vehicle of expression the 2nd embodiment of the present invention changes.Fig. 7 is the block scheme of structure of the Vehicular system of expression the 2nd embodiment of the present invention.In addition, in Fig. 6,, (b) be the drg action, (c) remove, (d) return for state for drg (a) for giving it the gun.
In this embodiment, as shown in Figure 7, input media 30 also has as the recurrence permission switch 32 that moves permitting mechanism except having the joystick 31 as target motoring condition deriving means.And occupant 15 returns permission switch 32 through operation when allowing the active weight of releasing portion drg 63, send enabling signal.
In addition, when vehicle 10 is handled through remote control, can replace above-mentioned joystick 31 and return permission switch 32, the receiving device of driving instruction that will be through wired or wireless reception controller is used as target motoring condition deriving means and uses.Also have; When vehicle 10 goes according to predetermined driving instruction data automatically; Can replace above-mentioned joystick 31 and return permission switch 32, the data fetch device that reads the driving instruction data in the storage mediums such as being stored in semiconductor memory, hard disk is used as target motoring condition deriving means.
And; From view of function, controller of vehicle 20 have the take portion 14 of prediction when having removed active weight portion drg 63 moving direction the moving direction projecting body and obtain according to the rules that the periodic signal of the interrupted periodic signal that sends of cycle obtains mechanism.
Through utilizing above-mentioned controller of vehicle 20 to carry out attitude control, vehicle 10 shown in Fig. 6 (a), quickens under the state that has forwards moved the portion of taking 14 when giving it the gun.And if active weight portion motor 62 occurs unusually in giving it the gun, promptly actuator occurs unusually, and active weight portion drg 63 is moved.Like this, after quickening end, in order to keep the handstand attitude of car body, shown in Fig. 6 (b), the tilted rearward car body.Then,, then carry out drg and remove operation, remove active weight portion drg 63, allow to utilize gravity rearward to move the portion 14 of taking if satisfy defined terms.Like this, shown in Fig. 6 (c), rearward move take portion 14 in, upwards boost car body, to keep the handstand attitude of car body.Then, shown in Fig. 6 (d), if let the portion of taking 14 revert to the reference position, the car body attitude revert to erectility, is under the persistent state at this state then, and active weight portion drg 63 is moved, and will take portion 14 and be fixed on the reference position.
In addition, the same for other structure with above-mentioned the 1st embodiment, the Therefore, omited explanation.
Then, specify the action of the vehicle 10 of this embodiment.The summary of vehicle control and treatment at first, is described.
Fig. 8 is the diagram of circuit of action of the vehicle control and treatment of expression the 2nd embodiment of the present invention.
Whether normally in the vehicle control and treatment, controller of vehicle 20 at first carries out motor is normally judged, judge motor (step S11).And if judge that motor is normal, then controller of vehicle 20 carries out drg releasing (step S12).
Then, controller of vehicle 20 goes and attitude control and treatment (step S13) usually, suitably move take portion 14 on one side, keep the attitude of car body on one side, realize driving instruction from occupant 15, finish the vehicle control and treatment.In addition, time gap according to the rules (for example, per 100 [μ s]), this vehicle control and treatment is carried out in circulation.The action of step S11-S13 is identical with the action of the step S1-S3 shown in Figure 3 of above-mentioned the 1st embodiment.
On the other hand, when judging whether motor is normal, occur when unusual, controller of vehicle 20 carries out control of braking and handles (step S14).When control of braking is handled,, make active weight portion's drg 63 actions or releasing according to the state of vehicle 10.
Then, controller of vehicle 20 goes and attitude control and treatment (step S15) very much, under the state of having fixed the portion of taking 14, Yi Bian keep the attitude of car body, Yi Bian realize the driving instruction from occupant 15, finishes the vehicle control and treatment.
Then, the control of braking processing is described.
Fig. 9 is the diagram of circuit of the control of braking processing action of expression the 2nd embodiment of the present invention.
In control of braking was handled, master control ECU21 at first obtained each quantity of state (step S14-1) from sensor.Specifically, obtain drive wheel pivot angle θ from driving wheel sensor 51
WOr rotational angular velocity
Obtain tilting of car body angle θ from tilting of car body sensor 41
1Or leaning angle speed
Obtain from active weight portion sensor 61 and to take location λ as active weight location
SPerhaps as the portion of the taking moving velocity of active weight portion moving velocity
In addition, in vehicle control, obtain drive wheel pivot angle θ from driving wheel sensor 51
WAnd/or rotational angular velocity
Obtain tilting of car body angle θ from tilting of car body sensor 41
1And/or leaning angle speed
Obtain from active weight portion sensor 61 and to take location λ
SAnd/or take portion's moving velocity
Also have, the quantity of state that is obtained is carried out time diffusion or time integral, calculate remaining quantity of state.For example, the quantity of state when acquisition is drive wheel pivot angle θ
W, tilting of car body angle θ
1With take location λ
SThe time, through it is carried out time diffusion, can obtain rotational angular velocity
Leaning angle speed
With take portion's moving velocity
Also have, for example working as the quantity of state that is obtained is rotational angular velocity
Leaning angle speed
With take portion's moving velocity
The time, through it is carried out time integral, can obtain drive wheel pivot angle θ
W, tilting of car body angle θ
1With take location λ
S
Moving velocity (step S14-2) when then, master control ECU21 prediction is liberated.At this moment, master control ECU21 is according to each quantity of state, and the formula below utilizing has been liberated the presumed value of the moving velocity of the portion of taking 14 when taking portion 14 thereby obtain the active weight of releasing portion drg 63.
[formula 18]
The presumed value that above-mentioned formula obtained is the presumed value for the moving velocity of following after a while portion of taking 14.In addition, T is the time of advancing (specified value).Also has F
SBe the application force that acts in the portion of taking 14, formula obtains below utilizing.
[formula 19]
The expression directed force F
SAbove-mentioned formula in each item be equivalent to following effect.
The 1st: the effect of the gravity that tilting of car body causes
The 2nd: the effect of the force of inertia that vehicle 10 acceleration and deceleration cause
The 3rd: the effect of the force of inertia that the rotational motion of car body causes
The 4th: with respect to the effect of the viscous friction of the moving velocity of the portion of taking 14
In addition, the value of tilting of car body angular acceleration in the above-mentioned formula and drive wheel pivot angle acceleration/accel obtains through the measured value of tilting of car body angle and drive wheel pivot angle being carried out 2 rank time diffusions (difference).Also have, the value of taking portion's moving velocity obtains through the value of taking location being carried out 1 rank time diffusion (difference).
Like this, in this embodiment, obtain when the moving velocity of having liberated the portion of taking 14 that is predicted when taking portion 14.That is, prediction when present moment has been removed active weight portion drg 63, or the specified time when continuing disarm state after the portion of taking moving velocity.Specifically, based on as the application force that acts on the power in the portion of taking 14, predict moving velocity when liberating.For example, when the portion of taking 14 is static,, towards the direction of target location the time, takes portion 14 head for target positions when active weight portion drg 63 is removed in prediction and move at effort, and remove active weight portion drg 63, portion 14 is taken in liberation.Like this, through considering to act on the power in the portion of taking 14, can move the portion of taking 14 to suitable direction reliably.
Also have, based on tilting of car body state, drive wheel rotary state and take portion's mobile status, infer application force.Specifically; As application force, consider to follow the gravity of tilting of car body effect, follow the force of inertia of drive wheel rotation acceleration effect, follow the tilting of car body acceleration/accel force of inertia effect and with respect to the viscous friction of the moving velocity of the portion of taking 14.Like this, need not append special-purpose sensor, just predicting function power, moving velocity when promptly liberating accurately.
In addition, based on the moving velocity of the portion of taking 14 of present moment, moving velocity during prediction liberation.For example, when towards the moving velocity of the portion of taking 14 of target location during,, active weight portion drg 63 is maintained disarm state, continue moving based on the portion of taking 14 of inertia then with the orientation independent of application force greater than specified value.Like this, take the inertia of portion 14, can more effectively make the portion of taking 14 fast near the target location through utilization.
In addition, based on car speed or drive wheel rotational angular velocity, confirm deceleration time.At this moment, car speed is high more, and it is just long more that vehicle 10 stops the required time, and is just big more to the influence of tilting of car body,, judges that inclination probability in the place ahead is big more that is.
In addition, in the present embodiment,, considered gravity, viscous friction, inertia force etc., but also can save a wherein part as active force.Also have, also can consider other key elements such as counter electromotive force of dryness friction, motor.
In addition, in this embodiment, utilize nonlinear function, confirm application force, but also can utilize the simple function of approximately linear to confirm.Also have, also can be set to mapping relations by nonlinear function, utilize it to confirm.
In addition, in this embodiment, utilize estimating mechanism to obtain the size and Orientation of application force, but also can utilize other mechanism to obtain.For example, also can have the force gauge of measuring the size act on the friction force on the active weight portion drg 63,, confirm the size and Orientation of application force based on its measured value.
Then, master control ECU21 carries out moving direction and judges, judges whether OK (step S14-3) of direction.That is, judge whether the moving direction that the quilt take portion 14 is predicted is the direction towards the reference position.Formula below utilizing is represented decision condition, promptly judged is the condition of suitable direction.
[formula 20]
Target location λ
* S=0.Also have, A is that direction determining is with threshold value (specified value).
In addition, for taking location (active weight location) λ
SValue, the reference position is made as 0.When this reference position representes that car body is in erectility, the position of the portion of taking 14 the when center of gravity of vehicle 10 is in the position on the plane of plumb bob vertical and and the earth point through drive wheel 12 parallel with the turning cylinder of drive wheel 12.
In the moving direction of this embodiment is judged, judge whether the moving direction of the portion of taking 14 when the active weight portion drg of being predicted 63 is removed is the directions towards the target location.Specifically, when being 0, if the product of moving velocity then is judged to be suitable direction less than the negative value of regulation when the position of the actual portion of taking 14 and the liberation of being inferred with the cooresponding value in the target location of the portion of taking 14.Like this; Through just when suitable direction moves, just removing active weight portion drg 63 being predicted as the portion of taking 14; Can be under the situation that does not adopt the actuator of giving thrust; The portion of taking 14 is moved to suitable position, thus uneasiness sense and unplessantness displeasure that the tilting of car body can eliminate the actuator fault time brings for occupant 15.
Also have, will become the position of moving the target of taking portion 14, be that the target location is as the reference position.And,, remove active weight portion drg 63 when being judged as the portion of taking 14 when move the reference position.Like this; Be made as the reference position through taking portion 14; The portion of taking 14 in the time of can vehicle 10 being stopped remains on horizontal attitude, can eliminate occupant 15 uneasiness sense and unplessantness displeasure, is in same degree but the center of gravity of while in front and back moves energy; Thereby prevent to have only the some remarkable reduction in acceleration capability and the deceleration performance, can ensure road-holding property to a certain degree.
Like this, in the present embodiment, will become move the target take portion 14 the position as a point, but also can be with the target location as to a certain degree scope.Like this, need near the target location, not carry out trickle control of braking, can prevent the vibration of the frequent switching generation of braking mode.
Also have, in the present embodiment, the target location is set at the reference position of regulation, but also can changes the target location according to situation.For example, the lift-launch loading center-of-gravity position that also can have the center-of-gravity position that obtains occupant 15 or carrying object obtains mechanism, according to its value, the target location is revised.Like this, can be necessarily with the portion's of taking 14 maintenance levels, and with to carry loading irrelevant.
In addition, also can change the target location according to the target of going of vehicle 10.For example, when occupant 15 has imported the acceleration target, also can the target location be shifted to the object traveling direction side of vehicle 10.Like this, even when active weight portion motor 62 breaks down, also can realize approaching acceleration and deceleration performance just often.
And the result who judges as moving direction is the direction towards the reference position if take the moving direction that the quilt of portion 14 predicts, is judged to be direction when being OK, and master control ECU21 carries out moving velocity and judges, whether judgement speed OK (step S14-4).In addition,, make drg 63 actions (step S14-7) of active weight portion, finish control of braking and handle when being judged to be direction not during OK.
When moving velocity is judged, judge whether the moving velocity of taking portion 14 is in the tolerance band.And,, then be judged to be in tolerance band if the absolute value of moving velocity is all below the threshold value of stipulating during the liberation of the absolute value of the moving velocity of the actual portion of taking 14 and prediction.Because after the moving velocity of taking portion 14 increases; Can make 63 actions of active weight portion drg; Therefore can the moving velocity of the portion of taking 14 be suppressed at below the predetermined restricted value, thereby can alleviate because high-speed mobile is given the uneasiness sense that occupant 15 brings and occupant 15 unplessantness displeasure is given in the impact when stopping thereafter and to the harmful effect of handstand attitude control.
And the result who judges as moving velocity is to be in the tolerance band if take the moving velocity that the quilt of portion 14 predicts, when being judged to be speed OK, master control ECU21 carries out the occupant and permits judgement, judges and whether permits OK (step S14-5).When the speed of being judged to be not during OK, make drg 63 actions (step S14-7) of active weight portion, finish control of braking and handle.
Permit in the judgement the occupant, judge whether occupant 15 permits the active weight of releasing portion drg 63.Master control ECU21 utilizes whether receive enabling signal, judges the serviceability that returns permission switch 32, when receiving enabling signal, judges that then occupant 15 has represented permission.Like this, can prevent to follow the casual action of the portion of taking 14 of the releasing of active weight portion drg 63 to bring uneasy sense for occupant 15, let occupant 15 know that active weight portion motor 62 is in error state simultaneously.
In addition, in this embodiment,, just do not carry out the control of braking of moving direction prediction, but under given conditions, also can carry out control of braking as long as occupant 15 disapproves the active weight of releasing portion drg 63, and irrelevant with occupant 15 permission status.For example, also can work as the portion of taking 14 when being fixed, carry out control of braking in the position of the distance of leaving the target location more than predetermined distance, and irrelevant with occupant 15 permission status.Like this, can effectively utilize the inning that the portion of taking 14 is moved to the appropriate location really.
And, permit the result of judgement as the occupant, if the active weight of occupant's 15 permission releasings portion drg 63, when judging permission for OK, master control ECU21 removes active weight drg 63 (the step S14-6) of portion, finishes the control of braking processing.In addition, when judgement is permitted not to be OK, make 63 actions (step S14-7) of active weight portion drg, finish control of braking and handle.
In control of braking was handled, it all be suitable having only 3 conditions, just removed active weight portion drg 63.Specifically, master control ECU21 is to active weight portion drg 63 input service voltages.
In addition, in this embodiment, only be in error state, just carry out above-mentioned control of braking and handle, handle but also can under other occasion, also carry out control of braking at active weight portion motor 62.For example, when the residual amount reduction owing to battery needs economize on electricity, handle, can reduce consumption electric power through carrying out control of braking.
Like this, in the present embodiment, when having removed active weight portion brake 63, the moving direction of portion 14 is taken in prediction, if when this direction be the direction of close target location, then removes active weight portion brake 63.Specifically, utilize the moving velocity and the application force presumed value of taking portion 14, the prediction moving direction.At this moment, infer application force and act on moving velocity afterwards at the appointed time, moving direction is predicted.And, when stopping,, then remove active weight portion drg 63 if the direction of predicting function power in the target location works in the portion of taking 14.Also have, when moving, if the moving velocity of head for target position, is then removed active weight portion drg 63 greater than the threshold value of regulation in the portion of taking 14.In addition, utilize tilting of car body angle and vehicle acceleration, infer application force.That is, consider the acceleration and deceleration of gravity, friction force and escort vehicle 10 and the bevelled The Effect of Inertia Force of car body.
Also have,, make drg 63 actions of active weight portion when the moving velocity of the portion of taking 14 during greater than the threshold value of regulation.In addition, return permission switch 32 having, and occupant's 15 permissions are when removing active weight portion drg 63, then remove active weight portion drg 63.In addition, move when taking the thrust of portion 14, carry out control of braking and handle when active weight portion motor 62 can not produce.In addition, the target location is a car body when being in erectility, and the center of gravity of vehicle 10 is in the location of taking through on the plumb bob vertical of the earth point of drive wheel 12 time.
Like this; Even following the unusual of active weight portion motor 62; Take portion 14 when stopping and being fixed in the position of significantly departing from center position; Through letting the attitude of car body revert to proper state automatically, can eliminate tilting of car body and give the unplessantness displeasure that occupant 15 brings and the reduction of uneasy sense and maneuvering performance.
Then, the 3rd embodiment of the present invention is described.In addition, the structure identical with the 1st and the 2nd embodiment adopts same-sign, its explanation of Therefore, omited.Also have,, omit its explanation for action identical and identical effect with the above-mentioned the 1st and the 2nd embodiment.
Figure 10 is the block scheme of structure of the Vehicular system of expression the 3rd embodiment of the present invention.
In this embodiment, under the situation of the measured value of the mobile status that does not adopt the portion of taking 14, carry out control of braking and handle.
Because the faulty condition of active weight portion motor 62 can not carry out applied thrust sometimes simultaneously and take location with obtaining.For example, obtain and take location at the required phase angle of current control of active weight portion motor 62 when adopting common sensor in obtaining, if this sensor et out of order then can't carry out applied thrust and obtain taking location simultaneously.In order to handle this fault, need to adopt other fault reply mechanism, therefore might be difficult to realize cheap vehicle 10.
In this embodiment, limit the releasing time length of active weight portion drg 63.Specifically, have periodic signal and obtain mechanism, only when periodic signal is exported, just allow the active weight of releasing portion drg 63.Also have, based on the direction of application force and unusual the generation before take location, control the state of active weight portion drg 63.Specifically, if the product of the value of taking location before the value of application force and unusual the generation is a negative value, then remove active weight portion drg 63.In addition, have reference position testing agency, when the portion of taking 14 arrival reference positions, forbid removing active weight portion drg 63.
Like this, apply and the obtaining of mobile status, also can carry out control of braking and handle, the cheap handstand type vehicle 10 of safety more can be provided even can not take the thrust of portion 14.
Shown in figure 10, in this embodiment, the reference position detecting sensor 64 that active weight portion control system 60 has as reference position testing agency.This reference position detecting sensor 64 then transmits arriving signal to master control ECU21 if detecting the portion of taking 14 has arrived the reference position.
In the present embodiment, as reference position detecting sensor 64, adopt the proximity transducer of light detection type.Specifically; On the movable part that comprises the portion of taking 14, has shutter; Position as the reference position that is equivalent to the portion of taking 14 of the body 11 of fixed part has illuminating part and light accepting part, if shutter blocks the light of illuminating part; Make light accepting part not receive the light time, then transmit arriving signal to master control ECU21.
In addition, the same for other structure with above-mentioned the 2nd embodiment, the Therefore, omited explanation.
Then, specify the action of the vehicle 10 of this embodiment.At first, the control of braking processing is described.
Figure 11 is the diagram of circuit of the control of braking processing action of expression the 3rd embodiment of the present invention.
In this embodiment, in control of braking was handled, master control ECU21 at first obtained each quantity of state (step S14-11) from sensor.Specifically, obtain drive wheel pivot angle θ from driving wheel sensor 51
WOr rotational angular velocity
Obtain tilting of car body angle θ from tilting of car body sensor 41
1Or leaning angle speed
Then, master control ECU21 predicting function power (step S14-12).At this moment, master control ECU21 is according to each quantity of state, and the formula below utilizing obtains application force (the taking portion's application force) F that acts in the portion of taking 14
S
[formula 21]
The expression directed force F
SAbove-mentioned formula in each item be equivalent to following effect.
The 1st: the effect of the gravity that tilting of car body causes
The 2nd: the effect of the force of inertia that vehicle 10 acceleration and deceleration cause
The 3rd: the effect of the force of inertia that the rotational motion of car body causes
In addition, the value of tilting of car body angular acceleration in the above-mentioned formula and drive wheel pivot angle acceleration/accel obtains through the measured value of tilting of car body angle and drive wheel pivot angle being carried out 2 rank time diffusions (difference).
Then, master control ECU21 carries out moving direction and judges, judges whether OK (step S14-13) of direction.That is, judge whether take portion's application force is the direction that acts on towards the reference position.Formula below utilizing is represented decision condition, promptly judged is the condition of suitable direction.
[formula 22]
Target location λ
* S=0.Also has λ
S, initTake location (reference position is 0) before taking place for motor is unusual, B is that direction determining is with threshold value (specified value).
In the moving direction of this embodiment is judged, judge whether the power that acts in the portion of taking 14 acts on to make the direction of the portion of taking 14 towards the target location.Specifically, when being 0 with the cooresponding value in the target location of the portion of taking 14, if the unusual negative value that produces the product of the application force of taking location and being inferred before less than regulation of motor, then being judged to be is suitable direction.Like this; For the location of taking before the motor abnormality detection; Through according to its positive and negative direction of judging that the portion of taking 14 should move; Even when failing to understand, the portion of taking 14 is moved to the target location, thereby the car body attitude when motor is produced unusually revert to suitable state to a certain extent in the position that motor is unusual takes portion 14 after producing.
In addition; In this embodiment; Have 1 reference position detecting sensor 64 as place, the reference position of target location, but also can have a plurality of reference positions detecting sensor 64, with each installation site as the candidate target position; According to carrying object center-of-gravity position or acceleration and deceleration target, it is selected.Like this, can the portion of taking 14 be directed to selected target location.
And the result who judges as moving direction if take portion's effort in the direction towards the reference position, is judged to be direction when being OK, and master control ECU21 carries out the periodic signal permission and judges, whether judges constantly OK (step S14-14).In addition,, make drg 63 actions (step S14-18) of active weight portion, finish control of braking and handle when being judged to be when not being OK.
In periodic signal permission is judged, judge it whether is the moment that the releasing of active weight portion drg 63 is permitted.Formula below utilizing is represented decision condition, is promptly removed the condition of active weight portion drg 63.
[formula 23]
n(T
H+T
L)≤t≤n(T
H+T
L)+T
H (n=0,1,2,…)
In addition, t is constantly, T
HFor removing permitted hours (specified value), T
LFor (specified value) forbidden the time in releasing.
Judge in periodic signal permission in (removing the time length restriction),, forbid removing active weight portion drg 63 according to constantly.Specifically, periodically permit and forbid removing active weight portion drg 63.That is, after in the releasing permitted hours of regulation, allowing circularly to remove, forbid forbidding in the time removing in the releasing of regulation again.Like this, the time limitation that continues the active weight of releasing portion drg 63 in the releasing permitted hours of regulation, even therefore can not obtain under the situation of taking portion's mobile status, can be prevented reliably that also the moving velocity of the portion of taking 14 from excessively rising.
In addition, irrelevant with other releasing permissive condition in the present embodiment, carry out the pressure action of active weight portion brake 63 periodically, but also can make it adapt to other condition.For example, the time that also can the time point from the releasing of moving direction is judged, having permitted active weight portion drg 63 be begun carries out the periodic signal permission and judges as constantly.Like this, can will take portion 14 more effectively apace and be directed to the target location.
And the result who judges as periodic signal permission if permitted the releasing of active weight portion drg 63, judges that master control ECU21 carries out the occupant and permits judgement when constantly being OK, judges and whether permits OK (step S14-15).In addition,, make drg 63 actions (step S14-18) of active weight portion, finish control of braking and handle when being judged to be when constantly being not OK.
Permit in the judgement the occupant, judge whether occupant 15 permits the active weight of releasing portion drg 63.Master control ECU21 utilizes whether receive enabling signal, judges the serviceability that returns permission switch 32, when receiving enabling signal, judges that then occupant 15 has represented permission.Like this, can prevent to follow the casual action of the portion of taking 14 of the releasing of active weight portion drg 63 to bring uneasy sense for occupant 15, let occupant 15 know that active weight portion motor 62 is in error state simultaneously.
And, permit the result of judgement as the occupant, if understanding, occupant 15 permission removes active weight portion drg 63, when judging permission for OK, master control ECU21 carries out the reference position and arrives and judge, judges whether no show (step S14-16).In addition,, make drg 63 actions (step S14-18) of active weight portion, finish control of braking and handle when being judged to be when being permitted not to be OK.
Arrive in the judgement in the reference position, judge whether take portion 14 has arrived the reference position.At this moment, master control ECU21 utilizes whether receive arriving signal, judges whether take portion 14 has arrived the reference position.If received arriving signal, then be judged to be the portion of taking 14 and arrived the reference position.Like this, even can not obtain the measured value of taking portion's mobile status, also can the portion of taking 14 be fixed in position.
In addition, in the present embodiment, will become move the target take portion 14 the position as a point, but also can be with the target location as to a certain degree scope.For example; Also can be on 2 points of the front and back of the reference position predetermined distance that leaves the portion of taking 14 reference for installation position-detection sensor 64 respectively; When one of them reference position detecting sensor 64 receives arriving signal; Judge that taking portion 14 is in the permissible range, thereby the drg after forbidding is removed.
And, arrive the result who judges as the reference position, if take portion 14 no show reference position still, when being judged to be no show, master control ECU21 removes active weight drg 63 (the step S14-17) of portion, finishes control of braking and handles.In addition,, make drg 63 actions (step S14-18) of active weight portion, finish control of braking and handle when being judged to be when arriving.
In control of braking was handled, it all be suitable having only 4 conditions, just removed active weight portion drg 63.Specifically, master control ECU21 is to active weight portion drg 63 input service voltages.
Like this, in this embodiment, under the situation of the measured value of the mobile status that does not adopt the portion of taking 14, carry out control of braking and handle.Specifically, if the product of the value of taking location before the value of application force and unusual the generation is a negative value, then remove active weight portion drg 63.Also have, allow the active weight of releasing portion drg 63 in the releasing time of regulation.In addition, when the portion of taking 14 has arrived the reference position, forbid removing active weight portion drg 63.
Like this, apply and the obtaining of mobile status, also can carry out control of braking and handle, the cheap handstand type vehicle 10 of safety more can be provided even can not take the thrust of portion 14.
In addition, in the of the present invention the 2nd and the 3rd embodiment, the means as problem points technological before solving can propose following technology.
A kind of vehicle; Thereby the active weight portion that has the drive wheel that is installed on the car body and can rotates, is movably mounted with respect to above-mentioned car body, active weight portion's drg of will this active weight portion fixing with respect to car body and control the controller of vehicle that the attitude of above-mentioned car body is controlled for the position of driving torque of giving above-mentioned drive wheel and above-mentioned active weight portion; This controller of vehicle has the moving direction projecting body of the moving direction of the active weight portion of prediction when having removed above-mentioned active weight portion drg; When above-mentioned moving direction projecting body predicts above-mentioned active weight portion when the direction near the target location moves, remove above-mentioned active weight portion drg.
Based on this structure,, can eliminate the unplessantness displeasure that tilting of car body brings to the occupant and the reduction of uneasy sense and maneuvering performance through allowing the attitude of car body revert to proper state automatically.
In other vehicle, moving velocity that above-mentioned moving direction projecting body also utilizes above-mentioned active weight portion and the presumed value that acts on the application force in the above-mentioned active weight portion are predicted above-mentioned moving direction.
In addition, in other vehicle, above-mentioned moving direction projecting body is also inferred above-mentioned application force and is acted on moving velocity afterwards at the appointed time, and predicts above-mentioned moving direction.
Based on this structure, can predict the moving direction of active weight portion exactly.
In addition, in other vehicle, above-mentioned moving direction projecting body also utilizes tilting of car body angle and car speed, infers above-mentioned application force.
Based on this structure, even the tailor-made size that is used in the power in the active weight portion of accident also can be predicted the moving direction of active weight portion.
In addition, in other vehicle, above-mentioned controller of vehicle is also at the moving velocity of above-mentioned active weight portion during greater than the threshold value of regulation, makes the drg action of above-mentioned active weight portion.
In addition; In other vehicle; The periodic signal that also has the interrupted periodic signal that sends of the cycle according to the rules obtained obtains mechanism, and above-mentioned controller of vehicle forbids removing above-mentioned active weight portion drg when above-mentioned periodic signal obtains mechanism and can not obtain above-mentioned periodic signal.
According to this structure, can alleviate because the uneasiness sense that active weight portion high-speed mobile is brought to the occupant and from the high-speed mobile impact in anxious stopping time.
In addition, in other vehicle, above-mentioned controller of vehicle also has mobile permitting mechanism, and the occupant operates above-mentioned mobile permitting mechanism, when permission understand to remove active weight portion drg, removes above-mentioned active weight portion drg.
According to this structure, can prevent that casual the moving to the occupant of active weight portion from bringing uneasy sense.
In addition, in other vehicle, above-mentioned controller of vehicle carries out the control of above-mentioned active weight portion drg in the time can not producing the thrust of the active weight portion actuator that moves above-mentioned active weight portion.
According to this structure, unusual even actuator occurs, also can let the attitude of car body revert to proper state automatically.
In addition, the present invention is not limited to above-mentioned embodiment, can carry out various distortion based on spirit of the present invention, and these distortion can not be excluded out scope of the present invention.
Utilize possibility on the industry
This invention goes for utilizing the vehicle of the attitude control of inverted pendulum.
Nomenclature among the figure:
10 ... Vehicle, 12 ... Drive wheel, 14 ... Take portion, 20 ... Controller of vehicle, 63 ... Active weight portion drg
Claims (8)
1. a vehicle is characterized in that,
Have
The drive wheel that is installed on the car body and can rotates;
The active weight portion that is mounted movably with respect to above-mentioned car body;
The active weight portion drg that this active weight portion is fixed with respect to car body; With
Position to the driving torque that offers above-mentioned drive wheel and above-mentioned active weight portion is controlled, thus the controller of vehicle that the attitude of above-mentioned car body is controlled,
Above-mentioned active weight portion is being carried out with respect to car body under the fixing situation; With will active weight portion be carried out timer-operated admittedly vehicle acceleration with respect to car body and compare with vehicle deceleration, this controller of vehicle reduces the limits value of vehicle acceleration and vehicle deceleration.
2. vehicle according to claim 1, wherein,
With will active weight portion be compared with respect to the expected value that car body carries out timer-operated admittedly vehicle acceleration and vehicle deceleration, above-mentioned controller of vehicle reduces the limits value to the expected value of vehicle acceleration and vehicle deceleration.
3. vehicle according to claim 1 and 2, wherein,
Above-mentioned controller of vehicle is confirmed the reduction of above-mentioned limits value according to the fixed position of above-mentioned active weight portion.
4. vehicle according to claim 3, wherein,
Above-mentioned controller of vehicle is according to the distance till movable territory leading edge to the above-mentioned fixed position of above-mentioned active weight portion; Confirm the reduction of the limits value of vehicle acceleration; According to the distance till movable territory trailing edge to the above-mentioned fixed position of above-mentioned active weight portion, confirm the reduction of the limits value of vehicle deceleration.
5. according to any described vehicle among the claim 1-4, wherein,
Above-mentioned controller of vehicle further reduces the limits value of vehicle acceleration according to the limits value of vehicle deceleration.
6. vehicle according to claim 5, wherein,
Above-mentioned controller of vehicle is revised the limits value of vehicle acceleration, so that the limits value of this vehicle acceleration is less than the limits value of vehicle deceleration.
7. vehicle according to claim 5, wherein,
Above-mentioned controller of vehicle reduces the limits value of drive wheel rotational angular velocity according to the limits value of vehicle deceleration.
8. according to any described vehicle among the claim 1-7, wherein,
Above-mentioned controller of vehicle is revised target car body leaning angle according to the fixed position of above-mentioned active weight portion.
Applications Claiming Priority (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009-082024 | 2009-03-30 | ||
JP2009082024A JP5182193B2 (en) | 2009-03-30 | 2009-03-30 | vehicle |
JP2009084072A JP5083265B2 (en) | 2009-03-31 | 2009-03-31 | vehicle |
JP2009-084072 | 2009-03-31 | ||
PCT/JP2010/002114 WO2010116640A1 (en) | 2009-03-30 | 2010-03-25 | Vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102378715A true CN102378715A (en) | 2012-03-14 |
CN102378715B CN102378715B (en) | 2013-09-25 |
Family
ID=42935941
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010800151656A Expired - Fee Related CN102378715B (en) | 2009-03-30 | 2010-03-25 | Vehicle |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN102378715B (en) |
WO (1) | WO2010116640A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107667274A (en) * | 2015-05-26 | 2018-02-06 | 克朗设备公司 | System and method for materials handling vehicle mileage meter calibrating |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB2598760B (en) * | 2020-09-11 | 2024-04-10 | Gabriel Birligea Danut | A vehicle |
WO2024056741A1 (en) | 2022-09-13 | 2024-03-21 | Genny Factory Sa | "control method for self-balancing vehicles and respective self-balancing vehicle" |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101316736A (en) * | 2005-12-28 | 2008-12-03 | 爱考斯研究株式会社 | Traveling vehicle |
WO2009020184A1 (en) * | 2007-08-07 | 2009-02-12 | Equos Research Co., Ltd. | Vehicle |
JP2009035054A (en) * | 2007-07-31 | 2009-02-19 | Equos Research Co Ltd | Vehicle control device |
WO2009022584A1 (en) * | 2007-08-10 | 2009-02-19 | Equos Research Co., Ltd. | Vehicle |
-
2010
- 2010-03-25 CN CN2010800151656A patent/CN102378715B/en not_active Expired - Fee Related
- 2010-03-25 WO PCT/JP2010/002114 patent/WO2010116640A1/en active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101316736A (en) * | 2005-12-28 | 2008-12-03 | 爱考斯研究株式会社 | Traveling vehicle |
JP2009035054A (en) * | 2007-07-31 | 2009-02-19 | Equos Research Co Ltd | Vehicle control device |
WO2009020184A1 (en) * | 2007-08-07 | 2009-02-12 | Equos Research Co., Ltd. | Vehicle |
WO2009022584A1 (en) * | 2007-08-10 | 2009-02-19 | Equos Research Co., Ltd. | Vehicle |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107667274A (en) * | 2015-05-26 | 2018-02-06 | 克朗设备公司 | System and method for materials handling vehicle mileage meter calibrating |
CN107667274B (en) * | 2015-05-26 | 2021-09-21 | 克朗设备公司 | System and method for materials handling vehicle odometer calibration |
Also Published As
Publication number | Publication date |
---|---|
CN102378715B (en) | 2013-09-25 |
WO2010116640A1 (en) | 2010-10-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101687528B (en) | Vehicle | |
CN101821155B (en) | Vehicle | |
CN101772436A (en) | Vehicle | |
CN101784437A (en) | Vehicle | |
CN101821122A (en) | Vehicle | |
CN101868392A (en) | Vehicle control device | |
JPWO2008065853A1 (en) | vehicle | |
CN102378715B (en) | Vehicle | |
JP4894706B2 (en) | vehicle | |
CN101646595B (en) | Vehicle | |
JP5181923B2 (en) | vehicle | |
CN102378700B (en) | Vehicle | |
JP5045354B2 (en) | vehicle | |
JP5561289B2 (en) | vehicle | |
JP4894707B2 (en) | vehicle | |
JP5061828B2 (en) | vehicle | |
JP5223265B2 (en) | vehicle | |
JP4888317B2 (en) | vehicle | |
JP2009073271A (en) | Vehicle | |
JP5083265B2 (en) | vehicle | |
JP5182193B2 (en) | vehicle | |
JP4888318B2 (en) | vehicle | |
JP2010202117A (en) | Vehicle | |
JP2010173611A (en) | Vehicle | |
JP2010100137A (en) | Vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20130925 |
|
CF01 | Termination of patent right due to non-payment of annual fee |