JP2008263676A

JP2008263676A - Self-propelled vehicle and its control device and control method

Info

Publication number: JP2008263676A
Application number: JP2007102921A
Authority: JP
Inventors: Mitsuo Koide; 光男小出; Kazutoshi Sukigara; 和俊鋤柄; Chisao Hayashi; 知三夫林; Koshi Yamada; 耕嗣山田; Yoshiyuki Senba; 快之仙波; Takashi Deo; 隆志出尾; Takuya Segi; 拓也瀬来
Original assignee: Toyota Motor Corp; Toyota Central R&D Labs Inc
Current assignee: Toyota Motor Corp; Toyota Central R&D Labs Inc
Priority date: 2007-04-10
Filing date: 2007-04-10
Publication date: 2008-10-30

Abstract

【課題】外乱トルクが負荷された場合でも正しく走行し続ける自走車を提供する。
【解決手段】自走車は、車体と、左右一対の車輪と、左右一対の車輪の一方を駆動する第１モータと他方を駆動する第２モータと、第１モータのモータ電流指令値を入力して第１モータのモータ電流を調節する手段と、第１モータのモータ電流指令値と実際動作量を入力して第１モータに負荷されている外乱トルクを算出する手段と、その外乱トルクに基づいてモータ電流指令値を修正する手段と、第２モータのモータ電流指令値を入力して第２モータに通電するモータ電流を調節する手段と、第２モータのモータ電流指令値と実際動作量を入力して第２モータに負荷されている外乱トルクを算出する手段と、その外乱トルクに基づいて第２モータのモータ電流指令値を修正する手段を備えている。
【選択図】図３PROBLEM TO BE SOLVED: To provide a self-propelled vehicle that continues to travel correctly even when a disturbance torque is applied.
A self-propelled vehicle receives a vehicle body, a pair of left and right wheels, a first motor that drives one of a pair of left and right wheels, a second motor that drives the other, and a motor current command value of the first motor. Means for adjusting the motor current of the first motor, means for calculating the disturbance torque loaded on the first motor by inputting the motor current command value and the actual operation amount of the first motor, and the disturbance torque Means for correcting the motor current command value on the basis thereof, means for adjusting the motor current to be supplied to the second motor by inputting the motor current command value of the second motor, the motor current command value of the second motor and the actual operation amount And a means for calculating the disturbance torque loaded on the second motor and a means for correcting the motor current command value of the second motor based on the disturbance torque.
[Selection] Figure 3

Description

本発明は、自走車に関する。特に、左右一対の車輪を備える自走車に関する。 The present invention relates to a self-propelled vehicle. In particular, the present invention relates to a self-propelled vehicle including a pair of left and right wheels.

特許文献１に、左右一対の車輪を備える同軸二輪車が開示されている。この同軸二輪車は、車体と、車体に設けられている左右一対の車輪と、左右一対の車輪を駆動するモータと、モータに動作指令を与える制御コンピュータと、車体の前後方向の傾きを検出する角度検出手段を備えている。制御コンピュータは、角度検出手段によって検出された車体の傾きを入力し、車体の傾きを所定角に維持するのに要するモータの出力トルクを算出することができる。そして、制御コンピュータは、算出したモータの出力トルクに基づいて、モータに動作指令を与えるようになっている。それにより、この同軸二輪車は、左右一対の車輪のみを接地させた倒立姿勢で走行することができる。 Patent Document 1 discloses a coaxial two-wheeled vehicle including a pair of left and right wheels. This coaxial two-wheeled vehicle includes a vehicle body, a pair of left and right wheels provided on the vehicle body, a motor that drives the pair of left and right wheels, a control computer that gives an operation command to the motor, and an angle that detects the inclination of the vehicle body in the front-rear direction. A detection means is provided. The control computer can input the vehicle body inclination detected by the angle detection means and calculate the output torque of the motor required to maintain the vehicle body inclination at a predetermined angle. The control computer gives an operation command to the motor based on the calculated output torque of the motor. Thereby, this coaxial two-wheeled vehicle can travel in an inverted posture in which only a pair of left and right wheels are grounded.

特開昭６３−３０５０８２号公報JP-A 63-305082

特許文献１の同軸二輪車では、角度検出手段によって検出された車体の傾きを、予め設定された制御入力算出式に代入することによって、モータの出力トルクを算出している。そのことから、同軸二輪車に外乱トルクが負荷されると、モータの出力トルクを正しく算出することができなくなる。例えば、同軸二輪車が斜面を走行する場合、斜面を登るときと降りるときで速度が大きく相違してしまう。さらに、例えば一方の車輪のみが斜面に乗り上げた場合、同軸二輪車は真っ直ぐに走行することができなくなり、大きくバランスを崩してしまう。
本発明は、上記の問題を解決する。本発明は、左右一対の車輪を備える自走車において、外乱トルクが負荷された場合でも正しく走行し続けることを可能とする技術を提供する。 In the coaxial two-wheeled vehicle of Patent Document 1, the output torque of the motor is calculated by substituting the inclination of the vehicle body detected by the angle detection means into a preset control input calculation formula. For this reason, when disturbance torque is applied to the coaxial two-wheeled vehicle, the output torque of the motor cannot be calculated correctly. For example, when a coaxial two-wheeled vehicle travels on a slope, the speed is greatly different when climbing up and down the slope. Furthermore, for example, when only one wheel rides on the slope, the coaxial two-wheeled vehicle cannot run straight and the balance is greatly lost.
The present invention solves the above problems. The present invention provides a technique that allows a self-propelled vehicle including a pair of left and right wheels to continue traveling correctly even when a disturbance torque is applied.

本発明によって具現化される自走車は、車体と、車体に設けられている左右一対の車輪と、左右一対の車輪の一方を駆動する第１モータと、左右一対の車輪の他方を駆動する第２モータと、第１モータに通電するモータ電流の指令値を入力し、第１モータに通電するモータ電流を調節する第１電流調節部と、第１電流調節部に入力されるモータ電流の指令値と第１モータの実際の動作量を入力し、第１モータに負荷されている外乱トルクを算出する第１外乱トルク算出部と、第１外乱トルク算出部が算出した外乱トルクに基づいて、第１電流調節部に入力されるモータ電流の指令値を修正する第１指令値修正部と、第２モータに通電するモータ電流の指令値を入力し、第２モータに通電するモータ電流を調節する第２電流調節部と、第２電流調節部に入力されるモータ電流の指令値と第２モータの実際の動作量を入力し、第２モータに負荷されている外乱トルクを算出する第２外乱トルク算出部と、第２外乱トルク算出部が算出した外乱トルクに基づいて、第２電流調節部に入力されるモータ電流の指令値を修正する第２指令値修正部を備えている。 A self-propelled vehicle embodied by the present invention drives a vehicle body, a pair of left and right wheels provided on the vehicle body, a first motor that drives one of the pair of left and right wheels, and the other of the pair of left and right wheels. A second motor, a command value of a motor current to be supplied to the first motor, a first current adjusting unit for adjusting the motor current to be supplied to the first motor, and a motor current input to the first current adjusting unit Based on the first disturbance torque calculation unit that inputs the command value and the actual operation amount of the first motor and calculates the disturbance torque loaded on the first motor, and the disturbance torque calculated by the first disturbance torque calculation unit The first command value correcting unit that corrects the command value of the motor current input to the first current adjusting unit, the command value of the motor current that supplies current to the second motor, and the motor current that supplies current to the second motor A second current adjusting unit for adjusting, and a second current; A second disturbance torque calculation unit that inputs a command value of the motor current input to the node and an actual operation amount of the second motor, calculates a disturbance torque loaded on the second motor, and calculates a second disturbance torque; A second command value correction unit that corrects the command value of the motor current input to the second current adjustment unit based on the disturbance torque calculated by the unit.

