JP2013070824A - Electric handy cart - Google Patents

Electric handy cart Download PDF

Info

Publication number
JP2013070824A
JP2013070824A JP2011211736A JP2011211736A JP2013070824A JP 2013070824 A JP2013070824 A JP 2013070824A JP 2011211736 A JP2011211736 A JP 2011211736A JP 2011211736 A JP2011211736 A JP 2011211736A JP 2013070824 A JP2013070824 A JP 2013070824A
Authority
JP
Japan
Prior art keywords
signal
speed
target
calculating
electric
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2011211736A
Other languages
Japanese (ja)
Other versions
JP5756384B2 (en
Inventor
Takashi Enomoto
孝史 榎本
Kazushige Kogure
和重 小暮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsuba Corp
Original Assignee
Mitsuba Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsuba Corp filed Critical Mitsuba Corp
Priority to JP2011211736A priority Critical patent/JP5756384B2/en
Publication of JP2013070824A publication Critical patent/JP2013070824A/en
Application granted granted Critical
Publication of JP5756384B2 publication Critical patent/JP5756384B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Handcart (AREA)
  • Rehabilitation Tools (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide an electric handy cart in which speed control is used as the control system of an electric motor that drives a driving wheel.SOLUTION: The electric handy cart 1 includes: an operation rod 3 to be held by a walker; an operation force detector 9; the electric motors (4, 5); speed detection means (4a, 5a) for detecting the rotation speeds of the electric motors (4, 5) respectively; the driving wheels (6, 7) rotated by the electric motors (4, 5); and a controller 10 for supplying a control current to the electric motors (4, 5) on the basis of force signals from the operation force detector 9. The controller 10 includes: a target speed computing means 12 for computing target speed signals by integrating the force signals from the operation force detector 9; an averaging means 25 for averaging detection speed signals and outputting average speed signals; and a target current computing means 21 for computing target current signals to be supplied to the electric motors (4, 5) on the basis of deviation signals of the average speed signals and the target speed signals.

Description

この発明は、電動式ハンディカートに関するものである。   The present invention relates to an electric handy cart.

高齢者などの足腰の弱くなった歩行者の歩行をアシストする装置として、特許文献1または特許文献2に示される電動式ハンディカートが提案されている。   As an apparatus for assisting walking of a pedestrian who has weak legs and legs such as an elderly person, an electric handy cart shown in Patent Document 1 or Patent Document 2 has been proposed.

上記の電動式ハンディカートは、電動モータにより独立して回転駆動することができる左右の駆動輪と、歩行者者が把持する操作桿(杖部)と、を備える。操作桿には、操作力検出装置が設けられており、この操作力検出装置により操作桿に作用する歩行者の操作力が検出される。そして、ハンディカートの左右の駆動輪を駆動する電動モータは、操作力検出装置にて検出される歩行者の操作力の値に基づいて、制御方式としてトルク制御により作動させられる。   The electric handy cart includes left and right drive wheels that can be driven to rotate independently by an electric motor, and an operating rod (cane portion) that a pedestrian grips. The operation rod is provided with an operation force detection device, and the operation force of the pedestrian acting on the operation rod is detected by the operation force detection device. The electric motor that drives the left and right drive wheels of the handy cart is operated by torque control as a control method based on the value of the pedestrian's operation force detected by the operation force detection device.

特開2010−125221号公報JP 2010-125221 A 特開2011−068239号公報JP 2011-068239 A

しかしながら、上述の電動式ハンディカートにあっては、制御方式としてトルク制御が用いられていたため、ハンディカートを所望の速度で走行させること、およびハンディカートを所定のときに停止させることが困難という課題があった。ここで、ハンディカートを所望の速度で走行させること、およびハンディカートを所定のときに停止させるためには、制御量として速度を用いる速度制御を用いることが有効であるといえる。   However, since the electric handy cart described above uses torque control as a control method, it is difficult to run the handy cart at a desired speed and to stop the handy cart at a predetermined time. was there. Here, in order to run the handy cart at a desired speed and stop the handy cart at a predetermined time, it can be said that it is effective to use speed control using the speed as the control amount.

そこで、この発明は、上述した事情に鑑みてなされたものであって、駆動輪を駆動する電動モータの制御方式として速度制御が用いられる電動式ハンディカートを提供するものである。   Therefore, the present invention has been made in view of the above-described circumstances, and provides an electric handy cart in which speed control is used as a control method of an electric motor that drives a drive wheel.

上記の課題を解決するために、本発明の電動式ハンディカートは、歩行者が保持する操作桿と、この操作桿に設けられ、歩行者が前記操作桿に与える操作力を検出する操作力検出装置と、第1および第2の電動モータと、これらの第1および第2の電動モータの回転速度をそれぞれ検出する第1および第2の速度検出手段と、第1および第2の電動モータによりそれぞれ回転駆動する第1および第2の駆動輪と、操作力検出装置からの力信号に基づき第1および第2の電動モータに制御電流を供給する制御装置と、を備える電動式ハンディカートにおいて、制御装置は、操作力検出装置からの力信号を積分処理することにより、第1の目標速度信号を演算する目標速度演算手段と、第1および第2の速度検出手段からの前記第1および第2の検出速度信号を平均化して平均速度信号を出力する平均化手段と、平均化手段からの平均速度信号と、前記目標速度演算手段からの第1の目標速度信号との偏差信号に基づき、前記電動モータに供給する目標電流信号を演算する目標電流演算手段と、目標電流演算手段からの目標電流信号に対応し、前記第1および第2の電動モータに制御電流をそれぞれ供給する第1および第2の電流出力手段と、を備えることを特徴とする。   In order to solve the above problems, an electric handy cart according to the present invention includes an operation rod that is held by a pedestrian and an operation force detection that is provided on the operation rod and detects an operation force that the pedestrian gives to the operation rod. An apparatus, first and second electric motors, first and second speed detecting means for detecting rotational speeds of the first and second electric motors, respectively, and first and second electric motors. In an electric handy cart comprising first and second drive wheels that respectively rotate and a control device that supplies a control current to the first and second electric motors based on a force signal from an operating force detection device, The control device integrates the force signal from the operating force detection device to calculate a first target speed signal, and the first and second speed detection means from the first and second speed detection means. 2 Based on the deviation signal between the averaging means for averaging the output speed signal and outputting the average speed signal, the average speed signal from the averaging means, and the first target speed signal from the target speed calculating means, Target current calculating means for calculating a target current signal to be supplied to the motor, and first and second for supplying a control current to the first and second electric motors corresponding to the target current signal from the target current calculating means, respectively. Current output means.

本発明の電動式ハンディカートによれば、駆動輪を駆動する電動モータの制御方式を速度制御とすることができる。   According to the electric handy cart of the present invention, the control method of the electric motor that drives the drive wheels can be speed control.

本発明の実施形態を示す斜視図である。It is a perspective view which shows embodiment of this invention. 本発明の第1の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 1st Embodiment of this invention. 本発明の第2の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 2nd Embodiment of this invention. 本発明の第3の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 3rd Embodiment of this invention. 本発明の第4の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 4th Embodiment of this invention. 本発明の他の実施形態を示す斜視図である。It is a perspective view which shows other embodiment of this invention. 本発明の第5の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 5th Embodiment of this invention. 本発明の第6の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 6th Embodiment of this invention. 本発明の第7の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 7th Embodiment of this invention. 本発明の第8の実施形態の制御装置のシステムブロック図である。It is a system block diagram of the control apparatus of the 8th Embodiment of this invention.

(電動式ハンディカートの実施形態)
次に、本発明の電動式ハンディカートの実施形態について、図1に基づいて説明する。図1は本実施形態における電動式ハンディカートの斜視図である。
(Embodiment of electric handy cart)
Next, an embodiment of the electric handy cart of the present invention will be described with reference to FIG. FIG. 1 is a perspective view of an electric handy cart according to the present embodiment.

図1に示すように、電動式ハンディカート1は、パイプ部材より形成された本体フレーム2と、本体フレーム2の端部に取り付けられ、歩行者が保持する棒状の操作桿3と、本体フレーム2に設けられたケースCと、本体フレーム2の両側に取り付けられた第1および第2の電動モータ(4,5)と、第1および第2の電動モータ(4,5)によりそれぞれ回転駆動する第1および第2の駆動輪(6,7)と、を備える。そして、ケースC内には、制御装置10(110,120,130)と、電動モータ(4,5)に電流を供給するバッテリ30と、ハンディカート1の傾斜角を検出する傾斜角検出手段としてのジャイロセンサ50と、が設けられている。また、ハンディカート1は、電動モータ(4,5)の回転速度をそれぞれ検出する第1および第2の速度検出手段(4a,5a)を備えている。   As shown in FIG. 1, the electric handy cart 1 includes a main body frame 2 formed of a pipe member, a rod-shaped operation rod 3 attached to an end of the main body frame 2 and held by a pedestrian, and a main body frame 2. And a case C provided on the main body frame 1, first and second electric motors (4, 5) attached to both sides of the main body frame 2, and first and second electric motors (4, 5), respectively. First and second drive wheels (6, 7). In the case C, the control device 10 (110, 120, 130), the battery 30 for supplying current to the electric motor (4, 5), and the inclination angle detecting means for detecting the inclination angle of the handy cart 1 The gyro sensor 50 is provided. The handy cart 1 also includes first and second speed detecting means (4a, 5a) for detecting the rotational speeds of the electric motors (4, 5), respectively.

また、操作桿3の上端部にはハンドグリップ8が取り付けられており、ハンドグリップ8には画像検出手段としてのステレオカメラ40が設けられているとともに、ハンドグリップ8内には操作力検出装置9が設けられている。ここで、ステレオカメラ40は、上下方向(操作桿の軸方向)に縦型に配置された2つのCCDカメラ(41,42)を備え、ハンディカート1の前方における対象物の画像を検出する。操作力検出装置9は、歩行者が操作桿3に与える操作力を検出する。ここで、操作力は、歩行者がハンディカート1を押し引きする力である。なお、操作桿3の中央部には、買い物かご等を懸架することができるかご用フック60が取り付けられている。   A hand grip 8 is attached to the upper end of the operation rod 3, and a stereo camera 40 as an image detecting means is provided on the hand grip 8, and an operating force detection device 9 is provided in the hand grip 8. Is provided. Here, the stereo camera 40 includes two CCD cameras (41, 42) arranged vertically in the vertical direction (axial direction of the operation rod), and detects an image of the object in front of the handy cart 1. The operation force detection device 9 detects an operation force applied to the operation rod 3 by the pedestrian. Here, the operation force is a force by which the pedestrian pushes and pulls the handy cart 1. A basket hook 60 that can suspend a shopping basket or the like is attached to the central portion of the operation rod 3.

(第1の実施形態の制御装置)
次に、図2に基づきハンディカート1に備わる第1の実施形態の制御装置10について説明する。図2は電動式ハンディカート1における第1の実施形態の制御装置を示すシステムブロック図である。
(Control device of the first embodiment)
Next, the control device 10 of the first embodiment provided in the handy cart 1 will be described with reference to FIG. FIG. 2 is a system block diagram showing the control device of the first embodiment in the electric handy cart 1.

制御装置10は、計測手段11と、目標速度演算手段12と、距離演算手段13と、上限速度演算手段14と、比較手段15と、リセット手段16と、計測手段17と、姿勢補償手段18と、減算器19と、加算器20と、目標電流演算手段21と、第1および第2の電流出力手段(22,23)と、加算器24と、平均化手段25と、を備える。   The control device 10 includes a measuring means 11, a target speed calculating means 12, a distance calculating means 13, an upper limit speed calculating means 14, a comparing means 15, a reset means 16, a measuring means 17, and an attitude compensating means 18. , A subtractor 19, an adder 20, a target current calculation means 21, first and second current output means (22, 23), an adder 24, and an averaging means 25.

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

距離演算手段13は、ステレオカメラ(画像検出手段)40からの画像信号に基づきステレオカメラ40から前方の対象物までの距離を演算する。そして、上限速度演算手段14は、距離演算手段13からの距離信号に基づき上限速度信号(Vr2)を演算する。そして、比較手段15は、目標速度演算手段12からの第1の目標速度信号(Vr1)と、上限速度演算手段14からの上限速度信号(Vr2)とを比較し、第1の目標速度信号(Vr1)と上限速度信号(Vr2)とのうち小さいほうの信号を第2の目標速度信号(Vr1 or Vr2)として選択する。なお、本実施形態では、上限速度信号(Vr2)を演算する手段するため検出手段として、ステレオカメラ(画像検出手段)40を用いているが、レーザレンジファイダ(LRF)を用いて、前方の対象物までの距離を演算し、演算した距離信号に基づき上限速度信号(Vr2)を演算してもよい。   The distance calculation means 13 calculates the distance from the stereo camera 40 to the front object based on the image signal from the stereo camera (image detection means) 40. Then, the upper limit speed calculation means 14 calculates an upper limit speed signal (Vr2) based on the distance signal from the distance calculation means 13. Then, the comparing means 15 compares the first target speed signal (Vr1) from the target speed calculating means 12 with the upper limit speed signal (Vr2) from the upper limit speed calculating means 14, and compares the first target speed signal (Vr1). The smaller one of Vr1) and the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2). In this embodiment, a stereo camera (image detection means) 40 is used as a detection means for calculating the upper limit speed signal (Vr2). However, a laser range finder (LRF) is used to detect the upper limit speed signal (Vr2). The distance to the object may be calculated, and the upper limit speed signal (Vr2) may be calculated based on the calculated distance signal.

