JP7014540B2 - Electric wheelchair - Google Patents

Electric wheelchair Download PDF

Info

Publication number
JP7014540B2
JP7014540B2 JP2017139282A JP2017139282A JP7014540B2 JP 7014540 B2 JP7014540 B2 JP 7014540B2 JP 2017139282 A JP2017139282 A JP 2017139282A JP 2017139282 A JP2017139282 A JP 2017139282A JP 7014540 B2 JP7014540 B2 JP 7014540B2
Authority
JP
Japan
Prior art keywords
distance
control
electric vehicle
obstacle
vehicle
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.)
Active
Application number
JP2017139282A
Other languages
Japanese (ja)
Other versions
JP2019017742A (en
Inventor
紀章 今岡
健 安藤
弘幸 上松
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.)
Panasonic Corp
Panasonic Holdings Corp
Original Assignee
Panasonic Corp
Matsushita Electric Industrial Co Ltd
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 Panasonic Corp, Matsushita Electric Industrial Co Ltd filed Critical Panasonic Corp
Priority to JP2017139282A priority Critical patent/JP7014540B2/en
Publication of JP2019017742A publication Critical patent/JP2019017742A/en
Application granted granted Critical
Publication of JP7014540B2 publication Critical patent/JP7014540B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Description

本発明は、自律的に障害物との衝突を回避する電動車いすに関するものである。 The present invention relates to an electric wheelchair that autonomously avoids a collision with an obstacle.

従来、電動車両として、人の操作に応じて走行するだけでなく、搭載された障害物検知センサが障害物を検知した際に自律的に走行を停止する機能を有した電動車両が知られている。 Conventionally, as an electric vehicle, an electric vehicle having a function of not only traveling in response to a human operation but also autonomously stopping traveling when an obstacle detection sensor mounted on the vehicle detects an obstacle has been known. There is.

このような電動車両において障害物検知センサが障害物を頻繁に検知すると、そのたびに電動車両は走行を停止することになる。また、電動車両が特定の対象物にあえて接近しようとする場面では、障害物検知センサが特定の対象物を障害物として検知して電動車両が自律的に走行を停止するため、特定の対象物に接近することができなくなる可能性がある。 When the obstacle detection sensor frequently detects an obstacle in such an electric vehicle, the electric vehicle stops traveling each time. In addition, when the electric vehicle dares to approach a specific object, the obstacle detection sensor detects the specific object as an obstacle and the electric vehicle autonomously stops traveling, so that the specific object is a specific object. May not be able to approach.

このような課題を解決するため、障害物検知センサが障害物を検知した場合でも、人の操作に従って電動車両を走行させることが可能な電動車両の走行制御方法が知られている。 In order to solve such a problem, there is known a traveling control method for an electric vehicle capable of driving the electric vehicle according to a human operation even when the obstacle detection sensor detects an obstacle.

例えば、特許文献1に開示されている電動車両の走行制御方法は、障害物検知センサが障害物を検知した場合、走行許可判断手段が警報発報指示信号を警報発報手段に出力するとともに、モータ駆動手段に動作停止を指示する信号を出力する。これにより、電動車両は動作を停止し、障害物への衝突を回避することができる。 For example, in the travel control method for an electric vehicle disclosed in Patent Document 1, when an obstacle detection sensor detects an obstacle, the travel permission determination means outputs an alarm issuance instruction signal to the alarm issuance means. A signal instructing the motor drive means to stop operation is output. As a result, the electric vehicle can stop operating and avoid a collision with an obstacle.

その後、再度、走行許可判断手段が操作手段から障害物の方向に進む走行指示を受け付けた場合は、走行許可判断手段は、警報発報指示信号を警報発報手段に出力しつつ、走行許可指示をモータ駆動手段に出力することによって電動車両の走行が可能となる。 After that, when the driving permission determining means again receives the driving instruction to proceed in the direction of the obstacle from the operating means, the traveling permission determining means outputs the warning issuing instruction signal to the warning issuing means and gives the driving permission instruction. Is output to the motor driving means, so that the electric vehicle can run.

また、特許文献1に記載された電動車両では、このような動作を実現するために、障害物検知センサが電動車両における人の着座部の最前部に配置されている。このような構成とすることによって、電動車両は、前方にある障害物を検知した際に、一旦停止して衝突を回避する。 Further, in the electric vehicle described in Patent Document 1, in order to realize such an operation, an obstacle detection sensor is arranged at the frontmost portion of a seated portion of a person in the electric vehicle. With such a configuration, when the electric vehicle detects an obstacle in front, it temporarily stops to avoid a collision.

そして、再度、前方への走行指示を受け付けた場合は、電動車両は、操作者への注意喚起を行いつつ走行を許可する。これにより、例えば、テーブルに接近して物の授受を行う場合において、テーブルに接近したり、テーブルの近くを走行したりすることができる。さらに、操作者は、電動車両を壁際へ収めるといったことも容易にできる。また、これらの動作は、障害物検知手段の解除操作など、特段の操作手順を踏まずとも行うことができる。 Then, when the traveling instruction to the front is received again, the electric vehicle permits the traveling while alerting the operator. Thereby, for example, when the object is exchanged by approaching the table, it is possible to approach the table or run near the table. Further, the operator can easily fit the electric vehicle near the wall. Further, these operations can be performed without any special operation procedure such as an operation of releasing the obstacle detecting means.

特開2011-177205号公報Japanese Unexamined Patent Publication No. 2011-177205