この自走車では、一方の車輪を駆動する第１モータの出力トルクを、第１モータに負荷されている外乱トルクに応じて決定し、他方の車輪を駆動する第２モータの出力トルクを、第２モータに負荷されている外乱トルクに応じて決定する。それにより、それぞれの車輪に外乱トルクが様々に負荷された場合でも、それぞれの車輪を正しく駆動することができる。例えば一方の車輪のみが上り斜面に乗り上げた場合でも、一方の車輪を駆動する第１モータの出力トルクより大きくすることによって、真っ直ぐに走行し続けることができる。 In this self-propelled vehicle, the output torque of the first motor that drives one wheel is determined according to the disturbance torque loaded on the first motor, and the output torque of the second motor that drives the other wheel is It is determined according to the disturbance torque loaded on the second motor. Thereby, even when disturbance torque is variously loaded on each wheel, each wheel can be driven correctly. For example, even when only one wheel rides on the uphill slope, it can continue to run straight by making it larger than the output torque of the first motor that drives one wheel.

上記の自走車は、車体の傾き及びその時間変化率を検出する傾きセンサと、少なくとも傾きセンサの出力信号を入力し、第１モータと第２モータに対するモータ電流の指令値を出力する走行制御部をさらに備え、左右一対の車輪のみを接地させた倒立姿勢で走行可能であることが好ましい。
左右一対の車輪のみを接地させた倒立姿勢では、それぞれの車輪に負荷されている外乱トルクをより正確に推定することが可能となる。そのことから、左右一対の車輪のみを接地させた倒立姿勢で走行可能であると、外乱トルクに抗してより正しく走行し続けることができる。 The above self-propelled vehicle has a tilt sensor that detects the tilt of the vehicle body and its rate of change over time, and at least an output signal from the tilt sensor, and outputs a command value of motor current for the first motor and the second motor. It is preferable that the vehicle can travel in an inverted posture in which only a pair of left and right wheels are grounded.
In the inverted posture in which only the pair of left and right wheels are grounded, the disturbance torque loaded on each wheel can be estimated more accurately. Therefore, if the vehicle can travel in an inverted posture in which only a pair of left and right wheels are grounded, it can continue to travel more correctly against disturbance torque.

上記の自走車において、第１外乱トルク算出部と第２外乱トルク算出部の少なくとも一方は、最小次元オブザーバであることが好ましい。
それにより、第１外乱トルク算出部と第２外乱トルク算出部を簡素に構成することが可能となる。 In the above self-propelled vehicle, it is preferable that at least one of the first disturbance torque calculation unit and the second disturbance torque calculation unit is a minimum dimension observer.
Accordingly, it is possible to simply configure the first disturbance torque calculation unit and the second disturbance torque calculation unit.

本発明の技術は、車体と、車体に設けられている左右一対の車輪と、左右一対の車輪の一方を駆動する第１モータと、左右一対の車輪の他方を駆動する第２モータを備える自走車の動作を制御する制御装置に具現化することもできる。この制御装置は、第１モータに通電するモータ電流の指令値を入力し、第１モータに通電するモータ電流を調節する第１電流調節部と、第１電流調節部に入力されるモータ電流の指令値と第１モータの実際の動作量を入力し、第１モータに負荷されている外乱トルクを算出する第１外乱トルク算出部と、第１外乱トルク算出部が算出した外乱トルクに基づいて、第１電流調節部に入力されるモータ電流の指令値を修正する第１指令値修正部と、第２モータに通電するモータ電流の指令値を入力し、第２モータに通電するモータ電流を調節する第２電流調節部と、第２電流調節部に入力されるモータ電流の指令値と第２モータの実際の動作量を入力し、第２モータに負荷されている外乱トルクを算出する第２外乱トルク算出部と、第２外乱トルク算出部が算出した外乱トルクに基づいて、第２電流調節部に入力されるモータ電流の指令値を修正する第２指令値修正部を備えている。
この制御装置によると、自走車に外乱トルクが負荷された場合でも、自走車を正しく走行させ続けることができる。 The technology of the present invention includes a vehicle body, a pair of left and right wheels provided on the vehicle body, a first motor that drives one of the pair of left and right wheels, and a second motor that drives the other of the pair of left and right wheels. It can also be embodied in a control device that controls the operation of the traveling vehicle. The control device inputs a command value of a motor current to be supplied to the first motor, adjusts a motor current to be supplied to the first motor, and a motor current input to the first current adjustment unit. Based on the first disturbance torque calculation unit that inputs the command value and the actual operation amount of the first motor and calculates the disturbance torque loaded on the first motor, and the disturbance torque calculated by the first disturbance torque calculation unit The first command value correcting unit that corrects the command value of the motor current input to the first current adjusting unit, the command value of the motor current that supplies current to the second motor, and the motor current that supplies current to the second motor The second current adjusting unit to be adjusted, the command value of the motor current input to the second current adjusting unit and the actual operation amount of the second motor are input, and the disturbance torque loaded on the second motor is calculated. 2 disturbance torque calculator and second disturbance torque Based on the disturbance torque calculating section is calculated, and a second command value correction unit for correcting a command value of the motor current input to the second current regulation unit.
According to this control device, even when a disturbance torque is applied to the self-propelled vehicle, the self-propelled vehicle can continue to travel correctly.

本発明の技術はまた、車体と、車体に設けられている左右一対の車輪と、左右一対の車輪の一方を駆動する第１モータと、左右一対の車輪の他方を駆動する第２モータを備える自走車の動作を制御する制御方法に具現化することもできる。この制御方法は、第１モータに通電するモータ電流の指令値を入力し、第１モータに通電するモータ電流を調節する第１電流調節工程と、第１電流調節工程で入力したモータ電流の指令値と第１モータの実際の動作量を入力し、第１モータに負荷されている外乱トルクを算出する第１外乱トルク算出工程と、第１外乱トルク算出工程で算出した外乱トルクに基づいて、第１電流調節工程で入力するモータ電流の指令値を修正する第１指令値修正工程と、第２モータに通電するモータ電流の指令値を入力し、第２モータに通電するモータ電流を調節する第２電流調節工程と、第２電流調節工程で入力したモータ電流の指令値と第２モータの実際の動作量を入力し、第２モータに負荷されている外乱トルクを算出する第２外乱トルク算出工程と、第２外乱トルク算出工程で算出した外乱トルクに基づいて、第２電流調節工程で入力するモータ電流の指令値を修正する第２指令値修正工程を備えている。
この制御方法によると、自走車に外乱トルクが負荷された場合でも、自走車を正しく走行させ続けることができる。 The technology of the present invention also includes a vehicle body, a pair of left and right wheels provided on the vehicle body, a first motor that drives one of the pair of left and right wheels, and a second motor that drives the other of the pair of left and right wheels. It can also be embodied in a control method for controlling the operation of the self-propelled vehicle. In this control method, a command value for a motor current to be supplied to the first motor is input, a first current adjustment step for adjusting the motor current to be supplied to the first motor, and a command for the motor current input in the first current adjustment step. Based on the disturbance torque calculated in the first disturbance torque calculation step, the first disturbance torque calculation step of calculating the disturbance torque loaded on the first motor, and the value and the actual operation amount of the first motor, The first command value correcting step for correcting the motor current command value input in the first current adjusting step, and the motor current command value for energizing the second motor are input to adjust the motor current energized for the second motor. Second disturbance torque for calculating disturbance torque applied to the second motor by inputting the second current adjustment step, the motor current command value input in the second current adjustment step, and the actual operation amount of the second motor. A calculation process; Based on the disturbance torque calculated by the second disturbance torque calculating step, and a second command value correcting step for correcting a command value of the motor current to be input by the second current adjusting step.
According to this control method, even when a disturbance torque is applied to the self-propelled vehicle, the self-propelled vehicle can continue to travel correctly.

