WO2015053244A1 - 手押し車 - Google Patents
手押し車 Download PDFInfo
- Publication number
- WO2015053244A1 WO2015053244A1 PCT/JP2014/076751 JP2014076751W WO2015053244A1 WO 2015053244 A1 WO2015053244 A1 WO 2015053244A1 JP 2014076751 W JP2014076751 W JP 2014076751W WO 2015053244 A1 WO2015053244 A1 WO 2015053244A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- main body
- angle
- control mode
- value
- drive wheel
- Prior art date
Links
- 238000001514 detection method Methods 0.000 claims description 29
- 238000000034 method Methods 0.000 abstract description 5
- 238000010586 diagram Methods 0.000 description 9
- 230000001133 acceleration Effects 0.000 description 5
- 210000000245 forearm Anatomy 0.000 description 2
- 125000002066 L-histidyl group Chemical group [H]N1C([H])=NC(C([H])([H])[C@](C(=O)[*])([H])N([H])[H])=C1[H] 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 210000005069 ears Anatomy 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000000452 restraining effect Effects 0.000 description 1
Images
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H3/04—Wheeled walking aids for patients or disabled persons
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H3/04—Wheeled walking aids for patients or disabled persons
- A61H2003/043—Wheeled walking aids for patients or disabled persons with a drive mechanism
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H3/04—Wheeled walking aids for patients or disabled persons
- A61H2003/046—Wheeled walking aids for patients or disabled persons with braking means
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5007—Control means thereof computer controlled
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5023—Interfaces to the user
- A61H2201/5025—Activation means
- A61H2201/5028—Contact activation, i.e. activated at contact with a surface of the user to be treated
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5061—Force sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5069—Angle sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5079—Velocity sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5084—Acceleration sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5092—Optical sensor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62B—HAND-PROPELLED VEHICLES, e.g. HAND CARTS OR PERAMBULATORS; SLEDGES
- B62B1/00—Hand carts having only one axis carrying one or more transport wheels; Equipment therefor
- B62B1/002—Hand carts having only one axis carrying one or more transport wheels; Equipment therefor convertible from a one-axled vehicle to a two-axled vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62B—HAND-PROPELLED VEHICLES, e.g. HAND CARTS OR PERAMBULATORS; SLEDGES
- B62B3/00—Hand carts having more than one axis carrying transport wheels; Steering devices therefor; Equipment therefor
- B62B3/12—Hand carts having more than one axis carrying transport wheels; Steering devices therefor; Equipment therefor characterised by three-wheeled construction
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62B—HAND-PROPELLED VEHICLES, e.g. HAND CARTS OR PERAMBULATORS; SLEDGES
- B62B5/00—Accessories or details specially adapted for hand carts
- B62B5/0026—Propulsion aids
- B62B5/0033—Electric motors
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62B—HAND-PROPELLED VEHICLES, e.g. HAND CARTS OR PERAMBULATORS; SLEDGES
- B62B5/00—Accessories or details specially adapted for hand carts
- B62B5/0026—Propulsion aids
- B62B5/0069—Control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62B—HAND-PROPELLED VEHICLES, e.g. HAND CARTS OR PERAMBULATORS; SLEDGES
- B62B5/00—Accessories or details specially adapted for hand carts
- B62B5/02—Accessories or details specially adapted for hand carts providing for travelling up or down a flight of stairs
-
- 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
- This invention relates to a wheelbarrow provided with wheels, and more particularly to a wheelbarrow that drives and controls wheels.
- Patent Document 1 discloses a walking auxiliary vehicle that detects a change in the inclination angle of the main body in the pitch direction and drives and controls the wheels so that the change in the angle of the main body becomes zero to prevent the pitch direction from falling. Is described.
- FIG. 8 (A) is a schematic view of a conventional walking assistance vehicle as viewed from the side
- FIG. 8 (B) is a control block diagram.
- the walking assistance vehicle 900 includes a driving wheel 911, a main body portion 910 that is rotatably connected to the axis of the driving wheel 911 in the pitch direction, and an inclination angular velocity of the main body portion 910.
- a gyro sensor 94 for detecting and an inclination angle sensor 95 for detecting an inclination angle of the main body 910 are provided.
- the walking assistance vehicle 900 functionally includes a target angular velocity calculation unit 901 and a torque command generation unit 902.
- the target angular velocity calculation unit 901 includes a target inclination angle (for example, an inclination angle slightly inclined backward from 0 degrees with respect to the vertical direction) and the current inclination angle ⁇ 1 of the main body 910 detected by the inclination angle sensor 95.
- the difference value is input, and the tilt angular velocity of the main body 910 is calculated such that the difference value becomes zero.
- the torque command generation unit 902 inputs a difference value between the inclination angular velocity calculated by the target angular velocity calculation unit 901 and the current inclination angle velocity of the main body 910 input from the gyro sensor 94, and the difference value is Torque is calculated to be zero.
- the calculated torque is applied to a drive unit (not shown) of the drive wheel 911, and the drive wheel 911 rotates.
- the walking assistance vehicle 900 performs the inverted pendulum control, and performs control so that the posture of the main body 910 is kept constant.
- the walking assist vehicle 900 rotates the driving wheel 911 in the traveling direction in order to keep the posture of the main body part 910 constant. it can.
- the user may lift the wheelbarrow when there is a large step in the traveling direction, for example.
- the rotation of the drive wheel is controlled so that the change in the angle of the main body becomes zero. Therefore, when the handcart is lifted, the drive wheel may idle.
- an object of the present invention is to provide a handcart that prevents unintentional idling when the main body is lifted.
- the handcart of the present invention includes a driving wheel, a driving unit that drives the driving wheel, a control unit that controls the driving unit, and a main body that is connected to the driving wheel so as to be rotatable in the pitch direction.
- a gripping portion provided in a direction opposite to a side of the main body portion connected to the driving wheel, and a support portion rotatably connected to the main body portion or the driving wheel in a pitch direction.
- Body angle change detecting means for detecting an angle change in the pitch direction of the body part
- inclination for detecting an inclination angle of the body part or the support part in the pitch direction with respect to a vertical axis
- Angle detection means and rotation speed detection means for detecting the rotation speed of the drive wheel are provided.
- the control means has a first control mode for controlling the rotation of the drive wheel so that the angle change of the main body portion becomes zero, and the main body angle change detection means and the tilt angle detection means, A rotation speed of the drive wheel is estimated from the second rotation speed, and when the difference between the estimated rotation speed and the rotation speed detected by the rotation speed detection means is equal to or greater than a predetermined value, the rotation of the drive wheel is stopped.
- a control mode for controlling the rotation of the drive wheel so that the angle change of the main body portion becomes zero, and the main body angle change detection means and the tilt angle detection means, A rotation speed of the drive wheel is estimated from the second rotation speed, and when the difference between the estimated rotation speed and the rotation speed detected by the rotation speed detection means is equal to or greater than a predetermined value, the rotation of the drive wheel is stopped.
- the rotation of the drive wheel is controlled by the inverted pendulum control so that the change in the tilt angle of the main body becomes zero.
- the control means calculates an angular velocity for maintaining the inclination angle of the main body portion with respect to the vertical direction at the target inclination angle, and the angular velocity becomes 0 based on a difference value between the calculated angular velocity and the current angular velocity. Calculate the torque. Furthermore, based on the value of the inclination angle sensor, an offset torque for compensating for the gravitational torque generated by the inclination of the ground is calculated.
- the control means estimates the rotational speed of the driving wheel from the main body angle change detecting means and the tilt angle detecting means, and the actual rotational speed detected by the estimated rotational speed and the rotational speed detecting means.
- the control mode is switched to the second control mode in which the drive wheels are stopped.
- the control means lifts the main body when the actual rotation speed of the drive wheels is higher than the rotation speed estimated from the torque obtained based on the main body angle change detection means and the tilt angle detection means. It is determined that unintentional idling has occurred, and the drive wheels are stopped.
- the inverted pendulum control is turned off (torque application is set to 0), the torque for maintaining the rotation angle of the driving wheel at the current value is generated, or physically This is achieved by applying a brake by restricting the rotation of the drive wheels.
- the handcart of the present invention can prevent unintentional idling when the main body is lifted.
- the handcart includes a crossing angle detection unit that detects a crossing angle formed by the main body and the support unit, and the control unit is configured to detect the main body angle change detection unit and the inclination in the first control mode. It is preferable to estimate the rotational speed of the drive wheel from the angle detection means and the intersection angle detection means.
- the control means calculates the torque from the intersection angle detection means, the main body angle change detection means, and the inclination angle detection means, and estimates the rotational speed from the calculated torque, thereby achieving higher accuracy.
- the support portion does not necessarily have to be parallel to the ground contact surface. If not, the angle formed by the line extending the support portion and the ground contact surface may always be the same angle.
- the position of the auxiliary wheel may be in front of the main body. In this case, it can be estimated that when the crossing angle is widened, it is inclined backward with respect to the traveling direction, and when the crossing angle is narrowed, it is inclined forward with respect to the traveling direction.
- the control means has one or more values of the main body angle change detection means, the tilt angle detection means, and the intersection angle detection means within a predetermined range.
- control unit performs the inverted pendulum control again when it is determined that the drive wheel and the auxiliary wheel are in contact with the ground and the main body portion is close to the target inclination angle based on at least one detection unit. .
- control means is configured to detect the second control mode if the inclination angle detecting means is equal to or greater than a predetermined value or equal to or greater than a predetermined value for a predetermined time even if the speed difference is within a predetermined value. You may move to. Even if the rotational speed difference is within a predetermined value, when the crossing angle detecting means is not less than a predetermined value or not less than a predetermined value for a predetermined time, the second control mode is entered. May be.
- FIG. 1 is a schematic view of a handcart 100 according to the present embodiment as viewed from the side
- FIG. 2 is a schematic view as viewed from the front
- FIG. 3 is a block diagram illustrating a hardware configuration of the handcart 100.
- the handcart 100 includes a pair of drive wheels 111, and a pair of main body portions 114 that are coupled to the drive wheels 111 so as to be rotatable in a pitch direction (a rotation direction around the axis of the drive wheels 111 in FIG. 1).
- a grip 116 provided in a direction opposite to the side connected to the drive wheel 111 of each main body 114, a support 112 connected to the drive wheel 111 so as to be rotatable in the pitch direction, and a support And an auxiliary wheel 113 connected to the portion 112.
- the pair of driving wheels 111 are individually driven and rotated. However, these drive wheels 111 are attached to the same shaft and can be rotated synchronously.
- the drive wheel 111 has shown the example which is 2 wheels, 1 wheel or 3 wheels or more may be sufficient.
- the auxiliary wheel 113 also shows the example which is one wheel in this embodiment, two or more wheels may be sufficient.
- the two rod-like main body portions 114 connected to each driving wheel 111 are connected via a cylindrical gripping portion 116, and are rotatable in the pitch direction around the axis of the driving wheel 111.
- the main body 114 does not have to be two as in this example, and may be a single bar-like member or a thin plate-like member.
- the support portion 112 is a thin plate-like member that is connected to the rotation shaft of the drive wheel 111 and extends rearward from the drive wheel 111 with respect to the traveling direction (the direction indicated by the arrow in the figure).
- the support part 112 is connected to the rotation axis of the drive wheel 111 so as to be rotatable in the pitch direction so as to extend in parallel with the horizontal ground, for example.
- an auxiliary wheel 113 is connected to the support portion 112 on the lower surface in the direction opposite to the side connected to the drive wheel 111. As a result, both the driving wheel 111 and the auxiliary wheel 113 are in contact with the ground.
- the rotation angle of the support portion 112 is limited to a predetermined angle (for example, 30 degrees) by a stopper or the like.
- the support part 112 should just be a fixed angle with the flat ground grounded, and does not necessarily need to be parallel.
- a box 30 containing a control board, a battery, and the like is placed on the upper surface of the support portion 112.
- the support part 112 may be an aspect that extends forward from the driving wheel 111 in the traveling direction.
- the support portion 112 may be connected to the main body portion 114 so as to be rotatable in the pitch direction instead of the rotation shaft of the drive wheel 111.
- the box 30 may be fixed to the main body 114.
- the grip 116 is provided with a user interface (I / F) 28 such as a power switch.
- the user can press the handcart 100 by gripping the grip 116 or placing a forearm or the like on the grip 116 and friction between the grip and the forearm.
- the handcart 100 includes an inclination angle sensor 20, a control unit 21, a ROM 22, a RAM 23, a gyro sensor 24, a drive unit 25, a drive wheel rotary encoder 26, a support unit rotary encoder 27, and a user I. / F28.
- the control unit 21 is a functional unit that comprehensively controls the handcart 100, and implements various operations by reading out a program stored in the ROM 22 and developing the program in the RAM 23.
- the gyro sensor 24 corresponds to the main body angle change detecting means of the present invention, detects the angular velocity of the main body portion 114 in the pitch direction, and outputs it to the control unit 21.
- the main body angle change detecting means can be realized by an inclination angle sensor built in the main body 114. This tilt angle sensor can detect the tilt angle of the main body 114 in the pitch direction, and obtain the angular velocity in the pitch direction of the main body 114 by differentiating the detected tilt angle.
- the main body angle change detecting means can also be realized by using a sensor capable of detecting the main body angle, such as an acceleration sensor.
- the main body angle change detecting means can be realized by using a combination of a plurality of sensors such as a gyro sensor, an inclination angle sensor, or an acceleration sensor.
- the control unit 21 compares the values of the respective sensors, and determines that any sensor has failed by determining that a sensor having a significantly different value has failed. It is also possible to detect whether or not.
- the drive wheel rotary encoder 26 detects the rotation angle of the drive wheel 111 and outputs the detection result to the control unit 21.
- the control unit 21 calculates the rotational speed of the drive wheel by differentiating the input rotation angle.
- the rotary encoder 26 for drive wheels functions as a rotational speed detection means of this invention.
- the rotation speed detecting means can be realized by using, for example, a gyro sensor.
- the support rotary encoder 27 corresponds to the crossing angle detection means of the present invention, detects a crossing angle formed by the main body 114 and the support 112, and outputs the detection result to the control unit 21.
- the crossing angle detection means can also be realized by detecting the tilt angle of the main body 114 and the tilt angle of the support 112 using an acceleration sensor or the like.
- the tilt angle sensor 20 corresponds to the tilt angle detecting means of the present invention, detects the tilt angle of the support portion 112 with respect to the vertical axis in the pitch direction, and outputs it to the control portion 21.
- the tilt angle detection means can also be realized using other sensors (for example, by integrating the values of the gyro sensor).
- the handcart 100 may further include an acceleration sensor that detects acceleration in each direction of the main body 114, a rotary encoder that detects the rotation angle of the auxiliary wheel 113, and the like.
- control unit 21 performs inverted pendulum control by controlling the drive unit 25 so that the angle change in the pitch direction of the main body unit 114 becomes zero.
- FIG. 4 is a control block diagram of the control unit 21 in the first control mode.
- the control unit 21 includes a target angular velocity calculation unit 211, a torque command generation unit 212, and an inclination estimation unit 213.
- the target angular velocity calculation unit 211 calculates a target inclination angle (here, an inclination angle slightly inclined backward from 0 degree with respect to the vertical direction) and an inclination angle ⁇ 1 in the pitch direction of the main body 114 with respect to the current vertical axis.
- the difference value is input, and the inclination angular velocity of the main body 114 is calculated such that the difference value becomes zero.
- the current inclination angle of the main body 114 in the pitch direction can also be obtained by integrating the output value of the gyro sensor 24 or attaching an inclination angle sensor (not shown) to the main body 114. It is also possible to calculate from the intersection angle ⁇ 2 between the main body 114 and the support 112 input from the support rotary encoder 27.
- the support portion 112 is connected to the shaft of the drive wheel 111 so as to be parallel to the horizontal ground. Therefore, when the handcart is in contact with the horizontal ground, the inclination angle ⁇ 1 of the main body 114 is assumed to be 0 degree when the intersection angle ⁇ 2 is 90 degrees, and the traveling direction is increased when the intersection angle ⁇ 2 increases. On the other hand, when the crossing angle ⁇ 2 is inclined forward, the current inclination angle ⁇ 1 of the main body 114 is assumed to be inclined backward with respect to the traveling direction.
- the target inclination angle is maintained at 0 degrees or a value close to 0 degrees with respect to the vertical direction even on the inclined surface. It is preferable to subtract the ground inclination angle detected by the inclination angle sensor 20.
- the torque command generation unit 212 inputs a difference value between the inclination angular velocity calculated by the target angular velocity calculation unit 211 and the current inclination angular velocity of the main body 114 input from the gyro sensor 24, and the difference value is calculated.
- the applied torque is calculated to be zero.
- the inclination estimation unit 213 calculates an offset torque for compensating for the gravitational torque generated by the ground inclination angle according to the ground inclination angle estimated based on the value of the inclination angle sensor 20.
- control unit 21 adds the offset torque to the applied torque calculated by the torque command generation unit 212 and outputs it to the drive unit 25.
- the drive unit 25 is a functional unit that drives a motor that rotates a shaft attached to the drive wheel 111, and applies the torque input from the control unit 21 to the motor of the drive wheel 111 to rotate the drive wheel 111.
- the inclination estimation unit 213 is used to compensate for the gravitational torque generated by the inclination angle, but the ground inclination angle is converted into a target inclination angle in the pitch direction of the main body 114 and input as an offset angle. May be.
- the handcart 100 performs the inverted pendulum control as the first control mode, and controls the posture of the main body 114 to be kept constant.
- the gyro sensor 24 corresponds to the main body angle change detecting means of the present invention.
- the support rotary encoder 27 is also used. It is included in the main body angle change detecting means of the present invention.
- the tilt angle sensor 20 is provided in the support portion 112 .
- the output of the tilt angle sensor 20 is The inclination angle of the support portion 112 with respect to the vertical axis in the pitch direction can be detected by combining the intersection angle between the main body portion 114 and the support portion 112 obtained from the support portion rotary encoder 27.
- the difference value between the rotational speed estimated from the torque applied to the drive wheel 111 and the actual rotational speed calculated from the drive wheel rotary encoder 26 is equal to or greater than a predetermined value, or When the difference value continues for a predetermined time or longer and is equal to or higher than the predetermined value, the operation shifts to the second control mode in which the rotation of the driving wheel 111 is stopped, and unintentional idling occurs when the main body 114 is lifted.
- the predetermined value may be a fixed value or a value obtained by multiplying the estimated value by a proportionality coefficient (for example, 10% of the estimated value).
- FIG. 5 is a diagram for explaining the operation of the handcart 100 when the main body 114 is lifted and when the main body 114 is lowered.
- FIG. 6 is a flowchart showing the operation of the control unit 21 when switching between the first control mode and the second control mode.
- the inclination angle of the main body 114 estimated from the intersection angle ⁇ 2 in the first control mode. Based on ⁇ 1, the posture of the main body 114 is kept constant.
- the ground is horizontal, for example, when the target inclination angle is 1 degree (clockwise in the figure is positive), the crossing angle ⁇ 2 is 89 degrees, and the support portion The inclination angle ⁇ 3 of 112 is 0 degree.
- the crossing angle ⁇ 2 increases.
- the inclination angle ⁇ 3 of the support portion 112 increases ( ⁇ 3 is positive when the support portion 112 is lowered downward).
- the crossing angle ⁇ 2 is maximum (for example, 120 degrees), and the inclination angle ⁇ 3 is also maximum (for example, 30 degrees).
- the inclination angle ⁇ 1 of the main body 114 is substantially equal to the vertical direction and is 0 degree.
- the handcart 100 shifts to the second control mode in which the driving wheel 111 is stopped when such a lifting operation is detected.
- FIG. 6A is a flowchart showing the operation of the control unit 21 when the first control mode is being executed.
- the rotational speed can be calculated by the following formula.
- the control unit 21 detects the crossing angle value detected from the support unit rotary encoder 27, the angular velocity value of the main body unit 114 detected from the gyro sensor 24, and the support unit 112 detected by the tilt angle sensor 20.
- the rotational speed is estimated based on the value of the inclination angle.
- the current inclination angle of the main body 114 can be obtained by integrating the output value of the gyro sensor 24 or by attaching an inclination angle sensor (not shown) to the main body 114. In the estimation, it is not essential to use the value of the crossing angle.
- the control unit 21 calculates the rotational speed value (estimated value) estimated in s11, the actual rotational speed (actually measured value) of the drive wheel 111 obtained by differentiating the output value of the drive wheel rotary encoder 26, and Are compared (s12). If the difference value between the actually measured value and the estimated value is less than the predetermined value ⁇ up (> 0), it is determined that the driving wheel 111 is in contact with the ground, and the process is repeated from s11. On the other hand, when the difference value between the actually measured value and the estimated value is equal to or greater than the predetermined value ⁇ up, the control unit 21 shifts to the second control mode in which the rotation of the drive wheels 111 is stopped (s13).
- the difference between the measured value and the estimated value may be calculated by taking the absolute value of the difference between the measured value and the estimated value, or the difference between the square value of the measured value and the square value of the estimated value.
- the square root of the absolute value may be used.
- the predetermined value ⁇ up may be a constant value or a value obtained by multiplying the estimated value by a proportional coefficient (for example, 10% of the estimated value).
- the inverted pendulum control is turned off (the torque applied to the driving wheel 111 is set to 0), and the rotation angle of the driving wheel 111 is changed to the value at the time of switching to the second control mode.
- This is realized by generating a torque for maintaining and preventing the drive wheel 111 from rotating, or by applying a brake by physically restraining the rotation of the drive wheel.
- control unit 21 assumes that the value of the inclination angle ⁇ 3 of the support part 112 detected by the inclination angle sensor 20 is assumed as shown in FIG. If the maximum inclination angle of the ground surface (for example, 10 degrees as shown in FIG. 7B) is exceeded, or if it exceeds the predetermined time continuously, it is determined that the main body 114 has been lifted. It is preferable to shift to the second control mode.
- the maximum inclination angle of the ground surface for example, 10 degrees as shown in FIG. 7B
- the inclination angle when the sensor 20 detects an inclination angle exceeding the maximum inclination angle, the driving wheel 111 stops.
- the value of the crossing angle detected from the support unit rotary encoder 27 changes from the initial value (90 degrees on the horizontal ground) beyond the maximum inclination angle (for example, 10 degrees), that is, the target When the tilt angle exceeds +10 degrees, or when the target tilt angle exceeds +10 degrees continuously for a predetermined time, it is preferable to determine that the main body 114 has been lifted and shift to the second control mode.
- FIG. 6B is a flowchart showing the operation of the control unit 21 executing the second control mode.
- the control unit 21 detects the value of the crossing angle detected from the rotary encoder 27 for the support unit, the value of the angular velocity of the main body 114 detected from the gyro sensor 24, or the value of the support unit 112 detected by the tilt angle sensor 20. It is determined whether or not the value of the inclination angle has changed (s21). The control unit 21 repeats this determination until there is a change in various sensor values.
- the control unit 21 determines whether all the sensor values or any one or more sensor values are within a predetermined value or within a predetermined value for a predetermined time. Judgment is made (s22). That is, the value of the angular velocity of the main body 114 detected from the gyro sensor 24 is 0 or a value close to 0, and the inclination angle of the support 112 detected by the inclination angle sensor 20 is equal to or less than the maximum inclination angle (for example, 10 degrees). And the value of the crossing angle detected from the support rotary encoder 27 is close to the initial value (for example, within 90 ⁇ 10 degrees).
- the support portion rotary encoder 27 is not an essential component in the present invention. When there is no support part rotary encoder 27, the support part rotary encoder 27 is not used when determining whether or not the value is a predetermined value.
- the value of the inclination angle ⁇ 3 of the support portion 112 exceeds the assumed value before the difference value between the actually measured value and the estimated value becomes equal to or larger than the predetermined value ⁇ up, the value of ⁇ 3 is set to the predetermined value.
- the first control mode is restored. Even when the tilt angle detected by the tilt angle sensor 20 exceeds the maximum tilt angle, when it is determined whether the tilt angle is within a predetermined range or within a predetermined range for a predetermined time, Return to the 1 control mode.
- control part 21 produces
- the value of the angular velocity of the main body 114 detected from the gyro sensor 24 is first 0 or close to 0 in s22, and is detected by the tilt angle sensor 20.
- the inclination angle of the support portion 112 is equal to or less than the maximum inclination angle (for example, 10 degrees), the user lowers the wheelbarrow 100 to the ground and the driving wheel 111 and the auxiliary wheel 113 are in contact with the ground.
- Inverted pendulum control may be started by determining that the state is in the state.
- the inverted pendulum control is started again, so that the user moves in the traveling direction. It can be used as a walking assistance vehicle by pushing.
- the second control mode is activated, at least one of “vibration (vibrator, etc.)”, “sound (buzzer, etc.)” and “light (LED light, etc.)” is activated in the walking assistance vehicle.
- a notification function for notifying may be provided. By providing such a function, the user can recognize that the mode has been switched without looking through the movement of the driving wheel, so that the walking assistance vehicle can be operated safely. .
- the aspect notified when the 1st control mode is operating may be sufficient, and it differs with the 1st control mode and the 2nd control mode.
- a notification method may be used.
- the notification may be made only when the first control mode and the second control mode are switched.
- the above notification function may be provided in any part of the walking assist vehicle, but is preferably provided in the grip portion.
- the gripping part is a place where the user grips with his / her hand and is located near the user's eyes and ears, so there is no need to make a loud sound or emit strong light, and notification with low power consumption can do.
Landscapes
- Health & Medical Sciences (AREA)
- Epidemiology (AREA)
- Pain & Pain Management (AREA)
- Physical Education & Sports Medicine (AREA)
- Rehabilitation Therapy (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Rehabilitation Tools (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
手押し車(100)は、第1の制御モードとして、倒立振子制御を行い、本体部(114)の姿勢を一定に保つように制御する。手押し車(100)は、駆動輪(111)に印加されるトルクから推算される回転速度(推定値)と駆動輪用ロータリエンコーダ(26)から算出される実際の回転速度(実測値)との差分値が所定値Δωup以上である場合に、駆動輪(111)の回転を停止する第2の制御モードに移行し、本体部(114)を持ち上げた時に意図しない空転が発生することを防止する。
Description
この発明は、車輪を備えた手押し車に関し、特に車輪を駆動、制御する手押し車に関するものである。
従来、車輪を駆動、制御して倒立振子制御を行う手押し車が知られている。例えば、特許文献1には、本体部のピッチ方向の傾斜角の変化を検知し、本体部の角度変化が0になるように車輪を駆動、制御してピッチ方向の転倒を防止する歩行補助車が記載されている。
図8(A)は、従来の歩行補助車を側面から見た模式図であり、図8(B)は、制御ブロック図である。
図8(A)に示すように、歩行補助車900は、駆動輪911と、駆動輪911の軸に対してピッチ方向に回転可能に連結された本体部910と、本体部910の傾斜角速度を検出するジャイロセンサ94と、本体部910の傾斜角度を検出する傾斜角センサ95と、を備えている。また、歩行補助車900は、図8(B)に示すように、機能的に、目標角速度計算部901と、トルク指令生成部902と、を備えている。
目標角速度計算部901は、目標の傾斜角度(例えば鉛直方向に対して0度より少し後方に傾いた傾斜角度)と、傾斜角センサ95で検出した現時点の本体部910の傾斜角度θ1と、の差分値を入力し、この差分値が0となるような本体部910の傾斜角速度を算出する。そして、トルク指令生成部902は、目標角速度計算部901で算出された傾斜角速度と、ジャイロセンサ94から入力された現時点の本体部910の傾斜角速度と、の差分値を入力し、この差分値が0となるようなトルクを算出する。
算出されたトルクは、駆動輪911の駆動部(不図示)に印加され、駆動輪911が回転する。このようにして、歩行補助車900は、倒立振子制御を行い、本体部910の姿勢を一定に保つように制御する。歩行補助車900は、本体部910を進行方向に押すと、本体部910の姿勢を一定に保つために駆動輪911が進行方向に回転するため、手押し車として使用者の歩行を補助することができる。
しかし、使用者は、例えば進行方向に大きな段差が存在した場合、手押し車を持ち上げる場合がある。倒立振子制御では、本体部の角度変化が0になるように駆動輪の回転を制御するため、手押し車を持ち上げた場合に駆動輪が空転する可能性がある。
そこで、この発明は、本体部を持ち上げた時に意図しない空転が発生することを防止する手押し車を提供することを目的とする。
本発明の手押し車は、駆動輪と、前記駆動輪を駆動する駆動手段と、前記駆動手段を制御する制御手段と、前記駆動輪に対して、ピッチ方向に回転可能に連結された本体部と、前記本体部のうち、前記駆動輪に連結されている側とは反対方向に設けられた把持部と、前記本体部または前記駆動輪に対してピッチ方向に回転可能に連結された支持部と、前記支持部に連結された補助輪と、前記本体部のピッチ方向の角度変化を検出する本体角度変化検出手段と、前記本体部または支持部の鉛直軸に対するピッチ方向の傾斜角を検出する傾斜角検出手段と、前記駆動輪の回転速度を検出する回転速度検出手段と、を備えている。
そして、制御手段は、前記本体部の角度変化が0となるように前記駆動輪の回転を制御する第1の制御モードを有し、かつ、前記本体角度変化検出手段と前記傾斜角検出手段とから前記駆動輪の回転速度を推算し、前記推算した回転速度と前記回転速度検出手段により検出した回転速度との速度差が所定値以上である場合、前記駆動輪の回転を停止させる第2の制御モードと、を有する。
第1の制御モードでは、倒立振子制御により、本体部の傾斜角度の変化が0となるように駆動輪の回転を制御する。例えば、制御手段は、本体部の鉛直方向に対する傾斜角度を目標傾斜角度に維持するための角速度を算出し、この算出した角速度と現在の角速度の差分値に基づいて当該角速度が0となるようなトルクを算出する。さらに、傾斜角センサの値に基づいて、地面の傾斜により発生する重力トルクを補償するためのオフセットトルクを算出する。
そして、制御手段は、第1の制御モードにおいて、本体角度変化検出手段と傾斜角検出手段とから駆動輪の回転速度を推算し、推算した回転速度と回転速度検出手段により検出した実際の駆動輪の回転速度との速度差が所定値以上である場合、または該速度差が所定の時間継続して所定値以上となった場合、駆動輪を停止する第2の制御モードに切り替わる。
すなわち、制御手段は、本体角度変化検出手段および傾斜角検出手段に基づいて求めたトルクから推算される回転速度に対して、駆動輪の実際の回転速度が速い場合には、本体部が持ち上げられて意図しない空転が発生していると判断し、駆動輪を停止する。駆動輪を停止するためには、例えば倒立振子制御をオフする(トルクの印加を0にする)、駆動輪の回転角度を現在の値に維持するためのトルクを発生させる、あるいは、物理的に駆動輪の回転を拘束することでブレーキをかける、等により実現する。これにより、本発明の手押し車は、本体部を持ち上げた時に意図しない空転が発生することを防止することができる。
なお、手押し車は、前記本体部と前記支持部とが成す交差角を検出する交差角検出手段を備え、前記制御手段は、前記第1の制御モードにおいて、前記本体角度変化検出手段、前記傾斜角検出手段、および前記交差角検出手段から前記駆動輪の回転速度を推算することが好ましい。
例えば、手押し車の駆動輪および補助輪が平らな地面に接地している状態で、水平な地面と平行になるように支持部を接続した場合、手押し車が水平な地面にあり、かつ交差角が90度である場合に本体部の鉛直軸に対するピッチ方向の傾斜角度が0度であると推定することができる。そして、交差角が拡がる場合は進行方向に対して前方に傾斜している、交差角が狭まる場合は進行方向に対して後方に傾斜している、と推定することができる。この場合、制御手段は、この交差角検出手段と、上記本体角度変化検出手段と、傾斜角検出手段と、からトルクを算出し、算出したトルクから回転速度を推算することで、より高精度に、本体部が持ち上げられて意図しない空転が発生しているか否かを判断することができる。なお、支持部は必ずしも接地地面と平行である必要はなく、平行でない場合は、支持部を延長した線と接地地面とのなす角度が常に同じ角度であればよい。また、本発明において、補助輪の位置は、本体部よりも前側でもよい。この場合において、交差角が拡がる場合は、進行方向に対して後方に傾斜し、交差角が狭まる場合は進行方向に対して前方に傾斜している、と推定することができる。
また、制御手段は、前記第2の制御モードにおいて、前記本体角度変化検出手段、前記傾斜角検出手段、および前記交差角検出手段のうちいずれか1つ以上の値が所定の範囲内にある場合、または所定時間継続して前記所定の範囲内である場合に、前記第1の制御モードに移行することが好ましい。
すなわち、制御手段は、少なくとも1つ以上の検出手段に基づいて、駆動輪および補助輪が地面に接して、本体部が目標傾斜角度に近くなったと判断される場合に、再び倒立振子制御を行う。
なお、制御手段は、回転速度の速度差が所定値内であっても、前記傾斜角検出手段が、所定値以上あるいは所定の時間継続して所定値以上である場合に、第2の制御モードに移行してもよい。また、回転速度の速度差が所定値内であっても、前記交差角検出手段が所定値以上あるいは所定の時間継続して所定値以上である場合に、第2の制御モードに移行するようにしてもよい。
この発明によれば、本体部を持ち上げた時に意図しない空転が発生することを防止することができる。
図1は、本実施形態に係る手押し車100を側面から見た模式図であり、図2は、正面から見た模式図である。図3は、手押し車100のハードウェア構成を示すブロック図である。
手押し車100は、一対の駆動輪111と、各駆動輪111に対してピッチ方向(図1における駆動輪111の軸を中心とする回転方向)に回転可能に連結された一対の本体部114と、各本体部114のうち駆動輪111に連結されている側とは反対方向に設けられた把持部116と、駆動輪111に対してピッチ方向に回転可能に連結された支持部112と、支持部112に連結された補助輪113と、を備えている。
一対の駆動輪111は、それぞれ個別に駆動させ、回転させる。ただし、これら駆動輪111は、同じ軸に取り付けられ、同期して回転させることも可能である。
なお、本実施形態では、駆動輪111は、2輪である例を示しているが、1輪あるいは3輪以上であってもよい。また、補助輪113も、本実施形態では1輪である例を示しているが、2輪以上であってもよい。
各駆動輪111に連結された2つの棒状の本体部114は、円筒形状の把持部116を介して接続され、駆動輪111の軸を中心としてピッチ方向に回転可能になっている。ただし、本体部114は、この例のように2つである必要はなく、1つの棒状の部材であってもよいし、薄い板状の部材であってもよい。
支持部112は、駆動輪111の回転軸に一方が接続され、進行方向(図中の矢印で示す方向)に対して駆動輪111よりも後方に延びる薄い板状の部材である。支持部112は、例えば水平な地面と平行に延びるように、駆動輪111の回転軸に対してピッチ方向に回転可能に接続されている。また、支持部112には、駆動輪111に連結されている側とは反対方向の下面に補助輪113が連結されている。これにより、駆動輪111と補助輪113の両方が地面に接するようになっている。ただし、支持部112の回転角度は、ストッパ等により所定角度(例えば30度)の範囲内に制限されている。なお、支持部112は、接地する平らな地面と一定の角度であればよく、必ずしも平行である必要はない。
支持部112の上面には制御用の基板や電池等を内蔵したボックス30が載せられている。なお、支持部112は、進行方向に対して駆動輪111よりも前方に延びる態様であってもよい。また、支持部112は、駆動輪111の回転軸ではなく、本体部114に対してピッチ方向に回転可能に接続されている態様であってもよい。また、ボックス30は本体部114に固定されていてもよい。
支持部112の上面には制御用の基板や電池等を内蔵したボックス30が載せられている。なお、支持部112は、進行方向に対して駆動輪111よりも前方に延びる態様であってもよい。また、支持部112は、駆動輪111の回転軸ではなく、本体部114に対してピッチ方向に回転可能に接続されている態様であってもよい。また、ボックス30は本体部114に固定されていてもよい。
把持部116には、電源スイッチ等のユーザインタフェース(I/F)28が設けられている。使用者は、把持部116を握る、あるいは前腕等を把持部116に載せ、グリップ部と前腕等の摩擦により、手押し車100を押すことができる。
次に、手押し車100の構成および基本動作について説明する。図3に示すように、手押し車100は、傾斜角センサ20、制御部21、ROM22、RAM23、ジャイロセンサ24、駆動部25、駆動輪用ロータリエンコーダ26、支持部用ロータリエンコーダ27、およびユーザI/F28を備えている。
制御部21は、手押し車100を統括的に制御する機能部であり、ROM22に記憶されているプログラムを読み出し、当該プログラムをRAM23に展開することで種々の動作を実現する。
ジャイロセンサ24は、本発明の本体角度変化検出手段に相当し、本体部114のピッチ方向の角速度を検知し、制御部21に出力する。また、本体角度変化検出手段は、本体部114に内蔵した傾斜角センサで実現することも可能である。この傾斜角センサは、本体部114のピッチ方向の傾斜角を検知し、検出した傾斜角を微分することで本体部114のピッチ方向の角速度を得ることができる。また、本体角度変化検出手段は、加速度センサ等、本体角度を検出可能なセンサを利用することでも実現可能である。さらに、本体角度変化検出手段は、ジャイロセンサ、傾斜角センサ、または加速度センサ等のセンサを複数組み合わせて利用することでも実現可能である。なお、複数のセンサを組み合わせた場合、制御部21は、それぞれのセンサの値を比較し、著しく値が異なるセンサについては故障していると判断することで、いずれかのセンサが故障しているか否かを検知するも可能である。
駆動輪用ロータリエンコーダ26は、駆動輪111の回転角度を検知し、検知結果を制御部21に出力する。制御部21は、入力された回転角度を微分することで、駆動輪の回転速度を算出する。これにより、駆動輪用ロータリエンコーダ26は、本発明の回転速度検出手段として機能する。なお、回転速度検出手段は、例えばジャイロセンサを用いることでも実現可能である。支持部用ロータリエンコーダ27は、本発明の交差角検出手段に相当し、本体部114と支持部112との成す角度である交差角を検知し、検知結果を制御部21に出力する。なお、交差角検出手段は、加速度センサ等を用いて、本体部114の傾斜角度および支持部112の傾斜角度を検出することでも実現可能である。
駆動輪用ロータリエンコーダ26は、駆動輪111の回転角度を検知し、検知結果を制御部21に出力する。制御部21は、入力された回転角度を微分することで、駆動輪の回転速度を算出する。これにより、駆動輪用ロータリエンコーダ26は、本発明の回転速度検出手段として機能する。なお、回転速度検出手段は、例えばジャイロセンサを用いることでも実現可能である。支持部用ロータリエンコーダ27は、本発明の交差角検出手段に相当し、本体部114と支持部112との成す角度である交差角を検知し、検知結果を制御部21に出力する。なお、交差角検出手段は、加速度センサ等を用いて、本体部114の傾斜角度および支持部112の傾斜角度を検出することでも実現可能である。
傾斜角センサ20は、本発明の傾斜角検出手段に相当し、支持部112のピッチ方向の鉛直軸に対する傾斜角を検知し、制御部21に出力する。なお、傾斜角検出手段についても、他のセンサを用いて(例えばジャイロセンサの値を積分する等して)実現可能である。
なお、手押し車100は、他にも本体部114の各方向の加速度を検知する加速度センサや、補助輪113の回転角度を検知するロータリエンコーダ等をさらに備えていてもよい。
基本動作(以下、第1の制御モードと言う。)として、制御部21は、本体部114のピッチ方向の角度変化がゼロとなるように駆動部25を制御することで倒立振子制御を行う。
図4は、第1の制御モード時における制御部21の制御ブロック図である。第1の制御モードでは、制御部21は、目標角速度計算部211、トルク指令生成部212、および斜度推定部213を備えている。
目標角速度計算部211は、目標傾斜角度(ここでは、鉛直方向に対して0度より少し後方に傾いた傾斜角度)と、現時点の鉛直軸に対する本体部114のピッチ方向の斜角度θ1と、の差分値を入力し、この差分値が0となるような本体部114の傾斜角速度を算出する。現時点の本体部114のピッチ方向の傾斜角度は、ジャイロセンサ24の出力値を積分する、あるいは本体部114に傾斜角センサ(不図示)を取り付けることでも得られる。また、支持部用ロータリエンコーダ27から入力された本体部114と支持部112の交差角θ2から算出することも可能である。上述のように、支持部112は、水平な地面と平行になるように駆動輪111の軸に接続されている。したがって、手押し車が水平な地面に接地しているとき、交差角θ2が90度である場合に本体部114の傾斜角度θ1が0度であるとし、交差角θ2が大きくなる場合に進行方向に対して前方に傾斜し、交差角θ2が小さくなる場合に進行方向に対して後方に傾斜しているとして、現時点の本体部114の傾斜角度θ1を推定する。
ただし、例えば後述の図7(B)に示すように地面が傾斜している場合もあるため、傾斜面上でも目標傾斜角度を鉛直方向に対して0度または0度に近い値に維持する場合には、傾斜角センサ20で検出される地面の傾斜角を差分することが好ましい。
そして、トルク指令生成部212は、目標角速度計算部211で算出された傾斜角速度と、ジャイロセンサ24から入力された現時点の本体部114の傾斜角速度と、の差分値を入力し、この差分値が0となるような印加トルクを算出する。
また、斜度推定部213は、傾斜角センサ20の値に基づいて推定した地面の傾斜角に応じて、当該地面の傾斜角によって生じる重力トルクを補償するためのオフセットトルクを算出する。
このようにして、制御部21は、トルク指令生成部212で算出された印加トルクに、オフセットトルクを加算し、駆動部25に出力する。
駆動部25は、駆動輪111に取り付けられた軸を回転させるモータを駆動する機能部であり、制御部21から入力されたトルクを駆動輪111のモータに印加し、駆動輪111を回転させる。なお、ここでは、傾斜角によって生じる重力トルクを補償するために斜度推定部213を用いたが、地面の傾斜角度を本体部114のピッチ方向の目標傾斜角度に換算してオフセット角度として入力してもよい。
これにより、手押し車100は、第1の制御モードとして、倒立振子制御を行い、本体部114の姿勢を一定に保つように制御する。
なお、上述では、ジャイロセンサ24が本発明の本体角度変化検出手段に相当すると説明したが、現時点の本体部114のピッチ方向の角度変化を交差角から算出する場合、支持部用ロータリエンコーダ27も本発明の本体角度変化検出手段に含まれる。また、上述では、傾斜角センサ20が支持部112に備わっている場合のみを説明していたが、この傾斜角センサ20が本体部114に備わっている場合は、この傾斜角センサ20の出力と、支持部用ロータリエンコーダ27から得られた本体部114と支持部112の交差角度とを、組み合わせることで支持部112のピッチ方向の鉛直軸に対する傾斜角度を検知することができる。例えば、図9に示すように、支持部112の鉛直軸に対する傾斜角度θaは、地面の傾斜角度θbによりθa=90°-θbと表すことができ、θb=θ1-(θ2-90°)であるから、θa=θ2-θ1で表される。
そして、本実施形態の手押し車100は、駆動輪111に印加されるトルクから推算される回転速度と駆動輪用ロータリエンコーダ26から算出される実際の回転速度との差分値が所定値以上、あるいは差分値が所定の時間以上継続して所定値以上である場合に、駆動輪111の回転を停止する第2の制御モードに移行し、本体部114を持ち上げた時に意図しない空転が発生することを防止する。なお、所定値は一定の値であってもよいし、推定値に比例係数を掛けた値(たとえば推定値の10%など)であってもよい。
図5は、本体部114を持ち上げた時および本体部114を下ろした時の手押し車100の動作を説明するための図である。図6は、第1の制御モードと第2の制御モードとを切り替える場合の制御部21の動作を示したフローチャートである。
図5(A)に示すように、使用者が手押し車100を地面に下ろし、進行方向に押している場合には、第1の制御モードにより、交差角θ2から推定される本体部114の傾斜角度θ1に基づいて、本体部114の姿勢が一定に保たれる。図5(A)に示すように、地面が水平である場合、例えば目標傾斜角度を1度(図中の時計回りを正とする)とした場合に、交差角θ2は89度となり、支持部112の傾斜角θ3は、0度となる。
一方、図5(B)に示すように、段差等が存在して使用者が手押し車100を持ち上げた場合、支持部112のうち駆動輪111に連結されている側とは反対方向が下方に下がるため、交差角θ2が拡がる。また、支持部112の傾斜角θ3が大きくなる(θ3は、支持部112が下方に下がる場合に正とする)。補助輪113が浮く程度まで持ち上げた場合は、交差角θ2は最大(例えば120度)になり、傾斜角θ3も最大(例えば30度)となる。また、本体部114の傾斜角θ1は、鉛直方向にほぼ等しくなり、0度となる。この場合において、仮に倒立振子制御を継続すると、本体部114の傾斜角θ1を目標傾斜角度に維持するためのトルクが算出されるため、駆動輪111が回転し続けることになる。そこで、手押し車100は、このような持ち上げ動作を検出した場合に、駆動輪111を停止する第2の制御モードに移行する。
図6(A)は、第1の制御モードを実行している場合における制御部21の動作を示したフローチャートである。まず、制御部21は、図4に示した制御ブロックにより算出されたトルクから回転速度を推算する(s11)。具体的には、図4に示した算出されるトルクをTrとすると、
Tr=JLsω
(JL:負荷、s:微分演算子d/dt 、ω:回転角速度)
であるから、
Tr=JLsω
(JL:負荷、s:微分演算子d/dt 、ω:回転角速度)
であるから、
の計算式によって回転速度を算出できる。
すなわち、制御部21は、支持部用ロータリエンコーダ27から検出される交差角の値、ジャイロセンサ24から検出される本体部114の角速度の値、および傾斜角センサ20で検出される支持部112の傾斜角の値、に基づいて回転速度を推算する。ただし、上述したように、現時点の本体部114の傾斜角度は、ジャイロセンサ24の出力値を積分する、あるいは本体部114に傾斜角センサ(不図示)を取り付けることでも得られるため、回転速度の推算において、交差角の値を用いることは必須ではない。
そして、制御部21は、s11で推算した回転速度の値(推定値)と、駆動輪用ロータリエンコーダ26の出力値を微分して得られる駆動輪111の実際の回転速度(実測値)と、を比較する(s12)。実測値と推定値との差分値が所定値Δωup(>0)未満である場合は、駆動輪111が地面に接している状態であると判断し、s11から処理を繰り返す。一方、制御部21は、実測値と推定値との差分値が所定値Δωup以上である場合に、駆動輪111の回転を停止する第2の制御モードに移行する(s13)。なお、実測値と推測値の差分値の求め方は、例えば実測値と推測値の差の絶対値を取ってもよいし、実測値の2乗値と推測値の2乗値との差分の絶対値の平方根を利用してもよい。また、所定値Δωupは一定の値であってもよいし、推定値に比例係数を掛けた値(例えば推定値の10%など)であってもよい。
駆動輪を停止するためには、例えば倒立振子制御をオフする(駆動輪111に印加されるトルクを0にする)、駆動輪111の回転角度を第2の制御モードに切り替えた時点の値に維持し、駆動輪111を回転させないためのトルクを発生させる、あるいは、物理的に駆動輪の回転を拘束することでブレーキをかける、等により実現する。
なお、制御部21は、図6(A)に示した動作に加えて、図7(A)に示すように、傾斜角センサ20で検出される支持部112の傾斜角θ3の値が、想定される地面の最大の傾斜角(例えば図7(B)に示すように10度)を超えた場合、または所定時間継続して超えた場合にも、本体部114が持ち上げられたと判断して第2の制御モードに移行することが好ましい。この場合、例えば、使用者が本体部114を素早く持ち上げ、実測値と推定値との差分値が所定値Δωup以上となるよりも前に駆動輪111が地面から離れる場合であっても、傾斜角センサ20で最大傾斜角を超える傾斜角が検出された時点で駆動輪111が停止する。なお、支持部用ロータリエンコーダ27から検出される交差角の値が、初期値(水平な地面上で90度)から最大傾斜角(例えば10度)を超えて変化している場合、すなわち、目標傾斜角度+10度を超えた場合、または所定時間継続して目標傾斜角度+10度を超えた場合にも、本体部114が持ち上げられたと判断して第2の制御モードに移行することが好ましい。
次に、図6(B)は、第2の制御モードを実行中の制御部21の動作を示したフローチャートである。まず、制御部21は、支持部用ロータリエンコーダ27から検出される交差角の値、ジャイロセンサ24から検出される本体部114の角速度の値、または傾斜角センサ20で検出される支持部112の傾斜角の値に変化があったか否かを判断する(s21)。制御部21は、各種センサ値に変化があるまでこの判断を繰り返す。
各種センサ値に変化があった場合、制御部21は、全てのセンサ値、またはいずれか1つ以上のセンサ値が所定値内、または所定の時間継続して所定値内であるか否かを判断する(s22)。すなわち、ジャイロセンサ24から検出される本体部114の角速度の値が0または0に近い値であり、傾斜角センサ20で検出される支持部112の傾斜角が最大傾斜角(例えば10度)以下であり、かつ支持部用ロータリエンコーダ27から検出される交差角の値が初期値に近い(例えば90±10度以内である)か否かを判断する。
そして、制御部21は、全てのセンサ値が所定値内であると判断した場合、使用者が手押し車100を地面に下ろして駆動輪111および補助輪113が地面に接して、本体部114が鉛直方向に近い傾斜角度になった状態であると判断し、第1の制御モードに復帰する(s23)。なお、支持部用ロータリエンコーダ27は、本発明において必須の構成ではない。支持部用ロータリエンコーダ27ない場合は、所定値であるか否かを判断する際に、支持部用ロータリエンコーダ27は用いない。また、上述したように、実測値と推定値との差分値が所定値Δωup以上となる前に、支持部112の傾斜角θ3の値が想定値を超えた場合は、θ3の値が所定の範囲内、または所定の時間継続して所定の範囲内であると判断した場合に、第1の制御モードに復帰する。傾斜角センサ20の検出した傾斜角が最大傾斜角を超える場合も、該傾斜角が所定の範囲内、または所定の時間継続して所定の範囲内にあるか否かを判断した場合に、第1の制御モードに復帰する。
なお、制御部21は、第2の制御モードとして、駆動輪111の回転角度を第2の制御モードに切り替えた時点の値に維持するためのトルクを発生させる、あるいは、物理的にブレーキをかける、等により駆動輪111を停止している場合には、上記s22において、まずジャイロセンサ24から検出される本体部114の角速度の値が0または0に近い値であり、傾斜角センサ20で検出される支持部112の傾斜角が最大傾斜角(例えば10度)以下となった時点で、使用者が手押し車100を地面に下ろして駆動輪111および補助輪113が地面に接した状態であると判断し、倒立振子制御をオフした状態(駆動輪111に印加されるトルクを0にした状態)に移行する。そして、さらに支持部用ロータリエンコーダ27から検出される交差角の値が初期値に近くなった(例えば90±10度以内となった)場合に、本体部114が鉛直方向に近い傾斜角度になった状態であると判断し、倒立振子制御を開始するようにしてもよい。
以上のようにして、使用者が手押し車100を地面に下ろし、本体部114が鉛直方向に近い傾斜角度になった場合には、再び倒立振子制御が開始されるため、使用者が進行方向に押して歩行補助車として用いることができる。歩行補助車には、第2の制御モードが作動している時に、「振動(バイブレータなど)」「音(ブザーなど)」「光(LEDライトなど)」の少なくとも1つが動作して、使用者に通知する通知機能を備えていてもよい。このような機能を備えることによって、使用者は、駆動輪の動きを覗き込むようにして確認することなくモードが切り替わっていることを認識することが出来るので、歩行補助車を安全に操作することができる。なお、ここでは第2の制御モードの時に通知する例を示したが、第1の制御モードが動作している時に通知する態様でも構わないし、第1の制御モードと第2の制御モードで異なる通知方法であってもよい。また、第1の制御モードと第2の制御モードとが切り替わる際にのみ通知する態様であってもよい。また、上記の通知機能は、歩行補助車のどの部分に設けられていてもよいが、把持部に備えていることが望ましい。把持部は、利用者が手で握る箇所であり、使用者の目や耳に近い位置に設けられているため、大きな音を出したり強い光を出したりする必要がなく、小さい消費電力で通知することができる。
20…傾斜角センサ
21…制御部
22…ROM
23…RAM
24…ジャイロセンサ
25…駆動部
26…駆動輪用ロータリエンコーダ
27…支持部用ロータリエンコーダ
28…ユーザI/F
30…ボックス
94…ジャイロセンサ
100…車
111…駆動輪
112…支持部
113…補助輪
114…本体部
116…把持部
211…目標角速度計算部
212…トルク指令生成部
213…斜度推定部
21…制御部
22…ROM
23…RAM
24…ジャイロセンサ
25…駆動部
26…駆動輪用ロータリエンコーダ
27…支持部用ロータリエンコーダ
28…ユーザI/F
30…ボックス
94…ジャイロセンサ
100…車
111…駆動輪
112…支持部
113…補助輪
114…本体部
116…把持部
211…目標角速度計算部
212…トルク指令生成部
213…斜度推定部
Claims (5)
- 駆動輪と、
前記駆動輪を駆動する駆動手段と、
前記駆動手段を制御する制御手段と、
前記駆動輪に対して、ピッチ方向に回転可能に連結された本体部と、
前記本体部のうち、前記駆動輪に連結されている側とは反対方向に設けられた把持部と、
前記本体部または前記駆動輪に対してピッチ方向に回転可能に連結された支持部と、
前記支持部に連結された補助輪と、
前記本体部のピッチ方向の角度変化を検出する本体角度変化検出手段と、
前記本体部または支持部の鉛直軸に対するピッチ方向の傾斜角を検出する傾斜角検出手段と、
前記駆動輪の回転速度を検出する回転速度検出手段と、
を備えた手押し車であって、
前記制御手段は、前記本体部の角度変化が0となるように前記駆動輪の回転を制御する第1の制御モードを有し、
かつ、前記本体角度変化検出手段と前記傾斜角検出手段とから前記駆動輪の回転速度を推算し、前記推算した回転速度と前記回転速度検出手段により検出した回転速度との速度差が所定値以上である場合、または該速度差が所定の時間継続して所定値以上である場合、前記駆動輪の回転を停止させる第2の制御モードと、
を有する手押し車。 - 前記本体部と前記支持部とが成す交差角を検出する交差角検出手段を備え、
前記制御手段は、前記第1の制御モードにおいて、前記本体角度変化検出手段、前記傾斜角検出手段、および前記交差角検出手段から前記駆動輪の回転速度を推算することを特徴とする請求項1に記載の手押し車。 - 前記制御手段は、前記回転速度の速度差が所定値内であっても、前記交差角検出手段が所定値以上あるいは所定の時間継続して所定値以上である場合、前記第2の制御モードに移行する請求項2に記載の手押し車。
- 前記制御手段は、前記第2の制御モードにおいて、
前記本体角度変化検出手段、前記傾斜角検出手段、および前記交差角検出手段のうちいずれか1つ以上の値が所定の範囲内にある場合、または所定時間継続して前記所定の範囲内である場合に、前記第1の制御モードに移行することを特徴とする請求項1または請求項2または請求項3に記載の手押し車。 - 前記制御手段は、前記回転速度の速度差が所定値内であっても、前記傾斜角検出手段が、所定値以上あるいは所定の時間継続して所定値以上である場合、前記第2の制御モードに移行する請求項1乃至4のいずれかに記載の手押し車。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015514277A JP5800110B2 (ja) | 2013-10-10 | 2014-10-07 | 手押し車 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013-212984 | 2013-10-10 | ||
JP2013212984 | 2013-10-10 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2015053244A1 true WO2015053244A1 (ja) | 2015-04-16 |
Family
ID=52813060
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2014/076751 WO2015053244A1 (ja) | 2013-10-10 | 2014-10-07 | 手押し車 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP5800110B2 (ja) |
WO (1) | WO2015053244A1 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015153149A (ja) * | 2014-02-14 | 2015-08-24 | トヨタ自動車株式会社 | 自律移動体、及びその故障判定方法 |
FR3056434A1 (fr) * | 2016-09-29 | 2018-03-30 | Kompai Robotics | Robot mobile d'assistance comprenant au moins un systeme d'appui pivotant |
WO2021039190A1 (ja) * | 2019-08-27 | 2021-03-04 | ソニー株式会社 | 情報処理装置、その制御方法及びプログラム |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009104360A (ja) * | 2007-10-23 | 2009-05-14 | Toyota Motor Corp | 倒立型移動体および倒立型移動体の制御方法 |
JP2010125221A (ja) * | 2008-11-28 | 2010-06-10 | Mitsuba Corp | 移動体 |
WO2012114597A1 (ja) * | 2011-02-23 | 2012-08-30 | 株式会社村田製作所 | 歩行補助車 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009241169A (ja) * | 2008-03-28 | 2009-10-22 | Nec Corp | 倒立振子型走行装置 |
-
2014
- 2014-10-07 JP JP2015514277A patent/JP5800110B2/ja not_active Expired - Fee Related
- 2014-10-07 WO PCT/JP2014/076751 patent/WO2015053244A1/ja active Application Filing
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2009104360A (ja) * | 2007-10-23 | 2009-05-14 | Toyota Motor Corp | 倒立型移動体および倒立型移動体の制御方法 |
JP2010125221A (ja) * | 2008-11-28 | 2010-06-10 | Mitsuba Corp | 移動体 |
WO2012114597A1 (ja) * | 2011-02-23 | 2012-08-30 | 株式会社村田製作所 | 歩行補助車 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2015153149A (ja) * | 2014-02-14 | 2015-08-24 | トヨタ自動車株式会社 | 自律移動体、及びその故障判定方法 |
FR3056434A1 (fr) * | 2016-09-29 | 2018-03-30 | Kompai Robotics | Robot mobile d'assistance comprenant au moins un systeme d'appui pivotant |
WO2018060597A1 (fr) * | 2016-09-29 | 2018-04-05 | Kompaï Robotics | Robot mobile d'assistance comprenant au moins un systeme d'appui pivotant |
US10603244B2 (en) | 2016-09-29 | 2020-03-31 | Kompaï Robotics | Mobile assistance robot comprising at least one pivoting bearing system |
WO2021039190A1 (ja) * | 2019-08-27 | 2021-03-04 | ソニー株式会社 | 情報処理装置、その制御方法及びプログラム |
Also Published As
Publication number | Publication date |
---|---|
JPWO2015053244A1 (ja) | 2017-03-09 |
JP5800110B2 (ja) | 2015-10-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3225290B1 (en) | Standing-ride type moving device | |
EP2093100A1 (en) | Travel gear and its controlling method | |
US9751551B2 (en) | Pushcart | |
JP6164300B2 (ja) | 手押し車 | |
US9845101B2 (en) | Pushcart | |
JP5943154B2 (ja) | 手押し車 | |
JP5800110B2 (ja) | 手押し車 | |
JP5403055B2 (ja) | 操舵制御装置 | |
JP6123907B2 (ja) | 手押し車 | |
US10052253B2 (en) | Hand-propelled vehicle | |
JP5958581B2 (ja) | 手押し車 | |
JP6252683B2 (ja) | 手押し車 | |
JP4677953B2 (ja) | 走行装置及びその制御方法 | |
WO2014132520A1 (ja) | 手押し車 | |
WO2015019982A1 (ja) | 手押し車 | |
WO2015098511A1 (ja) | 手押し車 | |
JP2015050836A (ja) | 歩行アシスト移動体 | |
JP5958546B2 (ja) | 手押し車 | |
JP6576756B2 (ja) | ショベル | |
JP5935965B1 (ja) | 手押し車 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 2015514277 Country of ref document: JP Kind code of ref document: A |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 14852892 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 14852892 Country of ref document: EP Kind code of ref document: A1 |