しかしながら、特許文献1に開示された電動車両の走行制御方法では、障害物に接近したり障害物の近くを走行したりすることが容易にできる一方で、操作者の不注意により電動車両が壁や物に接触する可能性もあり、安全性に関して未だ解決すべき課題を有していた。 However, in the traveling control method for an electric vehicle disclosed in Patent Document 1, while it is possible to easily approach an obstacle or travel near an obstacle, the electric vehicle is inadvertently moved to a wall by an operator. There was a possibility of contact with objects and objects, and there were still issues to be solved regarding safety.

本発明は、このような課題を解決するためになされたものであり、電動車いすが障害物に接近することを可能にするだけでなく、電動車いすが障害物に接近した状態において操作者の操作に誤りがあった場合でも、電動車いすが壁や物に接触することを回避することができる電動車いすを提供することを目的とする。 The present invention has been made to solve such a problem, and not only enables the electric wheelchair to approach an obstacle, but also operates the operator in a state where the electric wheelchair is close to the obstacle. It is an object of the present invention to provide an electric wheelchair capable of preventing the electric wheelchair from coming into contact with a wall or an object even if there is an error in the above.

上記目的を達成するために、本発明の電動車いすは、自車両が走行する速さの指示を受け付ける操作部と、前記自車両から障害物までの距離が、第1の距離以下、かつ、前記自車両の制動距離と制御マージンとを加算した制動制御距離よりも大きい場合に、前記速さよりも遅い速さで前記自車両を駆動させ、前記自車両から前記障害物までの距離が、前記第1の距離以下、かつ、前記制動制御距離以下の場合に、前記自車両を停止させる制御を行う制御部と、を備え、前記制御部は、前記自車両から前記障害物までの距離が、前記第1の距離より大きく、かつ、前記第1の距離と前記制動制御距離とを加算した第2の距離より大きい場合に、前記自車両を前記操作部で前記指示を受け付けた前記速さで駆動させ、前記自車両から前記障害物までの距離が、前記第1の距離より大きく、かつ、前記第2の距離以下の場合に、前記自車両を一旦停止させる他の制御を実行するIn order to achieve the above object, the electric wheelchair of the present invention has an operation unit that receives an instruction on the speed at which the own vehicle travels, and the distance from the own vehicle to an obstacle is equal to or less than the first distance, and the above-mentioned When the braking distance of the own vehicle is larger than the braking control distance obtained by adding the control margin, the own vehicle is driven at a speed slower than the above speed, and the distance from the own vehicle to the obstacle is the first. The control unit includes a control unit that controls to stop the own vehicle when the distance is 1 or less and the braking control distance or less, and the control unit has the distance from the own vehicle to the obstacle. When the distance is larger than the first distance and larger than the second distance obtained by adding the first distance and the braking control distance, the own vehicle is driven at the speed at which the instruction is received by the operation unit. When the distance from the own vehicle to the obstacle is larger than the first distance and equal to or less than the second distance, another control for temporarily stopping the own vehicle is executed .

本発明によれば、電動車いすが障害物に接近することが可能となるだけでなく、電動車いすが障害物に接近した状態において操作者の操作に誤りがあった場合でも、電動車いすが壁や物に接触することを回避することができる。 According to the present invention, not only the electric wheelchair can approach an obstacle, but also the electric wheelchair can be used on a wall or even if the operator makes an error in the state where the electric wheelchair is close to the obstacle. It is possible to avoid contact with an object.

本発明の実施の形態における電動車両の各部の機能を示すブロック図A block diagram showing the functions of each part of the electric vehicle according to the embodiment of the present invention. 本発明の実施の形態における電動車両の概略図Schematic diagram of an electric vehicle according to an embodiment of the present invention 本発明の実施の形態における電動車両の走行制御処理の一例を示すフローチャートA flowchart showing an example of traveling control processing of an electric vehicle according to an embodiment of the present invention. 本発明の実施の形態における電動車両の挙動の一例を示す概念図Conceptual diagram showing an example of the behavior of an electric vehicle according to the embodiment of the present invention. 電動車両が停止制御される際の第一停止距離L1と移動体の速さVとの関係を示す図The figure which shows the relationship between the first stop distance L1 and the speed V of a moving body at the time of stop control of an electric vehicle.

以下、本発明の実施の形態に係る電動車両ついて、図面を参照しながら説明する。なお、同じ構成要素には同じ符号を付している。また、図面は、理解しやすくするために模式的に表されている。電動車両とは、例えば、電動車いすである。 Hereinafter, the electric vehicle according to the embodiment of the present invention will be described with reference to the drawings. The same components are designated by the same reference numerals. In addition, the drawings are schematically shown for ease of understanding. The electric vehicle is, for example, an electric wheelchair.

図1は、本発明の実施の形態における電動車両100の各部の機能を示すブロック図である。また、図2は、電動車両100の概略を示す図である。図1に示すように、本発明の電動車両100は、操作部101と、障害物検知部102と、速度検知部103と、制御部104と、駆動部105とを有する。 FIG. 1 is a block diagram showing the functions of each part of the electric vehicle 100 according to the embodiment of the present invention. Further, FIG. 2 is a diagram showing an outline of the electric vehicle 100. As shown in FIG. 1, the electric vehicle 100 of the present invention has an operation unit 101, an obstacle detection unit 102, a speed detection unit 103, a control unit 104, and a drive unit 105.

操作部101は、操作者が電動車両100の移動方向と速さを指示するための入力装置である。操作部101は、例えば、レバーの操作方向によって電動車両100の移動方向の指示を受け付けるとともに、レバーの操作量によって電動車両100の速さの指示を受け付けるジョイスティックである。 The operation unit 101 is an input device for the operator to instruct the moving direction and speed of the electric vehicle 100. The operation unit 101 is, for example, a joystick that receives an instruction of the moving direction of the electric vehicle 100 according to the operation direction of the lever and also receives an instruction of the speed of the electric vehicle 100 according to the operation amount of the lever.

