Nothing Special   »   [go: up one dir, main page]

WO2010119740A1 - 車両及びフィードバック制御方法 - Google Patents

車両及びフィードバック制御方法 Download PDF

Info

Publication number
WO2010119740A1
WO2010119740A1 PCT/JP2010/054093 JP2010054093W WO2010119740A1 WO 2010119740 A1 WO2010119740 A1 WO 2010119740A1 JP 2010054093 W JP2010054093 W JP 2010054093W WO 2010119740 A1 WO2010119740 A1 WO 2010119740A1
Authority
WO
WIPO (PCT)
Prior art keywords
control
steering
wheel
output value
dead time
Prior art date
Application number
PCT/JP2010/054093
Other languages
English (en)
French (fr)
Inventor
松本 圭司
寺島 淳
Original Assignee
ヤンマー株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority claimed from JP2009101441A external-priority patent/JP5422251B2/ja
Priority claimed from JP2009112944A external-priority patent/JP5422257B2/ja
Priority claimed from JP2009207165A external-priority patent/JP5271853B2/ja
Application filed by ヤンマー株式会社 filed Critical ヤンマー株式会社
Priority to US13/264,805 priority Critical patent/US8630770B2/en
Priority to EP10764326.4A priority patent/EP2420431A4/en
Publication of WO2010119740A1 publication Critical patent/WO2010119740A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D7/00Steering linkage; Stub axles or their mountings
    • B62D7/06Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins
    • B62D7/14Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering
    • B62D7/15Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering characterised by means varying the ratio between the steering angles of the steered wheels
    • B62D7/1509Steering linkage; Stub axles or their mountings for individually-pivoted wheels, e.g. on king-pins the pivotal axes being situated in more than one plane transverse to the longitudinal centre line of the vehicle, e.g. all-wheel steering characterised by means varying the ratio between the steering angles of the steered wheels with different steering modes, e.g. crab-steering, or steering specially adapted for reversing of the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
    • B60L15/2036Electric differentials, e.g. for supporting steering vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D6/00Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
    • B62D6/002Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits computing target steering angles for front or rear wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION 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/00Type of vehicles
    • B60L2200/22Microcars, e.g. golf cars
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/64Electric machine technologies in electromobility
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Definitions

  • the present invention relates to a vehicle technology capable of independently steering four wheels, and more particularly, to a control technology for steering the four wheels based on an operation tool.
  • Patent Document 1 a vehicle described in Patent Document 1 is known.
  • the vehicle described in Patent Document 1 includes a mode selection unit that selects any one of a normal mode, a parallel movement mode, and a rotation mode, and a direction selection unit that selects a movement direction. .
  • the mode selection means When the normal mode is selected by the mode selection means, only the front wheels of the vehicle are steered by the steering operation. Further, when the rotation mode is selected by the mode selection means, the steering is performed so that the front sides of the front wheels are separated from each other so that the front sides of the front wheels are close to each other. In this state, by driving each wheel in a predetermined direction, the vehicle can turn around a predetermined turning center.
  • the parallel movement mode is selected by the mode selection unit, the four wheels of the vehicle are steered in the direction selected by the direction selection unit. Thus, the vehicle can translate in the selected direction.
  • the vehicle described in Patent Document 1 can translate in a predetermined direction (for example, eight directions), but cannot translate in any other direction.
  • a predetermined direction for example, eight directions
  • it is disadvantageous in that it must be moved by alternately repeating the translation in the predetermined direction.
  • the present invention has been made in view of the above situation, and provides a vehicle that can be easily translated in any direction.
  • a wheel consisting of two front wheels and two rear wheels; A steering actuator coupled to each of the wheels for steering the wheel; A drive actuator coupled to each of the wheels for driving the wheel; A first steering operation tool that can be operated by being tilted in an arbitrary direction, and that instructs the operation of the steering actuator; A driving operation tool for instructing the operation of the driving actuator; When the first steering operation tool is tilted, the wheel is steered in the direction in which the first steering operation tool is tilted, and when the drive operation tool is operated, Control means for driving the wheel based on an operation amount; It comprises.
  • the first steering operating tool is: It can be operated by being twisted in any direction
  • the control means includes When the first steering operation tool is twisted without being tilted, the wheel is steered in a direction in which the first steering operation tool can be turned in the rotational direction in which the first steering operation tool is twisted. To do.
  • the control means includes When the first steering operation tool is tilted in a twisted state, a second turning center is determined based on an inclination direction and an inclination angle of the first steering operation tool, and the second turning center is around the second turning center.
  • the wheel is steered in a direction in which the first steering operation tool can turn in a twisted rotation direction.
  • a second steering operation tool for instructing an operation of the steering actuator coupled to the front wheel A steering angle of the front wheel capable of turning around a turning center determined based on an operation amount of the second steering operation tool is calculated, and the steering angle of the front wheel is set to the calculated steering angle.
  • Control means for operating the steering actuator connected to a front wheel It comprises.
  • the steering actuator is The front wheels can be steered by 90 degrees or more.
  • the control means includes Based on the operation amount of the second steering operation tool and the operation amount of the driving operation tool, the speed of the wheel that can turn around the turning center without slipping with respect to the road surface is calculated. Then, the driving actuator is operated so that the speed of the wheel becomes the calculated speed.
  • the control means includes The calculated speed is limited so as not to exceed a predetermined value.
  • a control amount including a time delay that is a delay time until a response to the input is input to the inverse model of the transfer function of the control object excluding the time delay to calculate a first output value, Subtracting the first output value from the manipulated variable to calculate a second output value; The second output value is input to the transfer function of the control object excluding the dead time to calculate a third output value, Subtracting the third output value from the control deviation to calculate a corrected control deviation; Feedback control is performed based on the corrected control deviation.
  • a control amount including a time delay that is a delay time until a response to the input is input to the inverse model of the transfer function of the control object excluding the time delay to calculate a first output value, Subtracting the first output value from the manipulated variable to calculate a second output value;
  • the second output value is input to the transfer function of the control object excluding the dead time to calculate a third output value,
  • the third output value is input to a filter that passes only a specific frequency component to calculate a fourth output value, Calculating the corrected control deviation by subtracting the fourth output value from the control deviation; Feedback control is performed based on the corrected control deviation.
  • a plurality of wheels can be steered in the direction only by tilting the steering operation tool in a desired direction.
  • the vehicle can travel in that direction. Therefore, the vehicle can be easily translated in an arbitrary direction by a simple operation.
  • the wheel can be steered in such a direction that the steering operation tool can be turned in the rotation direction in which the steering operation tool is twisted by simply twisting the steering operation tool in a desired direction. it can.
  • the vehicle By operating the driving operation tool in this state, the vehicle can be turned in this direction. Accordingly, it is possible to easily turn around the predetermined first turning center by a simple operation.
  • the second turning center can be arbitrarily adjusted by simply tilting the steering operation tool in a desired direction, and the rotation of the steering operation tool being twisted around the second turning center.
  • the wheel can be steered in a direction that enables turning in the direction.
  • the driving operation tool By operating the driving operation tool in this state, the vehicle can be turned in this direction. Therefore, it is possible to easily turn around the arbitrary second turning center by a simple operation.
  • the present invention can easily turn around any turning center.
  • the steering angle of the two front wheels is not mechanically limited, and the vehicle can turn with a small turning radius.
  • the front wheel is steered by 90 degrees or more to turn around the center position of the vehicle body width (revolution turning), or turn around the center position of the vehicle body width (revolutionary turn). )can do.
  • the present invention can adjust the speed of the drive wheel based on the operation amount of the drive operation tool so that the drive wheel does not slide on the road surface. Therefore, it is possible to stably perform the super turn without damaging the road surface (turf, farm field, etc.) when turning and while preventing damage to the drive wheels.
  • the present invention by limiting the calculated speed to a predetermined value or less, it is possible to prevent the occurrence of problems due to over-rotation of the driving actuator.
  • the present invention makes it possible to compensate for the dead time of the controlled object and to drive the dead time out of the feedback loop in the feedback control of the controlled object including the dead time. Therefore, the control does not become unstable even when the control gain is increased. Therefore, the control gain can be set large to improve the control amount response.
  • the control target dead time is not included in the control parameters of the dead time compensator, even if the dead time changes due to aging, etc., or if there is an error in modeling the dead time, Time can be compensated for and stable control can be performed.
  • the present invention makes it possible to compensate for the dead time of the controlled object and to drive the dead time out of the feedback loop in the feedback control of the controlled object including the dead time. Therefore, the control does not become unstable even when the control gain is increased. Therefore, the control gain can be set large to improve the control amount response.
  • the control target dead time is not included in the control parameters of the dead time compensator, even if the dead time changes due to aging, etc., or if there is an error in modeling the dead time, Time can be compensated for and stable control can be performed. Further, even when the actual model of the controlled object changes due to aging or the like, or when an error occurs in the modeling of the controlled object, a steady deviation between the target value and the controlled variable does not occur.
  • FIG. 1 is a perspective view showing an overall configuration of a vehicle according to an embodiment of the present invention.
  • the perspective view which showed the left front wheel mechanism.
  • FIG. 4 is a schematic diagram illustrating a state of steering in a normal steering mode, (a) a schematic diagram illustrating a state of steering to the right direction, and (b) a schematic diagram illustrating a state of steering to the left direction.
  • Schematic which showed the relationship between the turning radius of a vehicle, the steering angle of a front wheel, and the speed of each wheel.
  • Schematic diagram showing the state of turning around an arbitrary turning center in the special steering mode (a) Schematic diagram when tilting the joystick to the right, (b) Schematic diagram when tilting the joystick greatly to the right Figure. Schematic diagram showing the state of turning around an arbitrary turning center in the special steering mode, (a) Schematic diagram when tilting the joystick leftward, (b) Schematic when tilting the joystick greatly to the left Figure.
  • the flowchart which shows the feedback control method which concerns on one Embodiment of this invention.
  • A The block diagram which shows the feedback control apparatus which concerns on other embodiment of this invention.
  • FIG. 1 A block diagram which shows the feedback control apparatus 201 which concerns on other embodiment of this invention.
  • the flowchart which shows the feedback control method which concerns on other embodiment of this invention.
  • A A block diagram when PID control is used for a control object including dead time.
  • B Block diagram when (a) is equivalently converted.
  • A The block diagram which estimates a disturbance.
  • B A block diagram in which the dead time has been removed from the feedback loop.
  • A The graph which shows the response when L changes by Smith dead time compensation.
  • A A graph showing a swash plate control result at the time of ⁇ limitation when there is no dead time compensator by a disturbance observer.
  • B A graph showing a swash plate control result at the time of ⁇ limitation when there is a dead time compensator by a disturbance observer.
  • A Block diagram when PID control is used for a control object including a conventional dead time.
  • B A graph showing a target value and a control amount when the control gain of the PID controller of FIG.
  • C A graph showing a target value and a control amount when the control gain of the PID controller of FIG.
  • A Block diagram when dead time is compensated using a conventional Smith dead time compensator.
  • B The block diagram when carrying out equivalent conversion of Fig.30 (a).
  • C A graph showing a target value and a control amount when an error occurs in the control parameter of the Smith dead time compensator.
  • the vehicle 1 which is one embodiment of the vehicle according to the present invention will be described.
  • the vehicle according to the present invention is not limited to the vehicle 1 according to the present embodiment, and may be various vehicles such as a construction vehicle, an agricultural vehicle, and an industrial vehicle.
  • the vehicle 1 travels with power generated by an electric motor.
  • the vehicle 1 includes a vehicle main body 10, a left front wheel mechanism 20, a right front wheel mechanism 30, a left rear wheel mechanism 40, a right rear wheel mechanism 50, an operation unit 60, and a controller 100 (see FIG. 3).
  • the vehicle body 10 constitutes the main structure of the vehicle 1.
  • the vehicle body 10 is configured by combining plate materials, pipe members, and the like.
  • the vehicle main body 10 is provided with a capacitor and the like for supplying electric power to each member included in the vehicle 1.
  • the left front wheel mechanism 20 is for causing the vehicle 1 to travel in an arbitrary direction.
  • the left front wheel mechanism 20 is disposed below the left front end of the vehicle body 10.
  • the left front wheel mechanism 20 mainly includes a left front wheel 21, a left front wheel drive motor 22, and a left front wheel steering motor 23.
  • the left front wheel 21 is an embodiment of the front wheel, and supports the vehicle main body 10 and moves the vehicle main body 10 by being rotationally driven.
  • the left front wheel drive motor 22 is an embodiment of a driving actuator, and drives the left front wheel 21 to rotate.
  • An output shaft (not shown) of the left front wheel drive motor 22 is connected to the left front wheel 21.
  • the driving force of the left front wheel drive motor 22 is transmitted to the left front wheel 21 via the output shaft of the left front wheel drive motor 22, and the left front wheel 21 is rotationally driven by the driving force.
  • the left front wheel steering motor 23 is an embodiment of an actuator for steering, and steers the left front wheel 21.
  • An output shaft (not shown) of the left front wheel steering motor 23 is disposed vertically downward, and is connected to the upper end of the bracket 23a (see FIG. 2) via a speed reduction mechanism (not shown).
  • the lower end of the bracket 23 a is connected to the left front wheel 21 and the left front wheel drive motor 22.
  • the driving force of the left front wheel steering motor 23 is transmitted to the bracket 23a via the output shaft of the left front wheel steering motor 23 and the speed reduction mechanism.
  • the bracket 23a is rotated around the vertical axis by the driving force.
  • the left front wheel 21 and the left front wheel 21 are steered when the left front wheel 21 and the left front wheel drive motor 22 rotate integrally with the vehicle body 10 together with the bracket 23a.
  • the right front wheel mechanism 30 is for causing the vehicle 1 to travel in an arbitrary direction.
  • the right front wheel mechanism 30 is disposed below the right front end of the vehicle body 10.
  • the right front wheel mechanism 30 mainly includes a right front wheel 31, a right front wheel drive motor 32, and a right front wheel steering motor 33.
  • the right front wheel 31 is an embodiment of a front wheel
  • the right front wheel drive motor 32 is an embodiment of a drive actuator
  • the right front wheel steering motor 33 is an embodiment of a steering actuator.
  • movement aspect of the right front wheel mechanism 30 are substantially the same as the left front wheel mechanism 20, description is abbreviate
  • the left front wheel 21 and the right front wheel 31 are steered by the left front wheel steering motor 23 and the right front wheel steering motor 33, respectively. That is, the steering angles of the left front wheel 21 and the right front wheel 31 are not mechanically limited to each other, and can be steered to arbitrary steering angles. Further, the left front wheel 21 and the right front wheel 31 are respectively steered by the left front wheel steering motor 23 and the right front wheel steering motor 33, whereby each front wheel can be steered until the steering angle becomes 90 degrees or more.
  • the left rear wheel mechanism 40 is for causing the vehicle 1 to travel in an arbitrary direction.
  • the left rear wheel mechanism 40 is disposed below the left rear end of the vehicle body 10.
  • the left rear wheel mechanism 40 mainly includes a left rear wheel 41, a left rear wheel drive motor 42, and a left rear wheel steering motor 43.
  • the left rear wheel drive motor 42 is an embodiment of a drive actuator
  • the left rear wheel steering motor 43 is an embodiment of a steering actuator.
  • movement aspect of the left rear wheel mechanism 40 are substantially the same as the left front wheel mechanism 20, description is abbreviate
  • the right rear wheel mechanism 50 is for driving the vehicle 1 in an arbitrary direction.
  • the right rear wheel mechanism 50 is disposed below the right rear end of the vehicle body 10.
  • the right rear wheel mechanism 50 mainly includes a right rear wheel 51, a right rear wheel drive motor 52, and a right rear wheel steering motor 53.
  • the right rear wheel drive motor 52 is an embodiment of a drive actuator
  • the right rear wheel steering motor 53 is an embodiment of a steering actuator.
  • movement aspect of the right rear wheel mechanism 50 are substantially the same as the left front wheel mechanism 20, description is abbreviate
  • the left front wheel 21 and the right front wheel 31 are collectively referred to simply as “front wheels”, the left rear wheel 41 and the right rear wheel 51 are collectively referred to simply as “rear wheels”, the left front wheel 21, and the right front wheel. 31, the left rear wheel 41, and the right rear wheel 51 are collectively referred to simply as “each wheel”.
  • the left front wheel drive motor 22, the right front wheel drive motor 32, the left rear wheel drive motor 42, and the right rear wheel drive motor 52 are collectively referred to simply as “each drive motor”, the left front wheel steering motor 23, and the right front wheel steering motor. 33, the left rear wheel steering motor 43, and the right rear wheel steering motor 53 are collectively referred to as “each steering motor”.
  • the operation unit 60 is a space for an operator to get on and operate the vehicle 1.
  • the operation unit 60 is disposed at a substantially central portion in the front and rear direction of the vehicle body 10.
  • the operation unit 60 mainly includes a seat 61, a steering wheel 62, an accelerator pedal 63, a joystick 64, and a changeover switch 65.
  • the seat 61 is for an operator to sit on.
  • the seat 61 is disposed at the rear of the operation unit 60.
  • the steering wheel 62 is an embodiment of the second steering operation tool, and is an operation tool for steering the vehicle 1.
  • the steering wheel 62 is formed in a substantially circular shape and is turned by an operator.
  • the steering wheel 62 is disposed in a front portion of the operation unit 60 at a position where an operator seated on the seat 61 can operate.
  • the accelerator pedal 63 is an embodiment of a driving operation tool, and is an operation tool for running the vehicle 1.
  • the accelerator pedal 63 is arranged at a front portion of the operation unit 60 and below the steering wheel 62 at a position where an operator sitting on the seat 61 can operate with his / her foot.
  • the joystick 64 is an embodiment of the first steering operation tool, and is an operation tool for steering the vehicle 1.
  • the joystick 64 is disposed on the side of the seat 61 and at a position where an operator seated on the seat 61 can operate.
  • the joystick 64 is rotatably supported at its lower part, and is operated by tilting the upper part in an arbitrary direction and rotating (twisting) the longitudinal direction as an axis.
  • the changeover switch 65 selects either the steering wheel 62 or the joystick 64 as an operating tool for steering the vehicle 1.
  • the changeover switch 65 is disposed on the side of the seat 61 and at a position where the operator seated on the seat 61 can operate. In the present embodiment, the changeover switch 65 is disposed in the vicinity of the joystick 64.
  • the changeover switch 65 according to the present embodiment is configured by a push button type switch, but the present invention is not limited to this, and can be configured by various switches such as a toggle switch and a slide switch. is there.
  • the controller 100 is an embodiment of the control means, and controls the driving and steering of each wheel based on the operation of each operation tool.
  • the controller 100 is disposed at an appropriate position of the vehicle main body 10.
  • the controller 100 may be configured such that a CPU, ROM, RAM, HDD, or the like is connected by a bus, or may be configured by a one-chip LSI or the like.
  • the controller 100 stores various programs and data for controlling the driving and steering of each wheel, and controls the driving and steering of each wheel based on the program and the like.
  • the controller 100 is mainly connected to an accelerator operation amount detection sensor 101, a steering operation amount detection sensor 102, a joystick operation amount detection sensor 103, a changeover switch 65, each drive motor, and each steering motor.
  • the accelerator operation amount detection sensor 101 detects the operation amount A of the accelerator pedal 63, more specifically, the rotation angle of the accelerator pedal 63 rotated by the operator.
  • the controller 100 can acquire a detection signal of the operation amount A of the accelerator pedal 63 by the accelerator operation amount detection sensor 101. Further, the controller 100 can calculate a target speed v t that is a target speed of the vehicle 1 based on the operation amount A of the accelerator pedal 63.
  • the steering operation amount detection sensor 102 detects the operation amount of the steering wheel 62, more specifically, the rotation angle ⁇ of the steering wheel 62 rotated by the operator.
  • the controller 100 can acquire a detection signal of the rotation angle ⁇ of the steering wheel 62 by the steering operation amount detection sensor 102.
  • the value of the rotation angle ⁇ of the steering wheel 62 is determined, the value of the turning radius r when the vehicle 1 turns is determined.
  • the turning radius r refers to the distance from the turning center Z to the midpoint between the left rear wheel 41 and the right rear wheel 51 (see FIG. 5).
  • the joystick operation amount detection sensor 103 is an operation amount of the joystick 64, more specifically, a tilt direction and a tilt angle when the joystick 64 is tilted by the operator, and a rotation when the operator is rotated (twisted). The direction is detected.
  • the controller 100 can acquire a detection signal of the operation amount of the joystick 64 by the joystick operation amount detection sensor 103.
  • the controller 100 is connected to the changeover switch 65 and can acquire a detection signal indicating that the changeover switch 65 has been operated.
  • the controller 100 is connected to each drive motor, and can control the drive of each drive motor, more specifically, the rotation direction and the rotation speed of each drive motor. With this control, the controller 100 can control the driving of each wheel, and consequently, the vehicle 1 can travel at an arbitrary speed.
  • the controller 100 is connected to each steering motor, and can control the driving of each steering motor, more specifically the rotation direction and the number of rotations of each steering motor. With this control, the controller 100 can control the steering of each wheel, and consequently, the vehicle 1 can be steered in an arbitrary direction.
  • the controller 100 selects either the steering wheel 62 or the joystick 64 as an operation tool for steering the vehicle 1 based on the operation of the changeover switch 65 by the operator.
  • the controller 100 controls the steering of each wheel based on the operation of the steering wheel 62.
  • the controller 100 can control the steering of each wheel based on the operation of the joystick 64. .
  • the controller 100 can control the driving of each wheel based on the operation of the accelerator pedal 63. More specifically, when the accelerator pedal 63 is operated, each wheel is driven, and control is performed so that the rotational speed of each wheel increases as the operation amount of the accelerator pedal 63 increases.
  • the normal steering mode is selected by the changeover switch 65.
  • the vehicle 1 is steered by operating the steering wheel 62.
  • the left front wheel 21 and the right front wheel 31 are steered in the right direction. More specifically, the left front wheel 21 and the right front wheel 31 are steered independently so that they can turn on concentric circles.
  • the accelerator pedal 63 By operating the accelerator pedal 63 in this state, the vehicle 1 can turn toward the right front.
  • the left front wheel 21 and the right front wheel 31 are steered leftward. More specifically, the left front wheel 21 and the right front wheel 31 are steered independently so that they can turn on concentric circles.
  • the accelerator pedal 63 By operating the accelerator pedal 63 in this state, the vehicle 1 can turn toward the left front.
  • the front wheels (the left front wheel 21 and the right front wheel 31) of the vehicle 1 can be steered based on the operation of the steering wheel 62. That is, the vehicle 1 can be run with the same operation feeling as that of a general automobile.
  • the technique of the vehicle which can steer a pair of left and right wheels independently is publicly known.
  • a pair of main drive wheels (rear wheels), a pair of hydraulic transmissions that individually drive the pair of main drive wheels, and the pair of hydraulic transmissions are individually operated.
  • a pair of operation levers In such a configuration, the vehicle can drive the pair of main drive wheels in opposite directions by operating the pair of operation levers in opposite directions. Therefore, the vehicle can turn around the center of the left and right of the main drive wheel (super turning).
  • the vehicle is disadvantageous in that it is complicated to operate because it is necessary to turn the pair of operation levers individually.
  • the vehicle 1 that can perform a super-revolution turn by a simple operation is provided.
  • the controller 100 can independently control the steering of the front wheels based on the operation of the steering wheel 62. Further, the controller 100 can independently control the driving of each wheel based on the operation of the accelerator pedal 63.
  • the turning center Z is located on a straight line connecting the ground point of the left rear wheel 41 and the ground point of the right rear wheel 51, and is based on the rotation angle ⁇ of the steering wheel 62. If the turning radius r is calculated, the position of the turning center Z is determined based on the calculated turning radius r.
  • Steering angle [delta] FR of the steering angle [delta] FL and the right front wheel 31 of the left front wheel 21 for this purpose respectively represented by the relationship expressed by a number 1 and number 2 below.
  • T represents the tread of the vehicle 1 (the distance between the center of the left front wheel 21 and the center of the right front wheel 31), and W represents the wheel base (the distance between the front wheel and the rear wheel) of the vehicle 1.
  • W represents the wheel base (the distance between the front wheel and the rear wheel) of the vehicle 1.
  • the front tread T and the rear tread T are the same.
  • the vehicle 1 steers only the front wheels as described above, the steering angles of the left rear wheel 41 and the right rear wheel 51 are both zero.
  • FIG. 6 shows an example of a map representing the relationship between the turning radius r, the steering angle ⁇ FL, and the steering angle ⁇ FR when the vehicle 1 is turned to the left (see FIG. 5).
  • the horizontal axis (turning radius r) in FIG. 6 is a logarithmic axis. It can be seen that the steering angle ⁇ FL and the steering angle ⁇ FR increase as the turning radius r decreases, and the steering angle ⁇ FL and the steering angle ⁇ FR decrease as the turning radius r increases. It can also be seen that the steering angle ⁇ FL of the left front wheel 21 located on the inner side in the turning direction is larger than the steering angle ⁇ FR of the right front wheel 31 located on the outer side in the turning direction. By using such a map, the steering angle of the front wheels can be calculated from the turning radius r.
  • the speed of each wheel is divided into the following relational expressions when the turning radius r is (1) T / 2 ⁇ r and (2) 0 ⁇ r ⁇ T / 2. expressed.
  • the speed of each wheel represents the speed with respect to the ground-contact surface of each wheel (refer FIG. 5).
  • each wheel speed coefficient (left front wheel speed coefficient C FL , right front wheel speed coefficient C FR , left rear wheel speed coefficient C RL , and right rear wheel speed coefficient C RR ) that is a generalized coefficient and the accelerator pedal 63
  • the speed of each wheel is expressed by the relational expressions shown in the following equations 11 to 14.
  • the ratio between the wheel speed coefficients is determined. Further, as can be seen from Expressions 11 to 14, if the wheel speed coefficients and the target speed v t are determined, the speed of each wheel is calculated.
  • FIG. 7 shows a turning radius r and each wheel speed coefficient (left front wheel speed coefficient C FL , right front wheel speed coefficient C FR , left rear wheel speed coefficient C when the vehicle 1 is turned to the left (see FIG. 5).
  • An example of the map showing the relationship between RL and the right rear wheel speed coefficient C RR ) is shown.
  • the horizontal axis (turning radius r) in FIG. 7 is a logarithmic axis.
  • FIG. 7 shows a case where the right front wheel speed coefficient C FR is set to be always 1. If the turning radius r is determined, the ratio of the other wheel speed coefficients (the left front wheel speed coefficient C FL , the left rear wheel speed coefficient C RL , and the right rear wheel speed coefficient C RR ) to the right front wheel speed coefficient C FR is also determined. The relationship between the turning radius r and each wheel speed coefficient is as shown in FIG. As can be seen from Equation 12, when the right front wheel speed coefficient C FR is always set to 1, the speed v FR of the right front wheel 31 is always the target speed v t . By using such a map and Equations 11 to 14, the speed of each wheel can be calculated from the turning radius r.
  • FIG. 8 shows an example of a map (hereinafter simply referred to as “steering angle map M1”) showing the relationship between the rotation angle ⁇ of the steering wheel 62, the steering angle ⁇ FL, and the steering angle ⁇ FR in this case.
  • FIG. 9 shows an example of a map (hereinafter simply referred to as “wheel speed coefficient map M2”) representing the relationship between the rotation angle ⁇ of the wheel 62 and each wheel speed coefficient.
  • the steering angle ⁇ FL and the steering angle ⁇ FR when the steering wheel 62 is rotated to the left, that is, when the front wheels are steered to the left, are set to positive values.
  • the steering angle ⁇ FL and the steering angle ⁇ FR are shown as negative values, respectively.
  • the right front wheel speed coefficient CFR is always 1 when the steering wheel 62 is rotated to the left, and the left front wheel speed coefficient when the steering wheel 62 is rotated to the right.
  • C FL is always set to 1 is shown.
  • the controller 100 acquires the rotation angle ⁇ of the steering wheel 62 detected by the steering operation amount detection sensor 102, and the steering angle corresponding to the rotation angle ⁇ based on the steering angle map M1.
  • ⁇ FL and steering angle ⁇ FR are respectively calculated.
  • the controller 100 as the steering angle [delta] FL and the steering angle [delta] FR of the left front wheel 21 and the right front wheel 31, a steering angle [delta] FL and the steering angle [delta] FR calculated on the basis of the steering angle map M1, the left front-wheel steering The driving of the motor 23 and the right front wheel steering motor 33 is controlled.
  • the trajectory between the left front wheel 21 and the right front wheel 31 during turning is determined. Will draw concentric circles, and the vehicle 1 can turn smoothly with the turning radius r. Further, since the left front wheel 21 and the right front wheel 31 are independently steered by the left front wheel steering motor 23 and the right front wheel steering motor 33, the steering angles ( ⁇ FL and ⁇ FR ) are mechanically limited by a link mechanism or the like. It will not be done. For this reason, even when the turning center Z is located inside the width of the rear wheel, it is possible to turn around the turning center Z, particularly when the turning center Z is located at the middle point of the rear wheel. Even turn (super turning) can be performed.
  • the controller 100 determines the target speed v t based on the operation amount A of the accelerator pedal 63 detected by the accelerator operation amount detection sensor 101 and the appropriate map M3 showing the relationship between the operation amount A and the target speed v t. Is calculated.
  • the controller 100 acquires the rotation angle ⁇ of the steering wheel 62, and each wheel speed coefficient (C FL , C FR , C RL , and C RR ) corresponding to the rotation angle ⁇ based on the wheel speed coefficient map M2. Are calculated respectively.
  • the controller 100 uses the target speed v t calculated based on the map M3 and each wheel speed coefficient calculated based on the wheel speed coefficient map M2, and from the relational expressions shown in Expression 11 to Expression 14, Velocity (v FL , v FR , v RL , and v RR ) is calculated respectively.
  • the controller 100 controls the drive of each drive motor so that the speed of each wheel becomes the calculated speed (v FL , v FR , v RL , and v RR ).
  • Each wheel can turn without sliding against the ground.
  • the road surface (turf, farm field, etc.) is not damaged, and damage due to friction with the road surface of each wheel can be prevented.
  • the wheel speed coefficient map M2 is moved to the right so that the right front wheel speed coefficient CFR is always 1 when the steering wheel 62 is rotated to the left (when turning to the left).
  • the left front wheel speed coefficient CFL is set to 1 at all times. That is, the control is performed so that the speed v FR of the right front wheel 31 is always v t when turning left, and the speed v FL of the left front wheel 21 is always v t when turning right. Is done.
  • the speed v FR of the right front wheel 31 is the highest among the speeds of the wheels. Therefore, as described above, by controlling the speed v FR of the right front wheel 31 to always become the target speed v t , the speeds of the other wheels (v FL , v RL , and v RR ) are made equal to or lower than the target speed v t . Can be suppressed.
  • the speed v FL of the left front wheel 21 is the highest among the speeds of the wheels. Therefore, as in the case of turning to the left as described above, by controlling the speed v FL of the left front wheel 21 to always become the target speed v t , the speed of each wheel is set to a predetermined value (in this embodiment, The target speed v t ) or less can be suppressed, and the occurrence of malfunctions (damage or the like) due to excessive rotation of each drive motor can be prevented.
  • each wheel speed coefficient is set so as not to exceed 1.
  • the present invention is not limited to this, and each wheel speed coefficient has a value exceeding 1. It is also possible.
  • each wheel is driven by each drive motor, but the present invention is not limited to this.
  • a configuration in which only the front wheels are driven, a configuration in which only the rear wheels are driven, or a configuration in which only one of the wheels is driven may be employed.
  • the vehicle 1 of the present embodiment is A plurality of wheels including two front wheels (a left front wheel 21 and a right front wheel 31); Steering actuators (left front wheel steering motor 23 and right front wheel steering motor 33) that are respectively connected to the front wheels and steer the front wheels; A steering wheel 62 for instructing the operation of the steering actuator; Steering angles ( ⁇ FL and ⁇ FR ) of the front wheels capable of turning around the turning center Z determined based on the turning angle ⁇ of the steering wheel 62 are calculated, and the steering angles of the front wheels are calculated.
  • the steering angle of the two front wheels is not mechanically limited, and the vehicle can turn with a small turning radius.
  • the sense of turning operation of the steering wheel 62 is similar to that of a general automobile, an operator accustomed to the sense of operation of the automobile can easily operate the vehicle 1.
  • the turning radius r can be reduced without steering the rear wheel, there is no need for a separate member (steering actuator, etc.) for steering the rear wheel, and the number of parts and part cost can be reduced. Can do.
  • the steering actuator is The front wheels can be steered by 90 degrees or more. With this configuration, the front wheel is steered by 90 degrees or more to turn around the turning position at the inner side of the rear wheel (reliable turning), or turn around the center position of the rear wheel. (Super Shinji turn) can be.
  • the vehicle 1 Among a plurality of wheels including two front wheels (left front wheel 21 and right front wheel 31), a plurality of wheels are drive wheels (left front wheel 21, right front wheel 31, left rear wheel 41, and right rear wheel 51), A drive actuator (left front wheel drive motor 22, right front wheel drive motor 32, left rear wheel drive motor 42, and right rear wheel drive motor 52) capable of being connected and driven for each of the plurality of drive wheels; An accelerator pedal 63 for setting a target speed v t ; Comprising The controller 100 Based on the turning angle ⁇ of the steering wheel 62 and the operation amount A of the accelerator pedal 63, the speed (v FL) of the driving wheel that allows the driving wheel to turn around the turning center Z without slipping on the road surface.
  • the drive actuator is operated so that the speed of the drive wheel becomes the calculated speed.
  • the speed of the driving wheel can be adjusted based on the operation amount A of the accelerator pedal 63 so that the driving wheel does not slide on the road surface. Therefore, it is possible to stably perform the super turn without damaging the road surface (turf, farm field, etc.) when turning and while preventing damage to the drive wheels.
  • the calculated speed is limited so as not to exceed a predetermined value (target speed v t ).
  • target speed v t a predetermined value
  • the calculated speed is limited to a predetermined value or less, so that it is possible to prevent the occurrence of problems due to over-rotation of the driving actuator.
  • the present invention when the steering wheel 62 is operated in the normal steering mode, only the front wheels of the vehicle 1 are steered.
  • the present invention is not limited to this. That is, when the steering wheel 62 is operated, the rear wheels (the left rear wheel 41 and the right rear wheel 51) are steered in addition to the front wheels of the vehicle 1, or only the rear wheels are steered. Is possible. For example, when the steering wheel 62 is rotated clockwise, the front wheels can be steered to the right and the rear wheels can be steered to the left. Thereby, the turning performance at the time of steering the vehicle 1 can be improved.
  • the vehicle 1 is steered by operating the joystick 64.
  • the operation of the joystick 64 in the special steering mode includes (1) an operation of tilting the joystick 64 in an arbitrary direction, and (2) rotation of the joystick 64 in an arbitrary direction with the longitudinal direction as an axis, without tilting. There is an operation of moving (twisting), and (3) an operation of tilting the joystick 64 in an arbitrary direction while rotating the joystick 64 in an arbitrary direction with the longitudinal direction as an axis.
  • each steering motor is driven, and each wheel moves to the right front (the same direction as the direction in which the joystick 64 is tilted). ).
  • each drive motor is driven, and the vehicle 1 can run toward the right front, that is, move in parallel, with the vehicle body 10 facing forward.
  • each steering motor is driven and each wheel is steered to the right (the same direction as the joystick 64 is tilted).
  • the accelerator pedal 63 By operating the accelerator pedal 63 in this state, each drive motor is driven, and the vehicle 1 can travel rightward with the vehicle body 10 facing forward.
  • each wheel of the vehicle 1 can be steered based on an operation of tilting the joystick 64.
  • the direction in which the joystick 64 is tilted is not limited to the above two directions. That is, the joystick 64 can be tilted in any direction (for example, left front, leftward, etc.), and each wheel is steered in the direction in which the joystick 64 is tilted. Therefore, by operating the accelerator pedal 63 while tilting the joystick 64 in a desired direction, the vehicle 1 can be driven in the desired direction while the vehicle body 10 faces forward.
  • each steering motor is driven, and each wheel is steered in a direction opposite to the direction in which the joystick 64 is tilted.
  • each drive motor is driven in the reverse direction (reverse direction).
  • each steering motor is driven, and each wheel has a predetermined first turning center C. It is steered in a direction in which it can turn clockwise. More specifically, each wheel is a tangential direction of a circle passing through the ground contact point of each wheel with the first turning center C as the center in a plan view, and the clockwise direction when the first turning center C is the center. It is steered to face.
  • each drive motor is driven, and the vehicle 1 can turn clockwise around the first turning center C. That is, it is possible to turn the joystick 64 in the direction in which the joystick 64 is twisted.
  • each wheel is steered in a direction in which it can turn counterclockwise around a predetermined first turning center C. Is done. More specifically, each wheel is in a tangential direction of a circle passing through the ground contact point of each wheel around the first turning center C in plan view, and counterclockwise when the first turning center C is the center. It is steered to face the direction.
  • the accelerator pedal 63 By operating the accelerator pedal 63 in this state, the vehicle 1 can turn counterclockwise about the first turning center C.
  • each wheel of the vehicle 1 can be steered based on an operation of rotating the joystick 64. That is, by operating the accelerator pedal 63 while rotating the joystick 64 in a desired direction, the vehicle 1 can turn in a desired direction around a predetermined first turning center C.
  • the position of the first turning center C can be configured to be stored in the controller 100 in advance, or can be configured to be adjustable with a separate adjustment unit.
  • each wheel rotates clockwise around the second turning center Cx. Steered in a turnable direction.
  • the position of the second turning center Cx is determined based on the tilt direction and tilt angle of the joystick 64. More specifically, the second turning center Cx corresponds to the amount (tilt angle) tilted from the position of the predetermined first turning center C (see FIG. 12) in the direction (rightward) in which the joystick 64 is tilted. It is determined as the position moved by the distance. Accordingly, for example, as shown in FIGS. 13A to 13B, when the tilt angle of the joystick 64 is increased, the position of the second turning center Cx is further moved to the right.
  • each wheel is steered in a direction in which it can turn clockwise around the second turning center Cx. More specifically, each wheel is a tangential direction of a circle passing through the contact point of each wheel with the second turning center Cx as the center in the plan view, and the clockwise direction when the second turning center Cx is the center. It is steered to face. By operating the accelerator pedal 63 in this state, the vehicle 1 can turn clockwise around the second turning center Cx.
  • each wheel can turn counterclockwise around the second turning center Cx. Steered in the direction.
  • the position of the second turning center Cx is determined based on the tilt direction and tilt angle of the joystick 64. That is, the second turning center Cx is a distance corresponding to the amount (tilt angle) tilted from the position of the predetermined first swing center C (see FIG. 12) in the direction (left) in which the joystick 64 is tilted. It is determined at the moved position. Therefore, for example, as shown in FIG. 14A to FIG. 14B, when the inclination angle of the joystick 64 is increased, the position of the second turning center Cx moves further to the left.
  • each wheel is steered in a direction capable of turning counterclockwise around the second turning center Cx. More specifically, each wheel is in a tangential direction of a circle passing through the ground contact point of each wheel with the second turning center Cx as the center in the plan view, and counterclockwise when the second turning center Cx is the center. It is steered to face the direction.
  • the accelerator pedal 63 By operating the accelerator pedal 63 in this state, the vehicle 1 can turn counterclockwise about the second turning center Cx.
  • each wheel of the vehicle 1 can be steered based on an operation of tilting the joystick 64 while rotating it. That is, the second turning center Cx is determined based on the operation of tilting the joystick 64, and the turning direction is determined based on the operation of rotating the joystick 64. Then, by operating the accelerator pedal 63 while performing both operations, the vehicle 1 can turn in a desired direction around the second turning center Cx.
  • the joystick 64 is tilted to the right while being rotated clockwise and the case where the joystick 64 is tilted to the left while being rotated counterclockwise have been described.
  • the operation of the joystick 64 is not limited to the above operation. That is, the joystick 64 can be tilted in any direction (for example, right front, left front, etc.) while being rotated in any direction (clockwise or counterclockwise). Therefore, by operating the accelerator pedal 63 in a state where the joystick 64 is tilted in an arbitrary direction while rotating in an arbitrary direction, the vehicle 1 is centered on the second turning center Cx determined as a desired position. It can turn in a desired direction.
  • the vehicle 1 of the present embodiment is A wheel composed of two front wheels (left front wheel 21 and right front wheel 31) and two rear wheels (left rear wheel 41 and right rear wheel 51); Steering actuators (left front wheel steering motor 23, right front wheel steering motor 33, left rear wheel steering motor 43, and right rear wheel steering motor 53) that are respectively connected to the wheels and steer the wheels; Driving actuators (left front wheel drive motor 22, right front wheel drive motor 32, left rear wheel drive motor 42, and right rear wheel drive motor 52) connected to the wheels and driving the wheels, A joystick 64 that can be operated by being tilted in an arbitrary direction, and that instructs the operation of the steering actuator; An accelerator pedal 63 for instructing the operation of the driving actuator; When the joystick 64 is tilted, the wheel is steered in the tilted direction of the joystick 64, and when the accelerator pedal 63 is operated, the controller 100 drives the wheel based on the operation amount of the accelerator pedal 63; It comprises.
  • the joystick 64 is It can be operated by being twisted in any direction, The controller 100
  • the wheel is steered in a direction in which the joystick 64 can turn around the first turning center C in the rotational direction in which the joystick 64 is twisted.
  • the wheel is steered in such a direction that the joystick 64 can be turned in the rotation direction in which the joystick 64 is twisted by simply twisting the joystick 64 in a desired direction. Can do.
  • the accelerator pedal 63 By operating the accelerator pedal 63 in this state, the vehicle 1 can be turned in that direction. Accordingly, it is possible to easily turn around the predetermined first turning center C by a simple operation.
  • the operator can easily predict the state of turning of the vehicle 1. Therefore, the operator can operate the vehicle 1 sensuously, and the operability can be improved.
  • the controller 100 includes: When the joystick 64 is tilted in a twisted state, the second turning center Cx is determined based on the inclination direction and the inclination angle of the joystick 64, and the joystick 64 is turned around the second turning center Cx in the rotational direction in which the joystick 64 is twisted.
  • the wheel is steered in a possible direction.
  • the second turning center Cx can be arbitrarily adjusted by simply tilting the joystick 64 in a desired direction while twisting, and the rotation of the joystick 64 being twisted around the second turning center Cx.
  • the wheel can be steered in a direction that enables turning in a direction.
  • the accelerator pedal 63 By operating the accelerator pedal 63 in this state, the vehicle 1 can be turned in that direction.
  • the vehicle 1 according to the present embodiment can be steered by the steering wheel 62 in the normal steering mode. Therefore, when it is not necessary to perform parallel movement, minimum turning, or the like, the vehicle 1 can be operated with the same operation feeling as that of a normal automobile. Furthermore, the vehicle 1 has only two modes, a normal steering mode and a special steering mode, and both modes can be switched only by operating the changeover switch 65. Therefore, since there is no need to switch many modes, the operator can easily select the operation method of the vehicle 1 and can easily select any mode by a simple operation.
  • the control related to the steering of each wheel has been mainly described.
  • the rotational speed of each wheel can be controlled at the same time. For example, when the vehicle 1 turns, it is possible to control the rotation speed of each wheel so that each wheel does not slip between the ground surface. By such control, it is possible to suppress wear of each wheel, to prevent the braking force due to the frictional force between each wheel and the contact surface from being applied to the vehicle 1, and the like.
  • the control gain (feedback gain) of the PID controller 262 is set. If it is increased, there is a problem that the control amount y is overshot with respect to the target value y * or hunting occurs due to the dead time, and the system becomes unstable (see FIG. 29B). ). On the other hand, if the control gain of the PID controller 262 is reduced, the time until the controlled variable y reaches the target value y * becomes longer, and there is a problem that the PID control cannot be applied to applications that require a high-speed response. (See FIG. 29 (c)).
  • FIG. 30 (a) a technique for compensating for the dead time included in the control target 261 by a Smith dead time compensator 263 is known.
  • the block diagram to which the Smith dead time compensator 263 is added is converted, the block diagram shown in FIG.
  • the transfer function e- Ls of the dead time can be driven out of the feedback loop 264, and only the actual model 265 of the control target 261 excluding the dead time is included in the feedback loop 264. Therefore, compared with the case where the dead time is included in the feedback loop 264, the control gain (feedback gain) of the PID controller 262 can be set larger, and the response of the control amount y can be improved while keeping the system stable. Can do well.
  • the dead time of the controlled object 261 is included in the control parameter (smith dead time compensator 263) of the feedback control device 266.
  • the Smith dead time compensator 263 does not function sufficiently, There is a problem that the control amount y diverges and the control becomes unstable (see FIG. 30C).
  • the actual model 265 of the controlled object 261 excluding the dead time
  • the actual model 265 of the controlled object 261 is included in the control parameter (smith dead time compensator 263) of the feedback control device 266.
  • the Smith dead time compensator 263 does not function sufficiently, and control is not possible. There was a problem of stability.
  • a feedback control device and a feedback control method that can stably control a control target including a dead time and that have good control amount responsiveness are provided.
  • a feedback control device for a control target including a dead time wherein the control amount is input to a detection unit that detects the control amount of the control target and an inverse model of the transfer function of the control target excluding the dead time
  • a second output value calculating means for obtaining a second output value by subtracting the first output value from the manipulated variable to be controlled The second output value is input to the transfer function of the control target excluding time, and third output value calculation means for obtaining a third output value, and the control amount is subtracted from the target value of the control amount.
  • control target dead time is not included in the control parameters of the dead time compensator, even if the dead time changes due to aging, etc., or if there is an error in modeling the dead time, Time can be compensated for and stable control can be performed.
  • the control target feedback control device includes a dead time, and the control amount is input to a detection unit that detects the control amount of the controlled object and an inverse model of the transfer function of the controlled object excluding the dead time.
  • a first output value calculating means for obtaining a first output value; a second output value calculating means for obtaining a second output value by subtracting the first output value from the manipulated variable to be controlled;
  • the third output value calculation means for obtaining the third output value by inputting the second output value to the transfer function to be controlled excluding time, and the filter for allowing only a specific frequency component to pass through the third output value.
  • a fourth output value calculating means for inputting the output value to obtain a fourth output value; a control deviation calculating means for subtracting the control amount from the target value of the control amount to obtain a control deviation; and the control deviation To subtract the fourth output value to obtain a corrected control deviation.
  • a control deviation correcting means by entering the corrected control deviation, is to and a operation amount calculating means for obtaining an operation amount of the control object.
  • control target dead time is not included in the control parameters of the dead time compensator, even if the dead time changes due to aging, etc., or if there is an error in modeling the dead time, Time can be compensated for and stable control can be performed. Further, even when the actual model of the controlled object changes due to aging or the like, or when an error occurs in the modeling of the controlled object, a steady deviation between the target value and the controlled variable does not occur.
  • a fifth output value calculating means for multiplying the control deviation by a predetermined proportional gain or integrating the control deviation for a predetermined time to obtain a fifth output value; Operation amount correction means for adding the output values to obtain a corrected operation amount.
  • control amount of the controlled object including the dead time is input to the inverse model of the transfer function of the controlled object excluding the dead time to calculate the first output value, and the first output value is calculated from the controlled object.
  • the second output value is calculated by subtracting from the manipulated variable, the second output value is input to the transfer function of the controlled object excluding the dead time, the third output value is calculated, and the third output value is calculated.
  • the control deviation corrected by subtracting from the control deviation is calculated, and feedback control is performed based on the corrected control deviation.
  • control gain can be set large to improve the control amount response.
  • control target dead time is not included in the control parameters of the dead time compensator, even if the dead time changes due to aging, etc., or if there is an error in modeling the dead time, Time can be compensated for and stable control can be performed.
  • control amount of the controlled object including the dead time is input to the inverse model of the transfer function of the controlled object excluding the dead time to calculate the first output value, and the first output value is calculated from the controlled object.
  • the second output value is calculated by subtracting from the manipulated variable, the second output value is input to the transfer function of the controlled object excluding the dead time, the third output value is calculated, and the third output value is calculated.
  • a fourth output value is calculated by inputting into a filter that passes only a specific frequency component, the fourth output value is subtracted from the control deviation, a corrected control deviation is calculated, and the corrected control deviation is calculated. Based on this, feedback control is performed.
  • the control target dead time is not included in the control parameters of the dead time compensator, even if the dead time changes due to aging, etc., or if there is an error in modeling the dead time, Time can be compensated for and stable control can be performed. Further, even when the actual model of the controlled object changes due to aging or the like, or when an error occurs in the modeling of the controlled object, a steady deviation between the target value and the controlled variable does not occur.
  • the feedback control device 201 includes an instruction for a control target 202, a PID controller 205, a control amount y detection unit 206, a control deviation calculation unit 207, and a target value y * of the control amount y.
  • Means (not shown), a dead time compensator 210, and a correction means 220.
  • the control target 202 is composed of an actuator or the like.
  • the transfer function of the control target 202 is expressed as G (s) e ⁇ Ls including the dead time.
  • the transfer function G (s) is expressed as a real model 203
  • the transfer function e ⁇ Ls is expressed as a dead time 204.
  • the actual model 203 includes a first-order lag system, a second-order lag system, and the like.
  • the dead time 204 is, for example, a model that responds L seconds after inputting a unit step. s is a Laplace operator.
  • the PID controller 205 is an operation amount calculation unit that calculates the operation amount U (s) of the control target 202.
  • a corrected control deviation 214a which will be described later, is input to the PID controller 205.
  • a value proportional to the corrected control deviation 214a (P operation) a value obtained by time integration of the corrected control deviation 214a (I operation), and a time derivative of the corrected control deviation 214a.
  • the value (D operation) is added to each other, and an operation amount U (s) serving as the calculated value is obtained.
  • the operation amount U (s) is input to the second output value calculation unit 212 of the dead time compensator 210 and the operation amount correction unit 222 of the correction unit 220.
  • the PID controller 205 is represented by a transfer function C (s).
  • the control gain (proportional gain), integral gain (integral time), and differential gain (derivative time) of the PID controller 205 are appropriately adjusted according to the transfer function G (s) of the controlled object 202, that is, the actual model 203, as a control parameter. Is done.
  • the detecting means 206 detects a control amount y that is an output value of the control object 202.
  • the control amount y that is the output value of the control object 202 is input to the control deviation calculation means 207 and the first output value calculation means 211 of the dead time compensator 210.
  • control deviation calculation means 207 the control amount y is subtracted from the target value y * instructed by the instruction means to obtain a control deviation 207a.
  • the control deviation 207 a is input to the control deviation correction unit 214 of the dead time compensator 210 and the fifth output value calculation unit 221 of the correction unit 220.
  • the dead time compensator 210 includes first output value calculation means 211, second output value calculation means 212, third output value calculation means 213, and control deviation correction means 214.
  • the first output value calculation means 211 is an inverse number (inverse model) of the real model 203 and is expressed as a transfer function 1 / Gn (s), which will be described in detail later.
  • the control amount y is input to the inverse model 1 / Gn (s) of the transfer function of the control target 202 excluding the dead time 204, and the first output value 211a is obtained.
  • the first output value 211a is input to the second output value calculation means 212.
  • the second output value calculation means 212 subtracts the first output value 211a of the first output value calculation means 211 from the manipulated variable U (s) output from the PID controller 205 to obtain the second output value 212a. Can be obtained.
  • the second output value 212a is input to the third output value calculation means 213.
  • the third output value calculation means 213 is the real model 203 and is expressed as a transfer function Gn (s), which will be described in detail later.
  • the second output value 212a is input to the transfer function Gn (s) of the control target 202 excluding the dead time 204, and the third output value 213a is obtained.
  • the third output value 213a is input to the control deviation correction unit 214.
  • the control deviation correction unit 214 subtracts the third output value 213a from the control deviation 207a to obtain a corrected control deviation 214a.
  • the corrected control deviation 214a is input to the PID controller 205.
  • the correction unit 220 includes a fifth output value calculation unit 221 and an operation amount correction unit 222.
  • the fifth output value calculation means 221 is composed of a proportional element that outputs a value proportional to the input value.
  • the control gain (proportional gain) is set to Kdist .
  • the control deviation 207a to be K dist is multiplied by the fifth output value 221a is obtained.
  • the fifth output value 221a is input to the operation amount correction unit 222.
  • the operation amount correction means 222 adds the fifth output value 221a to the operation amount U (s) output from the PID controller 205 to obtain a corrected operation amount 222a.
  • the corrected operation amount 222 a is input to the control target 202.
  • the feedback control apparatus 201 performs feedback control using the following feedback control method. That is, as shown in FIG. 16, the feedback control apparatus 201 inputs the control amount y of the controlled object 202 including the dead time into the inverse model 1 / Gn (s) of the transfer function of the controlled object excluding the dead time 204. Then, the first output value 211a is calculated (S1), the first output value 211a is subtracted from the operation amount U (s) of the control object 202, and the second output value 212a is calculated (S2).
  • the second output value 212a is input to the transfer function Gn (s) of the control object 202 excluding the dead time 204, the third output value 213a is calculated (S3), and the third output value 213a is calculated as a control deviation. And the corrected control deviation 214a is calculated (S4).
  • the feedback control device 201 performs feedback control based on the corrected control deviation 214a (S5).
  • the feedback control apparatus 201 is good also as a structure shown to Fig.17 (a). That is, the dead time compensator 210 of the feedback control device 201 has the same configuration, and the fifth output value calculation unit 221 of the correction unit 222 is an integration controller.
  • the control gain (integral gain) of the integral controller is I dist .
  • the control deviation 207a is integrated for a time corresponding to I dist to obtain a fifth output value 221a.
  • the fifth output value 221a is input to the operation amount correction unit 222.
  • the feedback control apparatus 201 is good also as a structure shown in FIG.17 (b). That is, the feedback control apparatus 201 includes a fourth output value calculation unit 215 instead of the correction unit 220.
  • the fourth output value calculation means 215 is a filter that passes only a specific frequency component, specifically a high-pass filter that passes only a frequency component equal to or higher than a set frequency, and is represented as a transfer function F (s).
  • the fourth output value calculation means 215 the third output value 213a output from the third output value calculation means 213 is input to the transfer function F (s), and the fourth output value 215a is obtained.
  • the fourth output value 215a is input to the control deviation correction unit 214.
  • the control deviation correction means 214 subtracts the fourth output value 215a from the control deviation 207a to obtain a corrected control deviation 214a.
  • the corrected control deviation 214a is input to the PID controller 205.
  • the manipulated variable U (s) is obtained from the corrected control deviation 214a.
  • the manipulated variable U (s) is input to the control object 202 and the second output value calculation means 212 of the dead time compensator 210.
  • the feedback control apparatus 201 performs feedback control using the following feedback control method. That is, as shown in FIG. 18, the feedback control apparatus 201 uses the inverse model 1 / Gn (s) of the transfer function of the control target 202 excluding the dead time 204 from the control amount y of the control target 202 including the dead time 204.
  • the first output value 211a is calculated (S11), and the first output value 211a is subtracted from the operation amount U (s) of the control target 202 to calculate the second output value 212a (S12).
  • the second output value 212a is input to the transfer function Gn (s) of the control object 202 excluding the dead time 204, the third output value 213a is calculated (S13), and the third output value 213a is calculated.
  • Input to the transfer function F (s) the fourth output value 215a is calculated (S14), the fourth output value 215a is subtracted from the control deviation 207a, and the corrected control deviation 214a is calculated (S15).
  • the feedback control device 201 performs feedback control based on the corrected control deviation 214a (S16).
  • the dead time is set as a control parameter (specifically, a constant L). Therefore, the dead time estimation by the constant L of the controlled object 261 and the modeling of the controlled object 261 is performed. If an error occurs between the value constant Ln, the control becomes unstable. Therefore, the dead time of the controlled object 261 is compensated by treating the dead time of the controlled object 261 as a disturbance and compensating for the disturbance with a disturbance observer.
  • a control parameter specifically, a constant L
  • FIG. 19A it is assumed that feedback control is performed by the PID controller 262 using the real model 265 of the control target 261 including the transfer function e ⁇ Ls of the dead time as the transfer function G (s).
  • the transfer function e ⁇ Ls of the dead time of the control object 261 is the disturbance d
  • equivalent conversion of FIG. 19A can be expressed as shown in FIG.
  • the signal of the disturbance d is expressed by the following formula 15.
  • the disturbance d is estimated by a disturbance observer.
  • an inverse model (referred to as an inverse model estimated value 267) of the real model 265 of the controlled object 261 that does not include the transfer function e ⁇ Ls is formed, and the inverse model estimated value 267 is controlled. Enter the quantity y.
  • the inverse model estimated value 267 is represented by a transfer function 1 / Gn (s).
  • the control amount y is expressed by the following formula 16.
  • a value obtained by inputting the control amount y to the inverse model estimated value 267 and subtracting the output (calculated value) from the operation amount U (s) that is the output of the PID controller 262 is expressed by the following Expression 17. expressed.
  • Equation 17 Equation 18 below.
  • Equation 18 is equal to Equation 15, the estimated value of the disturbance d can be obtained by obtaining the calculated value of Equation 18.
  • a disturbance (estimated to the actual model estimated value 268) of the controlled object 261 that does not include the transfer function e ⁇ Ls is formed, and the disturbance estimated to the actual model estimated value 268 is formed. Enter d.
  • the actual model estimated value 268 is represented by a transfer function Gn (s).
  • the calculated value is expressed by the following equation (19).
  • Equation 19 Equation 19
  • the calculated value (feedback value 269) of Equation 20 is the transfer function G (s) of the controlled object 261 excluding the transfer function e ⁇ Ls of the dead time, that is, when the manipulated variable U (s) is input to the real model 265.
  • This is an output and means a control amount y from which the effect of dead time is removed.
  • the dead time can be expelled from the feedback loop (feedback value 269) without using the dead time as a control parameter by the disturbance observer. Accordingly, since the control gain (feedback gain) of the PID controller 262 can be increased regardless of the dead time, control responsiveness can be improved.
  • the control amount y diverges in the Smith dead time compensation.
  • the dead time compensation by the disturbance observer detects the influence of the dead time as a disturbance, so that it can cope with any dead time and the control amount y does not diverge.
  • the system does not become unstable (see FIG. 21B).
  • the dead time compensation in the feedback control is not to remove the dead time but to drive the dead time out of the feedback loop and increase the control gain to improve the control performance.
  • the dead time compensation by the disturbance observer uses the real model 265 not including the dead time transfer function e ⁇ Ls of the controlled object 261, that is, G (s) as a control parameter. If there is an error in the model, that is, if G (s) ⁇ Gn (s), Expression 20 is expressed by Expression 21 below.
  • the proportional controller 270 may be an integral controller or a PI controller (proportional integral controller) depending on the characteristics of the controlled object.
  • an element that compensates for the influence of the model error may be added by configuring as shown in FIG.
  • the output value of the actual model estimated value 268 is input to the high-pass filter 271 that passes only a specific frequency component, that is, a frequency component equal to or higher than the set frequency in this embodiment, and then the control deviation is subtracted. .
  • This enables dead time compensation only in a high frequency range that becomes unstable due to the influence of dead time, and the compensation element becomes invalid at frequencies lower than that, thereby suppressing the steady-state deviation of the controlled variable y due to model error. Can do.
  • FIG. 23 is a graph showing the influence of model errors.
  • FIG. 23B shows a case where G (s) ⁇ Gn (s) and the model error is about 50%. According to this, a steady deviation occurs.
  • FIG. 23C shows a case where an element for compensating for the influence of the model error is added when G (s) ⁇ Gn (s) and the model error is about 50%. According to this, a steady deviation does not occur, and the control amount y converges to the target value y *.
  • Work vehicle 300 includes engine 230, flywheel 231, engine control device 232, HST 233, differential device 234, tire 236, speed lever 237, change rate limiting means 238, ⁇ setting dial 239, And a feedback control device 240.
  • Engine 230 generates rotational power for driving work vehicle 300.
  • a crankshaft 230 a of the engine 230 is interlocked with the flywheel 231.
  • the rotational power of the engine 230 is transmitted to the flywheel 231 via the crankshaft 230a.
  • the flywheel 231 smoothly rotates the engine 230 by accumulating inertial force.
  • the flywheel 231 is rotated by the rotational power transmitted by the crankshaft 230a.
  • the rotational speed of the flywheel 231 is detected by a rotational speed sensor 231a such as a magnetic pickup sensor or a rotary encoder.
  • the engine control device 232 controls the rotational speed of the engine 230.
  • the engine control device 232 is connected to the rotation speed sensor 231a.
  • the engine control device 232 controls the rotational speed of the engine 230 based on the rotational speed of the flywheel 231 detected by the rotational speed sensor 231a.
  • the HST 233 drives a variable displacement hydraulic pump by the engine 230 and converts the generated hydraulic pressure into a rotational force by a fixed displacement hydraulic motor.
  • the HST 233 adjusts the rotation speed and rotation direction of the hydraulic motor by changing the discharge amount and discharge direction of the hydraulic oil by the hydraulic pump according to the angle of the movable swash plate 233a provided in the hydraulic pump.
  • the rotational power of the engine 230 input from the input shaft 233b of the hydraulic pump is steplessly shifted and output to the output shaft 233c of the hydraulic motor.
  • One end of the input shaft 233b of the hydraulic pump is interlocked with the flywheel 231 and the rotational power of the engine is transmitted to the HST 233.
  • the differential device 234 distributes rotational power.
  • One end of the output shaft 233c of the hydraulic motor is linked to the differential device 234, and the rotational power of the engine 230 that has been changed by the HST 233 is transmitted to the differential device 234.
  • the transmitted rotational power is distributed to the left and right by the differential device 234.
  • One end of an axle shaft 235 is interlocked and connected to the left and right sides of the differential device 234.
  • the axle 235 transmits the rotational power distributed by the differential device 234.
  • the other end of the axle 235 is interlocked with the tire 236 and is rotated by rotational power transmitted from the axle 235.
  • the speed lever 237 sets (St) the tire speed (the number of rotations of the tire 236) S. The operator operates the speed lever 237 to adjust the tire speed S.
  • the change rate limiting means 238 limits the target value y * of the movable swash plate 233a to a predetermined change rate.
  • the change rate limit value B is determined according to the value of ⁇ (friction coefficient) set by the ⁇ setting dial 239.
  • the value of ⁇ is appropriately changed according to the state of the contact surface of the tire 236.
  • the target value y * of the movable swash plate is determined.
  • the target value y * is output from the change rate limiting means 238.
  • the feedback control device 240 includes an actuator 241, a PID controller 242, a dead time compensator 245 using a disturbance observer, and a correction means 246.
  • the movable swash plate 233a of the HST 233 is linked and connected to the rotation shaft of the actuator 241.
  • the feedback control device 240 receives a target angle (target value y *) of the rotation axis of the actuator 241 and outputs an angle (control amount y) of the rotation axis of the actuator 241.
  • the operator operates the speed lever 237 and the ⁇ setting dial 239 to input the target value y * of the actuator 241 from the change rate limiting means 238 to the feedback control device 240. Then, based on the control amount y of the actuator 241 output from the feedback control device 240, the angle of the movable swash plate 233a in the hydraulic pump of the HST 233 is changed, and the discharge amount and discharge direction of the hydraulic oil by the hydraulic pump are changed. Then, the rotational power transmitted from the engine 230 via the flywheel 231 is shifted. The changed rotational power is transmitted to the tire 236 via the differential 234 and the axle 235.
  • the feedback control device 240 and later are open control, and the tire speed S is determined by the angle of the swash plate corresponding to the control amount y.
  • the present invention is not limited to this.
  • a configuration may be adopted in which a rotation speed sensor is provided on the output shaft 233c, and the rotation speed of the tire 236 is fed back to control the tire speed S.
  • the feedback control device 240 includes an actuator 241 to be controlled, a PID controller 242, an angle sensor 243 to be a control amount y detection means, a control deviation calculation means 244, a dead time compensator 245 by a disturbance observer, Correction means 246.
  • the target angle (target value y *) of the rotation axis of the actuator 241 is input to the feedback control device 240, and the angle (control amount y) of the rotation axis of the actuator 241 is output.
  • the actuator 241 changes the inclination angle of the movable swash plate 233a of the HST 233.
  • the actuator 241 is configured by a servo motor or the like.
  • the transfer function of the actuator 241 is expressed as G (s) e ⁇ Ls including the dead time.
  • the PID controller 242 is an operation amount calculation unit that calculates the operation amount U (s) of the actuator 241.
  • a corrected control deviation 250a described later is input to the PID controller 242.
  • a value proportional to the control deviation 250a (P operation) a value obtained by integrating the control deviation 250a with time (I operation), and a value obtained by differentiating the control deviation 250a with time (D operation) are added.
  • an operation amount U (s) serving as the calculated value is obtained.
  • the manipulated variable U (s) is input to the second output value calculating unit 248 of the dead time compensator 245 and the manipulated variable correcting unit 252 of the correcting unit 246.
  • the PID controller 242 is represented by a transfer function C (s), and the control gain (proportional gain), integral gain (integral time), and differential gain (differential time) of the PID controller 242 are the transfer parameters of the actuator 241 as control parameters. It adjusts suitably according to G (s).
  • the angle sensor 243 includes a rotary encoder, a hall sensor, or the like.
  • the angle sensor 243 detects the control amount y of the actuator 241.
  • the control amount y is input to the control deviation calculation means 244 and the first output value calculation means 247 of the dead time compensator 245 by the disturbance observer.
  • the angle sensor 243 may be configured integrally with the actuator 241.
  • control deviation calculation unit 244 the control amount y detected by the angle sensor 243 is subtracted from the target value y * of the angle on the rotation axis of the actuator 241 instructed from the change rate limiting unit 238, and the control deviation 244a is obtained. can get.
  • the control deviation 244a is input to the control deviation correction means 250 of the dead time compensator 245 by the disturbance observer and the fifth output value calculation means 251 of the correction means 246.
  • the dead time compensator 245 by the disturbance observer is composed of first output value calculation means 247, second output value calculation means 248, third output value calculation means 249, and control deviation correction means 250.
  • the first output value calculation means 247 is the reciprocal number (inverse model estimated value) of the estimated transfer function of the actuator 241 excluding the dead time, and is represented as the transfer function 1 / Gn (s).
  • the control amount y detected by the angle sensor 243 is input to the inverse model 1 / Gn (s) of the transfer function of the actuator 241 excluding the dead time, and the first output is calculated.
  • the value 247a is obtained.
  • the first output value 247a is input to the second output value calculation means 248.
  • the first output value 247a of the first output value calculation means 247 is subtracted from the operation amount U (s) output from the PID controller 242 to obtain a second output value. 248a is obtained.
  • the second output value 248a is input to the third output value calculation means 249.
  • the third output value calculation means 249 is expressed as an estimated transfer function Gn (s) of the actuator 241 excluding the dead time.
  • the second output value 248a is input to the transfer function Gn (s) of the actuator 241 excluding the dead time, and the third output value 249a is obtained.
  • the third output value 249a is input to the control deviation correction unit 250.
  • control deviation correcting means 250 the third output value 249a is subtracted from the control deviation 244a to obtain a corrected control deviation 250a.
  • the corrected control deviation 250a is input to the PID controller 242.
  • the dead time included in the actuator 241 can be treated as a disturbance, and the dead time can be driven out of the feedback loop. Therefore, the control gain of the PID controller 242 can be set large, so that the control can be performed stably and the responsiveness of the control amount y can be improved.
  • the dead time of the actuator 241 is not included in the control parameters of the dead time compensator 245, when the dead time of the actuator 241 changes due to aging or the like, or when there is an error in modeling the dead time. Even in such a case, the dead time of the actuator 241 can be compensated, and the control can be performed stably.
  • the correction unit 246 includes a fifth output value calculation unit 251 and an operation amount correction unit 252.
  • the fifth output value calculation means 251 is a PI controller and includes a proportional element that outputs a value proportional to the input value and an integral element that outputs a cumulative value of the input value.
  • the proportional gain is Kdist and the integral gain is Idist .
  • K dist and I dist are adjusted as appropriate.
  • the integral element of the actuator 241 is small, the proportional gain Kdist may be set to 0, and the fifth output value calculation unit 251 may be operated as an I controller.
  • the integral gain Idist May be set to 0, and the fifth output value calculating means 251 may be operated as a P controller.
  • the fifth output value 251 a serving as the calculated value is input to the operation amount correction unit 252.
  • the fifth output value 251a is added to the operation amount U (s) output from the PID controller 242 to obtain a corrected operation amount 252a.
  • the corrected operation amount 252a is input to the actuator 241 as the command voltage Vd.
  • the PID controller 242, the control deviation calculation means 244, the dead time compensator 245 by the disturbance observer, and the correction means 246 are constituted by a CPU, a ROM, a RAM, an HDD, etc., and are corrected using a predetermined program.
  • the deviation 250a and the corrected operation amount 252a may be calculated.
  • the feedback control device 240 may be configured as follows. That is, as shown in FIG. 26, the feedback control device 240 obtains the fourth output value 253a after inputting the third output value 249a to the high-pass filter that passes only the frequency component equal to or higher than the set frequency. Then, the fourth output value 253a is input to the control deviation correction unit 250. In the control deviation correction means 250, the fourth output value 253a is subtracted from the control deviation 244a to obtain a corrected control deviation 250a. The corrected control deviation 250 a is input to the PID controller 242. In the PID controller 242, the operation amount U (s) is obtained from the corrected control deviation 250a. Then, the operation amount U (s) is input to the actuator 241.
  • the tire speed S is controlled by operating the speed lever 237.
  • the proportional gain of the PID controller 242 is increased by 40 times compared to the case without the dead time compensator 245 by the disturbance observer (Sb). Even if it does not become unstable, the responsiveness of swash plate control can be improved.
  • FIG. 28 shows the result of swash plate control (speed control) for an arbitrary setting of ⁇ ( ⁇ 1 to ⁇ 5).
  • ⁇ 1 to ⁇ 5
  • FIG. 28A shows the case of only the PID controller 242 as shown in FIG. 28A (that is, without the dead time compensator 245 using the disturbance observer)
  • the swash plate control can be performed with the same inclination as the speed control limit value B.
  • the tire speed S is a response that is offset in the time direction with respect to the speed control limit value B, that is, a response that compensates for a delay in dead time. This is a feature of this control that controls the dead time by driving it out of the feedback loop.
  • the feedback control device 201 of the control target 202 including the dead time 204 is a detection unit 206 that detects the control amount y of the control target 202 and the transmission of the control target 202 except the dead time 204.
  • the first output value 211a is obtained from the first output value calculation means 211 for obtaining the first output value 211a by inputting the control amount y to the inverse model of the function and the operation amount U (s) of the control target 202.
  • the second output value 212a is obtained by inputting the second output value 212a into the transfer function of the control object 202 excluding the dead time 204 and the second output value calculation means 212 for obtaining the second output value 212a.
  • the control deviation correction means 214 for obtaining the corrected control deviation 214a by subtracting the third output value 213a from 07a, and the corrected control deviation 214a are inputted, and the operation amount U ( and a PID controller 205 serving as an operation amount calculation means for obtaining s).
  • the dead time 204 of the control target 202 can be compensated and the dead time 204 can be driven out of the feedback loop. Therefore, the control does not become unstable even when the control gain is increased. Therefore, the control gain y can be set large to improve the response of the control amount y.
  • the dead time 204 of the control target 202 is not included in the control parameters of the dead time compensator 210, the dead time 204 changes due to secular change or the like, or when there is an error in modeling the dead time 204. Even in such a case, the dead time 204 can be compensated for and stable control can be performed.
  • a fifth output value calculation means 221 for multiplying the control deviation 207a by a predetermined proportional gain or integrating the control deviation 207a for a predetermined time to obtain a fifth output value 221a, and the manipulated variable U (S) is added with the fifth output value 221a to obtain a corrected operation amount 222a, so that an actual model of the control target 202 is obtained due to secular change or the like. Even when there is a change or when an error occurs in the modeling of the controlled object 202, a steady deviation between the target value and the controlled variable does not occur.
  • the feedback control device is a feedback control device 201 of the control target 202 including the dead time 204, and includes a detection unit 206 that detects the control amount y of the control target 202, and a dead time.
  • the first output value calculation means 211 for obtaining the first output value 211a by inputting the control amount y to the inverse model of the transfer function of the control target 202 excluding 204, and the operation amount U ( s), the second output value is calculated by subtracting the first output value 211a to obtain the second output value 212a and the transfer function of the control object 202 excluding the dead time 204.
  • the third output value 213a is input to the third output value calculation means 213 that inputs the value 212a and obtains the third output value 213a and the filter that passes only a specific frequency component.
  • a control deviation correction unit 214 that obtains a corrected control deviation 214a by subtracting the fourth output value 215a from the control deviation 207a, and inputs the corrected control deviation 214a to operate the control target 202.
  • a PID controller 205 serving as an operation amount calculation means for obtaining the amount U (s).
  • the dead time 204 of the control target 202 can be compensated and the dead time 204 can be driven out of the feedback loop. Therefore, the control does not become unstable even when the control gain is increased. Therefore, the control gain y can be set large to improve the response of the control amount y.
  • the dead time 204 of the control target 202 is not included in the control parameters of the dead time compensator 210, the dead time 204 changes due to secular change or the like, or when there is an error in modeling the dead time 204. Even in such a case, the dead time 204 can be compensated for and stable control can be performed. Even when the actual model of the controlled object 202 changes due to secular change or the like, or when an error occurs in the modeling of the controlled object 202, a steady deviation between the target value y * and the controlled variable y does not occur.
  • the feedback control apparatus 201 inputs the control amount y of the controlled object 202 including the dead time 204 to the inverse model of the transfer function of the controlled object 202 excluding the dead time 204.
  • the first output value 211a is calculated, the first output value 211a is subtracted from the manipulated variable U (s) of the control target 202 to calculate the second output value 212a, and the second output value 212a is wasted.
  • the third output value 213a is calculated by inputting into the transfer function of the control object 202 excluding the time 204, and the corrected control deviation 214a is calculated by subtracting the third output value 213a from the control deviation 207a. Feedback control is performed based on the corrected control deviation 214a.
  • the dead time 204 of the control target 202 can be compensated and the dead time 204 can be driven out of the feedback loop. Therefore, the control does not become unstable even when the control gain is increased. Therefore, the control gain y can be set large to improve the response of the control amount y.
  • the dead time 204 of the control target 202 is not included in the control parameters of the dead time compensator 210, the dead time 204 changes due to secular change or the like, or when there is an error in modeling the dead time 204. Even in such a case, the dead time 204 can be compensated for and stable control can be performed.
  • the feedback control apparatus 201 inputs the control amount y of the controlled object 202 including the dead time 204 to the inverse model of the transfer function of the controlled object 202 excluding the dead time 204.
  • the first output value 211a is calculated, the first output value 211a is subtracted from the manipulated variable U (s) of the control target 202 to calculate the second output value 212a, and the second output value 212a is wasted.
  • the third output value 213a is calculated by inputting it into the transfer function of the control object 202 excluding the time 204, and the third output value 213a is input to a filter that allows only a specific frequency component to pass through to be the fourth output value.
  • 215a is calculated, the fourth output value 215a is subtracted from the control deviation 207a, the corrected control deviation 214a is calculated, and the feed is performed based on the corrected control deviation 214a.
  • Tsu is intended to perform a click control.
  • the dead time 204 of the control target 202 can be compensated and the dead time 204 can be driven out of the feedback loop. Therefore, the control does not become unstable even when the control gain is increased. Therefore, the control gain y can be set large to improve the response of the control amount y.
  • the dead time 204 of the control target 202 is not included in the control parameters of the dead time compensator 210, the dead time 204 changes due to secular change or the like, or when there is an error in modeling the dead time 204. Even in such a case, the dead time 204 can be compensated for and stable control can be performed. Even when the actual model of the controlled object 202 changes due to secular change or the like, or when an error occurs in the modeling of the controlled object 202, a steady deviation between the target value y * and the controlled variable y does not occur.
  • the present invention can be applied to a vehicle technology that can steer four wheels independently, and more specifically, to a control technology for steering the four wheels based on an operation tool. It is possible to use.

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Power Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

 容易に任意の方向に平行移動することが可能な車両を提供することを課題とし、車両において、2つの前輪及び2つの後輪からなる車輪と、前記車輪にそれぞれ連結され、前記車輪を操舵する4つの操舵用アクチュエータと、前記車輪にそれぞれ連結され、前記車輪を駆動する4つの駆動用アクチュエータと、任意の方向に傾倒されることで操作可能であり、前記操舵用アクチュエータの動作を指示するジョイスティック64と、前記駆動用アクチュエータの動作を指示するアクセルペダル63と、ジョイスティック64が傾倒された場合、ジョイスティック64が傾倒された方向に前記車輪を操舵するとともに、アクセルペダル63が操作された場合、アクセルペダル63の操作量に基づいて前記車輪を駆動するコントローラ100と、を具備させる。