ここで、第2の目標速度信号(Vr1 or Vr2)として上限速度信号(Vr2)が選択されている場合には、リセット手段16により目標速度演算手段12での積分処理はリセットされ続け、上限速度信号(Vr2)が選択されなくなった場合には、再度、積分処理が再開される。   Here, when the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2), the integration process in the target speed calculation means 12 is continuously reset by the reset means 16, and the upper limit speed signal is set. When the signal (Vr2) is no longer selected, the integration process is restarted.

また、第1および第2の速度検出手段(4a,5a)で検出された電動モータ(4,5)の回転速度に対応する第1および第2の検出速度信号(Va1,Va2)は、加算器24で加算されるとともに、平均化手段25にて平均化され平均速度信号(Vave)として出力される。そして、減算器19により第2の目標速度信号(Vr1 or Vr2)から平均速度信号(Vave)が減じられ、第2の目標速度信号(Vr1 or Vr2)と平均速度信号(Vave)との偏差信号(Vε1)が減算器19より出力される。   The first and second detected speed signals (Va1, Va2) corresponding to the rotational speed of the electric motor (4, 5) detected by the first and second speed detecting means (4a, 5a) are added. The signal is added by the device 24 and averaged by the averaging means 25 and output as an average speed signal (Vave). Then, the subtracter 19 subtracts the average speed signal (Vave) from the second target speed signal (Vr1 or Vr2), and a deviation signal between the second target speed signal (Vr1 or Vr2) and the average speed signal (Vave). (Vε1) is output from the subtractor 19.

計測手段17は、ジャイロセンサ(傾斜角検出手段)50からの信号をサンプリングし、この信号に対応する角速度信号を出力する。姿勢補償手段18は、角速度信号を処理することによりハンディカート1の傾斜量を補償する補償角速度信号(Vθ)を演算する。そして、減算器19から出力された偏差信号(Vε1)と補償角速度信号(Vθ)とが加算器20にて合算され、合算された合算信号(Vε2)が加算器20より出力される。   The measuring means 17 samples a signal from the gyro sensor (tilt angle detecting means) 50 and outputs an angular velocity signal corresponding to this signal. The posture compensation means 18 calculates a compensation angular velocity signal (Vθ) that compensates for the amount of inclination of the handy cart 1 by processing the angular velocity signal. Then, the deviation signal (Vε1) output from the subtractor 19 and the compensation angular velocity signal (Vθ) are added together by the adder 20, and the added total signal (Vε2) is output from the adder 20.

目標電流演算手段21は、加算器20からの合算信号(Vε2)に基づき、電動モータ(4,5)に供給する目標電流信号を演算する。そして、第1および第2の電流出力手段(22,23)は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、それぞれ第1および第2の電動モータ(4,5)に供給する。   The target current calculation means 21 calculates a target current signal to be supplied to the electric motor (4, 5) based on the sum signal (Vε2) from the adder 20. The first and second current output means (22, 23) control the current supplied from the battery 30 based on the target current signal, and use the controlled control current as the first and second electric motors, respectively. (4, 5).

(第2の実施形態における制御装置)
次に、図3に基づきハンディカート1に備わる第2の実施形態の制御装置110について説明する。図3は電動式ハンディカート1における第2の実施形態の制御装置を示すシステムブロック図である。なお、図2の制御装置10と同一の手段については、同一の符号が付されている。
(Control device in the second embodiment)
Next, the control device 110 of the second embodiment provided in the handy cart 1 will be described with reference to FIG. FIG. 3 is a system block diagram showing the control device of the second embodiment in the electric handy cart 1. The same means as those in the control device 10 in FIG. 2 are denoted by the same reference numerals.