また、操作部101は、電動車両100の移動方向と速さの入力を受け付けるボタンであってもよい。また、操作部101は、上記入力を受け付けるアクセルレバーとハンドルであってもよい。 Further, the operation unit 101 may be a button that accepts inputs of the moving direction and speed of the electric vehicle 100. Further, the operation unit 101 may be an accelerator lever and a steering wheel that receive the above input.

障害物検知部102は、電動車両100の周囲に存在する物体を検知する検知装置である。障害物検知部102は、例えば、赤外線レーザ光を照射して、障害物が存在する方向と障害物までの距離を検知する赤外線レーザセンサである。 The obstacle detection unit 102 is a detection device that detects an object existing around the electric vehicle 100. The obstacle detection unit 102 is, for example, an infrared laser sensor that irradiates an infrared laser beam to detect the direction in which the obstacle exists and the distance to the obstacle.

例えば、障害物検知部102は、半円状のフィールドを0.36度などの細かいピッチで約270度、赤外線レーザ光で走査し、その反射光を検知するまでの時間に基づいて周囲の物体までの距離を算出する。 For example, the obstacle detection unit 102 scans a semicircular field at a fine pitch such as 0.36 degrees with an infrared laser beam at a fine pitch of about 270 degrees, and the surrounding object is based on the time until the reflected light is detected. Calculate the distance to.

ここで、電動車両100が自律走行を行う場合、障害物検知部102から得られる電動車両100の周辺の壁などの環境情報は、事前に登録された走行経路の近傍にある壁などの環境情報とマッチングさせることで、電動車両100の現在位置の推定に用いることができる。また、障害物検知部102から得られる環境情報は、事前に登録された走行経路において、環境情報として登録されていない人や物などの障害物を検知し、障害物を回避するためにも用いることもできる。 Here, when the electric vehicle 100 autonomously travels, the environmental information such as the wall around the electric vehicle 100 obtained from the obstacle detection unit 102 is the environmental information such as the wall near the travel path registered in advance. By matching with, it can be used to estimate the current position of the electric vehicle 100. The environmental information obtained from the obstacle detection unit 102 is also used to detect obstacles such as people and objects that are not registered as environmental information on the pre-registered travel route and to avoid the obstacles. You can also do it.

また、障害物検知部102は、TOF(Time-of-Flight)センサであってもよい。この場合、赤外線レーザセンサを用いる場合と比較して、電動車両100のコストを低減させることができる。 Further, the obstacle detection unit 102 may be a TOF (Time-of-Flight) sensor. In this case, the cost of the electric vehicle 100 can be reduced as compared with the case of using the infrared laser sensor.

また、障害物検知部102は、ステレオカメラであってもよい。この場合、奥行き情報に加え色情報も取得できるので、障害物を精度よく検知し、的確な電動車両100の障害物回避制御が実現できる。 Further, the obstacle detection unit 102 may be a stereo camera. In this case, since color information can be acquired in addition to depth information, obstacles can be detected accurately and accurate obstacle avoidance control of the electric vehicle 100 can be realized.

速度検知部103は、電動車両100の移動方向と速さを検知する検知装置である。速度検知部103は、例えば、後述する駆動部105の複数の車輪の回転角度および回転速度を検知するエンコーダである。また、速度検知部103は、ホールセンサやレゾルバといったモータ制御用に使用しているセンサであってもよい。 The speed detection unit 103 is a detection device that detects the moving direction and speed of the electric vehicle 100. The speed detection unit 103 is, for example, an encoder that detects the rotation angles and rotation speeds of a plurality of wheels of the drive unit 105, which will be described later. Further, the speed detection unit 103 may be a sensor used for motor control such as a hall sensor or a resolver.

制御部104は、電動車両100の各部を制御するプロセッサなどの制御装置である。制御部104は、速度推定部104aと速度制御部104bを含む。 The control unit 104 is a control device such as a processor that controls each unit of the electric vehicle 100. The control unit 104 includes a speed estimation unit 104a and a speed control unit 104b.

速度推定部104aは、速度検知部103から入力された入力信号に基づいて電動車両100の現在の移動方向と速さを算出する。 The speed estimation unit 104a calculates the current moving direction and speed of the electric vehicle 100 based on the input signal input from the speed detection unit 103.

速度制御部104bは、操作部101から入力された入力情報、および、速度推定部104aで算出された電動車両100の移動方向と速さ、並びに、障害物検知部102で検知された物体までの距離とに基づいて、電動車両100の走行制御および停止制御を実行する。 The speed control unit 104b reaches the input information input from the operation unit 101, the moving direction and speed of the electric vehicle 100 calculated by the speed estimation unit 104a, and the object detected by the obstacle detection unit 102. The travel control and the stop control of the electric vehicle 100 are executed based on the distance.

また、制御部104は、電動車両100を走行制御するための制御信号を次に説明する駆動部105に対して出力する。なお、具体的な制御処理については、後述する。 Further, the control unit 104 outputs a control signal for controlling the traveling of the electric vehicle 100 to the drive unit 105 described below. The specific control process will be described later.

駆動部105は、制御部104から出力された制御信号に基づいて駆動力を発生させる装置である。駆動部105は、例えば、後述する駆動輪と操舵輪として設けられた補助輪とを駆動させるステッピングモータやサーボモータなどの電動モータ、モータドライバ、ギア、バッテリなどを含む。 The drive unit 105 is a device that generates a driving force based on a control signal output from the control unit 104. The drive unit 105 includes, for example, an electric motor such as a stepping motor or a servomotor that drives a drive wheel and an auxiliary wheel provided as a steering wheel, which will be described later, a motor driver, a gear, a battery, and the like.