Description

車両及びフィードバック制御方法
 本発明は、四輪を独立して操舵することが可能な車両の技術に関し、より詳細には、操作具に基づいて前記四輪を操舵するための制御の技術に関する。
 従来、四輪を独立して操舵することが可能な車両の技術は公知となっている。このような車両の技術としては、特許文献1に記載の車両が知られている。
 特許文献1に記載の車両は、通常モード、平行移動モード、又は回転モードのうちいずれか一のモードを選択するモード選択手段と、移動方向を選択する方向選択手段と、を具備するものである。
 前記モード選択手段によって通常モードが選択された場合、ステアリングの操作により前記車両の前輪のみが操舵される。
 また、前記モード選択手段によって回転モードが選択された場合、前輪の前側が互いに近接するように、後輪の前側が互いに離間するように、それぞれ操舵される。この状態で、各車輪を所定の方向に駆動することによって、前記車両は所定の旋回中心周りに旋回することができる。
 そして、前記モード選択手段によって平行移動モードが選択された場合、方向選択手段によって選択された方向に前記車両の四輪が操舵される。従って、前記車両は当該選択された方向に平行移動することができる。
 しかし、特許文献1に記載の車両は、平行移動モードにおいて、所定の方向(例えば8方向)に平行移動することはできても、その他の任意の方向に平行移動することはできず、所望の方向に平行移動するためには、前記所定の方向への平行移動を交互に繰り返すことによって移動するしかない点で不利であった。