制御装置110は、計測手段11と、目標速度演算手段12と、距離演算手段13と、上限速度演算手段14と、比較手段15と、リセット手段16と、減算器19と、目標電流演算手段21と、第1および第2の電流出力手段(22,23)と、加算器24と、平均化手段25と、を備える。   The control device 110 includes a measurement unit 11, a target speed calculation unit 12, a distance calculation unit 13, an upper limit speed calculation unit 14, a comparison unit 15, a reset unit 16, a subtractor 19, and a target current calculation unit 21. And first and second current output means (22, 23), an adder 24, and an averaging means 25.

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

距離演算手段13は、ステレオカメラ(画像検出手段)40からの画像信号に基づきステレオカメラ40から前方の対象物までの距離を演算する。そして、上限速度演算手段14は、距離演算手段13からの距離信号に基づき上限速度信号(Vr2)を演算する。そして、比較手段15は、目標速度演算手段12からの第1の目標速度信号(Vr1)と、上限速度演算手段14からの上限速度信号(Vr2)とを比較し、第1の目標速度信号(Vr1)と上限速度信号(Vr2)とのうち小さいほうの信号を第2の目標速度信号(Vr1 or Vr2)として選択する。なお、本実施形態では、上限速度信号(Vr2)を演算する手段するため検出手段として、ステレオカメラ(画像検出手段)40を用いているが、レーザレンジファイダ(LRF)を用いて、前方の対象物までの距離を演算し、演算した距離信号に基づき上限速度信号(Vr2)を演算してもよい。   The distance calculation means 13 calculates the distance from the stereo camera 40 to the front object based on the image signal from the stereo camera (image detection means) 40. Then, the upper limit speed calculation means 14 calculates an upper limit speed signal (Vr2) based on the distance signal from the distance calculation means 13. Then, the comparing means 15 compares the first target speed signal (Vr1) from the target speed calculating means 12 with the upper limit speed signal (Vr2) from the upper limit speed calculating means 14, and compares the first target speed signal (Vr1). The smaller one of Vr1) and the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2). In this embodiment, a stereo camera (image detection means) 40 is used as a detection means for calculating the upper limit speed signal (Vr2). However, a laser range finder (LRF) is used to detect the upper limit speed signal (Vr2). The distance to the object may be calculated, and the upper limit speed signal (Vr2) may be calculated based on the calculated distance signal.

ここで、第2の目標速度信号(Vr1 or Vr2)として上限速度信号(Vr2)が選択されている場合には、リセット手段16により目標速度演算手段12での積分処理はリセットされ続け、上限速度信号(Vr2)が選択されなくなった場合には、再度、積分処理が再開される。   Here, when the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2), the integration process in the target speed calculation means 12 is continuously reset by the reset means 16, and the upper limit speed signal is set. When the signal (Vr2) is no longer selected, the integration process is restarted.

また、第1および第2の速度検出手段(4a,5a)で検出された電動モータ(4,5)の回転速度に対応する第1および第2の検出速度信号(Va1,Va2)は、加算器24で加算されるとともに、平均化手段25にて平均化され平均速度信号(Vave)として出力される。そして、減算器19により第2の目標速度信号(Vr1 or Vr2)から平均速度信号(Vave)が減じられ、第2の目標速度信号(Vr1 or Vr2)と平均速度信号(Vave)との偏差信号(Vε1)が減算器19より出力される。   The first and second detected speed signals (Va1, Va2) corresponding to the rotational speed of the electric motor (4, 5) detected by the first and second speed detecting means (4a, 5a) are added. The signal is added by the device 24 and averaged by the averaging means 25 and output as an average speed signal (Vave). Then, the subtracter 19 subtracts the average speed signal (Vave) from the second target speed signal (Vr1 or Vr2), and a deviation signal between the second target speed signal (Vr1 or Vr2) and the average speed signal (Vave). (Vε1) is output from the subtractor 19.

目標電流演算手段21は、減算器19からの偏差信号(Vε1)に基づき、電動モータ(4,5)に供給する目標電流信号を演算する。そして、第1および第2の電流出力手段(22,23)は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、それぞれ第1および第2の電動モータ(4,5)に供給する。   The target current calculation means 21 calculates a target current signal to be supplied to the electric motor (4, 5) based on the deviation signal (Vε1) from the subtracter 19. The first and second current output means (22, 23) control the current supplied from the battery 30 based on the target current signal, and use the controlled control current as the first and second electric motors, respectively. (4, 5).

(第3の実施形態における制御装置)
次に、図4に基づきハンディカート1に備わる第3の実施形態の制御装置120について説明する。図4は電動式ハンディカート1における第3の実施形態の制御装置を示すシステムブロック図である。なお、図2の制御装置10と同一の手段については、同一の符号が付されている。
(Control device in the third embodiment)
Next, the control device 120 of the third embodiment provided in the handy cart 1 will be described with reference to FIG. FIG. 4 is a system block diagram showing the control device of the third embodiment in the electric handy cart 1. The same means as those in the control device 10 in FIG. 2 are denoted by the same reference numerals.

制御装置10は、計測手段11と、目標速度演算手段12と、計測手段17と、姿勢補償手段18と、減算器19と、加算器20と、目標電流演算手段21と、第1および第2の電流出力手段(22,23)と、加算器24と、平均化手段25と、を備える。   The control device 10 includes a measuring unit 11, a target speed calculating unit 12, a measuring unit 17, an attitude compensating unit 18, a subtracter 19, an adder 20, a target current calculating unit 21, a first and a second. Current output means (22, 23), an adder 24, and an averaging means 25.

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

また、第1および第2の速度検出手段(4a,5a)で検出された電動モータ(4,5)の回転速度に対応する第1および第2の検出速度信号(Va1,Va2)は、加算器24で加算されるとともに、平均化手段25にて平均化され平均速度信号(Vave)として出力される。そして、減算器19により第1の目標速度信号(Vr1)から平均速度信
号(Vave)が減じられ、第1の目標速度信号(Vr1)と平均速度信号(Vave)との偏差信号(Vε1)が減算器19より出力される。
The first and second detected speed signals (Va1, Va2) corresponding to the rotational speed of the electric motor (4, 5) detected by the first and second speed detecting means (4a, 5a) are added. The signal is added by the device 24 and averaged by the averaging means 25 and output as an average speed signal (Vave). Then, the average speed signal (Vave) is subtracted from the first target speed signal (Vr1) by the subtracter 19, and a deviation signal (Vε1) between the first target speed signal (Vr1) and the average speed signal (Vave) is obtained. Output from the subtractor 19.

計測手段17は、ジャイロセンサ(傾斜角検出手段)50からの信号をサンプリングし、この信号に対応する角速度信号を出力する。姿勢補償手段18は、角速度信号を処理することによりハンディカート1の傾斜量を補償する補償角速度信号(Vθ)を演算する。そして、減算器19から出力された偏差信号(Vε1)と補償角速度信号(Vθ)とが加算器20にて合算され、合算された合算信号(Vε2)が加算器20より出力される。   The measuring means 17 samples a signal from the gyro sensor (tilt angle detecting means) 50 and outputs an angular velocity signal corresponding to this signal. The posture compensation means 18 calculates a compensation angular velocity signal (Vθ) that compensates for the amount of inclination of the handy cart 1 by processing the angular velocity signal. Then, the deviation signal (Vε1) output from the subtractor 19 and the compensation angular velocity signal (Vθ) are added together by the adder 20, and the added total signal (Vε2) is output from the adder 20.

目標電流演算手段21は、加算器20からの合算信号(Vε2)に基づき、電動モータ(4,5)に供給する目標電流信号を演算する。そして、第1および第2の電流出力手段(22,23)は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、それぞれ第1および第2の電動モータ(4,5)に供給する。   The target current calculation means 21 calculates a target current signal to be supplied to the electric motor (4, 5) based on the sum signal (Vε2) from the adder 20. The first and second current output means (22, 23) control the current supplied from the battery 30 based on the target current signal, and use the controlled control current as the first and second electric motors, respectively. (4, 5).

(第4の実施形態における制御装置)
次に、図5に基づきハンディカート1に備わる第4の実施形態の制御装置130について説明する。図5は電動式ハンディカート1における第4の実施形態の制御装置を示すシステムブロック図である。なお、図2の制御装置10と同一の手段については、同一の符号が付されている。
(Control device in the fourth embodiment)
Next, a control device 130 according to a fourth embodiment provided in the handy cart 1 will be described with reference to FIG. FIG. 5 is a system block diagram showing the control device of the fourth embodiment in the electric handy cart 1. The same means as those in the control device 10 in FIG. 2 are denoted by the same reference numerals.