駆動部105は、制御部104から出力された制御信号に基づいて補助輪を進行方向に向けるように補助輪に連結された電動モータを駆動させる。また、駆動部105は、制御部104からから出力された制御信号に基づいて駆動輪に連結された電動モータを駆動させる。 The drive unit 105 drives an electric motor connected to the training wheels so that the training wheels are directed in the traveling direction based on the control signal output from the control unit 104. Further, the drive unit 105 drives an electric motor connected to the drive wheels based on the control signal output from the control unit 104.

図2に示すように、本実施の形態の電動車両100は、電動車両100を駆動させる左右一対の駆動輪107と、操舵輪として設けられる左右一対の補助輪106と、駆動輪107と補助輪106とにより支持されたメインフレーム108と、メインフレーム108の上方に配置された着座部109と、メインフレーム108の上方に設置されたアームレスト110と、を有する。 As shown in FIG. 2, the electric vehicle 100 of the present embodiment includes a pair of left and right drive wheels 107 for driving the electric vehicle 100, a pair of left and right auxiliary wheels 106 provided as steering wheels, and a drive wheel 107 and auxiliary wheels. It has a main frame 108 supported by 106, a seating portion 109 arranged above the main frame 108, and an arm rest 110 installed above the main frame 108.

メインフレーム108には、補助輪106および駆動輪107を駆動するための駆動部105と駆動部105を駆動するためのバッテリ(図示せず)が内蔵されている。また、電動車両100の前部には、障害物検知部102が設けられている。 The main frame 108 contains a drive unit 105 for driving the training wheels 106 and the drive wheels 107, and a battery (not shown) for driving the drive unit 105. Further, an obstacle detection unit 102 is provided on the front portion of the electric vehicle 100.

アームレスト110には、操作者がアームレスト110に腕を載せたときに操作しやすい位置に操作部101が設けられている。 The armrest 110 is provided with an operation unit 101 at a position where the operator can easily operate the armrest 110 when the arm rests on the armrest 110.

図3は、本発明の実施の形態における電動車両100の走行制御の一例を示すフローチャートである。 FIG. 3 is a flowchart showing an example of traveling control of the electric vehicle 100 according to the embodiment of the present invention.

制御部104は、まず、制御変数Mを1に設定する(ステップS1)。制御変数Mは、制御手法を設定する変数であり、第一の制御手法で電動車両100を制御するときは制御変数Mが1に設定され、第二の制御手法で電動車両100を制御するときには制御変数Mが2に設定される。 First, the control unit 104 sets the control variable M to 1 (step S1). The control variable M is a variable for setting the control method. When the first control method controls the electric vehicle 100, the control variable M is set to 1, and when the second control method controls the electric vehicle 100, the control variable M is set to 1. The control variable M is set to 2.

第一の制御手法は、操作部101で指示された速さで電動車両100を走行させる制御手法である。また、第二の制御手法は、操作部101で指示された速さよりも遅い速さで電動車両100を走行させる制御手法である。なお、電源起動時には制御変数Mが1に設定され、第一の制御手法で電動車両100が制御される。 The first control method is a control method for driving the electric vehicle 100 at a speed instructed by the operation unit 101. The second control method is a control method for driving the electric vehicle 100 at a speed slower than the speed instructed by the operation unit 101. The control variable M is set to 1 when the power supply is started, and the electric vehicle 100 is controlled by the first control method.

次に、制御部104は、制動距離L(V),制動制御距離L’(V),第一停止距離L1を算出する(ステップS2)。これらの変数については図4を参照して説明する。 Next, the control unit 104 calculates the braking distance L (V), the braking control distance L'(V), and the first stop distance L1 (step S2). These variables will be described with reference to FIG.

図4は、本発明の実施の形態における電動車両100の挙動の一例を示す概念図である。制動距離L(V)は、速度推定部104aにより算出された電動車両100の速さにおいて電動車両100の停止制御が実行された場合に、電動車両100が停止するまでに必要な距離である。 FIG. 4 is a conceptual diagram showing an example of the behavior of the electric vehicle 100 according to the embodiment of the present invention. The braking distance L (V) is a distance required for the electric vehicle 100 to stop when the stop control of the electric vehicle 100 is executed at the speed of the electric vehicle 100 calculated by the speed estimation unit 104a.

制動制御距離L’(V)は、制動距離L(V)に制御マージンΔL(V)を加えた距離である。ここで、制御マージンΔL(V)について説明する。制御部104が電動車両100の停止制御を実行すると、理論上、電動車両100は、停止制御が実行されてから制動距離L(V)を走行した時点で停止する。しかしながら、制御部104の制御遅れを原因として、電動車両100が停止制御されてから停止するまでの距離には誤差が生じる。制御マージンΔL(V)は、電動車両100が速さVで走行中に停止制御された際に生じるこの誤差の最大値に相当する値である。 The braking control distance L'(V) is the distance obtained by adding the control margin ΔL (V) to the braking distance L (V). Here, the control margin ΔL (V) will be described. When the control unit 104 executes the stop control of the electric vehicle 100, theoretically, the electric vehicle 100 stops when the braking distance L (V) is traveled after the stop control is executed. However, due to the control delay of the control unit 104, an error occurs in the distance from the stop control of the electric vehicle 100 to the stop. The control margin ΔL (V) is a value corresponding to the maximum value of this error that occurs when the electric vehicle 100 is stopped and controlled while traveling at a speed V.