本発明により、例えば予期しない悪路を安定して走破することができる自走車を具現化することが可能となる。本発明による同軸二輪車は、従来の同軸二輪車では走行不能とされてきた悪路を走破することができ、その活動範囲を大きく広げることができる。 According to the present invention, for example, it is possible to embody a self-propelled vehicle that can stably run on an unexpected rough road. The coaxial two-wheeled vehicle according to the present invention can travel on a rough road that has been impossible to travel in the conventional coaxial two-wheeled vehicle, and can greatly expand its activity range.

最初に、実施例の主要な特徴を列記する。
（特徴１）自走車は、従動輪を備えている。従動輪は、左右一対の車輪の前方又は後方に位置している。
（特徴２）自走車は、車体に揺動可能に連結されているとともに左右一対の車輪が設けられているアームと、アームを車体に対して揺動させるアーム駆動機構を備えている。アーム駆動機構は、アームを揺動させることによって、車体と左右一対の車輪との相対位置を変化させることができる。自走車は、車体と左右一対の車輪の相対位置を変化させることによって、左右一対の車輪のみが接地する倒立姿勢と、従動輪も接地する安定姿勢との間で姿勢を変化させる。
（特徴３）自走車は、車体に揺動可能に連結されている座席と、座席を車体に対して揺動させる座席駆動機構を備えている。自走車は、車体と座席の相対位置を変化させることによって、搭乗者を含む自走車全体の重心位置を変化させることができる。 First, the main features of the embodiment are listed.
(Characteristic 1) The self-propelled vehicle has a driven wheel. The driven wheel is located in front of or behind the pair of left and right wheels.
(Feature 2) The self-propelled vehicle includes an arm that is swingably connected to the vehicle body and provided with a pair of left and right wheels, and an arm drive mechanism that swings the arm with respect to the vehicle body. The arm drive mechanism can change the relative position between the vehicle body and the pair of left and right wheels by swinging the arm. By changing the relative position of the vehicle body and the pair of left and right wheels, the self-propelled vehicle changes its posture between an inverted posture where only the pair of left and right wheels are grounded and a stable posture where the driven wheel is also grounded.
(Feature 3) The self-propelled vehicle includes a seat that is swingably connected to the vehicle body, and a seat drive mechanism that swings the seat with respect to the vehicle body. The self-propelled vehicle can change the position of the center of gravity of the entire self-propelled vehicle including the passenger by changing the relative position of the vehicle body and the seat.

本発明の実施例について図面を参照しながら説明する。図１、図２は、実施例の自走車１０の構成を模式的に示している。図１は自走車１０の構成を示す正面図であり、図２は自走車１０の構成を示す右側面図である。図１は自走車１０の前面を示しており、図２は自走車１０の左側面を示している。
図１、図２に示すように、自走車１０は、車体１８と、車体１８にシャフト２２を介して連結されているアーム２４と、アーム２４によって支持されている右車輪３０ａ及び左車輪３０ｂと、右車輪３０ａを駆動する右車輪モータ１２２と、左車輪３０ｂを駆動する左車輪モータ１４２を備えている。右車輪３０ａと左車輪３０ｂは、互いに対向する位置に設けられており、その車軸が実質的に同一直線状に位置している。車体１８には、アーム駆動機構２０が設けられている。アーム駆動機構２０は、アームモータ１８２（図３に図示されている）を備えており、アーム２４をシャフト２２の回りに揺動させる。アーム駆動機構２０は、アーム２４を揺動させることによって、右車輪３０ａ及び左車輪３０ｂと車体１８の相対位置を変化させる。 Embodiments of the present invention will be described with reference to the drawings. 1 and 2 schematically show the configuration of the self-propelled vehicle 10 of the embodiment. FIG. 1 is a front view showing the configuration of the self-propelled vehicle 10, and FIG. 2 is a right side view showing the configuration of the self-propelled vehicle 10. FIG. 1 shows the front surface of the self-propelled vehicle 10, and FIG. 2 shows the left side surface of the self-propelled vehicle 10.
As shown in FIGS. 1 and 2, the self-propelled vehicle 10 includes a vehicle body 18, an arm 24 connected to the vehicle body 18 via a shaft 22, and a right wheel 30 a and a left wheel 30 b supported by the arm 24. A right wheel motor 122 that drives the right wheel 30a, and a left wheel motor 142 that drives the left wheel 30b. The right wheel 30a and the left wheel 30b are provided at positions facing each other, and their axles are positioned substantially in the same straight line. The vehicle body 18 is provided with an arm drive mechanism 20. The arm drive mechanism 20 includes an arm motor 182 (shown in FIG. 3) and swings the arm 24 around the shaft 22. The arm drive mechanism 20 changes the relative position of the right wheel 30a and the left wheel 30b and the vehicle body 18 by swinging the arm 24.

自走車１０は、右従動輪３４ａ及び左従動輪３４ｂを備えている。右従動輪３４ａ及び左従動輪３４ｂは、右車輪３０ａ及び左車輪３０よりも前方で、互いに対向する位置に設けられている。右従動輪３４ａと左従動輪３４ｂは、その車軸（即ち、回転方向）を受動的に変化させる自在輪である。
なお、２つの従動輪３４ａ、３４ｂは必須の構成ではなく、左右方向の略中央に一つの従動輪のみを設ける構成とすることもできる。また、詳しくは後述するが、自走車１０は車輪３０ａ、３０ｂのみを接地させた倒立姿勢で走行する倒立走行と、従動輪も接地させた安定姿勢で走行する安定走行の両者が可能であるが、安定走行を必要としないのであれば、従動輪を設ける必要は必ずしもない。 The self-propelled vehicle 10 includes a right driven wheel 34a and a left driven wheel 34b. The right driven wheel 34a and the left driven wheel 34b are provided in front of the right wheel 30a and the left wheel 30 and at positions facing each other. The right driven wheel 34a and the left driven wheel 34b are universal wheels that passively change their axles (that is, the rotation direction).
Note that the two driven wheels 34a and 34b are not indispensable, and only one driven wheel may be provided at the approximate center in the left-right direction. Further, as will be described in detail later, the self-propelled vehicle 10 is capable of both an inverted traveling that travels in an inverted posture in which only the wheels 30a and 30b are grounded and a stable traveling that travels in a stable posture in which the driven wheels are also grounded. However, if stable running is not required, it is not always necessary to provide a driven wheel.

自走車１０は、ヒト２を搭乗させるための座席１２を備えている。座席１２は、車体１８にシャフト１４を介して連結されており、車体１８に対して揺動可能に設けられている。車体１８には、座席駆動機構１６が設けられている。座席駆動機構１６は、座席モータ１６２（図３に図示されている）を備えており、座席１２をシャフト１４の回りに揺動させる。座席駆動機構１６は、座席１２を揺動させることによって、座席１２と車体１８の相対位置を変化させる。 The self-propelled vehicle 10 includes a seat 12 on which a person 2 is boarded. The seat 12 is connected to the vehicle body 18 via the shaft 14 and is provided so as to be swingable with respect to the vehicle body 18. The vehicle body 18 is provided with a seat drive mechanism 16. The seat drive mechanism 16 includes a seat motor 162 (shown in FIG. 3), and swings the seat 12 around the shaft 14. The seat drive mechanism 16 changes the relative position of the seat 12 and the vehicle body 18 by swinging the seat 12.

自走車１０は、ヒト２が操作する操作部４０と、操作部４０に加えられた操作に基づいて自走車１０の動作を制御する制御装置１００と、車体１８の前後方向の傾きの時間変化率（傾き角速度）を測定するためのジャイロセンサ３８を備えている。操作部４０と制御装置１００とジャイロセンサ３８は、車体１８に設けられている。
操作部４０は、操作桿やスイッチを備えている。ヒト２は、操作桿やスイッチを操作することによって、自走車１０の速度や向きの調整や、倒立走行と安定走行の切替えを行うことができる。制御装置１００は、コンピュータ装置と、各種の制御ソフトを用いて構成されている。 The self-propelled vehicle 10 includes an operation unit 40 operated by the human 2, a control device 100 that controls the operation of the self-propelled vehicle 10 based on an operation applied to the operation unit 40, and a time for tilting the vehicle body 18 in the front-rear direction. A gyro sensor 38 for measuring the rate of change (inclination angular velocity) is provided. The operation unit 40, the control device 100, and the gyro sensor 38 are provided on the vehicle body 18.
The operation unit 40 includes an operation rod and a switch. The human 2 can adjust the speed and direction of the self-propelled vehicle 10 and switch between the inverted traveling and the stable traveling by operating the operation rod and the switch. The control device 100 is configured using a computer device and various control software.