特開2008-13045号公報
 本発明は、以上の如き状況を鑑みてなされたものであり、容易に任意の方向に平行移動することが可能な車両を提供するものである。
 本発明の解決しようとする課題は以上の如くであり、次にこの課題を解決するための手段を説明する。
 即ち、本発明においては、
 2つの前輪及び2つの後輪からなる車輪と、
 前記車輪にそれぞれ連結され、前記車輪を操舵する操舵用アクチュエータと、
 前記車輪にそれぞれ連結され、前記車輪を駆動する駆動用アクチュエータと、
 任意の方向に傾倒されることで操作可能であり、前記操舵用アクチュエータの動作を指示する第一操舵用操作具と、
 前記駆動用アクチュエータの動作を指示する駆動用操作具と、
 前記第一操舵用操作具が傾倒された場合、前記第一操舵用操作具が傾倒された方向に前記車輪を操舵するとともに、前記駆動用操作具が操作された場合、前記駆動用操作具の操作量に基づいて前記車輪を駆動する制御手段と、
 を具備するものである。
 本発明においては、
 前記第一操舵用操作具は、
 任意の方向に捩られることで操作可能であり、
 前記制御手段は、
 前記第一操舵用操作具が傾倒されない状態で捩られた場合、所定の第一旋回中心周りを前記第一操舵用操作具が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵するものである。
 本発明においては、
 前記制御手段は、
 前記第一操舵用操作具が捩られた状態で傾倒された場合、前記第一操舵用操作具の傾斜方向及び傾斜角度に基づいて第二旋回中心を決定し、前記第二旋回中心周りを前記第一操舵用操作具が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵するものである。
 本発明においては、
 前記前輪に連結された前記操舵用アクチュエータの動作を指示する第二操舵用操作具と、
 前記第二操舵用操作具の操作量に基づいて定められる旋回中心周りを旋回することが可能な前記前輪の操舵角を算出し、前記前輪の操舵角が算出された操舵角となるように前記前輪に連結された前記操舵用アクチュエータを動作させる制御手段と、
 を具備するものである。
 本発明においては、
 前記操舵用アクチュエータは、
 前記前輪を90度以上操舵することが可能なものである。
 本発明においては、
 前記制御手段は、
 前記第二操舵用操作具の操作量及び前記駆動用操作具の操作量に基づいて、前記車輪が路面に対して滑ることなく前記旋回中心周りを旋回することが可能な前記車輪の速度を算出し、前記車輪の速度が算出した速度となるように前記駆動用アクチュエータを動作させるものである。
 本発明においては、
 前記制御手段は、
 前記算出した速度が、所定の値を超えないように制限するものである。
 本発明においては、
 入力に対する応答までの遅れ時間であるむだ時間を含む制御対象の制御量を、むだ時間を除いた前記制御対象の伝達関数の逆モデルに入力して第一出力値を演算し、
 前記第一出力値を、前記制御対象の操作量から減算して第二出力値を演算し、
 前記第二出力値を、むだ時間を除いた前記制御対象の伝達関数に入力して第三出力値を演算し、
 前記第三出力値を、制御偏差から減算して補正された制御偏差を演算し、
 前記補正された制御偏差に基づいてフィードバック制御を行うものである。
 本発明においては、
 入力に対する応答までの遅れ時間であるむだ時間を含む制御対象の制御量を、むだ時間を除いた前記制御対象の伝達関数の逆モデルに入力して第一出力値を演算し、
 前記第一出力値を、前記制御対象の操作量から減算して第二出力値を演算し、
 前記第二出力値を、むだ時間を除いた前記制御対象の伝達関数に入力して第三出力値を演算し、
 前記第三出力値を、特定の周波数成分のみを通過させるフィルタに入力して第四出力値を演算し、
 前記第四出力値を、制御偏差から減算して補正された制御偏差を演算し、
 前記補正された制御偏差に基づいてフィードバック制御を行うものである。
 本発明の効果として、以下に示すような効果を奏する。
 本発明は、操舵用操作具を所望の方向に傾倒させるだけで、複数の車輪を当該方向に操舵することができる。この状態で駆動用操作具を操作することにより、当該方向に車両を走行させることができる。従って、簡易な操作により、容易に任意の方向に車両を平行移動させることが可能となる。
 本発明は、操舵用操作具を所望の方向に捩るだけで、所定の第一旋回中心周りを前記操舵用操作具が捩られた回転方向へ旋回可能となる向きに、車輪を操舵することができる。この状態で駆動用操作具を操作することにより、当該方向に車両を旋回させることができる。従って、簡易な操作により、容易に所定の第一旋回中心周りを旋回することが可能となる。
 本発明は、操舵用操作具を捩りながら所望の方向に傾倒させるだけで、第二旋回中心を任意に調節することができ、前記第二旋回中心周りを前記操舵用操作具が捩られた回転方向へ旋回可能となる向きに、車輪を操舵することができる。この状態で駆動用操作具を操作することにより、当該方向に車両を旋回させることができる。従って、簡易な操作により、容易に任意の第二旋回中心周りを旋回することが可能となる。
 本発明は、容易に任意の旋回中心周りを旋回することができる。また、2つの前輪を独立して操舵することができるため、2つの前輪の操舵角が機械的に制限されることがなく、小さな旋回半径で旋回を行うことができる。
 本発明は、前輪を90度以上操舵することで、車体幅の内側の位置を旋回中心として旋回(信地旋回)することや、車体幅の中央の位置を旋回中心として旋回(超信地旋回)することができる。
 本発明は、駆動用操作具の操作量に基づいて、駆動輪が路面に対して滑ることがないように、前記駆動輪の速度を調節することができる。従って、旋回する際に路面(芝や圃場等)を痛めることなく、また前記駆動輪の損傷も防止しつつ、超信地旋回を安定して行うことができる。
 本発明は、算出された速度を所定の値以下に制限することにより、駆動用アクチュエータの過回転による不具合の発生を防止することができる。
 本発明は、むだ時間を含む制御対象のフィードバック制御において、制御対象のむだ時間を補償して、フィードバックループの外にむだ時間を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量の応答性を良好にすることができる。また、制御対象のむだ時間がむだ時間補償器の制御パラメータに含まれないため、経年変化等でむだ時間が変化した場合や、むだ時間のモデル化に誤差が生じた場合であっても、むだ時間を補償することができ、安定して制御を行うことができる。
 本発明は、むだ時間を含む制御対象のフィードバック制御において、制御対象のむだ時間を補償して、フィードバックループの外にむだ時間を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量の応答性を良好にすることができる。また、制御対象のむだ時間がむだ時間補償器の制御パラメータに含まれないため、経年変化等でむだ時間が変化した場合や、むだ時間のモデル化に誤差が生じた場合であっても、むだ時間を補償することができ、安定して制御を行うことができる。また、経年変化等で制御対象の実モデルが変化した場合や、制御対象のモデル化に誤差が生じた場合であっても、目標値と制御量の定常偏差が発生しない。