第一停止距離L1(特許請求の範囲における「第2の距離」に相当。)は、制動制御距離L’(V)に第一停止距離マージンΔL1を加えた距離である。ここで、第一停止距離マージンΔL1(特許請求の範囲における「第1の距離」に相当。)は、電動車両100が障害物120に接近した際に電動車両100を一旦停止させる位置と障害物120との間の距離である。第一停止距離マージンΔL1の値は、発明者の実験の結果によると、0.3m≦ΔL1≦0.5mであることが望ましい。 The first stop distance L1 (corresponding to the "second distance" in the claims) is the distance obtained by adding the first stop distance margin ΔL1 to the braking control distance L'(V). Here, the first stop distance margin ΔL1 (corresponding to the “first distance” in the claims) is a position and an obstacle that temporarily stops the electric vehicle 100 when the electric vehicle 100 approaches the obstacle 120. The distance to 120. According to the result of the experiment of the inventor, the value of the first stop distance margin ΔL1 is preferably 0.3 m ≦ ΔL1 ≦ 0.5 m.

次に、制御部104は、現在の時刻tにおける電動車両100と障害物検知部102で検知された障害物120との間の距離l(t)を算出する(ステップS3)。そして、制御部104は、制御変数Mが1であるか否かを判定する(ステップS4)。 Next, the control unit 104 calculates the distance l (t) between the electric vehicle 100 and the obstacle 120 detected by the obstacle detection unit 102 at the current time t (step S3). Then, the control unit 104 determines whether or not the control variable M is 1 (step S4).

制御変数Mが1であると判定した場合(ステップS4においてYesの場合)、制御部104は、現在の時刻tにおける電動車両100と障害物120との間の距離l(t)が第一停止距離L1よりも大きいか否かを判定する(ステップS5)。 When it is determined that the control variable M is 1 (Yes in step S4), the control unit 104 first stops the distance l (t) between the electric vehicle 100 and the obstacle 120 at the current time t. It is determined whether or not the distance is larger than the distance L1 (step S5).

距離l(t)が第一停止距離L1よりも大きいと判定した場合(ステップS5においてYesの場合)、制御部104は、操作部101から入力された移動方向と速さで走行するための制御信号を駆動部105に出力する(ステップS13)。 When it is determined that the distance l (t) is larger than the first stop distance L1 (Yes in step S5), the control unit 104 controls to travel in the movement direction and speed input from the operation unit 101. The signal is output to the drive unit 105 (step S13).

すなわち、電動車両100と障害物120との間の距離l(t)が十分大きい場合は、電動車両100は、操作部101を用いて入力された移動方向と速さで走行するように制御される。 That is, when the distance l (t) between the electric vehicle 100 and the obstacle 120 is sufficiently large, the electric vehicle 100 is controlled to travel in the moving direction and speed input by using the operation unit 101. To.

その後、制御部104は、走行制御処理を終了するか否かを判定する(ステップS11)。 After that, the control unit 104 determines whether or not to end the travel control process (step S11).

走行制御処理を終了すると判定した場合(ステップS11においてYesの場合)、制御部104は、走行制御処理を終了する。 When it is determined that the travel control process is terminated (Yes in step S11), the control unit 104 ends the travel control process.

走行制御処理を終了しないと判定した場合(ステップS11においてNoの場合)、再び、ステップS2以降の処理が実行される。なお、ステップS11において走行制御処理を終了すると判定される場合は、例えば、電動車両100の電源が切られた場合である。 If it is determined that the travel control process is not completed (No in step S11), the processes after step S2 are executed again. When it is determined in step S11 that the travel control process is completed, for example, the power of the electric vehicle 100 is turned off.

距離l(t)が第一停止距離L1以下であると判定された場合(ステップS5においてNoの場合)、制御部104は、電動車両100を停止させるための制御信号を駆動部105に出力する(ステップS6)。これにより、電動車両100の速さが徐々に低下する。 When it is determined that the distance l (t) is equal to or less than the first stop distance L1 (No in step S5), the control unit 104 outputs a control signal for stopping the electric vehicle 100 to the drive unit 105. (Step S6). As a result, the speed of the electric vehicle 100 gradually decreases.

次に、制御部104は、入力時間Tinを算出する(ステップS7)。入力時間Tinとは、障害物120が存在する方向に電動車両100を走行させる指示入力を操作部101が継続して受け付けている時間である。指示入力が障害物120の方向とは異なる方向に電動車両100を走行させる指示入力である場合、入力時間Tinは0となる。 Next, the control unit 104 calculates the input time Tin (step S7). The input time Tin is a time during which the operation unit 101 continuously receives an instruction input for driving the electric vehicle 100 in the direction in which the obstacle 120 exists. When the instruction input is an instruction input for driving the electric vehicle 100 in a direction different from the direction of the obstacle 120, the input time Tin is 0.

続いて、入力時間Tinが制御周期より長い時間であるか否かを判定する(ステップS8)。制御周期とは、電動車両100の制御を行う周期である。 Subsequently, it is determined whether or not the input time Tin is longer than the control cycle (step S8). The control cycle is a cycle for controlling the electric vehicle 100.

入力時間Tinが制御周期以下の場合(ステップS8においてNoの場合)、ステップS11以降の処理が実行される。 When the input time Tin is equal to or less than the control cycle (No in step S8), the processing after step S11 is executed.

入力時間Tinが制御周期よりも長い時間であると判定した場合(ステップS8においてYesの場合)、制御部104は、現在の時刻tにおける電動車両100と障害物120との間の距離l(t)が第1停止距離マージンΔL1以下であるか否かを判定する(ステップS9)。 When it is determined that the input time Tin is longer than the control cycle (Yes in step S8), the control unit 104 determines that the distance l (t) between the electric vehicle 100 and the obstacle 120 at the current time t. ) Is equal to or less than the first stop distance margin ΔL1 (step S9).