図３は、自走車１０の電気的な構成を示している。図３に示す構成の一部は、制御装置１００のハードウエア及びソフトウエアによって構築されている。図３に示すように、自走車１０は、右車輪３０ａの動作を制御する右車輪制御部１２０と、左車輪３０ｂの動作を制御する左車輪制御部１４０と、座席１２の動作を制御する座席制御部１６０と、アーム２６の動作を制御するアーム制御部１８０を備えている。
また、自走車１０は、自走車１０の目標位置Ｐｔ（ｘ，ｙ）を生成する車両目標位置生成部１０２と、座席１２の目標位置（角度）θｔ_Ｓを生成する座席目標位置生成部１０４と、アーム１２の目標位置（角度）θｔ_Ａを生成するアーム目標位置生成部１０６を備えている。車両目標位置生成部１０２と座席目標位置生成部１０４とアーム目標位置生成部１０６は、操作部４０に加えられた操作に基づいて、目標位置Ｐｔ（ｘ，ｙ）、θｔ_Ｓ、θｔ_Ａをそれぞれ生成する。 FIG. 3 shows the electrical configuration of the self-propelled vehicle 10. A part of the configuration shown in FIG. 3 is constructed by hardware and software of the control device 100. As shown in FIG. 3, the self-propelled vehicle 10 controls the operation of the right wheel control unit 120 that controls the operation of the right wheel 30a, the left wheel control unit 140 that controls the operation of the left wheel 30b, and the operation of the seat 12. A seat control unit 160 and an arm control unit 180 that controls the operation of the arm 26 are provided.
The self-propelled vehicle 10 includes a vehicle target position generation unit 102 that generates a target position Pt (x, y) of the self-propelled vehicle 10 and a seat target position generation unit that generates a target position (angle) θt _S of the seat 12. 104 and an arm target position generation unit 106 that generates a target position (angle) θt _A of the arm 12. The vehicle target position generation unit 102, the seat target position generation unit 104, and the arm target position generation unit 106 set the target positions Pt (x, y), θt _S , and θt _A based on the operation applied to the operation unit 40, respectively. Generate.

また、自走車１０は、走行制御コントローラ１１０を備えている。走行制御コントローラ１１０は、右車輪制御部１２０から右車輪モータ１２２の実際の回転角θａ_Ｒを入力し、左車輪制御部１４０から左車輪モータ１４２の実際の回転角θａ_Ｌを入力し、ジャイロセンサ３８の出力信号Ｓｊを入力し、車両目標位置生成部１０２から自走車１０の目標位置Ｐｔ（ｘ，ｙ）を入力する。そして、走行制御コントローラ１１０は、これらの入力値θａ_Ｒ、θａ_Ｌ、Ｓｊ、Ｐｔ（ｘ，ｙ）に基づいて、右車輪モータ１２２に通電するモータ電流の指令値Ｉｃ_Ｒと左車輪モータ１４２に通電するモータ電流の指令値Ｉｃ_Ｌを算出する。走行制御コントローラ１１０は、算出したこれらの指令値Ｉｃ_Ｒ、値Ｉｃ_Ｒを、右車輪制御部１２０と左車輪制御部１４０にそれぞれ出力する。なお、走行制御コントローラ１１０は、モータ電流の指令値Ｉｃ_Ｒ、Ｉｃ_Ｌを算出するに際に、ジャイロセンサ３８の出力信号Ｓｊの出力信号Ｓｊに基づいて、車体１８の前後方向の傾きとその時間変化率の両者を算出する。 The self-propelled vehicle 10 includes a travel control controller 110. The travel controller 110 inputs the actual rotation angle θa _R of the right wheel motor 122 from the right wheel control unit 120, and inputs the actual rotation angle θa _L of the left wheel motor 142 from the left wheel control unit 140. The output signal Sj of 38 is input, and the target position Pt (x, y) of the vehicle 10 is input from the vehicle target position generation unit 102. Then, the travel controller 110 sends a command value Ic _R for the motor current energized to the right wheel motor 122 and the left wheel motor 142 based on these input values θa _R , θa _L , Sj, Pt (x, y). A command value Ic _L of the motor current to be energized is calculated. The travel controller 110 outputs the calculated command value Ic _R and value Ic _R to the right wheel control unit 120 and the left wheel control unit 140, respectively. When the travel controller 110 calculates the motor current command values Ic _R and Ic _L , the traveling controller 110 determines the inclination of the vehicle body 18 in the front-rear direction and the time based on the output signal Sj of the output signal Sj of the gyro sensor 38. Both rates of change are calculated.

先に言及したように、自走車１０は、右左の車輪３０ａ、３０ｂのみを接地させた倒立姿勢で走行する倒立走行が可能であるとともに、従動輪３４ａ、３４ｂも接地させた安定姿勢で走行する安定走行が可能である。操作部４０から倒立走行が指示された場合、走行制御コントローラ１１０は、車両目標位置生成部１０２から入力した自走車１０の目標位置Ｐｔ（ｘ，ｙ）及びジャイロセンサ３８の出力信号Ｓｊに基づいて、自走車１０が転倒することなく走行し続けるように、前記したモータ電流の指令値Ｉｃ_Ｒ、Ｉｃ_Ｌを算出する。結果として、右車輪３０ａ及び左車輪３０ｂの接地点に対する自走車１０（ヒト２を含む）の慣性力を加味した重心位置を制御することとなる。具体的には、結果的に自走車１０（ヒト２を含む）の慣性力を加味した重心位置が右車輪３０ａ及び左車輪３０ｂの接地点を結ぶ直線の略鉛直上方に位置するように制御することとなる。従って、自走車１０は、前方に加速（又は後方に減速）している間は前傾して走行し、前方に減速（又は後方に加速）している間は後傾して走行する。一方、操作部４０から安定走行が指示された場合、走行制御コントローラ１１０は、主に、車両目標位置生成部１０２から入力した自走車１０の目標位置Ｐｔ（ｘ，ｙ）に基づいて、前記したモータ電流の指令値Ｉｃ_Ｒ、Ｉｃ_Ｌを算出する。この場合、右車輪３０ａ及び左車輪３０ｂの接地点に対する、自走車１０（ヒト２を含む）の慣性力を加味した重心位置の相対位置を考慮する必要はない。 As mentioned above, the self-propelled vehicle 10 can run in an inverted manner in which only the right and left wheels 30a, 30b are grounded, and can travel in a stable posture in which the driven wheels 34a, 34b are also grounded. Stable running is possible. When the inverted traveling is instructed from the operation unit 40, the traveling control controller 110 is based on the target position Pt (x, y) of the self-propelling vehicle 10 input from the vehicle target position generating unit 102 and the output signal Sj of the gyro sensor 38. Thus, the motor motor command values Ic _R and Ic _L are calculated so that the self-propelled vehicle 10 continues to travel without falling. As a result, the center-of-gravity position taking into account the inertial force of the self-propelled vehicle 10 (including the human 2) with respect to the ground contact points of the right wheel 30a and the left wheel 30b is controlled. Specifically, as a result, control is performed so that the position of the center of gravity considering the inertial force of the self-propelled vehicle 10 (including the human 2) is positioned substantially vertically above the straight line connecting the ground contact points of the right wheel 30a and the left wheel 30b. Will be. Therefore, the self-propelled vehicle 10 runs forward while being accelerated forward (or decelerated backward), and moved backward while being decelerated forward (or accelerated backward). On the other hand, when stable operation is instructed from the operation unit 40, the travel controller 110 mainly performs the above-described operation based on the target position Pt (x, y) of the self-propelled vehicle 10 input from the vehicle target position generation unit 102. The motor current command values Ic _R and Ic _L are calculated. In this case, it is not necessary to consider the relative position of the center of gravity position taking into account the inertial force of the self-propelled vehicle 10 (including the human 2) with respect to the contact points of the right wheel 30a and the left wheel 30b.