本発明の一実施例に係る車両の全体的な構成を示した斜視図。 左前輪機構を示した斜視図。 車両の制御に関する構成を示した概略図。 通常操舵モードにおける操舵の様子を示した概略図、(a)右方向へ操舵した様子を示した概略図、(b)左方向へ操舵した様子を示した概略図。 車両の旋回半径と、前輪の操舵角及び各車輪の速度と、の関係を示した概略図。 旋回半径と前輪の操舵角との関係を表したマップの一例を示す図。 旋回半径と各車輪速度係数との関係を表したマップの一例を示す図。 ステアリングの回動角と前輪の操舵角との関係を表した操舵角マップを示す図。 ステアリングの回動角と各車輪速度係数との関係を表した車輪速度係数マップを示す図。 コントローラによる各操舵モータ及び各駆動モータの制御態様を示す概略図。 特殊操舵モードにおける平行移動の様子を示した概略図、(a)右前方への平行移動の様子を示した概略図、(b)右方への平行移動の様子を示した概略図。 特殊操舵モードにおける所定の旋回中心周りの旋回の様子を示した概略図、(a)時計回りに旋回する様子を示した概略図、(b)反時計回りに旋回する様子を示した概略図。 特殊操舵モードにおける任意の旋回中心周りの旋回の様子を示した概略図、(a)ジョイスティックを右方に傾倒させた場合の概略図、(b)ジョイスティックを右方に大きく傾倒させた場合の概略図。 特殊操舵モードにおける任意の旋回中心周りの旋回の様子を示した概略図、(a)ジョイスティックを左方に傾倒させた場合の概略図、(b)ジョイスティックを左方に大きく傾倒させた場合の概略図。 本発明の一実施形態に係るフィードバック制御装置を示すブロック線図。 本発明の一実施形態に係るフィードバック制御方法を示すフローチャート。 (a)本発明の他の実施形態に係るフィードバック制御装置を示すブロック線図。(b)本発明の他の実施形態に係るフィードバック制御装置201を示すブロック線図。 本発明の他の実施形態に係るフィードバック制御方法を示すフローチャート。 (a)むだ時間を含む制御対象に対してPID制御を用いた時のブロック線図。(b)(a)を等価変換したときのブロック線図。 (a)外乱を推定するブロック線図。(b)フィードバックループからむだ時間を追い出したブロック線図。 (a)smithのむだ時間補償で、Lが変化した時の応答を示すグラフ。(b)外乱オブザーバによるむだ時間補償で、Lが変化した時の応答を示すグラフ。 (a)本発明の一実施形態に係るモデルの誤差を考慮した外乱オブザーバによるむだ時間補償器を示すブロック線図。(b)本発明の他の実施形態に係るモデルの誤差を考慮した外乱オブザーバによるむだ時間補償器を示すブロック線図。 (a)モデルの誤差がない場合における定常偏差を示すグラフ。(b)モデルの誤差が50%の場合における定常偏差を示すグラフ。(c)モデルの誤差が50%であって、補償がある場合における定常偏差を示すグラフ。 フィードバック制御装置を、HSTの斜板制御に適用した場合における全体のシステム図。 フィードバック制御装置を示すブロック線図。 フィードバック制御装置を示すブロック線図。 外乱オブザーバによる斜板制御の性能を示すグラフ。 (a)μ制限時の斜板制御結果を示すグラフであって、外乱オブザーバによるむだ時間補償器がない時のグラフ。(b)μ制限時の斜板制御結果を示すグラフであって、外乱オブザーバによるむだ時間補償器がある時のグラフ。 (a)従来のむだ時間を含む制御対象に対してPID制御を用いた時のブロック線図。(b)図29(a)のPID制御器の制御ゲインを大きく設定したときの目標値と制御量を示すグラフ。(c)図29(a)のPID制御器の制御ゲインを小さく設定したときの目標値と制御量を示すグラフ。 (a)従来のsmithのむだ時間補償器を用いてむだ時間を補償したときのブロック線図。(b)図30(a)を等価変換したときのブロック線図。(c)smithのむだ時間補償器の制御パラメータに誤差が生じた場合における目標値と制御量を示すグラフ。
 1   車両
 21  左前輪(前輪、車輪)
 22  左前輪駆動モータ(駆動用アクチュエータ)
 23  左前輪操舵モータ(操舵用アクチュエータ)
 31  右前輪(前輪、車輪)
 32  右前輪駆動モータ(駆動用アクチュエータ)
 33  右前輪操舵モータ(操舵用アクチュエータ)
 41  左後輪(後輪、車輪)
 42  左後輪駆動モータ(駆動用アクチュエータ)
 43  左後輪操舵モータ(操舵用アクチュエータ)
 51  右後輪(後輪、車輪)
 52  右後輪駆動モータ(駆動用アクチュエータ)
 53  右後輪操舵モータ(操舵用アクチュエータ)
 62  ステアリングホイール(第二操舵用操作具)
 63  アクセルペダル(駆動用操作具)
 64  ジョイスティック(第一操舵用操作具)
 65  切り換えスイッチ
 100 コントローラ(制御手段)
 以下では、本発明に係る車両の実施の一形態である車両1について説明する。なお、本発明に係る車両は、本実施形態に係る車両1に限るものではなく、建設車両や農業車両、産業車両等の種々の車両であってもよい。
 図1に示すように、車両1は、電動機により発生される動力により走行するものである。車両1は、車両本体10、左前輪機構20、右前輪機構30、左後輪機構40、右後輪機構50、操作部60、コントローラ100(図3参照)を具備する。
 車両本体10は、車両1の主たる構造体を成すものである。車両本体10は板材やパイプ部材等を組み合わせて構成される。車両本体10には、車両1が具備する各部材へ電力を供給するキャパシタ等が配置される。
 図1から図3までに示すように、左前輪機構20は、車両1を任意の方向に走行させるためのものである。左前輪機構20は、車両本体10の左前端の下部に配置される。左前輪機構20は、主として左前輪21、左前輪駆動モータ22、左前輪操舵モータ23を具備する。
 左前輪21は、前輪の実施の一形態であり、車両本体10を支持するとともに、回転駆動されることにより車両本体10を移動させるものである。
 図2及び図3に示すように、左前輪駆動モータ22は、駆動用アクチュエータの実施の一形態であり、左前輪21を回転駆動させるものである。左前輪駆動モータ22の出力軸(図示せず)は、左前輪21に連結される。左前輪駆動モータ22の駆動力は、左前輪駆動モータ22の出力軸を介して左前輪21に伝達され、当該駆動力により左前輪21が回転駆動される。
 左前輪操舵モータ23は、操舵用アクチュエータの実施の一形態であり、左前輪21を操舵するものである。左前輪操舵モータ23の出力軸(図示せず)は鉛直下方に向けて配置され、図示せぬ減速機構を介してブラケット23a(図2参照)の上端に連結される。ブラケット23aの下端は、左前輪21及び左前輪駆動モータ22に連結される。左前輪操舵モータ23の駆動力は、左前輪操舵モータ23の出力軸及び前記減速機構を介してブラケット23aに伝達される。当該駆動力によりブラケット23aが鉛直方向の軸心周りに回動する。当該ブラケット23aとともに左前輪21及び左前輪駆動モータ22が車両本体10に対して一体的に回動することによって、左前輪21が操舵される。
 図1及び図3に示すように、右前輪機構30は、車両1を任意の方向に走行させるためのものである。右前輪機構30は、車両本体10の右前端の下部に配置される。右前輪機構30は、主として右前輪31、右前輪駆動モータ32、右前輪操舵モータ33を具備する。右前輪31は前輪の実施の一形態であり、右前輪駆動モータ32は駆動用アクチュエータの実施の一形態であり、右前輪操舵モータ33は操舵用アクチュエータの実施の一形態である。なお、右前輪機構30の構成及び動作態様は、左前輪機構20と略同一であるため、説明は省略する。
 上記の如く、左前輪21及び右前輪31は、それぞれ左前輪操舵モータ23及び右前輪操舵モータ33によって操舵される。すなわち、左前輪21及び右前輪31の操舵角は、互いに機械的に制限されることがないため、それぞれ任意の操舵角に操舵することができる。また、左前輪操舵モータ23及び右前輪操舵モータ33によって左前輪21及び右前輪31をそれぞれ操舵することで、各前輪を、操舵角が90度以上となるまで操舵することができる。
 左後輪機構40は、車両1を任意の方向に走行させるためのものである。左後輪機構40は、車両本体10の左後端の下部に配置される。左後輪機構40は、主として左後輪41、左後輪駆動モータ42、左後輪操舵モータ43を具備する。左後輪駆動モータ42は駆動用アクチュエータの実施の一形態であり、左後輪操舵モータ43は操舵用アクチュエータの実施の一形態である。なお、左後輪機構40の構成及び動作態様は、左前輪機構20と略同一であるため、説明は省略する。
 右後輪機構50は、車両1を任意の方向に走行させるためのものである。右後輪機構50は、車両本体10の右後端の下部に配置される。右後輪機構50は、主として右後輪51、右後輪駆動モータ52、右後輪操舵モータ53を具備する。右後輪駆動モータ52は駆動用アクチュエータの実施の一形態であり、右後輪操舵モータ53は操舵用アクチュエータの実施の一形態である。なお、右後輪機構50の構成及び動作態様は、左前輪機構20と略同一であるため、説明は省略する。
 以下では、説明の便宜上、左前輪21及び右前輪31を総称して単に「前輪」と、左後輪41及び右後輪51を総称して単に「後輪」と、左前輪21、右前輪31、左後輪41、及び右後輪51を総称して単に「各車輪」と記す。また、左前輪駆動モータ22、右前輪駆動モータ32、左後輪駆動モータ42、及び右後輪駆動モータ52を総称して単に「各駆動モータ」と、左前輪操舵モータ23、右前輪操舵モータ33、左後輪操舵モータ43、及び右後輪操舵モータ53を総称して単に「各操舵モータ」と、それぞれ記す。
 図1に示すように、操作部60は、オペレータが乗車し、車両1の操作を行うための空間である。操作部60は、車両本体10の前後略中央部に配置される。操作部60は、主として座席61、ステアリングホイール62、アクセルペダル63、ジョイスティック64、切り換えスイッチ65を具備する。
 座席61は、オペレータが着座するものである。座席61は、操作部60の後部に配置される。
 ステアリングホイール62は、第二操舵用操作具の実施の一形態であり、車両1を操舵するための操作具である。ステアリングホイール62は、略円形に形成され、オペレータにより回動操作される。ステアリングホイール62は、操作部60の前部であって、座席61に着座したオペレータが操作可能な位置に配置される。
 アクセルペダル63は、駆動用操作具の実施の一形態であり、車両1を走行させるための操作具である。アクセルペダル63は、操作部60の前部、かつステアリングホイール62の下方であって、座席61に着座したオペレータが足によって操作可能な位置に配置される。
 ジョイスティック64は、第一操舵用操作具の実施の一形態であり、車両1を操舵するための操作具である。ジョイスティック64は、座席61の側方であって、座席61に着座したオペレータが操作可能な位置に配置される。ジョイスティック64は、その下部を回動可能に支持され、その上部を任意の方向に向かって傾倒させること、及びその長手方向を軸心として回動させる(捩る)ことで操作される。
 切り換えスイッチ65は、ステアリングホイール62又はジョイスティック64のいずれか一方を、車両1を操舵するための操作具として選択するものである。切り換えスイッチ65は、座席61の側方であって、座席61に着座したオペレータが操作可能な位置に配置される。本実施形態においては、切り換えスイッチ65はジョイスティック64の近傍に配置される。本実施形態に係る切り換えスイッチ65は、押しボタン式のスイッチにより構成するものとするが、本発明はこれに限るものではなく、トグルスイッチやスライドスイッチ等の種々のスイッチにより構成することも可能である。
 図3に示すように、コントローラ100は、制御手段の実施の一形態であり、各操作具の操作に基づいて、各車輪の駆動及び操舵を制御するものである。コントローラ100は、車両本体10の適宜の位置に配置される。コントローラ100は、具体的にはCPU、ROM、RAM、HDD等がバスで接続される構成であってもよく、あるいはワンチップのLSI等からなる構成であってもよい。コントローラ100には、各車輪の駆動及び操舵を制御するための種々のプログラム及びデータが格納され、当該プログラム等に基づいて各車輪の駆動及び操舵を制御する。コントローラ100は、主としてアクセル操作量検出センサ101、ステアリング操作量検出センサ102、ジョイスティック操作量検出センサ103、切り換えスイッチ65、各駆動モータ、各操舵モータに接続される。
 アクセル操作量検出センサ101は、アクセルペダル63の操作量A、より詳細には、オペレータにより回動されるアクセルペダル63の回動角度を検出するものである。コントローラ100は、アクセル操作量検出センサ101によるアクセルペダル63の操作量Aの検出信号を取得することができる。また、コントローラ100は、アクセルペダル63の操作量Aに基づいて、車両1の目標となる速度である目標速度vを算出することができる。
 ステアリング操作量検出センサ102は、ステアリングホイール62の操作量、より詳細には、オペレータにより回動されるステアリングホイール62の回動角θを検出するものである。コントローラ100は、ステアリング操作量検出センサ102によるステアリングホイール62の回動角θの検出信号を取得することができる。ここで、ステアリングホイール62の回動角θの値が定まれば、車両1が旋回する際の旋回半径rの値が定まる。本実施形態において、旋回半径rとは、旋回中心Zから、左後輪41と右後輪51との中間点までの距離をいう(図5参照)。
 ジョイスティック操作量検出センサ103は、ジョイスティック64の操作量、より詳細には、ジョイスティック64がオペレータにより傾倒される際の傾斜方向及び傾斜角度、並びにオペレータにより回動される(捩られる)際の回動方向を検出するものである。コントローラ100は、ジョイスティック操作量検出センサ103によるジョイスティック64の操作量の検出信号を取得することができる。
 コントローラ100は、切り換えスイッチ65に接続され、切り換えスイッチ65が操作された旨の検出信号を取得することができる。
 コントローラ100は、各駆動モータに接続され、当該各駆動モータの駆動、より詳細には各駆動モータの回転方向及び回転数を制御することができる。当該制御によって、コントローラ100は各車輪の駆動を制御することができ、ひいては、車両1を任意の速度で走行させることができる。
 コントローラ100は、各操舵モータに接続され、当該各操舵モータの駆動、より詳細には各操舵モータの回転方向及び回転数を制御することができる。当該制御によって、コントローラ100は各車輪の操舵を制御することができ、ひいては、車両1を任意の方向に操舵することができる。
 上述の如く構成された車両1において、コントローラ100は、オペレータによる切り換えスイッチ65の操作に基づいて、ステアリングホイール62又はジョイスティック64のいずれか一方を、車両1を操舵するための操作具として選択する。切り換えスイッチ65によりステアリングホイール62が選択された場合(以下、この場合を単に「通常操舵モード」と記す)、コントローラ100は、当該ステアリングホイール62の操作に基づいて、各車輪の操舵を制御することができる。切り換えスイッチ65によりジョイスティック64が選択された場合(以下、この場合を単に「特殊操舵モード」と記す)、コントローラ100は、当該ジョイスティック64の操作に基づいて、各車輪の操舵を制御することができる。
 また、コントローラ100は、アクセルペダル63の操作に基づいて、各車輪の駆動を制御することができる。より詳細には、アクセルペダル63が操作された場合、各車輪を駆動させ、アクセルペダル63の操作量が大きくなるにつれて、各車輪の回転速度が大きくなるように制御する。
 以下では、コントローラ100による各車輪の制御態様について説明する。
 まず、切り換えスイッチ65により通常操舵モードが選択された場合について説明する。通常操舵モードにおいては、ステアリングホイール62を操作することによって車両1が操舵される。
 図4に示すように、通常操舵モードにおいて、ステアリングホイール62が時計回りに回動された場合、左前輪21及び右前輪31は右方向に操舵される。より詳細には、左前輪21及び右前輪31は、同心円上を旋回できるように各々独立して操舵される。この状態でアクセルペダル63を操作することにより、車両1は右前方に向かって旋回することができる。
 ステアリングホイール62が反時計回りに回動された場合、左前輪21及び右前輪31は左方向に操舵される。より詳細には、左前輪21及び右前輪31は、同心円上を旋回できるように各々独立して操舵される。この状態でアクセルペダル63を操作することにより、車両1は左前方に向かって旋回することができる。
 上記の如く、通常操舵モードにおいては、ステアリングホイール62の操作に基づいて車両1の前輪(左前輪21及び右前輪31)を操舵することができる。すなわち、一般的な自動車と同様の操作感覚で、車両1を走行させることができる。
 以下では、切り換えスイッチ65により通常操舵モードが選択された場合について、より詳細に説明する。
 従来、左右一対の車輪を独立して操舵することが可能な車両の技術は公知となっている。
 このような車両の具体例としては、一対の主駆動輪(後輪)と、前記一対の主駆動輪を個々に駆動する一対の油圧伝動装置と、前記一対の油圧伝動装置を個々に操作する一対の操作レバーと、を具備するものである。
 このような構成において、前記車両は、前記一対の操作レバーを相反する方向に操作することで、前記一対の主駆動輪を相反する方向に駆動させることができる。従って、前記車両は、主駆動輪の左右中間点を旋回中心として旋回(超信地旋回)することができる。
 しかし、前記車両は、前記一対の操作レバーを各個操作して旋回する必要があるため、操作が煩雑である点で不利であった。
 そこで、簡易な操作により、超信地旋回を行うことが可能な車両1を提供する。
 上述の如く構成された車両1において、コントローラ100は、ステアリングホイール62の操作に基づいて、前輪の操舵を各々独立して制御することができる。また、コントローラ100は、アクセルペダル63の操作に基づいて、各車輪の駆動を各々独立して制御することができる。
 ここで、上述の如く、切り換えスイッチ65により通常操舵モードが選択された場合、車両1は前輪のみを操舵して旋回するものである。従って、図5に示すように、旋回中心Zは左後輪41の接地点と右後輪51の接地点とを結ぶ直線上に位置することになり、ステアリングホイール62の回動角θに基づいて旋回半径rが算出されれば、当該算出された旋回半径rに基づいて、旋回中心Zの位置が定められる。
 以下では、図5から図9までを用いて、車両1が旋回半径rで旋回する場合における、前輪の操舵角及び各車輪の速度の算出方法について説明する。
 図5に示すように、車両1が旋回半径rで滑らかに旋回するためには、旋回時における左前輪21と右前輪31との軌跡が同心円を描く必要がある。このための左前輪21の操舵角δFL及び右前輪31の操舵角δFRは、以下の数1及び数2に示す関係式でそれぞれ表される。