距離l(t)がΔL1よりも大きいと判定された場合(ステップS9においてNoの場合)、ステップS11以降の処理が実行される。 When it is determined that the distance l (t) is larger than ΔL1 (No in step S9), the processing after step S11 is executed.

距離l(t)が第1停止距離マージンΔL1以下と判定した場合(ステップS9においてYesの場合)、制御部104は、制御変数Mを2に設定する(ステップS10)。これにより、電動車両100が第二の制御手法に基づいて制御される。その後、ステップS11以降の処理が実行される。 When it is determined that the distance l (t) is equal to or less than the first stop distance margin ΔL1 (Yes in step S9), the control unit 104 sets the control variable M to 2 (step S10). As a result, the electric vehicle 100 is controlled based on the second control method. After that, the processes after step S11 are executed.

ここで、ステップS6の処理により、電動車両100が停止制御された場合の電動車両100の挙動について説明する。図5は、電動車両100が停止制御された場合における第1停止距離L1と電動車両100の速さVとの関係を示す図である。 Here, the behavior of the electric vehicle 100 when the electric vehicle 100 is stopped and controlled by the process of step S6 will be described. FIG. 5 is a diagram showing the relationship between the first stop distance L1 and the speed V of the electric vehicle 100 when the electric vehicle 100 is stopped and controlled.

ステップS6において停止信号が出力されると、図5に示すように、電動車両100が減速するとともに、第1停止距離L1が小さくなっていく。 When the stop signal is output in step S6, as shown in FIG. 5, the electric vehicle 100 decelerates and the first stop distance L1 becomes smaller.

そして、第1停止距離L1が第一停止距離マージンΔL1に近づく過程において、電動車両100と障害物120との間の距離l(t)が第1停止距離L1より大きく、図3のステップS5においてYesと判断された場合は、ステップS13において、制御部104は、操作部101から入力された速さで電動車両100を走行させるための制御信号を駆動部105に出力する。 Then, in the process in which the first stop distance L1 approaches the first stop distance margin ΔL1, the distance l (t) between the electric vehicle 100 and the obstacle 120 is larger than the first stop distance L1, and in step S5 of FIG. If it is determined to be Yes, in step S13, the control unit 104 outputs a control signal for driving the electric vehicle 100 to the drive unit 105 at the speed input from the operation unit 101.

そして、再び、距離l(t)が第1停止距離L1以下になり、ステップS5においてNoと判定された場合、ステップS6において、制御部104は、電動車両100を停止させるための制御信号を駆動部105に出力する。 Then, when the distance l (t) becomes equal to or less than the first stop distance L1 and No is determined in step S5, the control unit 104 drives the control signal for stopping the electric vehicle 100 in step S6. Output to unit 105.

その後、距離l(t)が第一停止距離マージンΔL1以下となり、ステップS9においてYesと判定されるまでこのような処理が繰り返し実行されることにより、電動車両100は徐々に減速される。そして、図4に示すように、距離l(t)は、第一停止距離マージンΔL1に収束していくことになる。 After that, the distance l (t) becomes equal to or less than the first stop distance margin ΔL1, and such processing is repeatedly executed until it is determined to be Yes in step S9, so that the electric vehicle 100 is gradually decelerated. Then, as shown in FIG. 4, the distance l (t) converges to the first stop distance margin ΔL1.

図3の説明に戻ると、ステップS4において、制御変数Mが1ではないと判定した場合(ステップS4においてNoの場合)、制御部104は、距離l(t)が、制動制御距離L’(V)よりも大きいか否かを判定する(ステップS12)。 Returning to the description of FIG. 3, when it is determined in step S4 that the control variable M is not 1 (when No in step S4), the control unit 104 has a braking control distance L'(when the distance l (t) is 1). It is determined whether or not it is larger than V) (step S12).

距離l(t)が制動制御距離L’(V)以下であると判定した場合(ステップS12においてNoの場合)、制御部104は、電動車両100を停止させる制御信号を駆動部105に出力する(ステップS14)。そして、ステップ11以降の処理を実行する。 When it is determined that the distance l (t) is equal to or less than the braking control distance L'(V) (No in step S12), the control unit 104 outputs a control signal for stopping the electric vehicle 100 to the drive unit 105. (Step S14). Then, the processes after step 11 are executed.

距離l(t)が制動制御距離L’(V)よりも大きいと判定された場合(ステップS12においてYesの場合)、制御部104は、第二の制御手法に基づいて電動車両100を駆動するための制御信号を駆動部105に出力する(ステップS15)。 When it is determined that the distance l (t) is larger than the braking control distance L'(V) (Yes in step S12), the control unit 104 drives the electric vehicle 100 based on the second control method. Is output to the drive unit 105 (step S15).

第二の制御手法に基づいて電動車両100を駆動する場合、具体的には、制御部104は、操作部101が指示を受け付けた速さよりも遅い速さV2で電動車両100を走行させるための制御信号を駆動部105に出力する。発明者の実験の結果によると、速さV2の最大値は、0.05[m/s]以上、0.1[m/s]以下であることが望ましい。 When driving the electric vehicle 100 based on the second control method, specifically, the control unit 104 is for driving the electric vehicle 100 at a speed V2 slower than the speed at which the operation unit 101 receives the instruction. The control signal is output to the drive unit 105. According to the results of the inventor's experiment, it is desirable that the maximum value of the speed V2 is 0.05 [m / s] or more and 0.1 [m / s] or less.

次に、制御部104は、電動車両100が移動した結果、距離l(t)が制御手法切替距離Xよりも大きくなったか否かを判定する(ステップS16)。この判定処理は、制御手法を第二の制御手法から第一の制御手法に戻すか否かを決定するためになされる処理である。 Next, the control unit 104 determines whether or not the distance l (t) becomes larger than the control method switching distance X as a result of the movement of the electric vehicle 100 (step S16). This determination process is a process performed to determine whether or not to return the control method from the second control method to the first control method.