右車輪制御部１２０は、右車輪３０ａを駆動する右車輪モータ１２２と、右車輪モータ１２２の実際の回転角θａ_Ｒを検出するための右車輪エンコーダ１２４と、右車輪モータ１２２に通電するモータ電流Ｉａ_Ｒを調節する右車輪モータアンプ１２６を備えている。右車輪モータアンプ１２６は、右車輪エンコーダ１２４の出力信号Ｓｅ_Ｒを入力し、右車輪モータ１２２の実際の回転角θａ_Ｒを算出する。算出された右車輪モータ１２２の実際の回転角θａ_Ｒは、走行制御コントローラ１１０及び後述する右車輪外乱オブザーバ１２８に入力される。
また、右車輪制御部１２０は、右車輪モータ１２２に負荷されている外乱トルクＴｄ_Ｒを推定する右車輪外乱オブザーバ１２８と、右車輪外乱オブザーバ１２８が推定した外乱トルクＴｄ_Ｒに基づいて走行制御コントローラ１１０から入力したモータ電流の指令値Ｉｃ_Ｒを修正する右車輪指令値修正部１３０を備えている。右車輪指令値修正部１３０による修正後の修正指令値Ｉｍ_Ｒは、右車輪モータアンプ１２６に入力される。右車輪モータアンプ１２６は、右車輪モータ１２２に通電するモータ電流Ｉａ_Ｒを、入力した修正指令値Ｉｍ_Ｒに調節する。その結果、右車輪モータ１２２には、右車輪モータ１２２に負荷されている外乱トルクＴｄ_Ｒを補償するように、モータ電流が通電される。
ここでいう外乱トルクとは、予期せず負荷されるトルクである。例えば、走行する路面に予期せぬ傾斜や段差が存在したり、自走車１０に予期せぬ故障（例えばパンク）が生じたりしたときに、右車輪モータ１２２に外乱トルクが負荷される。 The right wheel control unit 120 includes a right wheel motor 122 that drives the right wheel 30 a, a right wheel encoder 124 that detects an actual rotation angle θa _R of the right wheel motor 122, and a motor current that energizes the right wheel motor 122. A right wheel motor amplifier 126 for adjusting Ia _R is provided. The right wheel motor amplifier 126 receives the output signal Se _R of the right wheel encoder 124 and calculates the actual rotation angle θa _R of the right wheel motor 122. The calculated actual rotation angle θa _R of the right wheel motor 122 is input to the travel controller 110 and a right wheel disturbance observer 128 described later.
The right wheel control unit 120 also includes a right wheel disturbance observer 128 that estimates the disturbance torque Td _R loaded on the right wheel motor 122, and a travel control controller based on the disturbance torque Td _R estimated by the right wheel disturbance observer 128. A right wheel command value correcting unit 130 that corrects the command value Ic _R of the motor current input from 110 is provided. The corrected command value Im _R corrected by the right wheel command value correcting unit 130 is input to the right wheel motor amplifier 126. The right wheel motor amplifier 126 adjusts the motor current Ia _R energized to the right wheel motor 122 to the input correction command value Im _R. As a result, the right wheel motor 122, to compensate for the disturbance torque Td _R that is loaded on the right wheel motor 122, the motor current is supplied.
The disturbance torque here is a torque that is unexpectedly loaded. For example, disturbance torque is applied to the right wheel motor 122 when an unexpected slope or step exists on the traveling road surface or when an unexpected failure (for example, puncture) occurs in the traveling vehicle 10.

図３に示すように、左車輪制御部１４０も、右車輪制御部１２０と同様の構成を有している。即ち、左車輪制御部１４０は、左車輪３０ｂを駆動する左車輪モータ１４２と、左車輪モータ１４２の実際の回転角θａ_Ｌを検出するための左車輪エンコーダ１４４と、左車輪モータ１４２に通電するモータ電流Ｉａ_Ｌを調節する左車輪モータアンプ１４６を備えている。左車輪モータアンプ１４６は、左車輪エンコーダ１４４の出力信号Ｓｅ_Ｌを入力し、左車輪モータ１４２の実際の回転角θａ_Ｌを算出する。算出された左車輪モータ１４２の実際の回転角θａ_Ｌは、走行制御コントローラ１１０及び後述する左車輪外乱オブザーバ１４８に入力される。
また、左車輪制御部１４０は、右車輪モータ１４２に負荷されている外乱トルクＴｄ_Ｌを推定する左車輪外乱オブザーバ１４８と、左車輪外乱オブザーバ１４８が推定した外乱トルクＴｄ_Ｌに基づいて走行制御コントローラ１１０から入力したモータ電流の指令値Ｉｃ_Ｌを修正する左車輪指令値修正部１５０を備えている。左車輪指令値修正部１５０による修正後の修正指令値Ｉｍ_Ｌは、左車輪モータアンプ１４６に入力される。左車輪モータアンプ１４６は、左車輪モータ１４２に通電するモータ電流Ｉａ_Ｌを、入力した修正指令値Ｉｍ_Ｌに調節する。その結果、左車輪モータ１４２には、左車輪モータ１４２に負荷されている外乱トルクＴｄ_Ｌを補償するように、モータ電流が通電される。 As shown in FIG. 3, the left wheel control unit 140 also has the same configuration as the right wheel control unit 120. That is, the left wheel control unit 140 energizes the left wheel motor 142 that drives the left wheel 30b, the left wheel encoder 144 that detects the actual rotation angle θa _L of the left wheel motor 142, and the left wheel motor 142. A left wheel motor amplifier 146 for adjusting the motor current Ia _L is provided. The left wheel motor amplifier 146 receives the output signal Se _L of the left wheel encoder 144 and calculates the actual rotation angle θa _L of the left wheel motor 142. The calculated actual rotation angle θa _L of the left wheel motor 142 is input to the travel controller 110 and a left wheel disturbance observer 148 described later.
The left wheel control unit 140 also includes a left wheel disturbance observer 148 that estimates a disturbance torque Td _L loaded on the right wheel motor 142, and a disturbance control controller Td _L that is estimated by the left wheel disturbance observer 148. 110 includes a left wheel command value correction unit 150 that corrects the motor current command value Ic _L input from 110. The corrected command value Im _L corrected by the left wheel command value correcting unit 150 is input to the left wheel motor amplifier 146. The left wheel motor amplifier 146 adjusts the motor current Ia _L energized to the left wheel motor 142 to the input correction command value Im _L. As a result, the motor current is applied to the left wheel motor 142 so as to compensate for the disturbance torque Td _L loaded on the left wheel motor 142.