Figure JPOXMLDOC01-appb-M000001
Figure JPOXMLDOC01-appb-M000002
 ここで、Tは車両1のトレッド(左前輪21の中心と右前輪31の中心との間の距離)を表し、Wは車両1のホイールベース(前輪と後輪との間の距離)を表す。なお、本実施形態において、前輪のトレッドTと後輪のトレッドTは同一である。
 また、上述の如く車両1は前輪のみを操舵するため、左後輪41及び右後輪51の操舵角は、いずれも0である。
 数1及び数2からも分かるように、トレッドT及びホイールベースWは車両1の諸元により予め定められる値であるため、目標となる旋回半径rが定まれば、当該旋回半径rに基づいて操舵角δFL及び操舵角δFRが算出される。
 図6には、車両1を左方へ旋回させる場合(図5参照)の、旋回半径rと操舵角δFL及び操舵角δFRとの関係を表したマップの一例を示す。図6の横軸(旋回半径r)は対数軸である。旋回半径rが小さくなるにつれて操舵角δFL及び操舵角δFRは大きくなり、旋回半径rが大きくなるにつれて操舵角δFL及び操舵角δFRは小さくなることが分かる。また、旋回方向内側に位置する左前輪21の操舵角δFLは、旋回方向外側に位置する右前輪31の操舵角δFRよりも大きくなることが分かる。このようなマップを用いることにより、旋回半径rから前輪の操舵角を算出することができる。
 また、車両1(車両本体10)が速度vで旋回する際に、各車輪が地面に対して滑ることなく旋回するためには、各車輪の速度をそれぞれ最適な値に決定する必要がある。このための各車輪の速度は、旋回半径rが(1)T/2≦rである場合と、(2)0<r≦T/2である場合と、に分けて以下の関係式でそれぞれ表される。なお、左前輪21の速度をvFLと、右前輪31の速度をvFRと、左後輪41の速度をvRLと、右後輪51の速度をvRRと、それぞれ表す。また、各車輪の速度とは、各車輪の接地面に対する速度を表す(図5参照)。
 前記(1)T/2≦rである場合、すなわち、旋回中心Zが後輪の幅の外側に位置する場合における各車輪の速度は、以下の数3から数6までに示す関係式でそれぞれ表される。
Figure JPOXMLDOC01-appb-M000003
Figure JPOXMLDOC01-appb-M000004
Figure JPOXMLDOC01-appb-M000005
Figure JPOXMLDOC01-appb-M000006
 前記(2)0<r≦T/2である場合、すなわち、旋回中心Zが後輪の内側に位置する場合における各車輪の速度は、以下の数7から数10までに示す関係式でそれぞれ表される。
Figure JPOXMLDOC01-appb-M000007
Figure JPOXMLDOC01-appb-M000008
Figure JPOXMLDOC01-appb-M000009
Figure JPOXMLDOC01-appb-M000010
 数3から数10までからも分かるように、トレッドT及びホイールベースWは車両1の諸元により予め定められる値であるため、目標となる車両本体10の速度vが定まれば、当該速度vに基づいて各車輪の速度(vFL、vFR、vRL、及びvRR)は算出される。
 ここで、一般化された係数である各車輪速度係数(左前輪速度係数CFL、右前輪速度係数CFR、左後輪速度係数CRL、及び右後輪速度係数CRR)及びアクセルペダル63の操作量Aに基づいて算出される目標速度vを用いると、各車輪の速度は以下の数11から数14までに示す関係式でそれぞれ表される。