ここで、制御手法切替距離X(特許請求の範囲における「第3の距離」に相当。)は、電動車両100の速さに依存しない予め設定された距離である。例えば、制御手法切替距離Xは、制御手法の切替が頻繁に発生することを防止するため、第一停止距離L1よりも大きい値に設定される。制御手法切替距離Xは、障害物検知部102の測定誤差を考慮して、第一停止距離L1よりも5cm以上大きいことが望ましい。 Here, the control method switching distance X (corresponding to the "third distance" in the claims) is a preset distance that does not depend on the speed of the electric vehicle 100. For example, the control method switching distance X is set to a value larger than the first stop distance L1 in order to prevent frequent switching of the control method. It is desirable that the control method switching distance X is 5 cm or more larger than the first stop distance L1 in consideration of the measurement error of the obstacle detection unit 102.

制御部104が、距離l(t)が制御手法切替距離X以下であると判定した場合(ステップS16においてNoの場合)、ステップS11以降の処理が実行される。 When the control unit 104 determines that the distance l (t) is equal to or less than the control method switching distance X (No in step S16), the processes after step S11 are executed.

距離l(t)が制御手法切替距離Xより大きいと判定した場合(ステップS16においてYesの場合)、制御部104は、電動車両100を停止させる制御信号を駆動部105に出力し(ステップS17)、制御変数Mを1に設定する(ステップS18)。その後、ステップS11以降の処理が実行される。 When it is determined that the distance l (t) is larger than the control method switching distance X (Yes in step S16), the control unit 104 outputs a control signal for stopping the electric vehicle 100 to the drive unit 105 (step S17). , The control variable M is set to 1 (step S18). After that, the processes after step S11 are executed.

なお、ステップS17において、電動車両100を停止させる制御信号を出力しているが、これは第二の制御手法から第一の制御手法への切替時に急激に電動車両100の速さが速くなることを避けるためである。 In step S17, a control signal for stopping the electric vehicle 100 is output, which means that the speed of the electric vehicle 100 suddenly increases when the second control method is switched to the first control method. This is to avoid.

ここで、ステップS14において、電動車両100が停止制御された際の電動車両100の挙動について説明する。制御部104が、ステップS14の処理において、電動車両100を停止させるための制御信号を駆動部105に対して出力すると、電動車両100は減速し、障害物120までの距離が0以上、制御マージンΔL(V2)以下となる位置で停止する。 Here, the behavior of the electric vehicle 100 when the electric vehicle 100 is stopped and controlled in step S14 will be described. When the control unit 104 outputs a control signal for stopping the electric vehicle 100 to the drive unit 105 in the process of step S14, the electric vehicle 100 decelerates, the distance to the obstacle 120 is 0 or more, and the control margin. It stops at a position below ΔL (V2).

ただし、障害物120から離れる方向へ電動車両100を移動させる操作入力を操作部101が受け付けると、電動車両100は、その方向へ速さV2で移動する。そして、制御部104は、距離l(t)が制御手法切替距離Xよりも大きいと判断すると、電動車両100を停止制御した後、第1の制御手法で電動車両100を制御する。 However, when the operation unit 101 receives an operation input for moving the electric vehicle 100 in a direction away from the obstacle 120, the electric vehicle 100 moves in that direction at a speed V2. Then, when the control unit 104 determines that the distance l (t) is larger than the control method switching distance X, the control unit 104 stops and controls the electric vehicle 100, and then controls the electric vehicle 100 by the first control method.

以上の走行制御処理により、電動車両100が障害物120に接近することが可能になるだけでなく、電動車両100が障害物120に接近した場合において操作者の操作の誤りがあった場合でも、電動車両100が壁やモノへ接触することを回避することができる。 By the above traveling control process, not only the electric vehicle 100 can approach the obstacle 120, but also when the electric vehicle 100 approaches the obstacle 120 and there is an error in the operation of the operator. It is possible to prevent the electric vehicle 100 from coming into contact with a wall or an object.

本発明は、障害物を検知して回避走行を行う電動車いすに広く利用可能である。 INDUSTRIAL APPLICABILITY The present invention can be widely used in an electric wheelchair that detects an obstacle and performs avoidance traveling.

100 電動車両
101 操作部
102 障害物検知部
103 速度検知部
104 制御部
104a 速度推定部
104b 速度制御部
105 駆動部
106 補助輪
107 駆動輪
108 メインフレーム
109 着座部
110 アームレスト
120 障害物
100 Electric vehicle 101 Operation unit 102 Obstacle detection unit 103 Speed detection unit 104 Control unit 104a Speed estimation unit 104b Speed control unit 105 Drive unit 106 Auxiliary wheel 107 Drive wheel 108 Main frame 109 Seating unit 110 Armrest 120 Obstacle

Claims (4)