図４を参照して、右車輪外乱オブザーバ１２８と左車輪外乱オブザーバ１４８について説明する。右車輪外乱オブザーバ１２８と左車輪外乱オブザーバ１４８は、同一の構成を有しており、その構成は図４に示すブロック線図で表現される。図中のＡの範囲は、制御対象であるモータ１２２、１４２に係るシステムを示しており、図中のＢの範囲は、外乱オブザーバ１２８、１４８に係る構成を示している。
外乱オブザーバ１２８、１４８は、モータアンプ１２６、１４６に実際に入力されたモータ電流の修正指令値Ｉｍと、モータ１２２、１４２の実際の回転角θａを入力し、モータ１２２、１４２に負荷されている外乱トルクＴｄの推定値［Ｔｄ］を出力する。なお、図中では添え字のＲ、Ｌを省略しており、修正指令値Ｉｍ_Ｒ又はＩｍ_Ｌを単にＩｍと記し、実際の回転角θａ_Ｒ又はθａ_Ｌを単にθａと記し、外乱トルクＴｄ_Ｒ又はＴｄ_Ｌを単にＴｄと記し、外乱トルクの推定値［Ｔｄ_Ｒ］又は［Ｔｄ_Ｌ］を単に［Ｔｄ］と記す。図４において、Ｋｔはトルク定数を示しており、Ｊはモータ１２２、１４２のイナーシャを示しており、ｓはラプラス演算子を示しており、ω^２／（ｓ^２＋２ζωｓ＋ω^２）はローパスフィルタを示している。図４に示すように、外乱オブザーバ１２８、１４８は、いわゆる最小次元オブザーバである。なお、外乱オブザーバ１２８、１４８は、同一次元（完全次元）オブザーバとすることもできる。外乱オブザーバ１２８、１４８の構成は、公知の構成法に基づいて設計することができる。
図４に示すように、外乱オブザーバ１２８、１４８は、モータアンプ１２６、１４６に入力されたモータ電流の修正指令値Ｉｍに基づいてモータ１２２、１４２の出力トルクを算出する一方、モータ１２２、１４２の実際の回転角θａに基づいてモータ１２２、１４２の出力トルクを算出し、両者の偏差に基づいてモータ１２２、１４２に負荷されている外乱トルクＴｄを推定する。 The right wheel disturbance observer 128 and the left wheel disturbance observer 148 will be described with reference to FIG. The right wheel disturbance observer 128 and the left wheel disturbance observer 148 have the same configuration, and the configuration is expressed by a block diagram shown in FIG. The range of A in the figure indicates a system related to the motors 122 and 142 to be controlled, and the range of B in the figure shows a configuration related to the disturbance observers 128 and 148.
The disturbance observers 128 and 148 receive the motor current correction command value Im actually input to the motor amplifiers 126 and 146 and the actual rotation angle θa of the motors 122 and 142, and are loaded on the motors 122 and 142. The estimated value [Td] of the disturbance torque Td is output. In the drawing, the subscripts R and L are omitted, the correction command value Im _R or Im _L is simply written as Im, the actual rotation angle θa _R or θa _L is simply written as θa, and the disturbance torque Td _R Or, Td _L is simply written as Td, and the estimated value [Td _R ] or [Td _L ] of the disturbance torque is simply written as [Td]. In FIG. 4, Kt indicates a torque constant, J indicates inertia of the motors 122 and 142, s indicates a Laplace operator, and ω ² / (s ² + 2ζωs + ω ² ) indicates a low-pass filter. ing. As shown in FIG. 4, the disturbance observers 128 and 148 are so-called minimum dimension observers. The disturbance observers 128 and 148 may be the same dimension (full dimension) observer. The configuration of the disturbance observers 128 and 148 can be designed based on a known configuration method.
As shown in FIG. 4, the disturbance observers 128 and 148 calculate the output torque of the motors 122 and 142 based on the motor current correction command value Im input to the motor amplifiers 126 and 146, while The output torque of the motors 122 and 142 is calculated based on the actual rotation angle θa, and the disturbance torque Td loaded on the motors 122 and 142 is estimated based on the deviation between the two.

図３に示すように、座席制御部１６０は、座席１２を揺動させる座席モータ１６２と、座席モータ１６２の実際の回転角θａ_Ｓを検出するための座席エンコーダ１６４と、座席モータ１６２に通電するモータ電流Ｉａ_Ｓを調節する座席モータアンプ１６６と、座席位置コントローラ１７０を備えている。座席モータアンプ１６６は、座席エンコーダ１６４の出力信号Ｓｅ_Ｓを入力し、座席モータ１６２の実際の回転角θａ_Ｓを算出する。算出された座席モータ１６２の実際の回転角θａ_Ｓは、座席位置コントローラ１７０に入力される。座席位置コントローラ１７０は、座席目標位置生成部１０４から座席１２の目標位置（角度）θｔ_Ｓを入力するとともに、座席モータアンプ１６６から座席モータ１６２の実際の回転角θａ_Ｓを入力し、これらの入力値θｔ_Ｓ、θａ_Ｓに基づいて、座席モータ１６２に通電するモータ電流の指令値Ｉｃ_Ｓを算出する。座席位置コントローラ１７０が算出した指令値Ｉｃ_Ｓは、座席モータアンプ１６６に入力される。座席モータアンプ１６６は、座席モータ１６２に通電するモータ電流Ｉａ_Ｓを、入力した指令値Ｉｃ_Ｓに調節する。その結果、座席モータ１６２には、座席１２の実際の位置（角度）がその目標位置（角度）θｔ_Ｓとなるように、モータ電流が通電される。 As shown in FIG. 3, the seat control unit 160 energizes the seat motor 162 that swings the seat 12, the seat encoder 164 for detecting the actual rotation angle θa _S of the seat motor 162, and the seat motor 162. a seat motor amplifier 166 to adjust the motor current Ia _S, and a seat position controller 170. The seat motor amplifier 166 receives the output signal Se _S of the seat encoder 164 and calculates the actual rotation angle θa _S of the seat motor 162. The calculated actual rotation angle θa _S of the seat motor 162 is input to the seat position controller 170. The seat position controller 170 inputs the target position (angle) θt _S of the seat 12 from the seat target position generation unit 104, and also inputs the actual rotation angle θa _S of the seat motor 162 from the seat motor amplifier 166, and inputs them. Based on the values θt _S and θa _S , a command value Ic _S for the motor current to be supplied to the seat motor 162 is calculated. The command value Ic _S calculated by the seat position controller 170 is input to the seat motor amplifier 166. The seat motor amplifier 166 adjusts the motor current Ia _S energized to the seat motor 162 to the input command value Ic _S. As a result, the seat motor 162, so that the actual position of the seat 12 (angle) becomes its target position (angle) [theta] t _S, the motor current is supplied.

アーム制御部１８０は、アーム２６を揺動させるアームモータ１８２と、アームモータ１８２の実際の回転角θａ_Ａを検出するためのアームエンコーダ１８４と、アームモータ１８２に通電するモータ電流Ｉａ_Ａを調節するアームモータアンプ１８６と、アーム位置コントローラ１９０を備えている。アームモータアンプ１８６は、アームエンコーダ１８４の出力信号Ｓｅ_Ａを入力し、アームモータ１８２の実際の回転角θａ_Ａを算出する。算出されたアームモータ１８２の実際の回転角θａ_Ａは、アーム位置コントローラ１９０に入力される。アーム位置コントローラ１９０は、アーム目標位置生成部１０６からアーム２６の目標位置（角度）θｔ_Ａを入力するとともに、アームモータアンプ１８６からアームモータ１８２の実際の回転角θａ_Ａを入力し、これらの入力値θｔ_Ａ、θａ_Ａに基づいて、アームモータ１８２に通電するモータ電流の指令値Ｉｃ_Ａを算出する。アーム位置コントローラ１９０が算出した指令値Ｉｃ_Ａは、アームモータアンプ１８６に入力される。アームモータアンプ１８６は、アームモータ１８２に通電するモータ電流Ｉａ_Ａを、入力した指令値Ｉｃ_Ａに調節する。その結果、アームモータ１８２には、アーム２６の実際の位置（角度）がその目標位置（角度）θｔ_Ａとなるように、モータ電流が通電される。 The arm control unit 180 adjusts an arm motor 182 that swings the arm 26, an arm encoder 184 that detects an actual rotation angle θa _A of the arm motor 182, and a motor current Ia _A that is supplied to the arm motor 182. An arm motor amplifier 186 and an arm position controller 190 are provided. The arm motor amplifier 186 receives the output signal Se _A of the arm encoder 184 and calculates the actual rotation angle θa _A of the arm motor 182. The calculated actual rotation angle θa _A of the arm motor 182 is input to the arm position controller 190. The arm position controller 190 inputs the target position (angle) θt _A of the arm 26 from the arm target position generation unit 106 and also inputs the actual rotation angle θa _A of the arm motor 182 from the arm motor amplifier 186. Based on the values θt _A and θa _A , a command value Ic _A for the motor current to be supplied to the arm motor 182 is calculated. The command value Ic _A calculated by the arm position controller 190 is input to the arm motor amplifier 186. The arm motor amplifier 186 adjusts the motor current Ia _A energized to the arm motor 182 to the input command value Ic _A. As a result, the arm motor 182, so that the actual position of the arm 26 (angle) becomes its target position (angle) [theta] t _A, the motor current is supplied.