制御装置10は、計測手段11と、目標速度演算手段12と、減算器19と、目標電流演算手段21と、第1および第2の電流出力手段(22,23)と、加算器24と、平均化手段25と、を備える。   The control device 10 includes a measuring means 11, a target speed calculating means 12, a subtractor 19, a target current calculating means 21, first and second current output means (22, 23), an adder 24, And averaging means 25.

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

また、第1および第2の速度検出手段(4a,5a)で検出された電動モータ(4,5)の回転速度に対応する第1および第2の検出速度信号(Va1,Va2)は、加算器24で加算されるとともに、平均化手段25にて平均化され平均速度信号(Vave)として出力される。そして、減算器19により第1の目標速度信号(Vr1)から平均速度信号(Vave)が減じられ、第1の目標速度信号(Vr1)と平均速度信号(Vave)との偏差信号(Vε1)が減算器19より出力される。   The first and second detected speed signals (Va1, Va2) corresponding to the rotational speed of the electric motor (4, 5) detected by the first and second speed detecting means (4a, 5a) are added. The signal is added by the device 24 and averaged by the averaging means 25 and output as an average speed signal (Vave). Then, the average speed signal (Vave) is subtracted from the first target speed signal (Vr1) by the subtracter 19, and a deviation signal (Vε1) between the first target speed signal (Vr1) and the average speed signal (Vave) is obtained. Output from the subtractor 19.

目標電流演算手段21は、減算器19からの偏差信号(Vε1)に基づき、電動モータ(4,5)に供給する目標電流信号を演算する。そして、第1および第2の電流出力手段(22,23)は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、それぞれ第1および第2の電動モータ(4,5)に供給する。   The target current calculation means 21 calculates a target current signal to be supplied to the electric motor (4, 5) based on the deviation signal (Vε1) from the subtracter 19. The first and second current output means (22, 23) control the current supplied from the battery 30 based on the target current signal, and use the controlled control current as the first and second electric motors, respectively. (4, 5).

(電動式ハンディカートの他の実施形態)
次に、本発明の電動式ハンディカートの他の実施形態について、図6に基づいて説明する。図6は本実施形態における電動式ハンディカート1000の斜視図である。なお、図1に示すハンディカート1と同一の部品については同一の符号が付されている。
(Another embodiment of the electric handy cart)
Next, another embodiment of the electric handy cart of the present invention will be described with reference to FIG. FIG. 6 is a perspective view of the electric handy cart 1000 according to this embodiment. In addition, the same code | symbol is attached | subjected about the component same as the handy cart 1 shown in FIG.

図6に示すように、電動式ハンディカート1000は、パイプ部材より形成された本体フレーム2と、本体フレーム2の端部に取り付けられ、歩行者が保持する棒状の操作桿3と、本体フレーム2に設けられたケースCと、本体フレーム2の両側に取り付けられた電動モータ400と、電動モータ400によりそれぞれ回転駆動する駆動輪600と、を備える。そして、ケースC内には、制御装置300(310,320,330)と、電動モ
ータ400に電流を供給するバッテリ30と、ハンディカート1000の傾斜角を検出する傾斜角検出手段としてのジャイロセンサ50と、が設けられている。また、ハンディカート1000は、電動モータ400の回転速度をそれぞれ検出する速度検出手段400aを備えている。
As shown in FIG. 6, the electric handy cart 1000 includes a main body frame 2 formed of a pipe member, a rod-like operation rod 3 attached to an end of the main body frame 2 and held by a pedestrian, and a main body frame 2. And a drive wheel 600 that is driven to rotate by the electric motor 400, respectively. In the case C, the control device 300 (310, 320, 330), the battery 30 for supplying current to the electric motor 400, and the gyro sensor 50 as an inclination angle detecting means for detecting the inclination angle of the handy cart 1000 are provided. And are provided. The handy cart 1000 includes speed detection means 400 a that detects the rotational speed of the electric motor 400.

また、操作桿3の上端部にはハンドグリップ8が取り付けられており、ハンドグリップ8には画像検出手段としてのステレオカメラ40が設けられているとともに、ハンドグリップ8内には操作力検出装置9が設けられている。ここで、ステレオカメラ40は、上下方向(操作桿の軸方向)に縦型に配置された2つのCCDカメラ(41,42)を備え、ハンディカート1000の前方における対象物の画像を検出する。操作力検出装置9は、歩行者が操作桿3に与える操作力を検出する。ここで、操作力は、歩行者がハンディカート1000を押し引きする力である。なお、操作桿3の中央部には、買い物かご等を懸架することができるかご用フック60が取り付けられている。   A hand grip 8 is attached to the upper end of the operation rod 3, and a stereo camera 40 as an image detecting means is provided on the hand grip 8, and an operating force detection device 9 is provided in the hand grip 8. Is provided. Here, the stereo camera 40 includes two CCD cameras (41, 42) arranged vertically in the vertical direction (axial direction of the operation rod), and detects an image of the object in front of the handy cart 1000. The operation force detection device 9 detects an operation force applied to the operation rod 3 by the pedestrian. Here, the operation force is a force by which the pedestrian pushes and pulls the handy cart 1000. A basket hook 60 that can suspend a shopping basket or the like is attached to the central portion of the operation rod 3.

(第5の実施形態の制御装置)
次に、図7に基づきハンディカート1000に備わる第5の実施形態の制御装置300について説明する。図7は電動式ハンディカート1000における第5の実施形態の制御装置を示すシステムブロック図である。なお、図2に示す制御装置10と同一の手段については同一の符号が付されている。
(Control Device of Fifth Embodiment)
Next, a control device 300 according to a fifth embodiment provided in the handy cart 1000 will be described with reference to FIG. FIG. 7 is a system block diagram showing the control device of the fifth embodiment in the electric handy cart 1000. In addition, the same code | symbol is attached | subjected about the same means as the control apparatus 10 shown in FIG.

制御装置10は、計測手段11と、目標速度演算手段12と、距離演算手段13と、上限速度演算手段14と、比較手段15と、リセット手段16と、計測手段17と、姿勢補償手段18と、減算器19と、加算器20と、目標電流演算手段21と、電流出力手段220と、を備える。   The control device 10 includes a measuring means 11, a target speed calculating means 12, a distance calculating means 13, an upper limit speed calculating means 14, a comparing means 15, a reset means 16, a measuring means 17, and an attitude compensating means 18. , A subtractor 19, an adder 20, a target current calculation means 21, and a current output means 220.

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

距離演算手段13は、ステレオカメラ(画像検出手段)40からの画像信号に基づきステレオカメラ40から前方の対象物までの距離を演算する。そして、上限速度演算手段14は、距離演算手段13からの距離信号に基づき上限速度信号(Vr2)を演算する。そして、比較手段15は、目標速度演算手段12からの第1の目標速度信号(Vr1)と、上限速度演算手段14からの上限速度信号(Vr2)とを比較し、第1の目標速度信号(Vr1)と上限速度信号(Vr2)とのうち小さいほうの信号を第2の目標速度信号(Vr1 or Vr2)として選択する。なお、本実施形態では、上限速度信号(Vr2)を演算する手段するため検出手段として、ステレオカメラ(画像検出手段)40を用いているが、レーザレンジファイダ(LRF)を用いて、前方の対象物までの距離を演算し、演算した距離信号に基づき上限速度信号(Vr2)を演算してもよい。   The distance calculation means 13 calculates the distance from the stereo camera 40 to the front object based on the image signal from the stereo camera (image detection means) 40. Then, the upper limit speed calculation means 14 calculates an upper limit speed signal (Vr2) based on the distance signal from the distance calculation means 13. Then, the comparing means 15 compares the first target speed signal (Vr1) from the target speed calculating means 12 with the upper limit speed signal (Vr2) from the upper limit speed calculating means 14, and compares the first target speed signal (Vr1). The smaller one of Vr1) and the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2). In this embodiment, a stereo camera (image detection means) 40 is used as a detection means for calculating the upper limit speed signal (Vr2). However, a laser range finder (LRF) is used to detect the upper limit speed signal (Vr2). The distance to the object may be calculated, and the upper limit speed signal (Vr2) may be calculated based on the calculated distance signal.