自車両が走行する速さの指示を受け付ける操作部と、
前記自車両から障害物までの距離が、第1の距離以下、かつ、前記自車両の制動距離と制御マージンとを加算した制動制御距離よりも大きい場合に、前記速さよりも遅い速さで前記自車両を駆動させ、前記自車両から前記障害物までの距離が、前記第1の距離以下、かつ、前記制動制御距離以下の場合に、前記自車両を停止させる制御を行う制御部と、を備え
前記制御部は、前記自車両から前記障害物までの距離が、前記第1の距離より大きく、かつ、前記第1の距離と前記制動制御距離とを加算した第2の距離より大きい場合に、前記自車両を前記操作部で前記指示を受け付けた前記速さで駆動させ、前記自車両から前記障害物までの距離が、前記第1の距離より大きく、かつ、前記第2の距離以下の場合に、前記自車両を一旦停止させる他の制御を実行する電動車いす。
An operation unit that receives instructions on the speed at which the vehicle travels,
When the distance from the own vehicle to the obstacle is equal to or less than the first distance and is larger than the braking control distance obtained by adding the braking distance of the own vehicle and the control margin, the speed is slower than the speed. A control unit that drives the own vehicle and controls to stop the own vehicle when the distance from the own vehicle to the obstacle is equal to or less than the first distance and equal to or less than the braking control distance. Prepare ,
When the distance from the own vehicle to the obstacle is larger than the first distance and larger than the second distance obtained by adding the first distance and the braking control distance, the control unit may use the control unit. When the own vehicle is driven at the speed at which the instruction is received by the operation unit, and the distance from the own vehicle to the obstacle is larger than the first distance and equal to or less than the second distance. In addition, an electric wheelchair that executes other control for temporarily stopping the own vehicle .
前記制御部は、前記操作部が、所定時間よりも長い時間、前記速さの指示を受け付けた場合に前記他の制御から前記制御への切り替えを行う請求項に記載の電動車いす。 The electric wheelchair according to claim 1 , wherein the control unit switches from the other control to the control when the operation unit receives an instruction of the speed for a time longer than a predetermined time. 前記制御部は、前記制御を実行している状態で、前記自車両から前記障害物までの距離が、前記第2の距離よりも大きい第3の距離よりも大きくなった場合に、前記制御から前記他の制御に切り替える請求項またはに記載の電動車いす。 When the distance from the own vehicle to the obstacle becomes larger than the third distance, which is larger than the second distance, from the control, the control unit is in the state of executing the control. The electric wheelchair according to claim 1 or 2 , wherein the control is switched to the other control. 前記制御部は、前記制御から前記他の制御に切り替える場合に、前記自車両を一旦停止させる請求項に記載の電動車いす。 The electric wheelchair according to claim 3 , wherein the control unit temporarily stops the own vehicle when switching from the control to the other control.
JP2017139282A 2017-07-18 2017-07-18 Electric wheelchair Active JP7014540B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017139282A JP7014540B2 (en) 2017-07-18 2017-07-18 Electric wheelchair

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017139282A JP7014540B2 (en) 2017-07-18 2017-07-18 Electric wheelchair

Publications (2)

Publication Number Publication Date
JP2019017742A JP2019017742A (en) 2019-02-07
JP7014540B2 true JP7014540B2 (en) 2022-02-01

Family

ID=65352513

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017139282A Active JP7014540B2 (en) 2017-07-18 2017-07-18 Electric wheelchair

Country Status (1)

Country Link
JP (1) JP7014540B2 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004321722A (en) 2003-04-22 2004-11-18 Mizukoshi Keiki Kk Motor-driven wheelchair
JP2011177016A (en) 2001-07-31 2011-09-08 Sanyo Electric Co Ltd Electric vehicle
JP2011177205A (en) 2010-02-26 2011-09-15 Quest Engineering:Kk Running control method of electric wheelchair
JP2012011886A (en) 2010-06-30 2012-01-19 Toyota Central R&D Labs Inc Motive power car

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011177016A (en) 2001-07-31 2011-09-08 Sanyo Electric Co Ltd Electric vehicle
JP2004321722A (en) 2003-04-22 2004-11-18 Mizukoshi Keiki Kk Motor-driven wheelchair
JP2011177205A (en) 2010-02-26 2011-09-15 Quest Engineering:Kk Running control method of electric wheelchair
JP2012011886A (en) 2010-06-30 2012-01-19 Toyota Central R&D Labs Inc Motive power car

Also Published As

Publication number Publication date
JP2019017742A (en) 2019-02-07

Similar Documents

Publication Publication Date Title
US11572062B2 (en) Driving assistance control device
US10525974B2 (en) Parking trajectory calculation apparatus and parking trajectory calculation method
JP5967303B2 (en) Parking assistance device
KR101779962B1 (en) Steering control apparatus for comprising will decision of drivers and method for operating the same
JP3749483B2 (en) Parking assistance device
US11541883B2 (en) Vehicle driving assist apparatus
KR102306474B1 (en) Self-driving vehicle
US20160207527A1 (en) Automatic driving apparatus
KR20130106005A (en) Smart parking assist system of vehicle and control method thereof
KR20170038898A (en) Method for the at least semi-autonomous manoeuvring of a motor vehicle, driver assistance system and motor vehicle
KR20120137025A (en) Collision avoidance method for vehicles
US10933866B2 (en) Method for controlling electrically driven vehicle, and electrically driven vehicle
JP2016150593A (en) Vehicle control device and vehicle control device
KR101903969B1 (en) Controlling apparatus for auto parking of double parked vehicle and method thereof
JP2018045397A (en) Automatic operation vehicle
WO2020195501A1 (en) Parking assistance device, vehicle, parking assistance method, and parking assistance program
JP2018020590A (en) Travel support system
JP2014034287A (en) Parking support system
KR101257566B1 (en) Auto guided vehicle and method for controlling the same
JP7014540B2 (en) Electric wheelchair
JP3238496B2 (en) Anti-collision device for vehicles
JP2014205457A (en) Vehicle contact prevention system
KR20080016242A (en) Car paruing assitance equipment and control method thereof
US20190381896A1 (en) Electric vehicle
JPH07160995A (en) Automatic steering device for vehicle

Legal Events

Date Code Title Description
RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20190718

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20191121

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200527

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210209

A601 Written request for extension of time

Free format text: JAPANESE INTERMEDIATE CODE: A601

Effective date: 20210407

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210524

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20211207

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20211223

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: 20220118

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220120