以上の構成により、自走車１０は、搭乗者２が操作部４０に加えた操作に追従して右左の車輪３０ａ、３０ｂの回転量をそれぞれ制御することにより、搭乗者２の意図に応じて前進、後退、方向転換を行うことができる。また、自走車１０は、右左の車輪３０ａ、３０ｂのみを接地させた倒立姿勢で走行する倒立走行と、従動輪３４ａ、３４ｂも接地させた安定姿勢で走行する安定走行の両者が可能である。
図５、図６を参照して、自走車１０の安定姿勢から倒立姿勢への切替動作について説明する。通常、搭乗者２の乗降は、安定姿勢で行われる。自走車１０への乗車後、搭乗者２が操作部４０によって倒立姿勢への切替指示を行うと、自走車１０は図５に示す初期姿勢へ移行する。図５に示す初期姿勢は、搭乗者２の重心Ｍｈと自走車１０の重心Ｍｍを合成した合成重心Ｍｔが、右左の車輪３０ａ、３０ｂの接地点を結ぶ直線の鉛直上方に位置する姿勢である。このときの座席１２のシャフト１４を中心とする回転角θ_Ｓ１と、アーム２６のシャフト２２を中心とする回転角θ_Ａ１は、座席目標位置生成部１０４とアーム目標位置生成部１０６によってそれぞれ決定される。ここで、図中の直線Ｈは、水平面を示している。搭乗者２の体重等は、座席目標位置生成部１０４やアーム目標位置生成部１０６に予め教示されている。 With the above configuration, the self-propelled vehicle 10 follows the operation applied by the passenger 2 to the operation unit 40 and controls the amount of rotation of the right and left wheels 30a and 30b, respectively, according to the intention of the passenger 2 You can move forward, backward, and change direction. In addition, the self-propelled vehicle 10 can perform both an inverted traveling that travels in an inverted posture in which only the right and left wheels 30a and 30b are grounded, and a stable traveling that travels in a stable posture in which the driven wheels 34a and 34b are also grounded. .
With reference to FIG. 5, FIG. 6, the switching operation | movement from the stable attitude | position of the self-propelled vehicle 10 to an inverted attitude | position is demonstrated. Usually, the passenger 2 gets on and off in a stable posture. When the passenger 2 gives an instruction to switch to the inverted posture by using the operation unit 40 after getting on the self-propelled vehicle 10, the self-propelled vehicle 10 shifts to the initial posture shown in FIG. The initial posture shown in FIG. 5 is a posture in which a combined center of gravity Mt obtained by combining the center of gravity Mh of the passenger 2 and the center of gravity Mm of the self-propelled vehicle 10 is positioned vertically above a straight line connecting the ground contact points of the right and left wheels 30a and 30b. is there. The rotation angle θ _S 1 around the shaft 14 of the seat 12 and the rotation angle θ _A 1 around the shaft 22 of the arm 26 at this time are respectively determined by the seat target position generation unit 104 and the arm target position generation unit 106. It is determined. Here, a straight line H in the figure indicates a horizontal plane. The weight and the like of the passenger 2 are taught in advance in the seat target position generation unit 104 and the arm target position generation unit 106.

次に、自走車１０は、合成重心Ｍｔを右左の車輪３０ａ、３０ｂの接地点を結ぶ直線の鉛直上方に維持しながら、座席１２とアーム２６を同期しながら揺動させる。それにより、自走車１０は図６に示す倒立姿勢へと移行する。図６に示す倒立姿勢は、合成重心Ｍｔが右左の車輪３０ａ、３０ｂの接地点を結ぶ直線の鉛直上方に位置するとともに、右左の従動輪３４ａ、３４ｂが空中に浮遊する姿勢である。図５に示す安定姿勢から図６に示す倒立姿勢への移行期間における座席１２の回転角θ_Ｓとアーム２６の回転角θ_Ａについても、座席目標位置生成部１０４とアーム目標位置生成部１０６によってそれぞれ決定される。この安定姿勢から倒立姿勢への移行期間中に、走行制御コントローラ１１０の制御方式は倒立走行用に切り替えられる。それにより、自走車１０は必要に応じて前進後退し、安定姿勢から倒立姿勢への移行期間に転倒することを防止する。 Next, the self-propelled vehicle 10 swings the seat 12 and the arm 26 in synchronization while maintaining the combined center of gravity Mt vertically above the straight line connecting the grounding points of the right and left wheels 30a and 30b. Thereby, the self-propelled vehicle 10 shifts to the inverted posture shown in FIG. The inverted posture shown in FIG. 6 is a posture in which the combined center of gravity Mt is positioned vertically above a straight line connecting the ground contact points of the right and left wheels 30a and 30b, and the right and left driven wheels 34a and 34b float in the air. The seat target position generation unit 104 and the arm target position generation unit 106 also perform the rotation angle θ _S of the seat 12 and the rotation angle θ _A of the arm 26 in the transition period from the stable posture illustrated in FIG. 5 to the inverted posture illustrated in FIG. Each is decided. During the transition period from the stable posture to the inverted posture, the control method of the traveling controller 110 is switched to the inverted traveling. Thereby, the self-propelled vehicle 10 moves forward and backward as necessary, and prevents the vehicle from falling during the transition period from the stable posture to the inverted posture.

自走車１０が走行する際、右左の車輪３０ａ、３０ｂには、様々な外乱トルクがそれぞれ負荷される。このとき、自走車１０は、それぞれの車輪３０ａ、３０ｂに負荷された外乱トルクを、それぞれの車輪３０ａ、３０ｂで独立して補償することができる。例えば、右車輪３０ａのみが傾斜や段差に乗り上げた場合には、右車輪３０ａのみをより大きなトルクで駆動することができる。あるいは、右車輪３０ａがパンクした場合にも、右車輪３０ａのみをより大きなトルクで駆動することができる。それにより、自走車１０は、突然にバランスを崩したり転倒したりすることなく、走行し続けることができる。特に、倒立走行時には、従来の技術では走行困難とされるような悪路を、転倒することなくスムーズに走行することが可能となる。 When the self-propelled vehicle 10 travels, various disturbance torques are respectively applied to the right and left wheels 30a and 30b. At this time, the self-propelled vehicle 10 can compensate the disturbance torque applied to the wheels 30a and 30b independently by the wheels 30a and 30b. For example, when only the right wheel 30a rides on a slope or a step, only the right wheel 30a can be driven with a larger torque. Alternatively, even when the right wheel 30a is punctured, only the right wheel 30a can be driven with a larger torque. Thus, the self-propelled vehicle 10 can continue to travel without suddenly losing balance or falling down. In particular, during upside down traveling, it is possible to smoothly travel on a rough road, which is difficult to travel with the conventional technology, without falling down.