Figure JPOXMLDOC01-appb-M000011
Figure JPOXMLDOC01-appb-M000012
Figure JPOXMLDOC01-appb-M000013
Figure JPOXMLDOC01-appb-M000014
 旋回半径rが定まれば、各車輪速度係数同士の比は定められる。また、数11から数14までからも分かるように、各車輪速度係数及び目標速度vが定まれば、各車輪の速度が算出される。
 図7には、車両1を左方へ旋回させる場合(図5参照)の、旋回半径rと各車輪速度係数(左前輪速度係数CFL、右前輪速度係数CFR、左後輪速度係数CRL、及び右後輪速度係数CRR)との関係を表したマップの一例を示す。図7の横軸(旋回半径r)は対数軸である。
 図7は、右前輪速度係数CFRが常に1となるように設定した場合を示している。旋回半径rが定まれば、右前輪速度係数CFRに対する他の車輪速度係数(左前輪速度係数CFL、左後輪速度係数CRL、及び右後輪速度係数CRR)の比も定まるため、旋回半径rと各車輪速度係数との関係は図7に示すような関係になる。数12からも分かるように、右前輪速度係数CFRが常に1となるように設定した場合、右前輪31の速度vFRは常に目標速度vになる。このようなマップ及び数11から数14までを用いることにより、旋回半径rから各車輪の速度を算出することができる。
 ここまでは、旋回半径rと、図6及び図7に例示するようなマップと、に基づいて前輪の操舵角及び各車輪速度係数を算出する方法を説明してきた。しかし、旋回半径rはステアリングホイール62の回動角θに基づいて定まるため、実際には旋回半径rではなく回動角θに基づいて、前輪の操舵角及び各車輪速度係数が算出されることになる。この場合の、ステアリングホイール62の回動角θと操舵角δFL及び操舵角δFRとの関係を表したマップの一例(以下、単に「操舵角マップM1」と記す)を図8に、ステアリングホイール62の回動角θと各車輪速度係数との関係を表したマップの一例(以下、単に「車輪速度係数マップM2」と記す)を図9に、それぞれ示す。
 図8に示す操舵角マップM1においては、ステアリングホイール62を左方へ回動させる場合、すなわち、前輪を左方へ操舵させる場合の操舵角δFL及び操舵角δFRを正の値として、ステアリングホイール62を右方へ回動させる場合、すなわち、前輪を右方へ操舵させる場合の操舵角δFL及び操舵角δFRを負の値として、それぞれ示している。このような操舵角マップM1を用いることにより、回動角θから前輪の操舵角を算出することができる。
 図9に示す車輪速度係数マップM2においては、ステアリングホイール62を左へ回動させた場合は右前輪速度係数CFRが常に1となるように、右へ回動させた場合は左前輪速度係数CFLが常に1となるように、それぞれ設定した場合を示している。このような車輪速度係数マップM2及び数11から数14までを用いることにより、回動角θから各車輪の速度を算出することができる。
 以下では、図8から図10までを用いて、コントローラ100による各駆動モータ及び各操舵モータの制御態様について説明する。
 図10に示すように、コントローラ100は、ステアリング操作量検出センサ102によって検出されるステアリングホイール62の回動角θを取得し、操舵角マップM1に基づいて当該回動角θに対応する操舵角δFL及び操舵角δFRをそれぞれ算出する。
 コントローラ100は、左前輪21及び右前輪31の操舵角δFL及び操舵角δFRが、操舵角マップM1に基づいて算出された操舵角δFL及び操舵角δFRとなるように、左前輪操舵モータ23及び右前輪操舵モータ33の駆動をそれぞれ制御する。
 このように、操舵角δFL及び操舵角δFRの値がそれぞれ操舵角マップM1に基づいて算出された値となるように制御することにより、旋回時における左前輪21と右前輪31との軌跡は同心円を描くことになり、車両1は旋回半径rで滑らかに旋回することができる。また、左前輪21及び右前輪31は、左前輪操舵モータ23及び右前輪操舵モータ33によって独立して操舵されるため、リンク機構等によってその操舵角(δFL及びδFR)が機械的に制限されることがない。このため、旋回中心Zが後輪の幅の内側に位置する場合であっても当該旋回中心Zの周りを旋回することができ、特に旋回中心Zが後輪の中間点に位置する場合であっても旋回(超信地旋回)することができる。
 また、コントローラ100は、アクセル操作量検出センサ101によって検出されるアクセルペダル63の操作量A及び操作量Aと目標速度vとの関係を示した適宜のマップM3に基づいて、目標速度vを算出する。
 コントローラ100は、ステアリングホイール62の回動角θを取得し、車輪速度係数マップM2に基づいて当該回動角θに対応する各車輪速度係数(CFL、CFR、CRL、及びCRR)をそれぞれ算出する。
 コントローラ100は、マップM3に基づいて算出された目標速度v及び車輪速度係数マップM2に基づいて算出された各車輪速度係数を用いて、数11から数14までに示す関係式から各車輪の速度(vFL、vFR、vRL、及びvRR)をそれぞれ算出する。
 コントローラ100は、各車輪の速度が、算出された速度(vFL、vFR、vRL、及びvRR)となるように、各駆動モータの駆動をそれぞれ制御する。
 このように、車輪速度係数マップM2に基づいて算出された各車輪速度係数を用いて各車輪の速度を算出し、当該算出された速度となるように各車輪の速度をそれぞれ制御することにより、各車輪は地面に対して滑ることなく旋回することができる。これによって、車両1が旋回する際に路面(芝や圃場等)を痛めることがなく、また、各車輪の路面との摩擦による損傷も防止することができる。
 また、本実施形態において、車輪速度係数マップM2は、ステアリングホイール62を左へ回動させた場合(左方へ旋回する場合)は右前輪速度係数CFRが常に1となるように、右へ回動させた場合(右方へ旋回する場合)は左前輪速度係数CFLが常に1となるように、それぞれ設定されている。すなわち、左方へ旋回する場合は右前輪31の速度vFRが常にvとなるように、右方へ旋回する場合は左前輪21の速度vFLが常にvとなるように、それぞれ制御される。
 ここで、車両1が左方へ旋回する場合、各車輪が描く円の半径のうち、右前輪31が描く円の半径が最も大きくなる(図5参照)。従って、各車輪の速度の中で、右前輪31の速度vFRが最も大きくなる。そこで、上述の如く右前輪31の速度vFRが常に目標速度vとなるように制御することによって、他の車輪の速度(vFL、vRL、及びvRR)を目標速度v以下に抑えることができる。このように、各車輪の速度を所定値(本実施形態においては、目標速度v)以下に抑えることで、各駆動モータの過回転による不具合(損傷等)の発生を防止することができる。例えば、各車輪を目標速度v以上で無理なく駆動することができる各駆動モータを選定することで、各駆動モータの過回転を防止することができる。
 車両1が右方へ旋回する場合、各車輪が描く円の半径のうち、左前輪21が描く円の半径が最も大きくなる。従って、各車輪の速度の中で、左前輪21の速度vFLが最も大きくなる。そこで、上述の左方へ旋回する場合と同様に、左前輪21の速度vFLが常に目標速度vとなるように制御することによって、各車輪の速度を所定値(本実施形態においては、目標速度v)以下に抑えることができ、各駆動モータの過回転による不具合(損傷等)の発生を防止することができる。
 なお、本実施形態において、各車輪速度係数は1を超えないように設定されるものとしたが、本発明はこれに限るものではなく、各車輪速度係数が1を超える値をとる構成とすることも可能である。例えば、車両本体10の速度が常に目標速度vとなるように構成すること等が可能である。
 また、本実施形態においては、各車輪を各駆動モータによって駆動する構成としたが、本発明はこれに限るものではない。例えば、前輪のみを駆動する構成や、後輪のみを駆動する構成、いずれか1つの車輪のみを駆動する構成とすることも可能である。
 ただし、後輪のうちいずれか1つのみを駆動する構成とした場合、当該車輪の接地点が旋回中心Zと一致した際には、駆動される車輪の速度が0となる。例えば、図9に示す車輪速度係数マップM2における、回動角θの際の左後輪速度係数CRLや、回動角θの際の右後輪速度係数CRRである。このような場合は、当該車輪のみ駆動する構成では車両1は走行できないため、後輪のうちいずれか1つのみを駆動する構成とすることはできない。
 以上の如く、本実施形態の車両1は、
 2つの前輪(左前輪21及び右前輪31)を含む複数の車輪と、
 前記前輪にそれぞれ連結され、前記前輪を操舵する操舵用アクチュエータ(左前輪操舵モータ23及び右前輪操舵モータ33)と、
 前記操舵用アクチュエータの動作を指示するステアリングホイール62と、
 ステアリングホイール62の回動角θに基づいて定められる旋回中心Z周りを旋回することが可能な前記前輪の操舵角(δFL及びδFR)をそれぞれ算出し、前記前輪の操舵角が算出された操舵角となるように前記操舵用アクチュエータを動作させるコントローラ100と、
 を具備するものである。
 このように構成することにより、ステアリングホイール62の回動操作という簡易な操作により、容易に任意の旋回中心Z周りを旋回することができる。また、前記2つの前輪を独立して操舵することができるため、前記2つの前輪の操舵角が機械的に制限されることがなく、小さな旋回半径で旋回を行うことができる。さらに、ステアリングホイール62の回動操作の感覚は、一般的な自動車の操作感覚に類似するため、自動車の操作感覚に慣れたオペレータは、車両1を容易に操作することができる。さらにまた、後輪を操舵することなく旋回半径rを小さくすることができるため、別途後輪を操舵するための部材(操舵用アクチュエータ等)が不要であり、部品点数及び部品コストを削減することができる。
 また、前記操舵用アクチュエータは、
 前記前輪を90度以上操舵することが可能なものである。
 このように構成することにより、前記前輪を90度以上操舵することで、後輪の内側の位置を旋回中心として旋回(信地旋回)することや、後輪の中央の位置を旋回中心として旋回(超信地旋回)することができる。
 また、車両1は、
 2つの前輪(左前輪21及び右前輪31)を含む複数の車輪のうち複数の車輪を駆動輪(左前輪21、右前輪31、左後輪41、及び右後輪51)とし、
 前記複数の駆動輪ごとに連結されて駆動することが可能な駆動用アクチュエータ(左前輪駆動モータ22、右前輪駆動モータ32、左後輪駆動モータ42、及び右後輪駆動モータ52)と、
 目標速度vを設定するアクセルペダル63と、
 を具備し、
 コントローラ100は、
 ステアリングホイール62の回動角θ及びアクセルペダル63の操作量Aに基づいて、前記駆動輪が路面に対して滑ることなく旋回中心Z周りを旋回することが可能な前記駆動輪の速度(vFL、vFR、vRL、及びvRR)を算出し、前記駆動輪の速度が算出した速度となるように前記駆動用アクチュエータを動作させるものである。
 このように構成することにより、アクセルペダル63の操作量Aに基づいて、前記駆動輪が路面に対して滑ることがないように、前記駆動輪の速度を調節することができる。従って、旋回する際に路面(芝や圃場等)を痛めることなく、また前記駆動輪の損傷も防止しつつ、超信地旋回を安定して行うことができる。
 また、コントローラ100は、
 前記算出した速度が、所定の値(目標速度v)を超えないように制限するものである。
 このように構成することにより、算出された速度を所定の値以下に制限することで、前記駆動用アクチュエータの過回転による不具合の発生を防止することができる。
 なお、本実施形態では、通常操舵モードにおいてステアリングホイール62を操作すると、車両1の前輪のみが操舵される構成としたが、本発明はこれに限るものではない。すなわち、ステアリングホイール62を操作すると、車両1の前輪に加えて後輪(左後輪41及び右後輪51)も操舵される構成とすることや、後輪のみが操舵される構成とすることが可能である。例えば、ステアリングホイール62が時計回りに回動された場合、前輪が右方向に操舵されるとともに、後輪が左方向に操舵される構成とすることができる。これによって、車両1を操舵する際の旋回性能を向上させることができる。
 次に、切り換えスイッチ65により特殊操舵モードが選択された場合について説明する。特殊操舵モードにおいては、ジョイスティック64を操作することによって車両1が操舵される。また、特殊操舵モードにおけるジョイスティック64の操作としては、(1)ジョイスティック64を任意の方向に傾倒させる操作、(2)ジョイスティック64を傾倒させずに、その長手方向を軸心として任意の方向に回動させる(捩る)操作、(3)ジョイスティック64をその長手方向を軸心として任意の方向に回動させながら任意の方向に傾倒させる操作、がある。
 まず、上記(1)ジョイスティック64を任意の方向に傾倒させる操作を行った場合について説明する。
 図11(a)に示すように、特殊操舵モードにおいて、ジョイスティック64が右前方に傾倒された場合、各操舵モータが駆動されて、各車輪は右前方(ジョイスティック64が傾倒された方向と同一方向)に操舵される。この状態でアクセルペダル63を操作することにより、各駆動モータが駆動されて、車両1は車両本体10が前方を向いたまま右前方に向かって走行、すなわち平行移動することができる。
 図11(b)に示すように、ジョイスティック64が右方に傾倒された場合、各操舵モータが駆動されて、各車輪は右方(ジョイスティック64が傾倒された方向と同一方向)に操舵される。この状態でアクセルペダル63を操作することにより、各駆動モータが駆動されて、車両1は車両本体10が前方を向いたまま右方に向かって走行することができる。
 上記の如く、特殊操舵モードにおいては、ジョイスティック64を傾倒させる操作に基づいて車両1の各車輪を操舵することができる。上記の説明においては、ジョイスティック64が右前方及び右方に傾倒された場合についてのみ説明したが、ジョイスティック64が傾倒される方向は上記2方向に限るものではない。すなわち、ジョイスティック64は任意の方向(例えば、左前方、左方等)に傾倒されることが可能であり、各車輪はジョイスティック64が傾倒された方向に操舵される。従って、ジョイスティック64を所望の方向に傾倒させながらアクセルペダル63を操作することにより、車両1を車両本体10が前方を向いたまま所望の方向に向かって走行させることができる。
 なお、ジョイスティック64を右後方、左後方、後方等に傾斜させた場合、各操舵モータが駆動されて、各車輪はジョイスティック64が傾倒された方向と逆方向に操舵される。この状態でアクセルペダル63を操作すると、各駆動モータは通常と逆方向(後進方向)に駆動される。このように構成することによって、ジョイスティック64を後側へ傾倒させた場合においても、車両1を車両本体10が前方を向いたまま所望の方向に向かって走行させることができる。
 次に、上記(2)ジョイスティック64を傾倒させずに、その長手方向を軸心として任意の方向に回動させる(捩る)操作を行った場合について説明する。
 図12(a)に示すように、特殊操舵モードにおいて、ジョイスティック64が傾倒されない状態で時計回りに回動された場合、各操舵モータが駆動されて、各車輪は、所定の第一旋回中心C周りを時計回りに旋回可能な方向に操舵される。より詳細には、各車輪は、平面視において、第一旋回中心Cを中心として各車輪の接地点を通る円の接線方向であって、第一旋回中心Cを中心とした場合の時計回り方向を向くように操舵される。この状態でアクセルペダル63を操作することにより、各駆動モータが駆動されて、車両1は第一旋回中心Cを中心として時計回りに旋回することができる。つまり、ジョイスティック64を捩じった方向に信地旋回することができる。
 図12(b)に示すように、ジョイスティック64が傾倒されない状態で反時計回りに回動された場合、各車輪は、所定の第一旋回中心C周りを反時計回りに旋回可能な方向に操舵される。より詳細には、各車輪は、平面視において、第一旋回中心Cを中心として各車輪の接地点を通る円の接線方向であって、第一旋回中心Cを中心とした場合の反時計回り方向を向くように操舵される。この状態でアクセルペダル63を操作することにより、車両1は第一旋回中心Cを中心として反時計回りに旋回することができる。
 上記の如く、特殊操舵モードにおいては、ジョイスティック64を回動させる操作に基づいて車両1の各車輪を操舵することができる。すなわち、ジョイスティック64を所望の方向に回動させながらアクセルペダル63を操作することにより、車両1は所定の第一旋回中心Cを中心として所望の方向に旋回することができる。なお、第一旋回中心Cの位置は、予めコントローラ100に記憶させておく構成にすることや、別途調節手段を備えて調節可能に構成すること等が可能である。
 次に、上記(3)ジョイスティック64をその長手方向を軸心として任意の方向に回動させながら任意の方向に傾倒させる操作を行った場合について説明する。
 図13(a)及び(b)に示すように、特殊操舵モードにおいて、ジョイスティック64が時計回りに回動されながら右方に傾倒された場合、各車輪は第二旋回中心Cx周りを時計回りに旋回可能な方向に操舵される。
 ここで、ジョイスティック64が時計回りに回動されながら右方に傾倒された場合、第二旋回中心Cxの位置は、ジョイスティック64の傾斜方向及び傾斜角度に基づいて決定される。より詳細には、第二旋回中心Cxは、所定の第一旋回中心Cの位置(図12参照)からジョイスティック64が傾倒された方向(右方)へ、傾倒された量(傾斜角度)に対応する距離だけ移動した位置に決定される。従って、例えば図13(a)から図13(b)のように、ジョイスティック64の傾斜角度を大きくすると、第二旋回中心Cxの位置はさらに右方に移動する。
 そして、各車輪は、第二旋回中心Cx周りを時計回りに旋回可能な方向に操舵される。より詳細には、各車輪は、平面視において、第二旋回中心Cxを中心として各車輪の接地点を通る円の接線方向であって、第二旋回中心Cxを中心とした場合の時計回り方向を向くように操舵される。この状態でアクセルペダル63を操作することにより、車両1は第二旋回中心Cxを中心として時計回りに旋回することができる。
 図14(a)及び(b)に示すように、ジョイスティック64が反時計回りに回動されながら左方に傾倒された場合、各車輪は第二旋回中心Cx周りを反時計回りに旋回可能な方向に操舵される。
 ここで、ジョイスティック64が反時計回りに回動されながら左方に傾倒された場合、第二旋回中心Cxの位置は、ジョイスティック64の傾斜方向及び傾斜角度に基づいて決定される。すなわち、第二旋回中心Cxは、所定の第一旋回中心Cの位置(図12参照)からジョイスティック64が傾倒された方向(左方)へ、傾倒された量(傾斜角度)に対応する距離だけ移動した位置に決定される。従って、例えば図14(a)から図14(b)のように、ジョイスティック64の傾斜角度を大きくすると、第二旋回中心Cxの位置はさらに左方に向かって移動する。
 そして、各車輪は、第二旋回中心Cx周りを反時計回りに旋回可能な方向に操舵される。より詳細には、各車輪は、平面視において、第二旋回中心Cxを中心として各車輪の接地点を通る円の接線方向であって、第二旋回中心Cxを中心とした場合の反時計回り方向を向くように操舵される。この状態でアクセルペダル63を操作することにより、車両1は第二旋回中心Cxを中心として反時計回りに旋回することができる。
 上記の如く、特殊操舵モードにおいては、ジョイスティック64を回動させながら傾倒させる操作に基づいて車両1の各車輪を操舵することができる。すなわち、ジョイスティック64を傾倒させる操作に基づいて第二旋回中心Cxを決定するとともに、ジョイスティック64を回動させる操作に基づいて旋回方向を決定する。そして、両操作を行いながらアクセルペダル63を操作することにより、車両1は第二旋回中心Cxを中心として所望の方向に旋回することができる。
 なお、上記の説明においては、ジョイスティック64が時計回りに回動されながら右方に傾倒された場合、及びジョイスティック64が反時計回りに回動されながら左方に傾倒された場合についてのみ説明したが、ジョイスティック64の操作は上記操作に限るものではない。すなわち、ジョイスティック64は任意の方向(時計回り又は反時計回り)に回動されながら、任意の方向(例えば、右前方、左前方等)に傾倒されることが可能である。従って、ジョイスティック64を任意の方向に回動しながら任意の方向に傾倒させた状態で、アクセルペダル63を操作することにより、車両1は所望の位置に決定される第二旋回中心Cxを中心として所望の方向に旋回することができる。
 以上の如く、本実施形態の車両1は、
 2つの前輪(左前輪21及び右前輪31)及び2つの後輪(左後輪41及び右後輪51)からなる車輪と、
 前記車輪にそれぞれ連結され、前記車輪を操舵する操舵用アクチュエータ(左前輪操舵モータ23、右前輪操舵モータ33、左後輪操舵モータ43、及び右後輪操舵モータ53)と、
 前記車輪にそれぞれ連結され、前記車輪を駆動する駆動用アクチュエータ(左前輪駆動モータ22、右前輪駆動モータ32、左後輪駆動モータ42、及び右後輪駆動モータ52)と、
 任意の方向に傾倒されることで操作可能であり、前記操舵用アクチュエータの動作を指示するジョイスティック64と、
 前記駆動用アクチュエータの動作を指示するアクセルペダル63と、
 ジョイスティック64が傾倒された場合、ジョイスティック64が傾倒された方向に前記車輪を操舵するとともに、アクセルペダル63が操作された場合、アクセルペダル63の操作量に基づいて前記車輪を駆動するコントローラ100と、
 を具備するものである。
 このように構成することにより、ジョイスティック64を所望の方向に傾倒させるだけで、複数の車輪を当該方向に操舵することができる。この状態でアクセルペダル63を操作することにより、当該方向に車両1を走行させることができる。従って、簡易な操作により、容易に任意の方向に車両1を平行移動させることが可能となる。
 また、本実施形態に係るジョイスティック64は、
 任意の方向に捩られることで操作可能であり、
 コントローラ100は、
 ジョイスティック64が傾倒されない状態で捩られた場合、所定の第一旋回中心C周りをジョイスティック64が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵するものである。
 このように構成することにより、ジョイスティック64を所望の方向に捩るだけで、所定の第一旋回中心C周りをジョイスティック64が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵することができる。この状態でアクセルペダル63を操作することにより、当該方向に車両1を旋回させることができる。従って、簡易な操作により、容易に所定の第一旋回中心C周りを旋回することが可能となる。また、ジョイスティック64の操作の様子と車両1の旋回の様子とが類似するため、オペレータは車両1の旋回の様子を容易に予測することができる。従って、オペレータは感覚的に車両1の操作を行うことができ、操作性を向上させることができる。
 また、本実施形態に係るコントローラ100は、
 ジョイスティック64が捩られた状態で傾倒された場合、ジョイスティック64の傾斜方向及び傾斜角度に基づいて第二旋回中心Cxを決定し、第二旋回中心Cx周りをジョイスティック64が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵するものである。
 このように構成することにより、ジョイスティック64を捩りながら所望の方向に傾倒させるだけで、第二旋回中心Cxを任意に調節することができ、第二旋回中心Cx周りをジョイスティック64が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵することができる。この状態でアクセルペダル63を操作することにより、当該方向に車両1を旋回させることができる。従って、簡易な操作により、容易に任意の第二旋回中心Cx周りを旋回することが可能となる。また、ジョイスティック64の操作の様子と車両1の旋回の様子とが類似するため、オペレータは車両1の旋回の様子を容易に予測することができる。従って、オペレータは感覚的に車両1の操作を行うことができ、操作性を向上させることができる。
 また、本実施形態に係る車両1は、通常操舵モードにおいてステアリングホイール62による操舵を行うことができる。従って、平行移動や極小旋回等を行う必要がない場合は、通常の自動車と同様の操作感覚で車両1を操作することができる。さらに、車両1が有するモードは通常操舵モードと特殊操舵モードの2つのモードのみであり、切り換えスイッチ65の操作のみで両モードを切り換えることができる。従って、多くのモードを切り換える必要がないためオペレータは容易に車両1の操作方法を選択でき、また簡易な操作により容易にいずれかのモードを選択することができる。
 なお、本実施形態においては、主に各車輪の操舵に関する制御について説明したが、これと同時に各車輪の回転速度を制御することも可能である。例えば、車両1が旋回する場合において、各車輪が接地面との間に滑りを生じないように、各車輪の回転速度を制御することが可能である。このような制御によって、各車輪の摩耗を抑制することや、各車輪と接地面との摩擦力による制動力が車両1加わることを防止すること等ができる。
 以下では、むだ時間を含む制御対象のフィードバック制御性能を向上するための技術について説明する。
 従来、図29(a)に示すようなむだ時間を含む制御対象261に対してPID制御器262を用いて制御量yのフィードバック制御を行う場合、PID制御器262の制御ゲイン(フィードバックゲイン)を大きくすると、むだ時間の影響を受け、制御量yが目標値y*に対してオーバーシュートしたりハンチングが生じたりして、システムが不安定となるという問題があった(図29(b)参照)。その一方、PID制御器262の制御ゲインを小さくすると、制御量yが目標値y*に到達するまでの時間が長くなり、高速な反応を求められる用途にはPID制御を適用できないという問題もあった(図29(c)参照)。
 また、図30(a)に示すように、このような制御対象261に含まれるむだ時間をsmithのむだ時間補償器263により補償する技術が公知となっている。smithのむだ時間補償器263を加えたブロック線図を変換すると、図30(b)に示すブロック線図となる。
 この技術では、フィードバックループ264の外にむだ時間の伝達関数e―Lsを追い出すことができて、むだ時間を除いた制御対象261の実モデル265のみがフィードバックループ264内に含まれることとなる。そのため、むだ時間をフィードバックループ264に含む場合と比較して、PID制御器262の制御ゲイン(フィードバックゲイン)を大きく設定することが可能となり、システムを安定に保ちつつ、制御量yの応答性をよくすることができる。
 しかしながら、前述のsmithのむだ時間補償器263によりむだ時間を補償した技術では、制御対象261のむだ時間が、フィードバック制御装置266の制御パラメータ(smithのむだ時間補償器263)に含まれるため、経年変化等で制御対象261のむだ時間が変化した場合や、むだ時間のモデル化に誤差(定数Lに誤差)が生じた場合には、前記smithのむだ時間補償器263が十分に機能せず、制御量yが発散して制御が不安定となる問題があった(図30(c)参照)。
 また、前記むだ時間を除いた制御対象261の実モデル265においても同様で、制御対象261の実モデル265が、フィードバック制御装置266の制御パラメータ(smithのむだ時間補償器263)に含まれるため、経年変化等で制御対象261の実モデル265が変化した場合や、実モデル265のモデル化に誤差が生じた場合には、前記smithのむだ時間補償器263が十分に機能せず、制御が不安定となる問題があった。
 上記の如き課題を鑑み、むだ時間を含む制御対象に対して安定して制御を行うことができ、かつ、制御量の応答性が良好となるフィードバック制御装置とフィードバック制御方法を提供する。
 すなわち、むだ時間を含む制御対象のフィードバック制御装置であって、前記制御対象の制御量を検出する検出手段と、むだ時間を除いた前記制御対象の伝達関数の逆モデルに、前記制御量を入力して、第一出力値を得る第一出力値計算手段と、前記制御対象の操作量から、前記第一出力値を減算して、第二出力値を得る第二出力値計算手段と、むだ時間を除いた前記制御対象の伝達関数に、前記第二出力値を入力して、第三出力値を得る第三出力値計算手段と、前記制御量の目標値から、前記制御量を減算して、制御偏差を得る制御偏差計算手段と、前記制御偏差から、前記第三出力値を減算して、補正された制御偏差を得る制御偏差補正手段と、前記補正された制御偏差を入力して、前記制御対象の操作量を得る操作量計算手段と、を具備するものである。
 このように構成することにより、むだ時間を含む制御対象のフィードバック制御において、制御対象のむだ時間を補償して、フィードバックループの外にむだ時間を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量の応答性を良好にすることができる。また、制御対象のむだ時間がむだ時間補償器の制御パラメータに含まれないため、経年変化等でむだ時間が変化した場合や、むだ時間のモデル化に誤差が生じた場合であっても、むだ時間を補償することができ、安定して制御を行うことができる。
 また、むだ時間を含む制御対象のフィードバック制御装置であって、前記制御対象の制御量を検出する検出手段と、むだ時間を除いた前記制御対象の伝達関数の逆モデルに、前記制御量を入力して、第一出力値を得る第一出力値計算手段と、前記制御対象の操作量から、前記第一出力値を減算して、第二出力値を得る第二出力値計算手段と、むだ時間を除いた前記制御対象の伝達関数に、前記第二出力値を入力して、第三出力値を得る第三出力値計算手段と、特定の周波数成分のみを通過させるフィルタに、前記第三出力値を入力して、第四出力値を得る第四出力値計算手段と、前記制御量の目標値から、前記制御量を減算して、制御偏差を得る制御偏差計算手段と、前記制御偏差から、前記第四出力値を減算して、補正された制御偏差を得る制御偏差補正手段と、前記補正された制御偏差を入力して、前記制御対象の操作量を得る操作量計算手段と、を具備するものである。
 このように構成することにより、むだ時間を含む制御対象のフィードバック制御において、制御対象のむだ時間を補償して、フィードバックループの外にむだ時間を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量の応答性を良好にすることができる。また、制御対象のむだ時間がむだ時間補償器の制御パラメータに含まれないため、経年変化等でむだ時間が変化した場合や、むだ時間のモデル化に誤差が生じた場合であっても、むだ時間を補償することができ、安定して制御を行うことができる。また、経年変化等で制御対象の実モデルが変化した場合や、制御対象のモデル化に誤差が生じた場合であっても、目標値と制御量の定常偏差が発生しない。
 また、前記制御偏差に所定の比例ゲインを乗算して、または、前記制御偏差を所定の時間積分して、第五出力値を得る第五出力値計算手段と、前記操作量に、前記第五出力値を加算して、補正された操作量を得る操作量補正手段と、を具備するものである。
 このように構成することにより、経年変化等で制御対象の実モデルが変化した場合や、制御対象のモデル化に誤差が生じた場合であっても、目標値と制御量の定常偏差が発生しない。
 また、むだ時間を含む制御対象の制御量を、むだ時間を除いた前記制御対象の伝達関数の逆モデルに入力して第一出力値を演算し、前記第一出力値を、前記制御対象の操作量から減算して第二出力値を演算し、前記第二出力値を、むだ時間を除いた前記制御対象の伝達関数に入力して第三出力値を演算し、前記第三出力値を、制御偏差から減算して補正された制御偏差を演算し、前記補正された制御偏差に基づいてフィードバック制御を行うものである。
 このように構成することにより、むだ時間を含む制御対象のフィードバック制御において、制御対象のむだ時間を補償して、フィードバックループの外にむだ時間を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量の応答性を良好にすることができる。また、制御対象のむだ時間がむだ時間補償器の制御パラメータに含まれないため、経年変化等でむだ時間が変化した場合や、むだ時間のモデル化に誤差が生じた場合であっても、むだ時間を補償することができ、安定して制御を行うことができる。
 また、むだ時間を含む制御対象の制御量を、むだ時間を除いた前記制御対象の伝達関数の逆モデルに入力して第一出力値を演算し、前記第一出力値を、前記制御対象の操作量から減算して第二出力値を演算し、前記第二出力値を、むだ時間を除いた前記制御対象の伝達関数に入力して第三出力値を演算し、前記第三出力値を、特定の周波数成分のみを通過させるフィルタに入力して第四出力値を演算し前記第四出力値を、制御偏差から減算して補正された制御偏差を演算し、前記補正された制御偏差に基づいてフィードバック制御を行うものである。
 このように構成することにより、むだ時間を含む制御対象のフィードバック制御において、制御対象のむだ時間を補償して、フィードバックループの外にむだ時間を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量の応答性を良好にすることができる。また、制御対象のむだ時間がむだ時間補償器の制御パラメータに含まれないため、経年変化等でむだ時間が変化した場合や、むだ時間のモデル化に誤差が生じた場合であっても、むだ時間を補償することができ、安定して制御を行うことができる。また、経年変化等で制御対象の実モデルが変化した場合や、制御対象のモデル化に誤差が生じた場合であっても、目標値と制御量の定常偏差が発生しない。
 次に、一実施形態に係るフィードバック制御装置201の構成について説明する。
 図15に示すように、フィードバック制御装置201は、制御対象202と、PID制御器205と、制御量yの検出手段206と、制御偏差計算手段207と、制御量yの目標値y*の指示手段(不図示)と、むだ時間補償器210と、補正手段220とを具備する。
 制御対象202は、アクチュエータ等で構成される。制御対象202の伝達関数は、むだ時間を含む、G(s)e―Lsとして表される。ここで、伝達関数G(s)を実モデル203として表し、伝達関数e―Lsをむだ時間204として表す。実モデル203は、一次遅れ系や、二次遅れ系等を含む。むだ時間204は、例えば、単位ステップを入力してからL秒後に応答するモデルである。sはラプラス演算子である。
 PID制御器205は、制御対象202の操作量U(s)を演算する操作量計算手段である。PID制御器205には、後述する補正された制御偏差214aが入力される。PID制御器205においては、補正された制御偏差214aに比例した値(P動作)と、補正された制御偏差214aを時間積分した値(I動作)と、補正された制御偏差214aを時間微分した値(D動作)とがそれぞれ加算され、その演算値となる操作量U(s)が得られる。操作量U(s)は、むだ時間補償器210の第二出力値計算手段212と、補正手段220の操作量補正手段222とに入力される。PID制御器205は伝達関数C(s)で表される。PID制御器205の制御ゲイン(比例ゲイン)や積分ゲイン(積分時間)や微分ゲイン(微分時間)は、制御パラメータとして制御対象202の伝達関数G(s)、すなわち実モデル203に応じて適宜調整される。
 検出手段206では、前記制御対象202の出力値である制御量yが検出される。前記制御対象202の出力値である制御量yは、制御偏差計算手段207と、むだ時間補償器210の第一出力値計算手段211とに入力される。
 制御偏差計算手段207においては、指示手段で指示された目標値y*から制御量yが減算されて、制御偏差207aが得られる。制御偏差207aは、むだ時間補償器210の制御偏差補正手段214と、補正手段220の第五出力値計算手段221とに入力される。
 むだ時間補償器210は、第一出力値計算手段211と、第二出力値計算手段212と、第三出力値計算手段213と、制御偏差補正手段214とから構成される。
 第一出力値計算手段211は、前記実モデル203の逆数(逆モデル)としており、伝達関数1/Gn(s)として表し、詳細は後述する。第一出力値計算手段211においては、むだ時間204を除いた制御対象202の伝達関数の逆モデル1/Gn(s)に、制御量yが入力されて、第一出力値211aが得られる。第一出力値211aは、第二出力値計算手段212に入力される。
 第二出力値計算手段212は、前記PID制御器205から出力された操作量U(s)から、前記第一出力値計算手段211の第一出力値211aが減算されて、第二出力値212aを得られる。第二出力値212aは、第三出力値計算手段213に入力される。
 第三出力値計算手段213は、前記実モデル203としており、伝達関数Gn(s)として表し、詳細は後述する。第三出力値計算手段213においては、むだ時間204を除いた制御対象202の伝達関数Gn(s)に、第二出力値212aが入力されて、第三出力値213aが得られる。第三出力値213aは、制御偏差補正手段214に入力される。
 制御偏差補正手段214は、前記制御偏差207aから、前記第三出力値213aが減算されて、補正された制御偏差214aが得られる。補正された制御偏差214aは、前記PID制御器205に入力される。
 補正手段220は、第五出力値計算手段221と、操作量補正手段222と、から構成される。
 第五出力値計算手段221は、入力値に比例した値を出力する比例要素で構成される。制御ゲイン(比例ゲイン)はKdistとされる。第五出力値計算手段221においては、前記制御偏差207aにKdistが乗算されて、第五出力値221aが得られる。第五出力値221aは、操作量補正手段222に入力される。
 操作量補正手段222においては、前記PID制御器205から出力される操作量U(s)に、前記第五出力値221aが加算されて、補正された操作量222aが得られる。補正された操作量222aは、制御対象202に入力される。
 以上の構成により、フィードバック制御装置201は、次のフィードバック制御方法を用いてフィードバック制御を行う。すなわち、図16に示すように、フィードバック制御装置201は、むだ時間を含む制御対象202の制御量yをむだ時間204を除いた前記制御対象の伝達関数の逆モデル1/Gn(s)に入力して、第一出力値211aを演算し(S1)、この第一出力値211aを前記制御対象202の操作量U(s)から減算して、第二出力値212aを演算し(S2)、この第二出力値212aをむだ時間204を除いた前記制御対象202の伝達関数Gn(s)に入力して、第三出力値213aを演算し(S3)、この第三出力値213aを制御偏差から減算して、補正された制御偏差214aを演算する(S4)。そして、フィードバック制御装置201は、補正された制御偏差214aに基づいてフィードバック制御を行うのである(S5)。
 また、フィードバック制御装置201は、図17(a)に示す構成としてもよい。
 すなわち、フィードバック制御装置201のむだ時間補償器210は同じ構成として、補正手段222の第五出力値計算手段221は、積分制御器とされる。積分制御器の制御ゲイン(積分ゲイン)はIdistとされる。前記制御偏差207aがIdistに対応した時間だけ積分されて第五出力値221aが得られる。第五出力値221aは、操作量補正手段222に入力される。
 また、フィードバック制御装置201は、図17(b)に示す構成としてもよい。
 すなわち、フィードバック制御装置201は、補正手段220の代わりに、第四出力値計算手段215を具備する。
 第四出力値計算手段215は、特定の周波数成分のみを通過させるフィルタ、詳細には、設定した周波数以上の周波数成分のみを通過させるハイパスフィルタとしており、伝達関数F(s)として表す。第四出力値計算手段215においては、伝達関数F(s)に、第三出力値計算手段213から出力される第三出力値213aが入力されて、第四出力値215aが得られる。第四出力値215aは、制御偏差補正手段214に入力される。
 制御偏差補正手段214においては、前記制御偏差207aから、前記第四出力値215aが減算されて、補正された制御偏差214aが得られる。補正された制御偏差214aは、PID制御器205に入力される。
 PID制御器205においては、補正された制御偏差214aから操作量U(s)が得られる。操作量U(s)は、前記制御対象202と、むだ時間補償器210の第二出力値計算手段212とに入力される。
 以上の構成により、フィードバック制御装置201は、次のフィードバック制御方法を用いてフィードバック制御を行う。すなわち、図18に示すように、フィードバック制御装置201は、むだ時間204を含む制御対象202の制御量yをむだ時間204を除いた前記制御対象202の伝達関数の逆モデル1/Gn(s)に入力して、第一出力値211aを演算し(S11)、この第一出力値211aを前記制御対象202の操作量U(s)から減算して、第二出力値212aを演算し(S12)、この第二出力値212aをむだ時間204を除いた前記制御対象202の伝達関数Gn(s)に入力して、第三出力値213aを演算し(S13)、この第三出力値213aを伝達関数F(s)に入力して、第四出力値215aを演算し(S14)、この第四出力値215aを制御偏差207aから減算して、補正された制御偏差214aを演算する(S15)。そして、フィードバック制御装置201は、補正された制御偏差214aに基づいてフィードバック制御を行うのである(S16)。
 次に、むだ時間補償器210と、補正手段220を前述の構成とした根拠を、図19から図23を用いて説明する。
 smithのむだ時間補償器263(図29)では、むだ時間を制御パラメータ(詳細には定数L)とするため、制御対象261のむだ時間の定数Lと、制御対象261のモデル化によるむだ時間推定値の定数Lnとの間に誤差が生じると、制御が不安定となる。そこで、制御対象261のむだ時間を外乱として扱い、外乱オブザーバで外乱を補償することにより、制御対象261のむだ時間を補償する。
 図19(a)において、むだ時間の伝達関数e―Lsを含む制御対象261の実モデル265を伝達関数G(s)として、PID制御器262によりフィードバック制御を行うものとする。ここで、制御対象261のむだ時間の伝達関数e―Lsを外乱dとして、図19(a)を等価変換すると図19(b)のように表すことができる。外乱dの信号は以下の数15で表される。
Figure JPOXMLDOC01-appb-M000015
 次に、前記外乱dを補償するため、外乱オブザーバにより外乱dを推定する。
 図20(a)に示すように、伝達関数e―Lsを含まない制御対象261の実モデル265の逆モデル(逆モデル推定値267と呼ぶ)を形成して、この逆モデル推定値267に制御量yを入力する。この時、逆モデル推定値267は、伝達関数1/Gn(s)で表される。そして、制御量yは、以下の数16で表される。
Figure JPOXMLDOC01-appb-M000016
 ここで、PID制御器262の出力である操作量U(s)から、前記逆モデル推定値267に制御量yを入力し、その出力(演算値)を減算した値は、以下の数17で表される。
Figure JPOXMLDOC01-appb-M000017
 ここで、G(s)とGn(s)が等しく、モデルに誤差がないとするならば、G(s)=Gn(s)となり、数17は、以下の数18で表される。
Figure JPOXMLDOC01-appb-M000018
 すなわち、数18は数15と等しくなるので、数18の計算値を求めることで、外乱dの推定値を求めることができる。
 次に、図20(b)に示すように、伝達関数e―Lsを含まない制御対象261のモデル(実モデル推定値268と呼ぶ)を形成して、この実モデル推定値268に推定した外乱dを入力する。このとき、実モデル推定値268は、伝達関数Gn(s)で表される。そして、この実モデル推定値268の出力に制御量yを足し合わせると、演算値は以下の数19で表される。
Figure JPOXMLDOC01-appb-M000019
 ここで、G(s)とGn(s)が等しく、モデルに誤差がないとするならば、G(s)=Gn(s)となり、数19は、以下の数20で表される。
Figure JPOXMLDOC01-appb-M000020
 数20の演算値(フィードバック値269)は、むだ時間の伝達関数e-Lsを除いた制御対象261の伝達関数G(s)、即ち実モデル265に操作量U(s)を入力したときの出力であり、むだ時間の影響を取り除いた制御量yを意味する。言い換えれば、外乱オブザーバによって制御パラメータにむだ時間を用いることなく、フィードバックループ(フィードバック値269)からむだ時間を追い出せたこととなる。従って、むだ時間に関係なくPID制御器262の制御ゲイン(フィードバックゲイン)を大きくできるため、制御の応答性を良くすることができる。
 また、制御対象のむだ時間に変化が生じて、推定したむだ時間の誤差が増大(L1からL4になるにつれて誤差が増大)した場合には、smithのむだ時間補償では、制御量yが発散してシステムが不安定となるが(図21(a)参照)、外乱オブザーバによるむだ時間補償では、むだ時間の影響を外乱として検出するので、あらゆるむだ時間に対応でき、制御量yが発散せず、システムが不安定とならない(図21(b)参照)。
 このように、フィードバック制御でのむだ時間補償は、むだ時間を取り除くのではなく、むだ時間をフィードバックループの外に追い出して、制御ゲインを増大させることで、制御性能を向上させることとしている。
 次に、モデルの誤差による影響について検討する。前述のように、外乱オブザーバによるむだ時間補償は、制御対象261のむだ時間の伝達関数e-Lsを含まない実モデル265、即ちG(s)を制御パラメータとして用いる。モデルに誤差があれば、つまりG(s)≠Gn(s)であれば、数20は、以下の数21で表される。
Figure JPOXMLDOC01-appb-M000021
 すなわち、制御対象の実モデル265に基づいたフィードフォワード制御を行うのと等価であり、制御量yにモデルの誤差分の定常偏差などが発生する。
 このモデルの誤差の影響を補償する要素を図20(b)に追加すると図22(a)のようになる。つまり、外乱オブザーバによる補償要素を、目標値y*と制御量yとの偏差を求めた後に減算して、モデルの誤差の影響を制御偏差として求められる形とする。そして、その制御偏差と比例制御器270における制御ゲインKdistの積をモデルの誤差の補償要素として、PID制御器262の出力である操作量U(s)に加算する(補正手段220)。このように構成することで、モデルの誤差による制御量yの定常偏差を抑えることができる。
 尚、前記比例制御器270は、制御対象の特性により積分制御器としてもよく、PI制御器(比例積分制御器)としてもよい。
 また、図22(b)のように構成して、モデルの誤差の影響を補償する要素を追加してもよい。つまり、実モデル推定値268の出力値を特定の周波数成分、本実施形態においては、設定した周波数以上の周波数成分のみを通過させるハイパスフィルタ271に入力させてから、制御偏差を減算する構成とする。これにより、むだ時間の影響により不安定になる高い周波数域のみでむだ時間補償を有効にし、それ以下の周波数では補償要素が無効となるので、モデルの誤差による制御量yの定常偏差を抑えることができる。
 図23は、モデルの誤差による影響を示すグラフである。図23(a)は、G(s)=Gn(s)であり、モデルの誤差がない場合である。これによると目標値y*と制御量yの定常的な偏差である定常偏差は発生せず、制御量yは目標値y*に収束する。図23(b)は、G(s)≠Gn(s)であり、モデルの誤差が50%程度ある場合である。これによると定常偏差が発生する。図23(c)は、G(s)≠Gn(s)であり、モデルの誤差が50%程度ある場合に、モデルの誤差の影響を補償する要素を追加した場合である。これによると定常偏差が発生せず、制御量yは目標値y*に収束する。
 次に前述の一実施形態と同様のフィードバック制御装置240を作業車両300におけるHST(Hydro Static Transmission)の斜板角度制御に適用した場合を説明する。
 はじめに、図24を用いて、作業車両300の全体構成を説明する。作業車両300は、エンジン230と、フライホイール231と、エンジン制御装置232と、HST233と、差動装置234と、タイヤ236と、速度レバー237と、変化率制限手段238と、μ設定ダイヤル239と、フィードバック制御装置240とを備える。
 エンジン230は、作業車両300が駆動するための回転動力を発生するものである。エンジン230のクランク軸230aは、フライホイール231と連動連結される。エンジン230の回転動力は、クランク軸230aを介してフライホイール231に伝達される。
 フライホイール231は、慣性力を蓄えることによりエンジン230を滑らかに回転させるものである。フライホイール231は、クランク軸230aにより伝達される回転動力により回転する。フライホイール231の回転数は、磁気ピックアップ式のセンサや、ロータリエンコーダ等の回転数センサ231aにより検出される。
 エンジン制御装置232は、エンジン230の回転数の制御を行うものである。エンジン制御装置232は、回転数センサ231aに接続される。エンジン制御装置232は、回転数センサ231aにより検出されるフライホイール231の回転数に基づいて、エンジン230の回転数の制御を行う。
 HST233は、可変容量型の油圧ポンプをエンジン230により駆動させて、発生した油圧を固定容量型の油圧モータで回転力に変換する。HST233は、油圧ポンプに備えられた可動斜板233aの角度に応じて当該油圧ポンプによる作動油の吐出量や吐出方向を変化させて、油圧モータの回転数及び回転方向を調整する。これにより、油圧ポンプの入力軸233bから入力されたエンジン230の回転動力が無段階に変速されて、油圧モータの出力軸233cに出力される。油圧ポンプの入力軸233bの一端は、フライホイール231と連動連結され、エンジンの回転動力がHST233に伝達される。
 差動装置234は、回転動力を分配するものである。差動装置234には、油圧モータの出力軸233cの一端が連動連結されて、HST233で変速されたエンジン230の回転動力が伝達される。当該伝達される回転動力は、差動装置234により左右に分配される。
 差動装置234の左右には、車軸235の一端がそれぞれ連動連結される。車軸235は、差動装置234により分配された回転動力を伝達する。
 タイヤ236には、車軸235の他端が連動連結され、車軸235から伝達される回転動力により回転する。
 速度レバー237は、タイヤ速度(タイヤ236の回転数)Sを設定(St)するものである。作業者は速度レバー237を操作して、タイヤ速度Sを調整する。
 変化率制限手段238は、可動斜板233aの目標値y*を所定の変化率に制限するものである。μ設定ダイヤル239で設定されたμ(摩擦係数)の値に応じて変化率の制限値Bが決定される。μの値は、タイヤ236の接地面の状況に応じて適宜変更される。
 可動斜板233aの目標値y*の変化率と、前記μ設定ダイヤル239で設定された変化率の制限値Bとを比較して、可動斜板の目標値y*が決定される。変化率制限手段238から、目標値y*が出力される。
 フィードバック制御装置240は、後述するように、アクチュエータ241と、PID制御器242と、外乱オブザーバによるむだ時間補償器245と、補正手段246と、を具備する。アクチュエータ241の回転軸には、HST233の可動斜板233aが連動連結される。フィードバック制御装置240には、アクチュエータ241の回転軸の目標角度(目標値y*)が入力され、アクチュエータ241の回転軸の角度(制御量y)が出力される。
 このような構成において、作業者は、速度レバー237とμ設定ダイヤル239を操作することにより、変化率制限手段238からアクチュエータ241の目標値y*がフィードバック制御装置240に入力される。そして、フィードバック制御装置240から出力されるアクチュエータ241の制御量yに基づいて、HST233の油圧ポンプにおける可動斜板233aの角度が変更されて、当該油圧ポンプによる作動油の吐出量や吐出方向が変更され、エンジン230からフライホイール231を介して伝達された回転動力が変速される。変速された回転動力は、差動装置234、車軸235を介して、タイヤ236に伝達される。
 尚、本実施形態においては、タイヤ速度Sの制御において、フィードバック制御装置240以降はオープン制御となり、制御量yに応じた斜板の角度により、タイヤ速度Sが決定される構成となっているが、これに限定するものでなく、例えば、出力軸233cに回転数センサを設け、タイヤ236の回転数等をフィードバックして、タイヤ速度Sの制御を行う構成としてもよい。
 次に、図25を用いて、フィードバック制御装置240の構成について説明する。
 フィードバック制御装置240は、制御対象となるアクチュエータ241と、PID制御器242と、制御量yの検出手段となる角度センサ243と、制御偏差計算手段244と、外乱オブザーバによるむだ時間補償器245と、補正手段246とを具備する。前述のように、フィードバック制御装置240には、アクチュエータ241の回転軸の目標角度(目標値y*)が入力され、アクチュエータ241の回転軸の角度(制御量y)が出力される。
 アクチュエータ241は、前記HST233の可動斜板233aの傾斜角度を変更するものである。アクチュエータ241は、サーボモータ等により構成される。アクチュエータ241の伝達関数は、むだ時間を含む、G(s)e―Lsとして表される。
 PID制御器242は、アクチュエータ241の操作量U(s)を演算する操作量計算手段である。PID制御器242には、後述する補正された制御偏差250aが入力される。PID制御器242においては、制御偏差250aに比例した値(P動作)と、制御偏差250aを時間積分した値(I動作)と、制御偏差250aを時間微分した値(D動作)とがそれぞれ加算され、その演算値となる操作量U(s)が得られる。この操作量U(s)は、むだ時間補償器245の第二出力値計算手段248と、補正手段246の操作量補正手段252と、に入力される。PID制御器242は伝達関数C(s)で表され、PID制御器242の制御ゲイン(比例ゲイン)や積分ゲイン(積分時間)や微分ゲイン(微分時間)は、制御パラメータとしてアクチュエータ241の伝達関数G(s)に応じて適宜調整される。
 角度センサ243は、ロータリエンコーダや、ホールセンサ等で構成される。この角度センサ243によりアクチュエータ241の制御量yが検出される。制御量yは制御偏差計算手段244と、外乱オブザーバによるむだ時間補償器245の第一出力値計算手段247とに入力される。
 尚、該角度センサ243は、前記アクチュエータ241と一体的に構成されてもよい。
 制御偏差計算手段244においては、前記変化率制限手段238から指示されたアクチュエータ241の回転軸における角度の目標値y*から、前記角度センサ243が検出した制御量yが減算され、制御偏差244aが得られる。制御偏差244aは、外乱オブザーバによるむだ時間補償器245の制御偏差補正手段250と、補正手段246の第五出力値計算手段251とに入力される。
 外乱オブザーバによるむだ時間補償器245は、第一出力値計算手段247と、第二出力値計算手段248と、第三出力値計算手段249と、制御偏差補正手段250とで構成される。
 第一出力値計算手段247は、むだ時間を除いたアクチュエータ241の推定された伝達関数の逆数(逆モデル推定値)であり、伝達関数1/Gn(s)として表される。第一出力値計算手段247においては、むだ時間を除いたアクチュエータ241の伝達関数の逆モデル1/Gn(s)に、前記角度センサ243で検出された制御量yが入力されて、第一出力値247aが得られる。第一出力値247aは、第二出力値計算手段248に入力される。
 第二出力値計算手段248においては、前記PID制御器242から出力された操作量U(s)から、前記第一出力値計算手段247の第一出力値247aが減算されて、第二出力値248aが得られる。第二出力値248aは、第三出力値計算手段249に入力される。
 第三出力値計算手段249は、むだ時間を除いたアクチュエータ241の推定された伝達関数Gn(s)として表される。第三出力値計算手段249においては、むだ時間を除いたアクチュエータ241の伝達関数Gn(s)に、第二出力値248aが入力されて、第三出力値249aが得られる。第三出力値249aは、制御偏差補正手段250に入力される。
 制御偏差補正手段250においては、前記制御偏差244aから、前記第三出力値249aが減算されて、補正された制御偏差250aが得られる。補正された制御偏差250aは、前記PID制御器242に入力される。
 このように構成することにより、アクチュエータ241に含まれるむだ時間を外乱として扱い、むだ時間をフィードバックループの外に追い出すことができる。したがって、PID制御器242の制御ゲインを大きく設定することが可能となるので、安定して制御を行うとともに、制御量yの応答性を良くすることができる。また、アクチュエータ241のむだ時間が、むだ時間補償器245の制御パラメータに含まれないため、経年変化等でアクチュエータ241のむだ時間が変化した場合や、むだ時間のモデル化に誤差が生じた場合であっても、アクチュエータ241のむだ時間の補償が可能で、安定して制御を行うことができる。
 補正手段246は、第五出力値計算手段251と、操作量補正手段252とで構成される。
 第五出力値計算手段251は、PI制御器であり、入力値に比例した値を出力する比例要素と、入力値の累積値を出力する積分要素とで構成される。比例ゲインはKdistとされ、積分ゲインはIdistとされる。アクチュエータ241の特性に応じて、Kdist及びIdistが適宜調整される。アクチュエータ241の積分要素が小さい場合は、比例ゲインKdistを0として、第五出力値計算手段251をI制御器として動作させてもよく、アクチュエータ241の積分要素が大きい場合は、積分ゲインIdistを0として、第五出力値計算手段251をP制御器として動作させてもよい。その演算値となる第五出力値251aは、操作量補正手段252に入力される。
 操作量補正手段252においては、PID制御器242から出力される操作量U(s)に、第五出力値251aが加算されて、補正された操作量252aが得られる。補正された操作量252aは、指令電圧Vdとしてアクチュエータ241に入力される。
 このように構成することにより、経年変化等でアクチュエータ241の実モデルとなる伝達関数G(s)が変化した場合や、アクチュエータ241の実モデルとなる伝達関数G(s)のモデル化に誤差が生じた場合においても、目標値y*と制御量yの定常偏差が発生しない。
 尚、前記PID制御器242、制御偏差計算手段244、外乱オブザーバによるむだ時間補償器245及び補正手段246は、CPU、ROM、RAM、HDD等で構成され、所定のプログラムを用いて補正された制御偏差250aや、補正された操作量252aが演算される構成としてもよい。
 また、フィードバック制御装置240は、次のように構成してもよい。すなわち、図26に示すように、フィードバック制御装置240は、第三出力値249aを設定した周波数以上の周波数成分のみを通過させるハイパスフィルタに入力させてから、第四出力値253aを得る。そして、第四出力値253aを制御偏差補正手段250に入力する。制御偏差補正手段250においては、制御偏差244aから、第四出力値253aが減算されて、補正された制御偏差250aが得られる。補正された制御偏差250aは、PID制御器242に入力される。PID制御器242においては、補正された制御偏差250aから操作量U(s)が得られる。そして、操作量U(s)がアクチュエータ241に入力される。
 これにより、むだ時間の影響で不安定になる高い周波数域のみでむだ時間補償を有効にし、それ以下の周波数では補償要素が無効となるので、モデルの誤差による制御量yの定常偏差を抑えることができる。
 次に、図27から図28を用いて、図24のシステムの計測結果を示す。
 図27に示すように、作業車両300においては、速度レバー237を操作して、タイヤ速度Sの制御を行う。このように、外乱オブザーバによるむだ時間補償器245がある場合(Sa)は、外乱オブザーバによるむだ時間補償器245がない場合(Sb)に比べて、PID制御器242の比例ゲインを40倍に大きくしても不安定とならず、斜板制御の応答性を改善することができる。
 つづいて、μの任意の設定(μ1からμ5)に対する斜板制御(速度制御)の結果を図28に示す。図28(a)に示すようなPID制御器242のみ(すなわち外乱オブザーバを用いたむだ時間補償器245なし)の場合と比較して、図28(b)に示すようなむだ時間補償器245ありの場合の方が、速度レバー237の操作直後の応答がよく、速度制御の制限値Bと同様の傾きで斜板制御ができていることがわかる。タイヤ速度Sは速度制御の制限値Bに対して時間方向にオフセットした応答、すなわち、むだ時間の遅れを補償した応答となっている。これは、むだ時間をフィードバックループから追い出して制御する本制御の特徴といえる。
 以上のように、むだ時間204を含む制御対象202のフィードバック制御装置201であって、前記制御対象202の制御量yを検出する検出手段206と、むだ時間204を除いた前記制御対象202の伝達関数の逆モデルに、前記制御量yを入力して、第一出力値211aを得る第一出力値計算手段211と、前記制御対象202の操作量U(s)から、前記第一出力値211aを減算して、第二出力値212aを得る第二出力値計算手段212と、むだ時間204を除いた前記制御対象202の伝達関数に、前記第二出力値212aを入力して、第三出力値213aを得る第三出力値計算手段213と、前記制御量yの目標値y*から、前記制御量yを減算して、制御偏差207aを得る制御偏差計算手段207と、前記制御偏差207aから、前記第三出力値213aを減算して、補正された制御偏差214aを得る制御偏差補正手段214と、前記補正された制御偏差214aを入力して、前記制御対象202の操作量U(s)を得る操作量計算手段となるPID制御器205と、を具備するものである。
 これにより、むだ時間204を含む制御対象202のフィードバック制御において、制御対象202のむだ時間204を補償して、フィードバックループの外にむだ時間204を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量yの応答性を良好にすることができる。また、制御対象202のむだ時間204がむだ時間補償器210の制御パラメータに含まれないため、経年変化等でむだ時間204が変化した場合や、むだ時間204のモデル化に誤差が生じた場合であっても、むだ時間204を補償することができ、安定して制御を行うことができる。
 また、前記制御偏差207aに所定の比例ゲインを乗算して、または、前記制御偏差207aを所定の時間積分して、第五出力値221aを得る第五出力値計算手段221と、前記操作量U(s)に、前記第五出力値221aを加算して、補正された操作量222aを得る操作量補正手段222と、を具備するものであるので、経年変化等で制御対象202の実モデルが変化した場合や、制御対象202のモデル化に誤差が生じた場合であっても、目標値と制御量の定常偏差が発生しない。
 また、本発明の一実施形態に係るフィードバック制御装置は、むだ時間204を含む制御対象202のフィードバック制御装置201であって、前記制御対象202の制御量yを検出する検出手段206と、むだ時間204を除いた前記制御対象202の伝達関数の逆モデルに、前記制御量yを入力して、第一出力値211aを得る第一出力値計算手段211と、前記制御対象202の操作量U(s)から、前記第一出力値211aを減算して、第二出力値212aを得る第二出力値計算手段212と、むだ時間204を除いた前記制御対象202の伝達関数に、前記第二出力値212aを入力して、第三出力値213aを得る第三出力値計算手段213と、特定の周波数成分のみを通過させるフィルタに、前記第三出力値213aを入力して、第四出力値215aを得る第四出力値計算手段215と、前記制御量yの目標値y*から、前記制御量yを減算して、制御偏差207aを得る制御偏差計算手段207と、前記制御偏差207aから、前記第四出力値215aを減算して、補正された制御偏差214aを得る制御偏差補正手段214と、前記補正された制御偏差214aを入力して、前記制御対象202の操作量U(s)を得る操作量計算手段となるPID制御器205と、を具備するものである。
 これにより、むだ時間204を含む制御対象202のフィードバック制御において、制御対象202のむだ時間204を補償して、フィードバックループの外にむだ時間204を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量yの応答性を良好にすることができる。また、制御対象202のむだ時間204がむだ時間補償器210の制御パラメータに含まれないため、経年変化等でむだ時間204が変化した場合や、むだ時間204のモデル化に誤差が生じた場合であっても、むだ時間204を補償することができ、安定して制御を行うことができる。また、経年変化等で制御対象202の実モデルが変化した場合や、制御対象202のモデル化に誤差が生じた場合であっても、目標値y*と制御量yの定常偏差が発生しない。
 また、本発明の一実施形態に係るフィードバック制御装置201は、むだ時間204を含む制御対象202の制御量yを、むだ時間204を除いた前記制御対象202の伝達関数の逆モデルに入力して第一出力値211aを演算し、前記第一出力値211aを、前記制御対象202の操作量U(s)から減算して第二出力値212aを演算し、前記第二出力値212aを、むだ時間204を除いた前記制御対象202の伝達関数に入力して第三出力値213aを演算し、前記第三出力値213aを、制御偏差207aから減算して補正された制御偏差214aを演算し、前記補正された制御偏差214aに基づいてフィードバック制御を行うものである。
 これにより、むだ時間204を含む制御対象202のフィードバック制御において、制御対象202のむだ時間204を補償して、フィードバックループの外にむだ時間204を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量yの応答性を良好にすることができる。また、制御対象202のむだ時間204がむだ時間補償器210の制御パラメータに含まれないため、経年変化等でむだ時間204が変化した場合や、むだ時間204のモデル化に誤差が生じた場合であっても、むだ時間204を補償することができ、安定して制御を行うことができる。
 また、本発明の一実施形態に係るフィードバック制御装置201は、むだ時間204を含む制御対象202の制御量yを、むだ時間204を除いた前記制御対象202の伝達関数の逆モデルに入力して第一出力値211aを演算し、前記第一出力値211aを、前記制御対象202の操作量U(s)から減算して第二出力値212aを演算し、前記第二出力値212aを、むだ時間204を除いた前記制御対象202の伝達関数に入力して第三出力値213aを演算し、前記第三出力値213aを、特定の周波数成分のみを通過させるフィルタに入力して第四出力値215aを演算し、前記第四出力値215aを、制御偏差207aから減算して補正された制御偏差214aを演算し、前記補正された制御偏差214aに基づいてフィードバック制御を行うものである。
 これにより、むだ時間204を含む制御対象202のフィードバック制御において、制御対象202のむだ時間204を補償して、フィードバックループの外にむだ時間204を追い出すことが可能となる。したがって、制御ゲインを大きくした場合であっても制御が不安定とならなくなる。そのため、制御ゲインを大きく設定して、制御量yの応答性を良好にすることができる。また、制御対象202のむだ時間204がむだ時間補償器210の制御パラメータに含まれないため、経年変化等でむだ時間204が変化した場合や、むだ時間204のモデル化に誤差が生じた場合であっても、むだ時間204を補償することができ、安定して制御を行うことができる。また、経年変化等で制御対象202の実モデルが変化した場合や、制御対象202のモデル化に誤差が生じた場合であっても、目標値y*と制御量yの定常偏差が発生しない。
 本発明は、四輪を独立して操舵することが可能な車両の技術に利用することが可能であり、より詳細には、操作具に基づいて前記四輪を操舵するための制御の技術に利用することが可能である。

Claims (9)

  1.  2つの前輪及び2つの後輪からなる車輪と、
     前記車輪にそれぞれ連結され、前記車輪を操舵する操舵用アクチュエータと、
     前記車輪にそれぞれ連結され、前記車輪を駆動する駆動用アクチュエータと、
     任意の方向に傾倒されることで操作可能であり、前記操舵用アクチュエータの動作を指示する第一操舵用操作具と、
     前記駆動用アクチュエータの動作を指示する駆動用操作具と、
     前記第一操舵用操作具が傾倒された場合、前記第一操舵用操作具が傾倒された方向に前記車輪を操舵するとともに、前記駆動用操作具が操作された場合、前記駆動用操作具の操作量に基づいて前記車輪を駆動する制御手段と、
     を具備する車両。
  2.  前記第一操舵用操作具は、
     任意の方向に捩られることで操作可能であり、
     前記制御手段は、
     前記第一操舵用操作具が傾倒されない状態で捩られた場合、所定の第一旋回中心周りを前記第一操舵用操作具が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵する請求項1に記載の車両。
  3.  前記制御手段は、
     前記第一操舵用操作具が捩られた状態で傾倒された場合、前記第一操舵用操作具の傾斜方向及び傾斜角度に基づいて第二旋回中心を決定し、前記第二旋回中心周りを前記第一操舵用操作具が捩られた回転方向へ旋回可能となる向きに、前記車輪を操舵する請求項2に記載の車両。
  4.  前記前輪に連結された前記操舵用アクチュエータの動作を指示する第二操舵用操作具と、
     前記第二操舵用操作具の操作量に基づいて定められる旋回中心周りを旋回することが可能な前記前輪の操舵角を算出し、前記前輪の操舵角が算出された操舵角となるように前記前輪に連結された前記操舵用アクチュエータを動作させる制御手段と、
     を具備する請求項1から請求項3までのいずれか一項に記載の車両。
  5.  前記操舵用アクチュエータは、
     前記前輪を90度以上操舵することが可能な請求項4に記載の車両。
  6.  前記制御手段は、
     前記第二操舵用操作具の操作量及び前記駆動用操作具の操作量に基づいて、前記車輪が路面に対して滑ることなく前記旋回中心周りを旋回することが可能な前記車輪の速度を算出し、前記車輪の速度が算出した速度となるように前記駆動用アクチュエータを動作させる請求項5に記載の車両。
  7.  前記制御手段は、
     前記算出した速度が、所定の値を超えないように制限する請求項6に記載の車両。
  8.  入力に対する応答までの遅れ時間であるむだ時間を含む制御対象の制御量を、むだ時間を除いた前記制御対象の伝達関数の逆モデルに入力して第一出力値を演算し、
     前記第一出力値を、前記制御対象の操作量から減算して第二出力値を演算し、
     前記第二出力値を、むだ時間を除いた前記制御対象の伝達関数に入力して第三出力値を演算し、
     前記第三出力値を、制御偏差から減算して補正された制御偏差を演算し、
     前記補正された制御偏差に基づいてフィードバック制御を行うフィードバック制御方法。
  9.  入力に対する応答までの遅れ時間であるむだ時間を含む制御対象の制御量を、むだ時間を除いた前記制御対象の伝達関数の逆モデルに入力して第一出力値を演算し、
     前記第一出力値を、前記制御対象の操作量から減算して第二出力値を演算し、
     前記第二出力値を、むだ時間を除いた前記制御対象の伝達関数に入力して第三出力値を演算し、
     前記第三出力値を、特定の周波数成分のみを通過させるフィルタに入力して第四出力値を演算し、
     前記第四出力値を、制御偏差から減算して補正された制御偏差を演算し、
     前記補正された制御偏差に基づいてフィードバック制御を行うフィードバック制御方法。
PCT/JP2010/054093 2009-04-17 2010-03-11 車両及びフィードバック制御方法 WO2010119740A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
US13/264,805 US8630770B2 (en) 2009-04-17 2010-03-11 Vehicle and feedback control method
EP10764326.4A EP2420431A4 (en) 2009-04-17 2010-03-11 VEHICLE AND METHOD FOR CONTROLLING FEEDBACK

Applications Claiming Priority (6)

Application Number Priority Date Filing Date Title
JP2009101441A JP5422251B2 (ja) 2009-04-17 2009-04-17 車両
JP2009-101441 2009-04-17
JP2009112944A JP5422257B2 (ja) 2009-05-07 2009-05-07 車両
JP2009-112944 2009-05-07
JP2009207165A JP5271853B2 (ja) 2009-09-08 2009-09-08 フィードバック制御装置とフィードバック制御方法
JP2009-207165 2009-09-08

Publications (1)

Publication Number Publication Date
WO2010119740A1 true WO2010119740A1 (ja) 2010-10-21

Family

ID=42982408

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2010/054093 WO2010119740A1 (ja) 2009-04-17 2010-03-11 車両及びフィードバック制御方法

Country Status (3)

Country Link
US (1) US8630770B2 (ja)
EP (1) EP2420431A4 (ja)
WO (1) WO2010119740A1 (ja)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2012153596A1 (ja) * 2011-05-09 2012-11-15 Ntn株式会社 小型車両
CN103974874A (zh) * 2011-11-28 2014-08-06 Ntn株式会社 汽车
EP2694320B1 (de) * 2011-04-07 2019-05-15 Klaus Ebert Verfahren zum betreiben eines fahrzeugs
WO2023195444A1 (ja) * 2022-04-04 2023-10-12 株式会社デンソー 転舵制御装置

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2014008370A1 (en) 2012-07-06 2014-01-09 Mtd Products Inc Suspension and lock-out systems for a tracked vehicle
JP2014234001A (ja) 2013-05-31 2014-12-15 Ntn株式会社 車両の停車制御装置
US9884662B2 (en) 2013-09-13 2018-02-06 Mtd Products Inc Suspension and lock-out systems for a partially tracked vehicle
CN109501877B (zh) 2013-09-13 2020-07-14 Mtd产品公司 履带车辆用驱动链轮
EP2974942B1 (en) * 2014-06-30 2017-07-12 Danfoss Power Solutions Aps A method for controlling steering of a vehicle
US9725114B1 (en) 2014-07-03 2017-08-08 Hydro-Gear Limited Partnership Control system for a vehicle
CN105691443A (zh) * 2014-12-09 2016-06-22 Dy株式会社 利用pid控制的高尔夫球车的自动转向装置及转向方法
US10155537B2 (en) * 2015-05-29 2018-12-18 Mtd Products Inc Utility vehicle
CN105313953B (zh) * 2015-08-26 2017-06-27 杭州伯坦科技工程有限公司 具备独立转向和轮边驱动的汽车单轮装置及控制方法
DE102016214763A1 (de) * 2016-08-09 2018-02-15 Zf Friedrichshafen Ag Verfahren zum Wenden eines Fahrzeugs
JP6493342B2 (ja) * 2016-09-07 2019-04-03 トヨタ自動車株式会社 走行装置
CN106476888B (zh) 2016-10-28 2019-05-21 东莞市强乐塑胶制品有限公司 万向车
JP6919349B2 (ja) * 2017-06-09 2021-08-18 株式会社アイシン 走行支援システム
CN108001527A (zh) * 2017-11-16 2018-05-08 西南交通大学 一种全转向底盘
CN111511631B (zh) * 2017-12-26 2022-10-25 北越工业株式会社 高空作业车的行驶控制方法和行驶控制装置
WO2020004972A1 (en) 2018-06-27 2020-01-02 Lg Electronics Inc. Automatic control artificial intelligence device and method for updating a control function
WO2020004974A1 (en) 2018-06-27 2020-01-02 Lg Electronics Inc. Automatic control artificial intelligence device and method for updating control function
DE102019003008A1 (de) * 2019-04-26 2020-10-29 Daimler Ag Verfahren zum Betreiben eines Fahrerassistenzsystems eines zumindest teilweise elektrisch betreibbaren Kraftfahrzeugs zum Ansteuern von vier Rädern, Fahrerassistenzsystem sowie Kraftfahrzeug
CN111497637B (zh) * 2020-05-29 2023-03-10 浙江同筑科技有限公司 一种四舵轮agv的运动控制方法
CN111619336B (zh) * 2020-06-29 2024-03-22 徐州徐工港口机械有限公司 港口转运车辆及其控制方法
KR20220055947A (ko) * 2020-10-27 2022-05-04 현대자동차주식회사 4륜 독립조향 차량의 제자리 회전모드 제어방법 및 시스템
DE102021115823B3 (de) * 2021-06-18 2022-08-18 Schaeffler Technologies AG & Co. KG Fahrzeug und Verfahren zur Durchführung eines Parkmanövers
US11607952B1 (en) * 2022-05-04 2023-03-21 Dimaag-Ai, Inc. Methods and systems for controlling differential wheel speeds of multi- independent-wheel drive vehicles

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02220972A (ja) * 1989-02-18 1990-09-04 Nippon Yusoki Co Ltd 全方向車の手動データ入力装置
JPH0326672U (ja) * 1989-07-26 1991-03-18
JPH03132801A (ja) * 1989-10-19 1991-06-06 Toyo Electric Mfg Co Ltd 制御装置
JPH04287776A (ja) * 1991-03-15 1992-10-13 Komatsu Ltd 4輪操舵式車両
JPH0558330A (ja) * 1991-08-27 1993-03-09 Komatsu Ltd 全方向走行式車両
JPH06242836A (ja) * 1993-02-19 1994-09-02 Mitsubishi Electric Corp 車両走行制御装置
JPH09315334A (ja) * 1996-05-30 1997-12-09 Nippon Yusoki Co Ltd 全方向移動車両の操舵入力装置
JPH10244951A (ja) * 1997-03-07 1998-09-14 Meidensha Corp フォークリフト
JP2000267714A (ja) * 1999-03-15 2000-09-29 Toyoda Mach Works Ltd サーボ制御系の精密軌道制御のための補正入力値生成方法
JP2008013045A (ja) 2006-07-06 2008-01-24 Equos Research Co Ltd 操舵角制御装置

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0798619B2 (ja) 1989-06-26 1995-10-25 三菱電機株式会社 エレベータの群管理装置
JPH0580810A (ja) 1991-09-20 1993-04-02 Hitachi Ltd サーボ制御方法及び装置
JPH09294779A (ja) 1996-04-30 1997-11-18 Aisin Seiki Co Ltd 車椅子

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH02220972A (ja) * 1989-02-18 1990-09-04 Nippon Yusoki Co Ltd 全方向車の手動データ入力装置
JPH0326672U (ja) * 1989-07-26 1991-03-18
JPH03132801A (ja) * 1989-10-19 1991-06-06 Toyo Electric Mfg Co Ltd 制御装置
JPH04287776A (ja) * 1991-03-15 1992-10-13 Komatsu Ltd 4輪操舵式車両
JPH0558330A (ja) * 1991-08-27 1993-03-09 Komatsu Ltd 全方向走行式車両
JPH06242836A (ja) * 1993-02-19 1994-09-02 Mitsubishi Electric Corp 車両走行制御装置
JPH09315334A (ja) * 1996-05-30 1997-12-09 Nippon Yusoki Co Ltd 全方向移動車両の操舵入力装置
JPH10244951A (ja) * 1997-03-07 1998-09-14 Meidensha Corp フォークリフト
JP2000267714A (ja) * 1999-03-15 2000-09-29 Toyoda Mach Works Ltd サーボ制御系の精密軌道制御のための補正入力値生成方法
JP2008013045A (ja) 2006-07-06 2008-01-24 Equos Research Co Ltd 操舵角制御装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP2420431A4 *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2694320B1 (de) * 2011-04-07 2019-05-15 Klaus Ebert Verfahren zum betreiben eines fahrzeugs
WO2012153596A1 (ja) * 2011-05-09 2012-11-15 Ntn株式会社 小型車両
CN103974874A (zh) * 2011-11-28 2014-08-06 Ntn株式会社 汽车
WO2023195444A1 (ja) * 2022-04-04 2023-10-12 株式会社デンソー 転舵制御装置

Also Published As

Publication number Publication date
EP2420431A4 (en) 2014-05-21
US8630770B2 (en) 2014-01-14
EP2420431A1 (en) 2012-02-22
US20120046835A1 (en) 2012-02-23

Similar Documents

Publication Publication Date Title
WO2010119740A1 (ja) 車両及びフィードバック制御方法
US8660749B2 (en) Motor vehicle steering system
JP4534944B2 (ja) 乗り物
JP6081081B2 (ja) 倒立振子型車両
US8997911B2 (en) Vehicle
JP4294389B2 (ja) 車両用操舵装置
US8155839B2 (en) Steering device for vehicle
JP5921950B2 (ja) 倒立振子型車両
JP2013001230A (ja) 自走車両
WO2017037898A1 (ja) 電動アシスト車椅子および電動アシスト車椅子の制御方法
JP4456018B2 (ja) 車両の操舵装置
JP3685692B2 (ja) 車両用操舵装置
JP5422257B2 (ja) 車両
JP6414678B2 (ja) 車両用操舵装置
JP5808289B2 (ja) 倒立振子型車両
JP2013237323A (ja) 倒立振子型車両
JP4882409B2 (ja) 車両の操舵装置
JP6020386B2 (ja) 移動体及び制御方法、制御プログラム
KR20100101910A (ko) 암방식 로봇 차량의 조향 제어 방법 및 이를 이용한 조향 제어기를 구비하는 암방식 로봇 차량 장치
JP2006088989A (ja) 車両用操舵制御装置
JP4690168B2 (ja) 乗り物およびペダル操作装置
JP2014000959A (ja) 車両
JP2021195072A (ja) 車両用操舵装置
JP2005041385A (ja) 車両の操舵制御装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 10764326

Country of ref document: EP

Kind code of ref document: A1

DPE1 Request for preliminary examination filed after expiration of 19th month from priority date (pct application filed from 20040101)
NENP Non-entry into the national phase

Ref country code: DE

WWE Wipo information: entry into national phase

Ref document number: 13264805

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 2010764326

Country of ref document: EP