ここで、第2の目標速度信号(Vr1 or Vr2)として上限速度信号(Vr2)が選択されている場合には、リセット手段16により目標速度演算手段12での積分処理はリセットされ続け、上限速度信号(Vr2)が選択されなくなった場合には、再度、積分処理が再開される。   Here, when the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2), the integration process in the target speed calculation means 12 is continuously reset by the reset means 16, and the upper limit speed signal is set. When the signal (Vr2) is no longer selected, the integration process is restarted.

また、速度検出手段400aで検出された電動モータ400の回転速度に対応する検出速度信号(Va)は速度検出手段400aから出力される。そして、減算器19により第2の目標速度信号(Vr1 or Vr2)から検出速度信号(Va)が減じられ、第2の目標速度信号(Vr1 or Vr2)と検出速度信号(Va)との偏差信号(Vε1)が減算器19より出力される。   Further, a detection speed signal (Va) corresponding to the rotation speed of the electric motor 400 detected by the speed detection means 400a is output from the speed detection means 400a. Then, the subtracter 19 subtracts the detected speed signal (Va) from the second target speed signal (Vr1 or Vr2), and a deviation signal between the second target speed signal (Vr1 or Vr2) and the detected speed signal (Va). (Vε1) is output from the subtractor 19.

計測手段17は、ジャイロセンサ(傾斜角検出手段)50からの信号をサンプリングし、この信号に対応する角速度信号を出力する。姿勢補償手段18は、角速度信号を処理することによりハンディカート1000の傾斜量を補償する補償角速度信号(Vθ)を演算する。そして、減算器19から出力された偏差信号(Vε1)と補償角速度信号(Vθ)とが加算器20にて合算され、合算された合算信号(Vε2)が加算器20より出力される。   The measuring means 17 samples a signal from the gyro sensor (tilt angle detecting means) 50 and outputs an angular velocity signal corresponding to this signal. The attitude compensation means 18 calculates a compensation angular velocity signal (Vθ) that compensates for the amount of inclination of the handy cart 1000 by processing the angular velocity signal. Then, the deviation signal (Vε1) output from the subtractor 19 and the compensation angular velocity signal (Vθ) are added together by the adder 20, and the added total signal (Vε2) is output from the adder 20.

目標電流演算手段21は、加算器20からの合算信号(Vε2)に基づき、電動モータ400に供給する目標電流信号を演算する。そして、電流出力手段220は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、電動モータ400に供給する。   The target current calculation means 21 calculates a target current signal to be supplied to the electric motor 400 based on the sum signal (Vε2) from the adder 20. Then, the current output means 220 controls the current supplied from the battery 30 based on the target current signal, and supplies the controlled control current to the electric motor 400.

(第6の実施形態における制御装置)
次に、図8に基づきハンディカート1000に備わる第6の実施形態の制御装置310について説明する。図8は電動式ハンディカート1000における第6の実施形態の制御装置を示すシステムブロック図である。なお、図2の制御装置10と同一の手段については、同一の符号が付されている。
(Control Device in Sixth Embodiment)
Next, a control device 310 according to a sixth embodiment provided in the handy cart 1000 will be described with reference to FIG. FIG. 8 is a system block diagram showing a control device of the sixth embodiment in the electric handy cart 1000. The same means as those in the control device 10 in FIG. 2 are denoted by the same reference numerals.

制御装置310は、計測手段11と、目標速度演算手段12と、距離演算手段13と、上限速度演算手段14と、比較手段15と、リセット手段16と、減算器19と、目標電流演算手段21と、電流出力手段220と、を備える。   The control device 310 includes a measurement unit 11, a target speed calculation unit 12, a distance calculation unit 13, an upper limit speed calculation unit 14, a comparison unit 15, a reset unit 16, a subtractor 19, and a target current calculation unit 21. And current output means 220.

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

距離演算手段13は、ステレオカメラ(画像検出手段)40からの画像信号に基づきステレオカメラ40から前方の対象物までの距離を演算する。そして、上限速度演算手段14は、距離演算手段13からの距離信号に基づき上限速度信号(Vr2)を演算する。そして、比較手段15は、目標速度演算手段12からの第1の目標速度信号(Vr1)と、上限速度演算手段14からの上限速度信号(Vr2)とを比較し、第1の目標速度信号(Vr1)と上限速度信号(Vr2)とのうち小さいほうの信号を第2の目標速度信号(Vr1 or Vr2)として選択する。なお、本実施形態では、上限速度信号(Vr2)を演算する手段するため検出手段として、ステレオカメラ(画像検出手段)40を用いているが、レーザレンジファイダ(LRF)を用いて、前方の対象物までの距離を演算し、演算した距離信号に基づき上限速度信号(Vr2)を演算してもよい。   The distance calculation means 13 calculates the distance from the stereo camera 40 to the front object based on the image signal from the stereo camera (image detection means) 40. Then, the upper limit speed calculation means 14 calculates an upper limit speed signal (Vr2) based on the distance signal from the distance calculation means 13. Then, the comparing means 15 compares the first target speed signal (Vr1) from the target speed calculating means 12 with the upper limit speed signal (Vr2) from the upper limit speed calculating means 14, and compares the first target speed signal (Vr1). The smaller one of Vr1) and the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2). In this embodiment, a stereo camera (image detection means) 40 is used as a detection means for calculating the upper limit speed signal (Vr2). However, a laser range finder (LRF) is used to detect the upper limit speed signal (Vr2). The distance to the object may be calculated, and the upper limit speed signal (Vr2) may be calculated based on the calculated distance signal.

ここで、第2の目標速度信号(Vr1 or Vr2)として上限速度信号(Vr2)が選択されている場合には、リセット手段16により目標速度演算手段12での積分処理はリセットされ続け、上限速度信号(Vr2)が選択されなくなった場合には、再度、積分処理が再開される。   Here, when the upper limit speed signal (Vr2) is selected as the second target speed signal (Vr1 or Vr2), the integration process in the target speed calculation means 12 is continuously reset by the reset means 16, and the upper limit speed signal is set. When the signal (Vr2) is no longer selected, the integration process is restarted.

また、速度検出手段400aで検出された電動モータ400の回転速度に対応する検出速度信号(Va)は速度検出手段400aから出力される。そして、減算器19により第2の目標速度信号(Vr1 or Vr2)から検出速度信号(Va)が減じられ、第2の目標速度信号(Vr1 or Vr2)と検出速度信号(Va)との偏差信号(Vε1)が減算器19より出力される。   Further, a detection speed signal (Va) corresponding to the rotation speed of the electric motor 400 detected by the speed detection means 400a is output from the speed detection means 400a. Then, the subtracter 19 subtracts the detected speed signal (Va) from the second target speed signal (Vr1 or Vr2), and a deviation signal between the second target speed signal (Vr1 or Vr2) and the detected speed signal (Va). (Vε1) is output from the subtractor 19.

目標電流演算手段21は、減算器19からの偏差信号(Vε1)に基づき、電動モータ
400に供給する目標電流信号を演算する。そして、電流出力手段220は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、電動モータ400に供給する。
The target current calculation means 21 calculates a target current signal to be supplied to the electric motor 400 based on the deviation signal (Vε1) from the subtractor 19. Then, the current output means 220 controls the current supplied from the battery 30 based on the target current signal, and supplies the controlled control current to the electric motor 400.

(第7の実施形態における制御装置)
次に、図9に基づきハンディカート1000に備わる第7の実施形態の制御装置320について説明する。図9は電動式ハンディカート1000における第7の実施形態の制御装置を示すシステムブロック図である。なお、図2の制御装置10と同一の手段については、同一の符号が付されている。
(Control Device in Seventh Embodiment)
Next, a control device 320 according to a seventh embodiment provided in the handy cart 1000 will be described with reference to FIG. FIG. 9 is a system block diagram showing the control device of the seventh embodiment in the electric handy cart 1000. The same means as those in the control device 10 in FIG. 2 are denoted by the same reference numerals.

制御装置10は、計測手段11と、目標速度演算手段12と、計測手段17と、姿勢補償手段18と、減算器19と、加算器20と、目標電流演算手段21と、電流出力手段220と、を備える。   The control device 10 includes a measuring unit 11, a target speed calculating unit 12, a measuring unit 17, an attitude compensating unit 18, a subtractor 19, an adder 20, a target current calculating unit 21, and a current output unit 220. .

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

また、速度検出手段400aで検出された電動モータ400の回転速度に対応する検出速度信号(Va)は、速度検出手段400から出力される。そして、減算器19により第1の目標速度信号(Vr1)から検出速度信号(Va)が減じられ、第1の目標速度信号(Vr1)と検出速度信号(Va)との偏差信号(Vε1)が減算器19より出力される。   A detected speed signal (Va) corresponding to the rotation speed of the electric motor 400 detected by the speed detecting means 400 a is output from the speed detecting means 400. Then, the subtracter 19 subtracts the detected speed signal (Va) from the first target speed signal (Vr1), and a deviation signal (Vε1) between the first target speed signal (Vr1) and the detected speed signal (Va). Output from the subtractor 19.

計測手段17は、ジャイロセンサ(傾斜角検出手段)50からの信号をサンプリングし、この信号に対応する角速度信号を出力する。姿勢補償手段18は、角速度信号を処理することによりハンディカート1000の傾斜量を補償する補償角速度信号(Vθ)を演算する。そして、減算器19から出力された偏差信号(Vε1)と補償角速度信号(Vθ)とが加算器20にて合算され、合算された合算信号(Vε2)が加算器20より出力される。   The measuring means 17 samples a signal from the gyro sensor (tilt angle detecting means) 50 and outputs an angular velocity signal corresponding to this signal. The attitude compensation means 18 calculates a compensation angular velocity signal (Vθ) that compensates for the amount of inclination of the handy cart 1000 by processing the angular velocity signal. Then, the deviation signal (Vε1) output from the subtractor 19 and the compensation angular velocity signal (Vθ) are added together by the adder 20, and the added total signal (Vε2) is output from the adder 20.

目標電流演算手段21は、加算器20からの合算信号(Vε2)に基づき、電動モータ400に供給する目標電流信号を演算する。そして、電流出力手段220は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、電動モータ400に供給する。   The target current calculation means 21 calculates a target current signal to be supplied to the electric motor 400 based on the sum signal (Vε2) from the adder 20. Then, the current output means 220 controls the current supplied from the battery 30 based on the target current signal, and supplies the controlled control current to the electric motor 400.

(第8の実施形態における制御装置)
次に、図10に基づきハンディカート1000に備わる第8の実施形態の制御装置330について説明する。図10は電動式ハンディカート1000における第8の実施形態の制御装置を示すシステムブロック図である。なお、図2の制御装置10と同一の手段については、同一の符号が付されている。
(Control Device in Eighth Embodiment)
Next, a control device 330 according to an eighth embodiment provided in the handy cart 1000 will be described with reference to FIG. FIG. 10 is a system block diagram showing the control device of the eighth embodiment in the electric handy cart 1000. The same means as those in the control device 10 in FIG. 2 are denoted by the same reference numerals.

制御装置330は、計測手段11と、目標速度演算手段12と、減算器19と、目標電流演算手段21と、電流出力手段220と、を備える。   The control device 330 includes a measurement unit 11, a target speed calculation unit 12, a subtracter 19, a target current calculation unit 21, and a current output unit 220.

計測手段11は、操作力検出手段9からの信号をサンプリングし、この信号に対応する力信号を出力する。目標速度演算手段12は、力信号を積分処理することにより、第1の目標速度信号(Vr1)を演算する。   The measuring means 11 samples the signal from the operating force detecting means 9 and outputs a force signal corresponding to this signal. The target speed calculation means 12 calculates the first target speed signal (Vr1) by integrating the force signal.

また、速度検出手段400aで検出された電動モータ400の回転速度に対応する検出
速度信号(Va)は速度検出手段400aから出力される。そして、減算器19により第1の目標速度信号(Vr1)から検出速度信号(Va)が減じられ、第1の目標速度信号(Vr1)と検出速度信号(Va)との偏差信号(Vε1)が減算器19より出力される。
Further, a detection speed signal (Va) corresponding to the rotation speed of the electric motor 400 detected by the speed detection means 400a is output from the speed detection means 400a. Then, the subtracter 19 subtracts the detected speed signal (Va) from the first target speed signal (Vr1), and a deviation signal (Vε1) between the first target speed signal (Vr1) and the detected speed signal (Va). Output from the subtractor 19.

目標電流演算手段21は、減算器19からの偏差信号(Vε1)に基づき、電動モータ400に供給する目標電流信号を演算する。そして、電流出力手段220は、目標電流信号に基づきバッテリ30から供給された電流を制御し、制御された制御電流を、電動モータ400に供給する。   The target current calculation means 21 calculates a target current signal to be supplied to the electric motor 400 based on the deviation signal (Vε1) from the subtractor 19. Then, the current output means 220 controls the current supplied from the battery 30 based on the target current signal, and supplies the controlled control current to the electric motor 400.

1、1000 電動推進式ハンディカート
2 本体フレーム
3 操作桿
4、400 電動モータ(第1の電動モータ)
4a、400a 速度検出手段
5 電動モータ(第2の電動モータ)
5a 速度検出手段
6、600 駆動輪
7 駆動輪
8 ハンドグリップ
9 操作力検出装置
10、110、120、130、300、310、320、330 制御装置
11 計測手段
12 目標速度演算手段
13 距離演算手段
14 上限速度演算手段
15 比較手段
16 リセット手段
17 計測手段
18 姿勢補償手段
19 減算器
20 加算器
21 目標電流演算手段
22、220 第1の電流出力手段
23 第2の電流出力手段
24 加算器
25 平均化手段
30 バッテリ
40 画像検出手段(ステレオカメラ)
41 CCDカメラ
42 CCDカメラ
50 傾斜角検出手段(ジャイロセンサ)
60 かご用フック
C ケース
1,1000 Electric propulsion-type handy cart 2 Body frame 3 Operating rod 4,400 Electric motor (first electric motor)
4a, 400a Speed detection means 5 Electric motor (second electric motor)
5a Speed detecting means 6, 600 Driving wheel 7 Driving wheel 8 Hand grip 9 Operating force detecting device 10, 110, 120, 130, 300, 310, 320, 330 Control device 11 Measuring means 12 Target speed calculating means 13 Distance calculating means 14 Upper speed calculation means 15 Comparison means 16 Reset means 17 Measurement means 18 Attitude compensation means 19 Subtractor 20 Adder 21 Target current calculation means 22, 220 First current output means 23 Second current output means 24 Adder 25 Averaging Means 30 Battery 40 Image detection means (stereo camera)
41 CCD camera 42 CCD camera 50 Inclination angle detection means (gyro sensor)
60 Basket hook C case

Claims (8)

歩行者が保持する操作桿と、前記操作桿に設けられ、歩行者が前記操作桿に与える操作力を検出する操作力検出装置と、第1および第2の電動モータと、前記第1および第2の電動モータの回転速度をそれぞれ検出する第1および第2の速度検出手段と、前記第1および第2の電動モータによりそれぞれ回転駆動する第1および第2の駆動輪と、前記操作力検出装置からの信号に基づき前記第1および第2の電動モータに制御電流を供給する制御装置と、を備える電動式ハンディカートにおいて、
前記制御装置は、
前記操作力検出装置からの力信号を積分処理することにより、第1の目標速度信号を演算する目標速度演算手段と、
前記第1および第2の速度検出手段からの前記第1および第2の検出速度信号を平均化して平均速度信号を出力する平均化手段と、
前記平均化手段からの平均速度信号と、前記目標速度演算手段からの第1の目標速度信号との偏差信号に基づき、前記電動モータに供給する目標電流信号を演算する目標電流演算手段と、
前記目標電流演算手段からの目標電流信号に対応し、前記第1および第2の電動モータに制御電流をそれぞれ供給する第1および第2の電流出力手段と、を備えることを特徴とする電動式ハンディカート。
An operating rod held by a pedestrian, an operating force detection device that is provided on the operating rod and detects an operating force applied to the operating rod by the pedestrian, first and second electric motors, and the first and first First and second speed detecting means for detecting rotational speeds of the two electric motors, first and second driving wheels respectively driven to rotate by the first and second electric motors, and the operating force detection An electric handy cart comprising: a control device that supplies a control current to the first and second electric motors based on a signal from the device;
The controller is
Target speed calculation means for calculating a first target speed signal by integrating a force signal from the operating force detection device;
Averaging means for averaging the first and second detected speed signals from the first and second speed detecting means and outputting an average speed signal;
Target current calculation means for calculating a target current signal to be supplied to the electric motor based on a deviation signal between an average speed signal from the averaging means and a first target speed signal from the target speed calculation means;
An electric motor comprising first and second current output means corresponding to a target current signal from the target current calculating means and supplying a control current to the first and second electric motors, respectively. Handy cart.
請求項1に記載された電動式ハンディカートにおいて、前記ハンディカートの前方における対象物の画像を検出する画像検出手段を備え、
前記制御装置は、
前記画像検出手段からの画像信号に基づき前記画像検出手段から前記前方の対象物までの距離を演算する距離演算手段と、
前記距離演算手段からの距離信号に基づき上限速度を演算する上限速度演算手段と、
前記上限速度演算手段からの上限速度信号と、前記目標速度演算手段からの第1の目標速度信号を比較し、小さいほうの信号を第2の目標速度信号とする比較手段と、を備え、
前記目標電流演算手段は、前記平均化手段からの平均速度信号と、前記比較手段からの前記第2の目標速度信号との偏差信号に基づき、前記電動モータに供給する目標電流信号を演算することを特徴とする電動式ハンディカート。
The electric handy cart according to claim 1, further comprising image detecting means for detecting an image of an object in front of the handy cart,
The controller is
Distance calculating means for calculating a distance from the image detecting means to the front object based on an image signal from the image detecting means;
Upper limit speed calculating means for calculating an upper limit speed based on a distance signal from the distance calculating means;
Comparing means for comparing the upper limit speed signal from the upper limit speed calculating means with the first target speed signal from the target speed calculating means, and using the smaller signal as the second target speed signal;
The target current calculation means calculates a target current signal to be supplied to the electric motor based on a deviation signal between the average speed signal from the averaging means and the second target speed signal from the comparison means. Electric handy cart featuring
請求項1に記載された電動式ハンディカートにおいて、前記ハンディカートの傾斜角を検出する傾斜角検出手段を備え、
前記制御装置は、
前記傾斜角検出手段からの角度信号に基づき前記ハンディカートの姿勢を補償するための補償角速度信号を演算する姿勢補償手段を備え、
前記目標電流演算手段は、前記平均化手段からの平均速度信号と前記目標速度演算手段からの第1の目標速度信号との偏差信号に、前記補償角速度信号を合算した合算信号に基づき、前記電動モータに供給する目標電流信号を演算することを特徴とする電動式ハンディカート。
The electric handy cart according to claim 1, further comprising an inclination angle detecting means for detecting an inclination angle of the handy cart,
The controller is
Attitude compensation means for calculating a compensation angular velocity signal for compensating the attitude of the handy cart based on an angle signal from the tilt angle detection means;
The target current calculation means is based on a sum signal obtained by adding the compensation angular speed signal to a deviation signal between an average speed signal from the averaging means and a first target speed signal from the target speed calculation means. An electric handy cart that calculates a target current signal to be supplied to a motor.
請求項1に記載された電動式ハンディカートにおいて、前記ハンディカートの前方における対象物の画像を検出する画像検出手段と、前記ハンディカートの傾斜角を検出する傾斜角検出手段と、を備え、
前記制御装置は、
前記画像検出手段からの画像信号に基づき前記画像検出手段から前記前方の対象物までの距離を演算する距離演算手段と、
前記距離演算手段からの距離信号に基づき上限速度を演算する上限速度演算手段と、
前記上限速度演算手段からの上限速度信号と、前記目標速度演算手段からの第1の目標
速度信号を比較し、小さいほうの信号を第2の目標速度信号とする比較手段と、
前記傾斜角検出手段からの角度信号に基づき前記ハンディカートの姿勢を補償するための補償角速度信号を演算する姿勢補償手段を備え、
前記目標電流演算手段は、前記平均化手段からの平均速度信号と前記比較手段からの第2の目標速度信号との偏差信号に、前記補償角速度信号を合算した合算信号に基づき、前記電動モータに供給する目標電流信号を演算することを特徴とする電動式ハンディカート。
The electric handy cart according to claim 1, further comprising image detecting means for detecting an image of an object in front of the handy cart, and an inclination angle detecting means for detecting an inclination angle of the handy cart,
The controller is
Distance calculating means for calculating a distance from the image detecting means to the front object based on an image signal from the image detecting means;
Upper limit speed calculating means for calculating an upper limit speed based on a distance signal from the distance calculating means;
A comparison means for comparing the upper limit speed signal from the upper limit speed calculation means with the first target speed signal from the target speed calculation means, and using the smaller signal as the second target speed signal;
Attitude compensation means for calculating a compensation angular velocity signal for compensating the attitude of the handy cart based on an angle signal from the tilt angle detection means;
The target current calculating means adds the compensation angular velocity signal to the deviation signal between the average speed signal from the averaging means and the second target speed signal from the comparing means, and adds the compensation angular velocity signal to the electric motor. An electric handy cart that calculates a target current signal to be supplied.
歩行者が保持する操作桿と、前記操作桿に設けられ、歩行者が前記操作桿に与える操作力を検出する操作力検出装置と、電動モータと、前記電動モータの回転速度をそれぞれ検出する速度検出手段と、前記電動モータにより回転駆動する駆動輪と、前記操作力検出装置からの信号に基づき前記電動モータに制御電流を供給する制御装置と、を備える電動式ハンディカートにおいて、
前記制御装置は、
前記操作力検出装置からの力信号を積分処理することにより、第1の目標速度信号を演算する目標速度演算手段と、
前記速度検出手段からの前記検出速度信号と、前記目標速度演算手段からの第1の目標速度信号との偏差信号に基づき、前記電動モータに供給する目標電流信号を演算する目標電流演算手段と、
前記目標電流演算手段からの目標電流信号に対応し、前記電動モータに制御電流をそれぞれ供給する電流出力手段と、を備えることを特徴とする電動式ハンディカート。
An operating rod held by a pedestrian, an operating force detection device that is provided on the operating rod and detects an operating force applied to the operating rod by the pedestrian, an electric motor, and a speed at which the rotational speed of the electric motor is detected In an electric handy cart comprising: a detection means; a drive wheel that is rotationally driven by the electric motor; and a control device that supplies a control current to the electric motor based on a signal from the operation force detection device.
The controller is
Target speed calculation means for calculating a first target speed signal by integrating a force signal from the operating force detection device;
Target current calculation means for calculating a target current signal supplied to the electric motor based on a deviation signal between the detected speed signal from the speed detection means and a first target speed signal from the target speed calculation means;
An electric handy cart comprising: current output means for supplying a control current to the electric motor in response to a target current signal from the target current calculation means.
請求項5に記載された電動式ハンディカートにおいて、前記ハンディカートの前方における対象物の画像を検出する画像検出手段を備え、
前記制御装置は、
前記画像検出手段からの画像信号に基づき前記画像検出手段から前記前方の対象物までの距離を演算する距離演算手段と、
前記距離演算手段からの距離信号に基づき上限速度を演算する上限速度演算手段と、
前記上限速度演算手段からの上限速度信号と、前記目標速度演算手段からの第1の目標速度信号を比較し、小さいほうの信号を第2の目標速度信号とする比較手段と、を備え、
前記目標電流演算手段は、前記速度検出手段からの前記検出速度信号と、前記比較手段からの前記第2の目標速度信号との偏差信号に基づき、前記電動モータに供給する目標電流信号を演算することを特徴とする電動式ハンディカート。
The electric handy cart according to claim 5, further comprising image detecting means for detecting an image of an object in front of the handy cart,
The controller is
Distance calculating means for calculating a distance from the image detecting means to the front object based on an image signal from the image detecting means;
Upper limit speed calculating means for calculating an upper limit speed based on a distance signal from the distance calculating means;
Comparing means for comparing the upper limit speed signal from the upper limit speed calculating means with the first target speed signal from the target speed calculating means, and using the smaller signal as the second target speed signal;
The target current calculating means calculates a target current signal to be supplied to the electric motor based on a deviation signal between the detected speed signal from the speed detecting means and the second target speed signal from the comparing means. Electric handy cart characterized by that.
請求項5に記載された電動式ハンディカートにおいて、前記ハンディカートの傾斜角を検出する傾斜角検出手段を備え、
前記制御装置は、
前記傾斜角検出手段からの角度信号に基づき前記ハンディカートの姿勢を補償するための補償角速度信号を演算する姿勢補償手段を備え、
前記目標電流演算手段は、前記速度検出手段からの前記検出速度信号と前記目標速度演算手段からの第1の目標速度信号との偏差信号に、前記補償角速度信号を合算した合算信号に基づき、前記電動モータに供給する目標電流信号を演算することを特徴とする電動式ハンディカート。
The electric handy cart according to claim 5, further comprising an inclination angle detecting means for detecting an inclination angle of the handy cart,
The controller is
Attitude compensation means for calculating a compensation angular velocity signal for compensating the attitude of the handy cart based on an angle signal from the tilt angle detection means;
The target current calculation means is based on a sum signal obtained by adding the compensation angular speed signal to a deviation signal between the detection speed signal from the speed detection means and the first target speed signal from the target speed calculation means. An electric handy cart that calculates a target current signal to be supplied to an electric motor.
請求項5に記載された電動式ハンディカートにおいて、前記ハンディカートの前方における対象物の画像を検出する画像検出手段と、前記ハンディカートの傾斜角を検出する傾斜角検出手段と、を備え、
前記制御装置は、
前記画像検出手段からの画像信号に基づき前記画像検出手段から前記前方の対象物までの距離を演算する距離演算手段と、
前記距離演算手段からの距離信号に基づき上限速度を演算する上限速度演算手段と、
前記上限速度演算手段からの上限速度信号と、前記目標速度演算手段からの第1の目標速度信号を比較し、小さいほうの信号を第2の目標速度信号とする比較手段と、
前記傾斜角検出手段からの角度信号に基づき前記ハンディカートの姿勢を補償するための補償角速度信号を演算する姿勢補償手段を備え、
前記目標電流演算手段は、前記速度検出手段からの前記検出速度信号と前記比較手段からの第2の目標速度信号との偏差信号に、前記補償角速度信号を合算した合算信号に基づき、前記電動モータに供給する目標電流信号を演算することを特徴とする電動式ハンディカート。
The electric handy cart according to claim 5, further comprising: an image detecting unit that detects an image of an object in front of the handy cart; and an inclination angle detecting unit that detects an inclination angle of the handy cart,
The controller is
Distance calculating means for calculating a distance from the image detecting means to the front object based on an image signal from the image detecting means;
Upper limit speed calculating means for calculating an upper limit speed based on a distance signal from the distance calculating means;
A comparison means for comparing the upper limit speed signal from the upper limit speed calculation means with the first target speed signal from the target speed calculation means, and using the smaller signal as the second target speed signal;
Attitude compensation means for calculating a compensation angular velocity signal for compensating the attitude of the handy cart based on an angle signal from the tilt angle detection means;
The target current calculating means is based on a sum signal obtained by adding the compensation angular speed signal to a deviation signal between the detected speed signal from the speed detecting means and the second target speed signal from the comparing means. An electric handy cart that calculates a target current signal to be supplied to the vehicle.
JP2011211736A 2011-09-28 2011-09-28 Electric handy cart Active JP5756384B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2011211736A JP5756384B2 (en) 2011-09-28 2011-09-28 Electric handy cart

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011211736A JP5756384B2 (en) 2011-09-28 2011-09-28 Electric handy cart

Publications (2)

Publication Number Publication Date
JP2013070824A true JP2013070824A (en) 2013-04-22
JP5756384B2 JP5756384B2 (en) 2015-07-29

Family

ID=48475820

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011211736A Active JP5756384B2 (en) 2011-09-28 2011-09-28 Electric handy cart

Country Status (1)

Country Link
JP (1) JP5756384B2 (en)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5795664B1 (en) * 2014-05-26 2015-10-14 シャープ株式会社 Walking assist device
KR20160039047A (en) * 2014-09-30 2016-04-08 가천대학교 산학협력단 Method of Controlling Motor Driven Power Assisted Safe Stroller and Apparatus for the Same
JP2016129594A (en) * 2015-01-14 2016-07-21 株式会社ミツバ Hand-push mobile body
KR101644106B1 (en) * 2015-04-20 2016-08-11 대한민국 Indoor power-driven walking assistive device using one hand for hemiplegia
EP3000456A4 (en) * 2013-05-22 2016-12-14 Nabtesco Corp Electric walking assistance device, program for controlling electric walking assistance device, and method of controlling electric walking assistance device
JP2019177051A (en) * 2018-03-30 2019-10-17 トヨタ自動車株式会社 Walking assistance device and control program thereof
JP2019177052A (en) * 2018-03-30 2019-10-17 トヨタ自動車株式会社 Walking assistance device and control program thereof

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09202235A (en) * 1996-01-26 1997-08-05 Suzuki Motor Corp Hand truck with drive means
WO1998041182A1 (en) * 1997-03-17 1998-09-24 Hitachi, Ltd. Walking assist device
JPH10338143A (en) * 1997-06-09 1998-12-22 Shinko Electric Co Ltd Operating part for driving-assisted small vehicle
JP2002002488A (en) * 2000-06-27 2002-01-09 Matsushita Electric Works Ltd Power assist type handcart
JP2003079685A (en) * 2001-09-17 2003-03-18 Seiko Epson Corp Auxiliary appliance for walking of visually handicapped person
JP2003290302A (en) * 2002-04-03 2003-10-14 Hitachi Ltd Walking aid device and control program thereof
JP2007090019A (en) * 2005-09-29 2007-04-12 Hiroshi Okamura Walking support system

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09202235A (en) * 1996-01-26 1997-08-05 Suzuki Motor Corp Hand truck with drive means
WO1998041182A1 (en) * 1997-03-17 1998-09-24 Hitachi, Ltd. Walking assist device
JPH10338143A (en) * 1997-06-09 1998-12-22 Shinko Electric Co Ltd Operating part for driving-assisted small vehicle
JP2002002488A (en) * 2000-06-27 2002-01-09 Matsushita Electric Works Ltd Power assist type handcart
JP2003079685A (en) * 2001-09-17 2003-03-18 Seiko Epson Corp Auxiliary appliance for walking of visually handicapped person
JP2003290302A (en) * 2002-04-03 2003-10-14 Hitachi Ltd Walking aid device and control program thereof
JP2007090019A (en) * 2005-09-29 2007-04-12 Hiroshi Okamura Walking support system

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3000456A4 (en) * 2013-05-22 2016-12-14 Nabtesco Corp Electric walking assistance device, program for controlling electric walking assistance device, and method of controlling electric walking assistance device
JP5795664B1 (en) * 2014-05-26 2015-10-14 シャープ株式会社 Walking assist device
WO2015181996A1 (en) * 2014-05-26 2015-12-03 シャープ株式会社 Walking assistance apparatus
KR20160039047A (en) * 2014-09-30 2016-04-08 가천대학교 산학협력단 Method of Controlling Motor Driven Power Assisted Safe Stroller and Apparatus for the Same
KR101638242B1 (en) * 2014-09-30 2016-07-11 가천대학교 산학협력단 Method of Controlling Motor Driven Power Assisted Safe Stroller and Apparatus for the Same
JP2016129594A (en) * 2015-01-14 2016-07-21 株式会社ミツバ Hand-push mobile body
KR101644106B1 (en) * 2015-04-20 2016-08-11 대한민국 Indoor power-driven walking assistive device using one hand for hemiplegia
JP2019177051A (en) * 2018-03-30 2019-10-17 トヨタ自動車株式会社 Walking assistance device and control program thereof
JP2019177052A (en) * 2018-03-30 2019-10-17 トヨタ自動車株式会社 Walking assistance device and control program thereof
JP7006455B2 (en) 2018-03-30 2022-01-24 トヨタ自動車株式会社 Walking assist device and control program for walking assist device
JP7006456B2 (en) 2018-03-30 2022-01-24 トヨタ自動車株式会社 Walking assist device and control program for walking assist device

Also Published As

Publication number Publication date
JP5756384B2 (en) 2015-07-29

Similar Documents

Publication Publication Date Title
JP5756384B2 (en) Electric handy cart
TWI607926B (en) Displacement equipment and power-assisted system
TWI634885B (en) Method for controlling walking-assistance apparatus
EP1955936A1 (en) Fall-prevention control device
JP5890771B2 (en) Moving body
US9474678B2 (en) Pushcart
JP6164300B2 (en) Wheelbarrow
US11975787B2 (en) Control device for mobile body
JP2014128984A (en) Moving body
US9486384B2 (en) Walking assist cart
JP7083593B2 (en) Braking method for electric vehicles and electric vehicles
US9724261B2 (en) Handcart
US8678124B2 (en) Inverted pendulum type vehicle
WO2014045696A1 (en) Moving body
JP5797516B2 (en) Electric handy cart
US8985249B2 (en) Inverted pendulum type vehicle
JP2017035985A (en) Hand cart
JP5958546B2 (en) Wheelbarrow
US8874319B2 (en) Inverted pendulum type vehicle
KR101548930B1 (en) Apparatus for improve the linearity of the walking assistant robot to move on lateral slopes
US20210031855A1 (en) Control device of a rideable mobile body
JP5704283B2 (en) Wheelbarrow

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20140312

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20140522

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20150123

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20150203

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20150403

RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20150403

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20150519

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20150529

R150 Certificate of patent or registration of utility model

Ref document number: 5756384

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150