本明細書または図面に説明した技術要素は、単独であるいは各種の組み合わせによって技術的有用性を発揮するものであり、出願時の請求項に記載の組み合わせに限定されるものではない。
例えば、車体の前後方向の傾き及びその時間変化率を測定するために、本実施例ではジャイロセンサを用いている。しかしながら、車体の前後方向の傾きやその時間変化率は、そのうちの一方をセンサによって検出すれば、他方の値はそのセンサの出力信号を時間微分又は時間積分することによって算出することができる。そのことから、本実施例の自走車では、ジャイロセンサに代えて、車体の前後方向の傾きを検出する角度センサを用いることもできる。この場合でも、制御コントローラは、角度センサの出力信号に基づいて、車体の前後方向の傾き及びその時間変化率を算出することができる。
本明細書または図面に例示した技術は複数の目的を同時に達成するものであり、そのうちの一つの目的を達成すること自体で技術的有用性を持つものである。 The technical elements described in this specification or the drawings exhibit technical usefulness alone or in various combinations, and are not limited to the combinations described in the claims at the time of filing.
For example, a gyro sensor is used in the present embodiment in order to measure the longitudinal inclination of the vehicle body and the rate of change with time. However, if one of the vehicle body front-rear direction inclination and the time change rate is detected by a sensor, the other value can be calculated by time differentiation or time integration of the output signal of the sensor. Therefore, in the self-propelled vehicle of the present embodiment, an angle sensor that detects the inclination of the vehicle body in the front-rear direction can be used instead of the gyro sensor. Even in this case, the controller can calculate the inclination of the vehicle body in the front-rear direction and the time change rate thereof based on the output signal of the angle sensor.
The technology illustrated in this specification or the drawings achieves a plurality of objects at the same time, and achieving one of the objects itself has technical utility.

自走車の構成を模式的に示す正面図。The front view which shows the structure of a self-propelled vehicle typically. 自走車の構成を模式的に示す右側面図。The right view which shows the structure of a self-propelled vehicle typically. 自走車の制御システムの構成を示す図。The figure which shows the structure of the control system of a self-propelled vehicle. 外乱オブザーバの入出力の関係を示すブロック線図。The block diagram which shows the relationship of the input / output of a disturbance observer. 安定姿勢から倒立姿勢への切替時の初期姿勢の自走車を示す図。The figure which shows the self-propelled vehicle of the initial posture at the time of switching from a stable posture to an inverted posture. 倒立姿勢の自走車を示す図。The figure which shows the self-propelled vehicle of an inverted posture.

Explanation of symbols

・１０：自走車
・１２：座席
・１６：座席駆動機構
・１８：車体
・２０：アーム駆動機構
・２４：アーム
・３０ａ、３０ｂ：車輪
・３４ａ、３４ｂ：従動輪
・１００：制御装置
・１２０：右車輪制御部
・１２２：右車輪モータ
・１２４：右車輪エンコーダ
・１２６：右車輪モータアンプ
・１２８：右車輪外乱オブザーバ
・１３０：右車輪指令値修正部
・１４０：左車輪制御部
・１４２：左車輪モータ
・１４４：左車輪エンコーダ
・１４６：左車輪モータアンプ
・１４８：左車輪外乱オブザーバ
・１５０：左車輪指令値修正部
・１６０：座席制御部
・１６２：座席モータ
・１６４：座席エンコーダ
・１６６：座席モータアンプ
・１７０：座席位置コントローラ
・１８０：アーム制御部
・１８２：アームモータ
・１８４：アームエンコーダ
・１８６：アームモータアンプ
・１９０：アーム位置コントローラ 10: self-propelled vehicle 12: seat 16: seat drive mechanism 18: vehicle body 20: arm drive mechanism 24: arm 30a, 30b: wheels 34a, 34b: driven wheels 100: control device 120 : Right wheel control unit 122: right wheel motor 124: right wheel encoder 126 126 right wheel motor amplifier 128 128 right wheel disturbance observer 130 130 right wheel command value correction unit 140 140 left wheel control unit 142 Left wheel motor 144: Left wheel encoder 146: Left wheel motor amplifier 148: Left wheel disturbance observer 150: Left wheel command value correction unit 160: Seat control unit 162: Seat motor 164: Seat encoder 166 : Seat motor amplifier 170: Seat position controller 180: Arm control unit 182: Arm motor 184: Arm encoder 18 : Arm motor amplifier 190: arm position controller

Claims

The car body,
A pair of left and right wheels provided on the vehicle body;
A first motor that drives one of the pair of left and right wheels;
A second motor for driving the other of the pair of left and right wheels;
A first current adjusting unit for inputting a command value of a motor current to be supplied to the first motor and adjusting a motor current to be supplied to the first motor;
A first disturbance torque calculation unit that inputs a command value of the motor current input to the first current adjustment unit and an actual operation amount of the first motor, and calculates a disturbance torque loaded on the first motor;
A first command value correcting unit that corrects a command value of the motor current input to the first current adjusting unit based on the disturbance torque calculated by the first disturbance torque calculating unit;
A second current adjusting unit for inputting a command value of a motor current to be supplied to the second motor and adjusting a motor current to be supplied to the second motor;
A second disturbance torque calculation unit that inputs a command value of the motor current input to the second current adjustment unit and an actual operation amount of the second motor, and calculates a disturbance torque loaded on the second motor;
A second command value correcting unit that corrects a command value of the motor current input to the second current adjusting unit based on the disturbance torque calculated by the second disturbance torque calculating unit;
A self-propelled vehicle with

An inclination sensor for detecting at least one of the inclination of the vehicle body and the rate of change over time;
A travel control unit that inputs at least an output signal of the tilt sensor and outputs a command value of a motor current for the first motor and the second motor;
2. The self-propelled vehicle according to claim 1, wherein the vehicle can run in an inverted posture in which only the pair of left and right wheels are grounded.

The self-propelled vehicle according to claim 1 or 2, wherein at least one of the first disturbance torque calculation unit and the second disturbance torque calculation unit is a minimum dimension observer.

Controls the operation of a self-propelled vehicle including a vehicle body, a pair of left and right wheels provided on the vehicle body, a first motor that drives one of the pair of left and right wheels, and a second motor that drives the other of the pair of left and right wheels. A control device for
A first current adjusting unit for inputting a command value of a motor current to be supplied to the first motor and adjusting a motor current to be supplied to the first motor;
A first disturbance torque calculation unit that inputs a command value of the motor current input to the first current adjustment unit and an actual operation amount of the first motor, and calculates a disturbance torque loaded on the first motor;
A first command value correcting unit that corrects a command value of the motor current input to the first current adjusting unit based on the disturbance torque calculated by the first disturbance torque calculating unit;
A second current adjusting unit for inputting a command value of a motor current to be supplied to the second motor and adjusting a motor current to be supplied to the second motor;
A second disturbance torque calculation unit that inputs a command value of the motor current input to the second current adjustment unit and an actual operation amount of the second motor, and calculates a disturbance torque loaded on the second motor;
A second command value correcting unit that corrects a command value of the motor current input to the second current adjusting unit based on the disturbance torque calculated by the second disturbance torque calculating unit;
A control device comprising:

Controls the operation of a self-propelled vehicle including a vehicle body, a pair of left and right wheels provided on the vehicle body, a first motor that drives one of the pair of wheels, and a second motor that drives the other of the pair of left and right wheels. A control method,
A first current adjusting step of inputting a command value of a motor current to be supplied to the first motor and adjusting a motor current to be supplied to the first motor;
A first disturbance torque calculating step of inputting a command value of the motor current input in the first current adjustment step and an actual operation amount of the first motor, and calculating a disturbance torque loaded on the first motor;
A first command value correcting step of correcting a command value of the motor current input in the first current adjusting step based on the disturbance torque calculated in the first disturbance torque calculating step;
A second current adjusting step of inputting a command value of a motor current to be supplied to the second motor and adjusting a motor current to be supplied to the second motor;
A second disturbance torque calculating step of inputting a command value of the motor current input in the second current adjusting step and an actual operation amount of the second motor and calculating a disturbance torque loaded on the second motor;
A second command value correcting step of correcting the command value of the motor current input in the second current adjusting step based on the disturbance torque calculated in the second disturbance torque calculating step;
A control method comprising: