WO2014033789A1 - 倒立型移動体及びその制御方法 - Google Patents
倒立型移動体及びその制御方法 Download PDFInfo
- Publication number
- WO2014033789A1 WO2014033789A1 PCT/JP2012/005504 JP2012005504W WO2014033789A1 WO 2014033789 A1 WO2014033789 A1 WO 2014033789A1 JP 2012005504 W JP2012005504 W JP 2012005504W WO 2014033789 A1 WO2014033789 A1 WO 2014033789A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- inverted
- control
- moving body
- microcomputer
- torque
- Prior art date
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L3/00—Electric devices on electrically-propelled vehicles for safety purposes; Monitoring operating variables, e.g. speed, deceleration or energy consumption
- B60L3/0023—Detecting, eliminating, remedying or compensating for drive train abnormalities, e.g. failures within the drive train
- B60L3/0084—Detecting, eliminating, remedying or compensating for drive train abnormalities, e.g. failures within the drive train relating to control modules
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60K—ARRANGEMENT OR MOUNTING OF PROPULSION UNITS OR OF TRANSMISSIONS IN VEHICLES; ARRANGEMENT OR MOUNTING OF PLURAL DIVERSE PRIME-MOVERS IN VEHICLES; AUXILIARY DRIVES FOR VEHICLES; INSTRUMENTATION OR DASHBOARDS FOR VEHICLES; ARRANGEMENTS IN CONNECTION WITH COOLING, AIR INTAKE, GAS EXHAUST OR FUEL SUPPLY OF PROPULSION UNITS IN VEHICLES
- B60K28/00—Safety devices for propulsion-unit control, specially adapted for, or arranged in, vehicles, e.g. preventing fuel supply or ignition in the event of potentially dangerous conditions
- B60K28/02—Safety devices for propulsion-unit control, specially adapted for, or arranged in, vehicles, e.g. preventing fuel supply or ignition in the event of potentially dangerous conditions responsive to conditions relating to the driver
- B60K28/04—Safety devices for propulsion-unit control, specially adapted for, or arranged in, vehicles, e.g. preventing fuel supply or ignition in the event of potentially dangerous conditions responsive to conditions relating to the driver responsive to presence or absence of the driver, e.g. to weight or lack thereof
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/20—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L15/00—Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
- B60L15/32—Control or regulation of multiple-unit electrically-propelled vehicles
- B60L15/38—Control or regulation of multiple-unit electrically-propelled vehicles with automatic control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L3/00—Electric devices on electrically-propelled vehicles for safety purposes; Monitoring operating variables, e.g. speed, deceleration or energy consumption
- B60L3/04—Cutting off the power supply under fault conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L58/00—Methods or circuit arrangements for monitoring or controlling batteries or fuel cells, specially adapted for electric vehicles
- B60L58/10—Methods or circuit arrangements for monitoring or controlling batteries or fuel cells, specially adapted for electric vehicles for monitoring or controlling batteries
- B60L58/24—Methods or circuit arrangements for monitoring or controlling batteries or fuel cells, specially adapted for electric vehicles for monitoring or controlling batteries for controlling the temperature of batteries
- B60L58/25—Methods or circuit arrangements for monitoring or controlling batteries or fuel cells, specially adapted for electric vehicles for monitoring or controlling batteries for controlling the temperature of batteries by controlling the electric load
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62K—CYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
- B62K11/00—Motorcycles, engine-assisted cycles or motor scooters with one or two wheels
- B62K11/007—Automatic balancing machines with single main ground engaging wheel or coaxial wheels supporting a rider
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2200/00—Type of vehicles
- B60L2200/16—Single-axle vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2220/00—Electrical machine types; Structures or applications thereof
- B60L2220/40—Electrical machine applications
- B60L2220/46—Wheel motors, i.e. motor connected to only one wheel
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/42—Drive Train control parameters related to electric machines
- B60L2240/421—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/42—Drive Train control parameters related to electric machines
- B60L2240/423—Torque
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
- B60L2240/00—Control parameters of input or output; Target parameters
- B60L2240/40—Drive Train control parameters
- B60L2240/54—Drive Train control parameters related to batteries
- B60L2240/545—Temperature
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62K—CYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
- B62K5/00—Cycles with handlebars, equipped with three or more main road wheels
- B62K5/10—Cycles with handlebars, equipped with three or more main road wheels with means for inwardly inclining the vehicle body on bends
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/64—Electric machine technologies in electromobility
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/70—Energy storage systems for electromobility, e.g. batteries
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Definitions
- the present invention relates to an inverted moving body and a control method thereof, and more particularly, to a technique for controlling an inverted moving body that moves while being inverted by applying torque to a wheel by a plurality of multiplexed control systems. .
- Patent Document 1 As vehicles for carrying humans, vehicles having two wheels as disclosed in Patent Document 1 and Patent Document 2 have been studied. In such an inverted motorcycle, it is necessary to ensure control stability.
- inverted motorcycles ensure control stability by duplicating the control system of inverted motorcycles. However, it is difficult to ensure the stability of the control when the control system affected by a component failure in the inverted motorcycle is degenerated and the control is performed by a single system (single system). turn into.
- the present invention has been made on the basis of the above-described knowledge, and in an inverted moving body that moves by being inverted and controlled by applying torque to the wheels by a plurality of multiplexed control systems, It is an object of the present invention to provide an inverted moving body capable of further improving stability and a control method thereof.
- An inverted moving body includes an inverted moving body that includes a plurality of multiplexed control systems, and that moves while being inverted by driving the wheels by applying torque to the plurality of control systems.
- a moving body wherein the control system detects that the switching control unit has switched to the inverted control in which at least one of the plurality of control systems is degenerated, and the inversion by the switching detection unit.
- an inversion control unit that controls the inversion of the inverted moving body by limiting at least one of the speed and posture angle of the inverted moving body when switching of the control is detected.
- the control method according to the second aspect of the present invention is a control method for moving an inverted movable body by performing an inverted control by driving a wheel by applying torque to a plurality of multiplexed control systems, A switching detection step for detecting switching to the inverted control in which at least one control system is degenerated among the plurality of control systems; and when the switching of the inverted control is detected, the speed of the inverted mobile body And an inversion control step for performing inversion control of the inverted moving body by limiting at least one of the posture angles.
- the stability of control is further improved in an inverted moving body that moves by being inverted and controlled by applying torque to the wheels by a plurality of multiplexed control systems. It is possible to provide an inverted moving body that can be used and a control method thereof.
- FIG. 1 is a diagram showing a schematic configuration of an inverted motorcycle 1 according to a first embodiment of the present invention.
- the inverted motorcycle 1 detects a posture angle of the inverted motorcycle 1 in the front-rear direction when a passenger who has boarded the step plate 3 applies a load in the front-rear direction of the inverted motorcycle 1 with a sensor. Based on this, the motors that drive the left and right wheels 2 are controlled so that the inverted motorcycle 1 is maintained in the inverted state. In other words, the inverted motorcycle 1 accelerates forward so as to maintain the inverted state of the inverted motorcycle 1 when the passenger who has boarded the step plate 3 applies a load forward to tilt the inverted motorcycle 1 forward.
- the motors that drive the left and right wheels 2 are controlled so as to accelerate backward so as to maintain the inverted motorcycle 1 in an inverted state.
- a control system for controlling the motor is duplicated in order to ensure control stability.
- control of these motors is performed by a control device mounted on the inverted motorcycle 1.
- the control device will be described later with reference to FIG.
- FIG. 2 it is a block diagram which shows the structure of the control apparatus 10 concerning Embodiment 1 of this invention.
- the control device 10 includes microcontrollers 11 and 12 (hereinafter also referred to as “microcomputer”), DCDC converter (hereinafter also referred to as “DCDC”) 13 and 14, batteries 15 and 16, inverters 17 to 20, relay circuits (hereinafter referred to as “DCC”). 21 to 24), motors 25 and 26, rotation angle sensors 27 to 30, posture angle sensors 31 and 32, and load sensors 33 and 34.
- microcomputer microcontrollers 11 and 12
- DCDC converter hereinafter also referred to as “DCDC”
- DCC relay circuits
- motors 25 and 26 rotation angle sensors 27 to 30, posture angle sensors 31 and 32, and load sensors 33 and 34.
- the control device 10 is a dual system in which the control system of the inverted motorcycle 1 is duplexed into a control system of 1 system and a control system of 2 system in order to ensure the stability of the control.
- the first system includes a microcomputer 11, a DCDC converter 13, a battery 15, inverters 17 and 18, relays 21 and 22, rotation angle sensors 27 and 28, a posture angle sensor 31, and a load sensor 33.
- the second system includes a microcomputer 12, a DCDC converter 14, a battery 16, inverters 19 and 20, relays 23 and 24, rotation angle sensors 29 and 30, an attitude angle sensor 32, and a load sensor 34.
- Each of the microcomputers 11 and 12 is an ECU (Engine Control Unit) that controls the motors 25 and 26 so as to maintain the inverted state based on the attitude angle signals output from the attitude angle sensors 31 and 32 as described above. It is.
- Each of the microcomputers 11 and 12 has a CPU (Central Processing Unit) and a storage unit, and executes processing as each of the microcomputers 11 and 12 in the present embodiment by executing a program stored in the storage unit.
- the program stored in the storage unit of each of the microcomputers 11 and 12 includes a code for causing the CPU to execute processing in each of the microcomputers 11 and 12 in the present embodiment.
- the storage unit includes, for example, an arbitrary storage device that can store the program and various types of information used for processing in the CPU.
- the storage device is, for example, a memory.
- the microcomputer 11 outputs a command value for controlling the motor 25 to the inverter 17. Further, the microcomputer 11 outputs a command value for controlling the motor 26 to the inverter 18. The microcomputer 12 outputs a command value for controlling the motor 25 to the inverter 19. Further, the microcomputer 12 outputs a command value for controlling the motor 26 to the inverter 20.
- the microcomputer 11 generates a command value for the inverter 17 so that the motor 25 is feedback-controlled based on the rotation angle signal output from the rotation angle sensor 27 and indicating the rotation angle of the motor 25. Further, the microcomputer 11 generates a command value for the inverter 18 so as to feedback-control the motor 26 based on a rotation angle signal output from the rotation angle sensor 28 and indicating the rotation angle of the motor 26. The microcomputer 12 generates a command value for the inverter 19 so as to feedback control the motor 25 based on a rotation angle signal output from the rotation angle sensor 29 and indicating the rotation angle of the motor 25. Further, the microcomputer 12 generates a command value for the inverter 20 so as to feedback-control the motor 26 based on a rotation angle signal output from the rotation angle sensor 30 and indicating the rotation angle of the motor 26.
- microcomputer 11 operates based on the power supplied from the DCDC 13.
- microcomputer 12 operates based on the power supplied from the DCDC 14.
- the DCDC 13 transforms the voltage of the power supplied from the battery 15 into a voltage suitable for supply to the microcomputer 11 and supplies the power to the microcomputer 11.
- the DCDC 14 transforms the voltage in the electric power supplied from the battery 16 into a voltage suitable for supply to the microcomputer 12 and supplies the electric power to the microcomputer 12.
- Each of the batteries 15 and 16 supplies electric power necessary for the operation to the control device 10. Specifically, the battery 15 supplies power necessary for the operation of the microcomputer 11 to the DCDC 13. The battery 16 supplies power necessary for the operation of the microcomputer 12 to the DCDC 14.
- the inverter 17 performs PWM (Pulse Width Modulation) control based on the command value output from the microcomputer 11, thereby generating a drive current for driving the motor 25 from the power supplied from the battery 15, and the relay 21. Is supplied to the motor 25.
- the inverter 18 performs PWM control based on the command value output from the microcomputer 11, thereby generating a drive current for driving the motor 26 from the electric power supplied from the battery 15, and the motor 26 via the relay 22.
- the inverter 19 performs PWM control based on the command value output from the microcomputer 12, thereby generating a drive current for driving the motor 25 from the electric power supplied from the battery 16, and the motor 25 via the relay 23.
- the inverter 20 performs PWM control based on the command value output from the microcomputer 12, thereby generating a drive current for driving the motor 26 from the electric power supplied from the battery 16, and the motor 26 via the relay 24. To supply.
- the relay 21 separates the inverter 17 and the motor 25 according to the control from the microcomputer 11 which is performed according to the failure detection of the 1-system components by the microcomputer 11.
- the relay 22 separates the inverter 18 and the motor 26 in accordance with the control from the microcomputer 11 that is performed in response to the failure detection of the one-system component by the microcomputer 11.
- the relay 23 separates the inverter 19 and the motor 25 in accordance with control from the microcomputer 12 that is performed in response to the failure detection of the two system components by the microcomputer 12.
- the relay 24 separates the inverter 20 and the motor 26 in accordance with the control from the microcomputer 12 that is performed in response to the failure detection of the two system components by the microcomputer 12.
- Each of the motors 25 and 26 is a double-winding motor.
- the motor 25 is driven based on the drive current supplied from the inverter 17 via the relay 21 and the drive current supplied from the inverter 19 via the relay 23.
- the motor 26 is driven based on the drive current supplied from the inverter 18 via the relay 22 and the drive current supplied from the inverter 20 via the relay 24.
- the motor 26 By driving the motor 26, the right wheel 2 of the inverted motorcycle 1 rotates.
- the rotation angle sensor 27 detects the rotation angle of the motor 25, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the microcomputer 11.
- the rotation angle sensor 28 detects the rotation angle of the motor 26, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the microcomputer 11.
- the rotation angle sensor 29 detects the rotation angle of the motor 25, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the microcomputer 11.
- the rotation angle sensor 30 detects the rotation angle of the motor 26, generates a rotation angle signal indicating the detected rotation angle, and outputs the rotation angle signal to the microcomputer 11.
- Each of the posture angle sensors 31 and 32 detects and detects the posture angle of the inverted motorcycle 1 with respect to the front-rear direction when a load is applied to the step plate 3 in the front-rear direction of the inverted motorcycle 1.
- a posture angle signal indicating the posture angle is output to each of the microcomputers 11 and 12.
- Each of the posture angle sensors 31 and 32 is configured to detect the posture angle of the inverted moving body 1 by using, for example, an acceleration sensor and a gyro sensor.
- Each of the load sensors 33 and 34 detects the load from the passenger acting on the step plate 3 and outputs a load signal indicating the detected load to each of the microcomputers 11 and 12.
- FIG. 3 is a conceptual diagram of motor control according to the first embodiment of the present invention.
- Each of the motors 25 and 26 has a double winding as described above. Specifically, the motor 25 has a double winding of a coil 251 and a coil 252, and the motor 26 has a double winding of a coil 261 and a coil 262.
- the motor 25 is driven by a drive current supplied from the microcomputer 11 to the coil 251 via the relay 21 and a drive current supplied from the microcomputer 12 to the coil 252 supplied via the relay 23.
- the motor 26 is driven by the drive current supplied from the microcomputer 11 to the coil 261 via the relay 22 and to the coil 262 supplied from the microcomputer 12 via the relay 24.
- the motors 25 and 26 can be driven by supplying drive currents from the two control systems, so the motors 25 and 26 can drive the wheels of the inverted motorcycle 1. It is possible to drive with a large torque.
- the motors 25 and 26 are driven by supplying a drive current from only one control system. The motors 25 and 26 can be driven only with half the torque as compared with the operation in the dual system.
- Equation (1) is an equation of motion indicating the acceleration of the inverted motorcycle
- Equation (2) is an equation of motion indicating the angular acceleration of the posture angle in the inverted motorcycle.
- v indicates the speed of the inverted motorcycle.
- ⁇ represents a posture angle.
- u (t) represents torque.
- D represents the friction coefficient of an inverted motorcycle.
- m represents the mass (weight) of the pendulum (passenger).
- mc represents the mass of the inverted motorcycle.
- M represents 4mc + m.
- g represents gravitational acceleration.
- l indicates the length of the pendulum (passenger) from the center of gravity.
- each of the microcomputers 11 and 12 is operated by a single system, and based on the load signals output from the load sensors 33 and 34, the load from the passenger When it is determined that the load (including the load of the luggage held by the passenger) is heavy, it is determined that there is a possibility that torque shortage in driving the wheels 2 may occur.
- each of the microcomputers 11 and 12 reduces the torque required for maintaining the inversion by restricting at least one of the speed and posture angle of the inverted motorcycle 1 and performing the inversion control of the inverted motorcycle 1. Thus, the control stability of the inverted motorcycle 1 is ensured.
- the processing will be described.
- FIG. 5 is a flowchart showing the processing of the control device 10 according to the first embodiment of the present invention.
- the microcomputers 11 and 12 determine whether the dual system mode in which neither the 1-system nor the 2-system control system is degenerated (S1). Specifically, when the microcomputer 11 or the microcomputer 12 detects an abnormality (such as a failure of a component included in the self-control system) in the self-control system, the microcomputer 11 degenerates the self-control system and notifies the fact Is output to the microcomputer (the microcomputer 11 or the microcomputer 12) of the other control system. When receiving this information, the microcomputer (the microcomputer 11 or the microcomputer 12) determines that the other control system is degenerated and does not operate in the dual system mode (operates in the single system mode). (S1: No). If this information is not received, the microcomputers 11 and 12 determine that they are operating in the dual system mode (S1: Yes).
- each of the microcomputers 11 and 12 switches the relays (relays 21 and 22 or relays 23 and 24) included in the self-control system when the self-control system is degenerated.
- the inverters (inverters 17 and 18 or inverters 19 and 20) and motors 25 and 26 included in the system are separated. Thus, by separating the malfunctioning control system from the motors 25 and 26, erroneous control is prevented and safety in control is ensured.
- the microcomputer 11 detects an abnormality in the self-control system, degenerates the control system of the first system, and the microcomputer 11 belonging to the first system notifies the microcomputer 12 to that effect will be exemplified. That is, the case where it is determined that the microcomputer 12 is not in the dual system mode is illustrated. Needless to say, even when the microcomputer 12 detects an abnormality in the second control system and the second control system is degenerated, the microcomputer 11 can perform the same processing.
- the microcomputer 12 checks a factor that increases the risk of torque shortage in the single system (S2). Specifically, in the first embodiment, the microcomputer 12 determines whether the load acting on the step plate 3 is greater than a predetermined threshold (load) based on the load signal output from the load sensor 34. Determine. That is, the microcomputer 12 determines whether or not the load indicated by the load signal is larger than a predetermined threshold value (load). When it is determined that the load indicated by the load signal is greater than the predetermined threshold, the microcomputer 12 determines that there is a problem with the check (S3: No). If it is determined that the load indicated by the load signal is equal to or less than the predetermined threshold, the microcomputer 12 determines that there is no problem in the check (S3: Yes).
- a predetermined threshold load
- the microcomputer 12 determines that there is a problem in the check in step S2 (S3: No)
- the microcomputer 12 restricts the control content of the inverted motorcycle 1 so that the torque necessary for maintaining the inversion is reduced (S4).
- the control content of the inverted motorcycle 1 is limited by at least one of the following limiting methods (1) and (2).
- the microcomputer 12 determines the upper limit value of the speed of the inverted motorcycle 1 according to the load indicated by the load signal so as not to cause a torque shortage in driving the wheels 2.
- the microcomputer 12 determines the upper limit value of the speed so as to decrease as the load increases.
- the upper limit value of the speed according to the size of the load is, for example, a table that can specify the upper limit value of the speed suitable for the load from the size of the load, or suitable for the load from the size of the load.
- Information indicating a calculation formula capable of calculating the upper limit value of the speed may be stored in each storage unit of the microcomputer 12 so that the CPU of the microcomputer 12 can determine the information by referring to the information. Then, the microcomputer 12 performs the inversion control of the inverted motorcycle 1 so that the speed of the inverted motorcycle 1 is equal to or less than the determined upper limit value.
- the microcomputers 11 and 12 in the two control systems have the speed of the inverted motorcycle 1 of 2V.
- a drive current is supplied to the motors 25 and 26.
- the description will be made on the assumption that the upper limit value of the speed of the inverted motorcycle 1 is determined to be V based on the load on the inverted motorcycle 1 from the passenger.
- the drive current can be supplied to the motors 25 and 26 so that the speed of the inverted two-wheeled vehicle 1 becomes 2V even in the single system mode. Even if possible, the drive current supplied to the motors 25 and 26 is limited so that the speed of the inverted motorcycle 1 is limited to V or less.
- the microcomputer 12 outputs a command value to the inverters 17 and 18 so that the speed of the inverted motorcycle 1 is limited to V or less by the drive current supplied from the inverters 17 and 18 to the motors 25 and 26. To control.
- the microcomputer 12 determines that the speed of the inverted two-wheeled vehicle 1 calculated from the rotation angle indicated by the rotation angle signal output from each of the rotation angle sensors 29 and 30 exceeds the upper limit value V, the motor 25 , 26, the acceleration of the inverted motorcycle 1 is suppressed, and the speed of the inverted motorcycle 1 is maintained at the upper limit value V or less.
- the microcomputer 12 determines the upper limit value of the attitude angle of the inverted motorcycle 1 according to the load indicated by the load signal so as not to cause a torque shortage in driving the wheels 2.
- the microcomputer 12 determines the upper limit value of the posture angle so as to become smaller as the load becomes larger.
- the upper limit value of the posture angle according to the magnitude of the load is, for example, a table that can specify the upper limit value of the posture angle suitable for the load from the magnitude of the load, or the load from the magnitude of the load.
- Information indicating a calculation formula capable of calculating the upper limit value of the posture angle suitable for the condition is stored in each storage unit of the microcomputer 12, and the CPU of the microcomputer 12 can be determined by referring to the information. That's fine. Then, the microcomputer 12 performs the inversion control of the inverted two-wheeled vehicle 1 so that the posture angle of the inverted two-wheeled vehicle 1 becomes a posture angle equal to or less than the determined upper limit value.
- the microcomputer 12 limits the drive current supplied to the motors 25 and 26 so that the attitude angle of the inverted motorcycle 1 is limited to ⁇ or less.
- the microcomputer 12 outputs a command to the inverters 17 and 18 so that the attitude angle of the inverted motorcycle 1 is limited to ⁇ or less by the drive current supplied to the motors 25 and 26 from the inverters 17 and 18. Control the value.
- the microcomputer 12 determines that the posture angle indicated by the posture angle signal output from the posture angle sensor 31 exceeds the upper limit value ⁇ , the microcomputer 12 increases the drive current supplied to the motors 25 and 26. The inverted motorcycle 1 is accelerated so that the posture angle of the inverted motorcycle 1 is maintained below the upper limit value ⁇ .
- the inverted two-wheeled vehicle 1 can be stably controlled even when a sudden braking is performed during cruising with a heavy passenger.
- the microcomputer 12 determines that there is no problem in the check in step S2 (S3: Yes), the microcomputer 12 does not limit the control content of the inverted motorcycle 1 (S5).
- the control system when it is detected that the control system has been switched to the inverted control and the switching of the inverted control is detected, at least the speed and the attitude angle of the inverted motorcycle 1 are detected. Inverting control of the inverted motorcycle 1 is performed by limiting one. According to this, even when the control system is degenerated and the torque that can be applied to the wheel 2 of the inverted two-wheeled vehicle 1 is reduced, the torque necessary for driving the wheel 2 can also be reduced. Therefore, the control stability of the inverted motorcycle 1 can be further improved.
- the inverted motorcycle 1 is controlled to be inverted so as to limit at least one of the speed and the attitude angle of the inverted motorcycle 1. According to this, even if the load from what boarded the inverted two-wheeled vehicle 1 is large, the increase in the torque required for driving the wheel 2 can be suppressed. Therefore, the control stability of the inverted motorcycle 1 can be further improved.
- FIG. 6 the structure of the control apparatus 10 concerning Embodiment 2 of this invention is demonstrated.
- FIG. 6 it is a block diagram which shows the structure of the control apparatus 10 concerning Embodiment 2 of this invention.
- the control device 10 includes tilt angle sensors 35 and 36.
- the tilt angle sensor 35 is included in the first system, and the tilt angle sensor 36 is included in the second system.
- Each of the inclination angle sensors 35, 36 detects an inclination angle of a traveling surface (for example, a road surface) on which the inverted motorcycle 1 travels with respect to the front-rear direction of the inverted motorcycle 1, and outputs an inclination angle signal indicating the detected inclination angle to the microcomputer 11. , 12 respectively.
- Each of the inclination angle sensors 35 and 36 is configured to detect the inclination of the traveling surface on which the inverted two-wheeled vehicle 1 travels, for example, by an acceleration sensor.
- each of the microcomputers 11 and 12 is the inverted motorcycle 1 based on the tilt angle signals output from the tilt angle sensors 35 and 36 when operating in a single system.
- each of the microcomputers 11 and 12 reduces the torque required for maintaining the inversion by restricting at least one of the speed and posture angle of the inverted motorcycle 1 and performing the inversion control of the inverted motorcycle 1.
- the processing will be described.
- step S2 processing of the control device 10 according to the second embodiment of the present invention.
- the process of the control device 10 according to the second embodiment of the present invention is checked in step S2 as compared with the process of the control device 10 according to the first embodiment described with reference to FIG.
- the factors are different. That is, in the second embodiment, as described above, the inclination angle of the traveling surface on which the inverted two-wheeled vehicle 1 travels is checked as a factor that increases the risk of torque shortage with a single system.
- the upper limit value that restricts the control content of the inverted motorcycle 1 is determined according to the inclination angle of the traveling surface on which the inverted motorcycle 1 travels. Description of other processes similar to those in the first embodiment will be omitted.
- the microcomputer 12 determines that the inclination angle of the traveling surface on which the inverted two-wheeled vehicle 1 travels is based on the inclination angle signal output from the inclination angle sensor 36 from a predetermined threshold (inclination angle). It is determined whether or not the value is larger (S2). That is, the microcomputer 12 determines whether or not the inclination angle indicated by the inclination angle signal is larger than a predetermined threshold value (inclination angle). When it is determined that the inclination angle of the traveling surface on which the inverted motorcycle 1 travels is greater than the predetermined threshold, the microcomputer 12 determines that there is a problem with the check (S3: No). When it is determined that the inclination angle of the road surface on which the inverted motorcycle 1 travels is equal to or smaller than the predetermined threshold, the microcomputer 12 determines that there is no problem in the check (S3: Yes).
- the microcomputer 12 determines that there is a problem in the check in step S2 (S3: No), among the operation suppression methods of (1) and (2) described above, the torque necessary for maintaining the inversion is reduced.
- the operation of the inverted motorcycle 1 is suppressed by at least one (S4).
- the upper limit value of the speed or posture angle of the inverted motorcycle 1 is determined according to the inclination angle indicated by the inclination angle signal.
- the microcomputer 12 determines the upper limit value of the speed of the inverted two-wheeled vehicle 1 according to the tilt angle indicated by the tilt angle signal so as not to cause a torque shortage in driving the wheels 2.
- the microcomputer 12 determines the upper limit value of the speed so as to become smaller as the inclination angle becomes larger.
- the upper limit value of the speed according to the magnitude of the tilt angle is, for example, from the magnitude of the tilt angle, from a table that can specify the upper limit value of the speed suitable for the tilt angle, or from the magnitude of the tilt angle, Information indicating a calculation formula capable of calculating the upper limit value of the speed suitable for the inclination angle is stored in each storage unit of the microcomputer 12, and the CPU of the microcomputer 12 can be determined by referring to the information. And it is sufficient. Then, the microcomputer 12 performs the inversion control of the inverted motorcycle 1 so that the speed of the inverted motorcycle 1 is equal to or less than the determined upper limit value.
- the microcomputer 12 determines the upper limit value of the attitude angle of the inverted motorcycle 1 according to the inclination angle indicated by the inclination angle signal so as not to cause a torque shortage in driving the wheels 2. .
- the microcomputer 12 determines the upper limit value of the posture angle so as to become smaller as the inclination angle becomes larger.
- the upper limit value of the posture angle according to the size of the tilt angle is, for example, a table that can identify the upper limit value of the posture angle suitable for the tilt angle from the size of the tilt angle, or the size of the tilt angle. Therefore, information indicating a calculation formula capable of calculating the upper limit value of the posture angle suitable for the inclination angle is stored in each storage unit of the microcomputer 12, and the CPU of the microcomputer 12 refers to the information. It can be determined by. Then, the microcomputer 12 performs the inversion control of the inverted two-wheeled vehicle 1 so that the posture angle of the inverted two-wheeled vehicle 1 becomes a posture angle equal to or less than the determined upper limit value.
- the inclination angle of the moving surface (traveling surface) on which the inverted motorcycle 1 moves is detected by the inclination angle sensor, and the detected inclination angle is larger than a predetermined threshold value.
- the inverted motorcycle 1 is controlled so as to limit at least one of the speed and the attitude angle of the inverted motorcycle 1. According to this, even if the inclination angle of the moving surface on which the inverted two-wheeled vehicle 1 moves is large, an increase in torque necessary for driving the wheels 2 can be suppressed. Therefore, the control stability of the inverted motorcycle 1 can be further improved.
- FIG. 7 the structure of the control apparatus 10 concerning Embodiment 3 of this invention is demonstrated.
- FIG. 7 it is a block diagram which shows the structure of the control apparatus 10 concerning Embodiment 3 of this invention.
- the control device 10 includes temperature sensors 37 and 38.
- the temperature sensor 37 is included in the first system, and the temperature sensor 38 is included in the second system.
- Each of the temperature sensors 37 and 38 detects the temperature in each of the batteries 15 and 16 and outputs a temperature signal indicating the detected temperature to each of the microcomputers 11 and 12.
- the output of the battery decreases as the temperature thereof decreases. That is, when the temperature of the batteries 15 and 16 decreases, the drive current generated in the inverters 17 and 18 based on the output current also decreases, and the torque that can be applied to the wheels 2 also decreases. .
- the torque that can be applied to the wheel 2 is halved. Therefore, when the temperature of the battery decreases under the condition of operating in a single system, the risk that control becomes unstable due to insufficient torque increases.
- each of the microcomputers 11 and 12 is operated based on the temperature signal output from each of the temperature sensors 37 and 38 when operating in a single system.
- each of the microcomputers 11 and 12 reduces the torque required for maintaining the inversion by restricting at least one of the speed and posture angle of the inverted motorcycle 1 and performing the inversion control of the inverted motorcycle 1.
- the processing will be described.
- step S2 processing of the control device 10 according to the third embodiment of the present invention.
- the process of the control device 10 according to the third embodiment of the present invention is checked in step S2 as compared with the process of the control device 10 according to the first embodiment described with reference to FIG.
- the factors are different. That is, in the third embodiment, as described above, the temperature of the batteries 15 and 16 is checked as a factor that increases the risk of torque shortage with a single system.
- the upper limit value for limiting the control content of the inverted motorcycle 1 is determined according to the temperature of the batteries 15 and 16. Description of other processes similar to those in the first embodiment will be omitted.
- the microcomputer 12 determines whether or not the temperature of the battery 16 is smaller than a predetermined threshold (temperature) based on the temperature signal output from the temperature sensor 38 (S2). ). That is, the microcomputer 12 determines whether or not the temperature indicated by the temperature signal is smaller than a predetermined threshold (temperature). And when it determines with the temperature of the battery 16 being smaller than a predetermined threshold value, the microcomputer 12 determines with a problem in a check (S3: No). When it is determined that the temperature of the battery 16 is equal to or higher than the predetermined threshold, the microcomputer 12 determines that there is no problem in the check (S3: Yes).
- step S3 When the microcomputer 12 determines that there is a problem in the check in step S2 (S3: No), among the operation suppression methods of (1) and (2) described above, the torque necessary for maintaining the inversion is reduced.
- the operation of the inverted motorcycle 1 is suppressed by at least one (S4).
- the upper limit value of the speed or posture angle of the inverted motorcycle 1 is determined according to the temperature indicated by the temperature signal.
- the microcomputer 12 determines the upper limit value of the speed of the inverted motorcycle 1 according to the temperature indicated by the temperature signal so as not to cause a torque shortage in driving the wheels 2.
- the temperature indicated by the temperature signal decreases, the torque that can be applied to the wheel 2 also decreases.
- the microcomputer 12 determines the upper limit value of the speed so as to decrease as the temperature of the battery 16 decreases.
- the upper limit value of the speed according to the temperature of the battery 16 is, for example, a table that can identify the upper limit value of the speed suitable for the temperature of the battery 16 from the temperature of the battery 16 or the battery.
- Information indicating a calculation formula capable of calculating an upper limit value of the speed suitable for the temperature of the battery 16 from the magnitude of the temperature of the battery 16 is stored in each storage unit of the microcomputer 12, and the CPU of the microcomputer 12 It can be determined by referring to the information. Then, the microcomputer 12 performs the inversion control of the inverted motorcycle 1 so that the speed of the inverted motorcycle 1 is equal to or less than the determined upper limit value.
- the microcomputer 12 determines the upper limit value of the attitude angle of the inverted two-wheeled vehicle 1 according to the temperature indicated by the temperature signal so as not to cause torque shortage in driving the wheels 2.
- the microcomputer 12 determines the upper limit value of the posture angle so as to decrease as the temperature of the battery 16 decreases.
- the upper limit value of the posture angle corresponding to the temperature level of the battery 16 is, for example, a table that can specify the upper limit value of the posture angle suitable for the temperature of the battery 16 from the temperature level of the battery 38, or Information indicating a calculation formula capable of calculating the upper limit value of the posture angle suitable for the temperature of the battery 16 from the temperature of the battery 16 is stored in each storage unit of the microcomputer 12. The CPU may be determined by referring to the information. Then, the microcomputer 12 performs the inversion control of the inverted two-wheeled vehicle 1 so that the posture angle of the inverted two-wheeled vehicle 1 becomes a posture angle equal to or less than the determined upper limit value.
- the control content of the inverted motorcycle 1 in the single system mode, even when the temperature of the battery 16 is low, the control is performed only from the control system that is not degenerated, so that there is insufficient torque. It is possible to perform control while ensuring stability so as not to occur.
- the inverted two-wheeled vehicle 1 in the single system mode, can be stably stopped even when sudden braking is performed during cruising in an environment where the temperature is low.
- the inverted motorcycle 1 is controlled to be inverted so as to limit at least one of the speed and the posture angle of the inverted motorcycle 1. According to this, even when the temperature of the battery 16 is low, the torque necessary for driving the wheels 2 can be reduced to solve the torque shortage. Therefore, the control stability of the inverted motorcycle 1 can be further improved.
- control system is duplexed
- number of control systems to be multiplexed is not limited to this.
- three or more control systems may be multiplexed.
- the remaining control system microcomputer limits the speed or attitude angle of the inverted motorcycle as described above. do it.
- the inverted moving object to be controlled is an inverted two-wheeled vehicle having two wheels, but is not limited thereto.
- the present invention may be applied to an inverted moving body having one or three or more wheels.
- a predetermined factor is further detected by the sensor, and the wheel is driven based on the detected content.
- the present invention is not limited to this.
- the speed or posture angle of the inverted motorcycle may be limited. This is because the torque shortage due to the degeneration of the control system can be solved in general.
- the upper limit value of the speed or posture angle of the inverted motorcycle may be set to a predetermined speed or a predetermined posture angle.
- the operation of the inverted motorcycle is limited when it is determined that there is a problem by comparison with the threshold values in all of the detection factors (two or more of the load, the inclination angle, and the temperature) in each of the combined embodiments. It is also possible to limit the operation of the inverted motorcycle when it is determined that there is a problem by comparison with a threshold in at least one of the detection factors in each of the combined embodiments. .
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Transportation (AREA)
- Power Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- Sustainable Development (AREA)
- Sustainable Energy (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Motorcycle And Bicycle Frame (AREA)
- Safety Devices In Control Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
図1を参照して、本発明の実施の形態1にかかる倒立二輪車1について説明する。図1は、本発明の実施の形態1にかかる倒立二輪車1を概要構成に示す図である。
(2)倒立二輪車1の許容姿勢角を制限する
続いて、本発明の実施の形態2にかかる倒立二輪車1について説明する。なお、本発明の実施の形態2にかかる倒立二輪車1の概略構成については、図1を参照して説明した、実施の形態1にかかる倒立二輪車1の概要構成と同様であるため、その説明を省略する。
続いて、本発明の実施の形態3にかかる倒立二輪車1について説明する。なお、本発明の実施の形態3にかかる倒立二輪車1の概略構成については、図1を参照して説明した、実施の形態1にかかる倒立二輪車1の概要構成と同様であるため、その説明を省略する。
10 制御装置
11、12 マイコン
13、14 DCDC
15、16 バッテリ
17、18、19、20 インバータ
21、22、23、24 リレー
25、26 モータ
27、28、29、30 回転角センサ
31、32 姿勢角センサ
33、34 荷重センサ
35、36 傾斜角センサ
37、38 温度センサ
251、252、261、262 コイル
Claims (10)
- 多重化された複数の制御系を備え、当該複数の制御系によって車輪にトルクを与えて駆動することで倒立制御して移動する倒立型移動体であって、
前記制御系は、
前記複数の制御系のうち、少なくとも1つの制御系を縮退した前記倒立制御に切り替えられたことを検出する切替検出部と、
前記切替検出部によって前記倒立制御の切り替えが検出された場合、前記倒立型移動体の速度及び姿勢角の少なくとも1つを制限して前記倒立型移動体の倒立制御を行う倒立制御部と、
を有する倒立型移動体。 - 前記倒立型移動体は、さらに、前記車輪の駆動に必要なトルクの増加、又は、前記車輪に付与可能なトルクの減少に影響を及ぼすとして予め定められた要因を検出するセンサを備え、
前記倒立制御部は、
前記切替検出部によって前記倒立制御の切り替えが検出された場合に、前記車輪の駆動におけるトルク不足が発生する可能性があるか否かを、前記センサによる検出内容に基づいて判定し、
前記車輪の駆動におけるトルク不足が発生する可能性があると判定した場合に、前記倒立型移動体の速度及び姿勢角の少なくとも1つを制限するように前記倒立型移動体の倒立制御を行う、
請求項1に記載の倒立型移動体。 - 前記センサは、前記倒立型移動体に搭乗するものからの荷重を検出する荷重センサであり、
前記倒立制御部は、前記荷重センサによって検出された荷重が所定の閾値よりも大きい場合に、前記車輪の駆動におけるトルク不足が発生する可能性があると判定する、
請求項2に記載の倒立型移動体。 - 前記センサは、前記倒立型移動体が移動する移動面の傾斜角を検出する傾斜角センサであり、
前記倒立制御部は、前記傾斜角センサによって検出された傾斜角が所定の閾値よりも大きい場合に、前記車輪の駆動におけるトルク不足が発生する可能性があると判定する、
請求項2又は3に記載の倒立型移動体。 - 前記センサは、前記倒立型移動体に搭載された、前記車輪を駆動するための電力を供給するバッテリの温度を検出する温度センサであり、
前記倒立制御部は、前記温度センサによって検出された温度が所定の閾値よりも低い場合、前記車輪の駆動におけるトルク不足が発生する可能性があると判定する、
請求項2乃至4のいずれか1項に記載の倒立型移動体。 - 前記倒立制御部は、前記センサによる検出内容に応じて、前記倒立型移動体の速度及び姿勢角の少なくとも1つを制限する上限を決定する、
請求項2乃至5のいずれか1項に記載の倒立型移動体。 - 前記複数の制御系は、二重化された2つの制御系であり、
前記切替検出部は、前記二重化された制御系のうち、いずれかの制御系を縮退した前記倒立制御に切り替えられたことを検出する、
請求項1乃至6のいずれか1項に記載の倒立型移動体。 - 前記倒立型移動体は、前記車輪を2つ有する倒立二輪車である、
請求項1乃至7のいずれか1項に記載の倒立型移動体。 - 前記倒立型移動体は、前記複数の制御系によって、前記車輪にトルクを与えるモータに対して駆動電流を供給することで、前記車輪を駆動するものであって、
前記倒立制御部は、自制御系における異常の検出に応じて自制御系を縮退する場合に、自制御系から前記モータに対する駆動電流の供給を遮断する、
請求項1乃至8のいずれか1項に記載の倒立型移動体。 - 多重化された複数の制御系によって、車輪にトルクを与えて駆動することで倒立型移動体を倒立制御して移動させる制御方法であって、
前記複数の制御系のうち、少なくとも1つの制御系を縮退した前記倒立制御に切り替えられたことを検出する切替検出ステップと、
前記倒立制御の切り替えが検出された場合、前記倒立型移動体の速度及び姿勢角の少なくとも1つを制限して前記倒立型移動体の倒立制御を行う倒立制御ステップと、
を備えた制御方法。
Priority Applications (5)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2012/005504 WO2014033789A1 (ja) | 2012-08-30 | 2012-08-30 | 倒立型移動体及びその制御方法 |
US14/424,920 US20150231971A1 (en) | 2012-08-30 | 2012-08-30 | Inverted vehicle and its control method |
JP2014532574A JP5949926B2 (ja) | 2012-08-30 | 2012-08-30 | 倒立型移動体及びその制御方法 |
EP12883787.9A EP2891596A4 (en) | 2012-08-30 | 2012-08-30 | SELF-COMPATIBLE MOBILE BODY AND CONTROL PROCEDURE THEREFOR |
CN201280075433.2A CN104583066A (zh) | 2012-08-30 | 2012-08-30 | 倒立型移动体及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2012/005504 WO2014033789A1 (ja) | 2012-08-30 | 2012-08-30 | 倒立型移動体及びその制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2014033789A1 true WO2014033789A1 (ja) | 2014-03-06 |
Family
ID=50182641
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2012/005504 WO2014033789A1 (ja) | 2012-08-30 | 2012-08-30 | 倒立型移動体及びその制御方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20150231971A1 (ja) |
EP (1) | EP2891596A4 (ja) |
JP (1) | JP5949926B2 (ja) |
CN (1) | CN104583066A (ja) |
WO (1) | WO2014033789A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150210337A1 (en) * | 2014-01-28 | 2015-07-30 | Toyota Jidosha Kabushiki Kaisha | Vehicle |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6220763B2 (ja) * | 2014-11-06 | 2017-10-25 | 本田技研工業株式会社 | 倒立振子型車両 |
USD774600S1 (en) * | 2015-03-10 | 2016-12-20 | Hangzhou Notebike Technology Co., Ltd. | Electric balancing scooter |
CN106314199B (zh) * | 2016-09-05 | 2020-02-07 | 北京小米移动软件有限公司 | 平衡车速度控制方法及装置 |
DE102019206089A1 (de) * | 2019-04-29 | 2020-10-29 | Volkswagen Aktiengesellschaft | Verfahren zum Betreiben eines Elektromotors, Antriebssystem und Kraftfahrzeug |
IT201900018362A1 (it) * | 2019-10-10 | 2021-04-10 | Texa Spa | Metodo e sistema di controllo di almeno due motori elettrici di trazione di un veicolo |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003502002A (ja) | 1999-06-04 | 2003-01-14 | デカ・プロダクツ・リミテッド・パートナーシップ | 個人用移動車両及び方法 |
JP2004510637A (ja) | 2000-10-13 | 2004-04-08 | デカ・プロダクツ・リミテッド・パートナーシップ | 個人用輸送車の制御 |
JP2007062682A (ja) * | 2005-09-02 | 2007-03-15 | Toyota Motor Corp | 走行体 |
JP2012020739A (ja) * | 2011-09-29 | 2012-02-02 | Toyota Motor Corp | 走行体 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7090040B2 (en) * | 1993-02-24 | 2006-08-15 | Deka Products Limited Partnership | Motion control of a transporter |
JP4096481B2 (ja) * | 2000-01-21 | 2008-06-04 | 株式会社Ihi | サーボ制御装置 |
US6288505B1 (en) * | 2000-10-13 | 2001-09-11 | Deka Products Limited Partnership | Motor amplifier and control for a personal transporter |
AU2003247972A1 (en) * | 2002-07-12 | 2004-02-02 | Deka Products Limited Partnership | Control of a transporter based on attitude |
JP2004215350A (ja) * | 2002-12-27 | 2004-07-29 | Sony Corp | 駆動制御装置およびその方法と2輪車 |
JP5519093B2 (ja) * | 2006-08-03 | 2014-06-11 | トヨタ自動車株式会社 | 走行装置及び走行装置の制動制御方法 |
JP2011079510A (ja) * | 2009-09-10 | 2011-04-21 | Makita Corp | 電動車 |
EP2543582B1 (en) * | 2010-03-05 | 2016-06-15 | Toyota Jidosha Kabushiki Kaisha | Two-wheeled inverted pendulum device, method for controlling same, and control program |
JP2012126353A (ja) * | 2010-12-17 | 2012-07-05 | Bosch Corp | 倒立振子型移動体 |
JP5644821B2 (ja) * | 2012-08-29 | 2014-12-24 | トヨタ自動車株式会社 | 倒立二輪車及びその制御方法 |
-
2012
- 2012-08-30 WO PCT/JP2012/005504 patent/WO2014033789A1/ja active Application Filing
- 2012-08-30 EP EP12883787.9A patent/EP2891596A4/en not_active Withdrawn
- 2012-08-30 US US14/424,920 patent/US20150231971A1/en not_active Abandoned
- 2012-08-30 JP JP2014532574A patent/JP5949926B2/ja active Active
- 2012-08-30 CN CN201280075433.2A patent/CN104583066A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003502002A (ja) | 1999-06-04 | 2003-01-14 | デカ・プロダクツ・リミテッド・パートナーシップ | 個人用移動車両及び方法 |
JP2004510637A (ja) | 2000-10-13 | 2004-04-08 | デカ・プロダクツ・リミテッド・パートナーシップ | 個人用輸送車の制御 |
JP2007062682A (ja) * | 2005-09-02 | 2007-03-15 | Toyota Motor Corp | 走行体 |
JP2012020739A (ja) * | 2011-09-29 | 2012-02-02 | Toyota Motor Corp | 走行体 |
Non-Patent Citations (1)
Title |
---|
See also references of EP2891596A4 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20150210337A1 (en) * | 2014-01-28 | 2015-07-30 | Toyota Jidosha Kabushiki Kaisha | Vehicle |
US9376154B2 (en) * | 2014-01-28 | 2016-06-28 | Toyota Jidosha Kabushiki Kaisha | Vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP5949926B2 (ja) | 2016-07-13 |
EP2891596A4 (en) | 2015-09-09 |
US20150231971A1 (en) | 2015-08-20 |
EP2891596A1 (en) | 2015-07-08 |
JPWO2014033789A1 (ja) | 2016-08-08 |
CN104583066A (zh) | 2015-04-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5949926B2 (ja) | 倒立型移動体及びその制御方法 | |
CN102341298B (zh) | 倒立二轮装置及其控制方法以及控制程序 | |
JP4872276B2 (ja) | 走行体 | |
US11021153B2 (en) | Control apparatus of electric vehicle | |
JP5083648B2 (ja) | 車両 | |
JP6440971B2 (ja) | 左右独立駆動車のトラクション制御機能付き駆動制御装置 | |
JP2014046697A (ja) | 倒立二輪車及びその制御方法 | |
JP2016013794A (ja) | 電磁ダンパ | |
JP2012192780A (ja) | 車両の挙動制御装置 | |
WO2012002234A1 (ja) | 電動車両の駆動力制御装置 | |
JPH0956005A (ja) | 電気車の制御装置 | |
JP2015192471A (ja) | 車両運動制御装置 | |
CN104144817B (zh) | 作业车辆 | |
US11787293B2 (en) | Electric motor control device and method of electric motor control | |
JP5360178B2 (ja) | 走行体 | |
JP6167831B2 (ja) | 移動体の制御方法及び倒立二輪移動体 | |
JP2017169247A (ja) | 車輪独立駆動式車両の駆動制御装置 | |
CN102378715B (zh) | 车辆 | |
CN102378700B (zh) | 车辆 | |
JP2019068680A (ja) | 電力制御装置 | |
JP2010260532A (ja) | 車両 | |
JP2008219971A (ja) | 電動車輌 | |
KR20220036425A (ko) | 전기자전거의 관성 주행 제어 회로 및 방법 | |
CN116353330A (zh) | 电动移动机 | |
JP6435809B2 (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: 12883787 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2014532574 Country of ref document: JP Kind code of ref document: A |
|
REEP | Request for entry into the european phase |
Ref document number: 2012883787 Country of ref document: EP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2012883787 Country of ref document: EP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 14424920 Country of ref document: US |
|
NENP | Non-entry into the national phase |
Ref country code: DE |