JP5496717B2 - Mobile remote control system, environmental information collection system - Google Patents

Mobile remote control system, environmental information collection system Download PDF

Info

Publication number
JP5496717B2
JP5496717B2 JP2010056240A JP2010056240A JP5496717B2 JP 5496717 B2 JP5496717 B2 JP 5496717B2 JP 2010056240 A JP2010056240 A JP 2010056240A JP 2010056240 A JP2010056240 A JP 2010056240A JP 5496717 B2 JP5496717 B2 JP 5496717B2
Authority
JP
Japan
Prior art keywords
mobile
remote control
mobile remote
linear motion
control system
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
JP2010056240A
Other languages
Japanese (ja)
Other versions
JP2011189438A (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.)
Keio University
Original Assignee
Keio University
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 Keio University filed Critical Keio University
Priority to JP2010056240A priority Critical patent/JP5496717B2/en
Publication of JP2011189438A publication Critical patent/JP2011189438A/en
Application granted granted Critical
Publication of JP5496717B2 publication Critical patent/JP5496717B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Description

本発明は、操作システム(マスターシステム)と移動体システム(スレーブシステム)の間でバイラテラル制御が行われる移動体遠隔操作システムに関する。   The present invention relates to a mobile remote operation system in which bilateral control is performed between an operation system (master system) and a mobile system (slave system).

近年、操作デバイスと操作対象を機械的に非連結な構成としたシステムについて実用化及び研究が進められている。このようなシステムにおいては、特に、マスターシステムとスレーブシステムの間で姿勢と力の状態を一致させるように制御する手法は、バイラテラル制御と称されている。バイラテラル制御では、マスターシステムに対して行った操作に基づいてスレーブシステムが動作し、スレーブシステムが環境(障害物、勾配等)から受けた反力が、操作デバイスにおいてアクチュエータ等により再現される。   In recent years, practical use and research have been advanced on a system in which an operation device and an operation target are mechanically disconnected. In such a system, in particular, a method for controlling the posture and the force state to coincide between the master system and the slave system is called bilateral control. In the bilateral control, the slave system operates based on the operation performed on the master system, and the reaction force received by the slave system from the environment (obstacle, gradient, etc.) is reproduced by an actuator or the like in the operation device.

特許文献1には、バイラテラル制御を行う方法であって、時系列な位置情報と力の接触情報を取得し、これを解析して再現する位置、力再現方法等について記載されている。但し、係る方法は、移動体をスレーブシステムとするものではない。   Patent Document 1 describes a method of performing bilateral control, in which time-series position information and force contact information are acquired, analyzed and reproduced, and a force reproduction method. However, this method does not use the moving body as a slave system.

特許文献2には、電動式路上走行車両用の補力操舵システムについて記載されている。このシステムでは、トルク補助信号に追加されるように構成されている触覚トルクを、車両ヨーレート誤差又は横加速度誤差に基づいて生成している。   Patent Document 2 describes a supplementary steering system for an electric road vehicle. In this system, a haptic torque configured to be added to the torque assist signal is generated based on a vehicle yaw rate error or a lateral acceleration error.

特開2009−279699号公報JP 2009-279699 A 特開2008−087763号公報JP 2008-087763 A

バイラテラル制御を、路上を走行する移動体に適用した場合、通常であれば、直進運動(並進運動)と回転運動の双方についての制御が必要となる。しかしながら、特許文献2に記載のシステムでは、操舵に関する触覚情報(触覚トルク)についてのみ考慮されており、直進運動に関する制御については考慮されていない。   When bilateral control is applied to a moving body traveling on the road, normally, control for both straight motion (translational motion) and rotational motion is required. However, in the system described in Patent Document 2, only haptic information (tactile torque) related to steering is considered, and control related to linear motion is not considered.

本発明はこのような課題を解決するためのものであり、直進運動と回転運動についてのバイラテラル制御を正確に行うことが可能な移動体遠隔操作システム、及びこれが複数個集合して構成される環境情報収集システムを提供することを、主たる目的とする。   The present invention is to solve such problems, and is configured to be a mobile remote control system capable of accurately performing bilateral control on linear motion and rotational motion, and a plurality of such systems. The main purpose is to provide an environmental information collection system.

上記目的を達成するための本発明の第1の態様は、
人が操作を行う操作デバイスを有する操作システムと、
前記操作システムに対してなされた人の操作に基づいて駆動される移動体システムと、
を備え、
前記操作デバイスには、前記移動体システムが環境から受けた反力を再現するためのアクチュエータが取り付けられ、前記操作システムと前記移動体システムとの間でバイラテラル制御が行われる移動体遠隔操作システムであって、
前記操作デバイスには、直進運動指示と回転運動指示の双方を含む操作が可能となっており、
前記バイラテラル制御の前記操作システムと、前記移動体システムと、において二次のQuarry行列を用いて直進運動と、回転運動と、に分離する演算を行い、
前記演算によって分離された前記操作システムの直線運動の成分と、前記演算によって分離された前記移動体システムの直線運動の成分と、を二次のQuarry行列で乗算することを特徴とする、
移動体遠隔操作システムである。
In order to achieve the above object, the first aspect of the present invention provides:
An operation system having an operation device for human operation;
A mobile system driven based on a human operation performed on the operation system;
With
An actuator for reproducing the reaction force received by the mobile system from the environment is attached to the operating device, and a mobile remote control system in which bilateral control is performed between the operating system and the mobile system Because
The operation device can be operated including both a linear motion instruction and a rotational motion instruction,
In the operation system of the bilateral control and the mobile system, a calculation is performed to separate a linear motion and a rotational motion using a quadratic Quarry matrix,
The second-order Quarry matrix multiplies the linear motion component of the operating system separated by the computation and the linear motion component of the mobile system separated by the computation,
It is a mobile remote control system.

この本発明の第1の態様によれば、バイラテラル制御の少なくとも一部において、直進運動と回転運動のそれぞれについて独立した演算を行うため、直進運動と回転運動についてのバイラテラル制御を正確に行うことができる。   According to the first aspect of the present invention, in at least a part of the bilateral control, independent calculation is performed for each of the linear motion and the rotational motion, so that the bilateral control for the linear motion and the rotational motion is accurately performed. be able to.

この本発明の第1の態様において、
前記バイラテラル制御において、二次のQuarry行列を用いて直進運動と回転運動を分離することを特徴とするものとしてもよい。
In this first aspect of the invention,
In the bilateral control, the linear motion and the rotational motion may be separated using a secondary Quarry matrix.

これによって、直進運動と回転運動のそれぞれについての演算を正確且つ容易に行うことができる。   This makes it possible to accurately and easily perform calculations for each of the straight movement and the rotary movement.

また、本発明の第1の態様において、
前記操作デバイスは、相対角度の目標値をπ[rad]として制御される一対のペダルを含むものとしてもよい。
In the first aspect of the present invention,
The operation device may include a pair of pedals controlled with a target value of a relative angle as π [rad].

また、本発明の第1の態様において、
前記操作デバイスは、回転運動を指示する操作が可能なステアリング手段を含むものとしてもよい。
In the first aspect of the present invention,
The operation device may include steering means capable of performing an operation for instructing a rotational motion.

また、本発明の第1の態様において、
前記移動体システムは、左右独立して駆動可能な一対の車輪を含むものとしてもよい。
In the first aspect of the present invention,
The mobile system may include a pair of wheels that can be driven independently on the left and right.

本発明の第2の態様は、
本発明の第1の態様の移動体遠隔操作システムを複数個備え、
各移動体遠隔操作システムは、自己が有する移動体システムの位置を特定可能に構成されており、
各移動体遠隔操作システムにおいて取得された環境情報と、該環境情報が取得された際の移動体システムの位置とを収集し、位置に対応づけられた環境情報を生成する情報収集サーバを備えることを特徴とする、
環境情報収集システムである。
The second aspect of the present invention is:
A plurality of mobile remote control systems according to the first aspect of the present invention,
Each mobile remote control system is configured to be able to identify the position of the mobile system that it has,
An information collection server is provided that collects environmental information acquired in each mobile remote control system and the position of the mobile system when the environmental information is acquired, and generates environmental information associated with the position. Characterized by the
Environmental information collection system.

この本発明の第2の態様によれば、在る移動体遠隔装置システムにおいて収集された環境情報を、他の移動体遠隔装置システムの操作者に提供することができる。この結果、当該操作する人は、移動体システムの進路上に障害物等が存在するか否かを検知することができ、スムーズに移動体システムを移動させることができる。   According to the second aspect of the present invention, environment information collected in an existing mobile remote device system can be provided to an operator of another mobile remote device system. As a result, the person who operates can detect whether there is an obstacle or the like on the path of the mobile system, and can smoothly move the mobile system.

本発明によれば、直進運動と回転運動についてのバイラテラル制御を正確に行うことが可能な移動体遠隔操作システム、及びこれが複数個集合して構成される環境情報収集システムを提供することができる。   ADVANTAGE OF THE INVENTION According to this invention, the mobile body remote control system which can perform bilateral control about a linear motion and a rotational motion correctly, and the environmental information collection system comprised by combining two or more can be provided. .

本発明の第1実施例に係る移動体遠隔操作システム1の主要な構成要素の外観構成を示す図である。It is a figure which shows the external appearance structure of the main components of the mobile remote control system 1 which concerns on 1st Example of this invention. 本発明の第1実施例に係る移動体遠隔操作システム1が有する制御系の構成要素を示すブロック図である。It is a block diagram which shows the component of the control system which the mobile remote control system 1 which concerns on 1st Example of this invention has. 本発明の第1実施例に係る移動体遠隔操作システム1の制御系を周波数領域で表現したブロック線図である。It is the block diagram which expressed the control system of the mobile remote control system 1 which concerns on 1st Example of this invention in the frequency domain. ペダルシステム30や移動体システム50の右システム、左システムの機能を示すブロック線図である。It is a block diagram which shows the function of the right system of the pedal system 30 or the mobile body system 50, and the left system. 移動体システム50が平面から人工芝マットに乗り上げる場面を示す外観図である。It is an external view which shows the scene where the mobile body system 50 rides on an artificial grass mat from a plane. 第1実施例に係る移動体遠隔操作システム1を用いた実験におけるパラメータを示す図である。It is a figure which shows the parameter in the experiment using the mobile remote control system 1 which concerns on 1st Example. 右ペダル32Aと左ペダル32Bの相対角度の変化を示す図である。It is a figure which shows the change of the relative angle of the right pedal 32A and the left pedal 32B. 直進運動に関する、操作システム10と移動体システム50の、それぞれの位置応答及び力応答の変化を示す図である。It is a figure which shows the change of each position response and force response of the operation system 10 and the mobile body system 50 regarding a rectilinear motion. 回転運動に関する、操作システム10と移動体システム50の、それぞれの位置応答及び力応答の変化を示す図である。It is a figure which shows the change of each position response and force response of the operating system 10 and the mobile body system 50 regarding rotational motion. 直進運動と回転運動の双方について位置制御を行う場合のブロック線図である。It is a block diagram in the case of performing position control about both a linear motion and a rotational motion. 直進運動と回転運動の双方について力制御を行う場合のブロック線図である。It is a block diagram in the case of performing force control about both a rectilinear motion and a rotational motion. 直進運動について位置制御を行い、回転運動について力制御を行う場合のブロック線図である。It is a block diagram in the case of performing position control about linear motion and performing force control about rotational motion. 直進運動について力制御を行い、回転運動について位置制御を行う場合のブロック線図である。It is a block diagram in the case of performing force control for linear motion and performing position control for rotational motion. 本発明の第2実施例に係る環境情報収集システム200のシステム構成例である。It is an example of a system configuration | structure of the environmental information collection system 200 which concerns on 2nd Example of this invention. 本発明の第2実施例に係る移動体遠隔操作システム200が有する制御系の構成要素を示すブロック図である。It is a block diagram which shows the component of the control system which the mobile remote control system 200 which concerns on 2nd Example of this invention has.

以下、本発明を実施するための形態について、添付図面を参照しながら実施例を挙げて説明する。   DESCRIPTION OF EMBODIMENTS Hereinafter, embodiments for carrying out the present invention will be described with reference to the accompanying drawings.

<<第1実施例>>
以下、図面を参照し、本発明の第1実施例に係る移動体遠隔操作システムについて説明する。本実施例の移動体遠隔操作システムは、操作システムと移動体システムとの間でバイラテラル制御が行われるものであり、移動体システムは、2個のインホイールモータによって直進運動及び回転運動(これらの組み合わせを含む)を実現可能に構成されている。
<< First Example >>
A mobile remote control system according to a first embodiment of the present invention will be described below with reference to the drawings. In the mobile remote control system of this embodiment, bilateral control is performed between the operation system and the mobile system. The mobile system is a linear motion and a rotational motion (these are controlled by two in-wheel motors). (Including combinations of the above).

[構成]
図1は、本発明の第1実施例に係る移動体遠隔操作システム1の主要な構成要素の外観構成を示す図である。図示するように、移動体遠隔操作システム1は、操作システム10と、移動体システム50とを備える。操作システム10と移動体システム50は、有線又は無線接続によって互いに通信可能となっている。
[Constitution]
FIG. 1 is a diagram showing an external configuration of main components of a mobile remote control system 1 according to a first embodiment of the present invention. As shown in the figure, the mobile remote control system 1 includes an operation system 10 and a mobile system 50. The operation system 10 and the mobile system 50 can communicate with each other through a wired or wireless connection.

操作システム10は、ステアリングシステム20と、ペダルシステム30を有する。   The operation system 10 includes a steering system 20 and a pedal system 30.

ステアリングシステム20は、操作者が回転運動を指示可能なステアリングハンドル22と、ステアリングハンドル22に反力を出力可能なステアリングアクチュエータ24と、を備える。   The steering system 20 includes a steering handle 22 that allows an operator to instruct rotational movement, and a steering actuator 24 that can output a reaction force to the steering handle 22.

ペダルシステム30は、右ペダル32A、左ペダル32Bと、これらに反力を出力可能なペダルアクチュエータ34A、34Bと、を備える。   The pedal system 30 includes a right pedal 32A and a left pedal 32B, and pedal actuators 34A and 34B that can output a reaction force thereto.

ステアリングハンドル22は剛体に対して回動可能に取り付けられている。また、右ペダル32A、左ペダル32Bは、ステアリングハンドル22と同一の剛体に対してそれぞれが回動可能に取り付けられている。操作者は、同じく剛体に取り付けられたサドル部に跨って、自転車を運転するかのようにステアリングハンドル22やペダル32A、32Bを操作することにより、移動体システム50を移動させることができる。   The steering handle 22 is rotatably attached to the rigid body. The right pedal 32A and the left pedal 32B are attached to the same rigid body as the steering handle 22 so as to be rotatable. The operator can move the moving body system 50 by operating the steering handle 22 and the pedals 32A and 32B as if driving a bicycle across the saddle portion attached to the rigid body.

そして、ステアリングアクチュエータ24やペダルアクチュエータ34A、34Bは、移動体システム50が環境から受ける反力を操作者に伝えるために、ステアリングハンドル22や左右のペダル32A、32Bに力を出力する。また、ステアリングアクチュエータ24やペダルアクチュエータ34A、34Bには、回転位置を検出するための位置エンコーダが取り付けられている。   The steering actuator 24 and the pedal actuators 34A and 34B output force to the steering handle 22 and the left and right pedals 32A and 32B in order to transmit the reaction force received by the moving body system 50 from the environment to the operator. Further, a position encoder for detecting a rotational position is attached to the steering actuator 24 and the pedal actuators 34A and 34B.

移動体システム50は、本体部52と、右の主車輪54A、左の主車輪54Bと、補助車輪58と、を備える。各車輪は、本体部52に対して回動可能に取り付けられている。主車輪54A、54Bには、これらを回転駆動させるためのインホイールモータ56A、56Bが取り付けられている。インホイールモータ56A、56Bは、主車輪54A、54Bの内部に取り付けられ、例えば本体部52に連結されたステータと、主車輪54A、54Bに連結されたロータと、を有する(係る関係は逆であってもよい)。また、インホイールモータ56A、56Bには、回転位置を検出するための位置エンコーダが取り付けられている。   The mobile body system 50 includes a main body 52, a right main wheel 54 </ b> A, a left main wheel 54 </ b> B, and an auxiliary wheel 58. Each wheel is rotatably attached to the main body 52. In-wheel motors 56A and 56B for rotating these wheels are attached to the main wheels 54A and 54B. The in-wheel motors 56A and 56B are attached to the inside of the main wheels 54A and 54B, and include, for example, a stator connected to the main body 52 and a rotor connected to the main wheels 54A and 54B (the relationship is reversed). May be). Further, a position encoder for detecting a rotational position is attached to the in-wheel motors 56A and 56B.

図2は、本発明の第1実施例に係る移動体遠隔操作システム1が有する制御系の構成要素を示すブロック図である。移動体遠隔操作システム1は、バイラテラル制御を行う主体として制御装置60を備える。制御装置60は、マイクロコンピュータとして構成される。制御装置60は、操作システム10と移動体システム10のいずれかに併設されてもよいし、別体であってもよい。   FIG. 2 is a block diagram showing components of a control system included in the mobile remote control system 1 according to the first embodiment of the present invention. The mobile remote control system 1 includes a control device 60 as a main body that performs bilateral control. The control device 60 is configured as a microcomputer. The control device 60 may be provided in either the operation system 10 or the mobile body system 10 or may be a separate body.

[バイラテラル制御]
以下、上記のような構成を有する移動体遠隔操作システム1において行われるバイラテラル制御について、主に周波数領域で表現されたブロック線図を用いて説明する。なお、周波数領域から時間領域への変換等は、当業者にとって周知である。
[Bilateral control]
Hereinafter, bilateral control performed in the mobile remote control system 1 having the above-described configuration will be described mainly using a block diagram expressed in the frequency domain. The conversion from the frequency domain to the time domain is well known to those skilled in the art.

図3は、本発明の第1実施例に係る移動体遠隔操作システム1の制御系を周波数領域で表現したブロック線図である。図中、「s」はラプラス演算子である。また、「・・」は2階の微分を表し、「^」は推定値を表している。ペダルシステム30及び移動体システム50は、それぞれ左右のアクチュエータ又はインホイールモータを有し、それぞれに外乱オブザーバや反力推定オブザーバが併設されているため(物理的に近接している必要はない)、アクチュエータ又はインホイールモータと各オブザーバを含めて、右システム、左システムと表記している。   FIG. 3 is a block diagram representing the control system of the mobile remote control system 1 according to the first embodiment of the present invention in the frequency domain. In the figure, “s” is a Laplace operator. “··” represents the second-order differentiation, and “^” represents the estimated value. Since the pedal system 30 and the moving body system 50 have left and right actuators or in-wheel motors, respectively, and a disturbance observer and a reaction force estimation observer are attached to each of them (it is not necessary to be physically close). Including the actuator or in-wheel motor and each observer, it is described as the right system and the left system.

更に、図2において、「θ」はモータの回転角を表し、「tra」は直進運動を表し、「rot」は回転運動を表している。また、「res」は応答値(測定値)を表し、「ref」は参照値(制御目標値)を表し、「cmd」は指令値を表している。   Further, in FIG. 2, “θ” represents a rotation angle of the motor, “tra” represents a straight motion, and “rot” represents a rotational motion. “Res” represents a response value (measured value), “ref” represents a reference value (control target value), and “cmd” represents a command value.

また、τはトルクを表しており、上付き文字の「dis」は外乱を、「ext」は外乱から摩擦などを除去した値(アクチュエータ等に直接作用する外力)を表している。   Also, τ represents torque, the superscript “dis” represents a disturbance, and “ext” represents a value obtained by removing friction or the like from the disturbance (an external force directly acting on an actuator or the like).

また、「P」はペダルシステムを表し、「S」ステアリングシステムを表し、「M」はモバイルシステム(移動体システム)を表している。また、「C」は後述する和のモードを表し、「D」は差のモードを表している。   “P” represents a pedal system, “S” represents a steering system, and “M” represents a mobile system (mobile system). “C” represents a sum mode described later, and “D” represents a difference mode.

また、「Cf」は力制御器であり、「Cp(s)」は位置制御器であり、次式(1)で表される。   “Cf” is a force controller, and “Cp (s)” is a position controller, which is expressed by the following equation (1).

Figure 0005496717
Figure 0005496717

また、「Q2」は、次式(2)で表される二次のQuarry行列を示しており、「Q2 -1」は次式(3)で表される二次のQuarry逆行列を示している。 “Q 2 ” indicates a quadratic Quarry matrix expressed by the following equation (2), and “Q 2 −1 ” indicates a quadratic Quarry inverse matrix expressed by the following equation (3). Show.

Figure 0005496717
Figure 0005496717

まず、ペダルシステム30や移動体システム50の右システム、左システムの機能について説明する。   First, functions of the right system and the left system of the pedal system 30 and the moving body system 50 will be described.

[オブザーバ]
図4は、ペダルシステム30や移動体システム50の右システム、左システム(図では、単に「システム100」と表記している)の機能を示すブロック線図である。システム100は、アクチュエータ102(ここでは、移動体システム50におけるインホイールモータを含む概念である)と、外乱オブザーバ104と、外力推定オブザーバ106と、を備える。
[Observer]
FIG. 4 is a block diagram showing functions of the right system and the left system (in the figure, simply referred to as “system 100”) of the pedal system 30 and the mobile body system 50. The system 100 includes an actuator 102 (here, a concept including an in-wheel motor in the moving body system 50), a disturbance observer 104, and an external force estimation observer 106.

図4において、θ・・ref、Jn、Ktn、Iref、τdis 、τ^dis、τ^ext、θresは、それぞれ、加速度参照値、慣性モーメントのノミナル値、トルク定数のノミナル値、電流参照値、外乱、推定外乱、推定外力、位置エンコーダにより計測された位置応答を示している。 In FIG. 4, θ ·· ref , J n , K tn , I ref , τ dis , τ ^ dis , τ ^ ext , and θ res are the acceleration reference value, the inertia moment nominal value, and the torque constant nominal value, respectively. , Current reference value, disturbance, estimated disturbance, estimated external force, and position response measured by the position encoder.

アクチュエータ102に入力される電流参照値Irefは、次式(4)で表される。式中、第1項は、加速度参照値θ・・refから導出される電流参照値であり、第2項は、外乱オブザーバ104により推定される推定外乱τ^disから導出される電流参照値(補償電流)である。これによってロバストな加速度制御系が構築される。 The current reference value I ref input to the actuator 102 is expressed by the following equation (4). In the equation, the first term is a current reference value derived from the acceleration reference value θ ·· ref , and the second term is a current reference value derived from the estimated disturbance τ ^ dis estimated by the disturbance observer 104 ( Compensation current). As a result, a robust acceleration control system is constructed.

Figure 0005496717
Figure 0005496717

外乱τdisは、次式(5)で表される。式中、τc、Dθ、J、Ktは、それぞれ、クーロン摩擦、粘性摩擦、慣性モーメントの真値、トルク定数の真値である。そして、推定外力τ^extは、次式(6)で表される。この推定外力τ^extは、操作システム10にあっては、人の操作によってアクチュエータに作用する力を示し、移動体システム50にあっては、環境からインホイールモータに作用する力を示すものである。 The disturbance τ dis is expressed by the following equation (5). In the equation, τ c , Dθ · , J, and K t are the Coulomb friction, the viscous friction, the true value of the moment of inertia, and the true value of the torque constant, respectively. The estimated external force τ ^ ext is expressed by the following equation (6). This estimated external force τ ^ ext indicates the force acting on the actuator by human operation in the operation system 10, and indicates the force acting on the in-wheel motor from the environment in the mobile system 50. is there.

Figure 0005496717
Figure 0005496717

[主要な制御の流れ]
図3に戻り、移動体遠隔操作システム1の主要な制御の流れについて説明する。まず、移動体システム50に入力される加速度参照値θ・・ M,R ref、θ・・ M,L refの生成について説明する。
[Main control flow]
Returning to FIG. 3, the main control flow of the mobile remote control system 1 will be described. First, generation of the acceleration reference values θ ·· M, R ref and θ ·· M, L ref input to the mobile system 50 will be described.

ペダルシステム30の右システム及び左システムには、加速度参照値(目標値)θ・・ P,R ref、θ・・ P,L refと、外乱τP,R dis、τP,L disが入力される(図中、(A))。 Acceleration reference values (target values) θ ·· P, R ref , θ ·· P, L ref and disturbances τ P, R dis , τ P, L dis are input to the right and left systems of the pedal system 30 ((A) in the figure).

右システム及び左システムは、図3において説明した機能により、推定外力τ^P,R ext、τ^P,L ext、及び位置応答θP,R res、θP,L resを出力する(図中、(B))。 The right system and the left system output estimated external forces τ ^ P, R ext , τ ^ P, L ext and position responses θ P, R res , θ P, L res by the function described in FIG. (B)).

位置応答θP,R res、θP,L resは、二次のQuarry行列Q2によって、位置応答の直線運動成分であるθP,tra resと、位置応答の回転運動成分であるθP,rot resに分離される(図中、(C))。次式(7)は、本実施例において、ある成分が、二次のQuarry行列Q2によって直線運動成分と回転運動成分に分離されることを示す一般式である。 The position responses θ P, R res , θ P, L res are obtained by the second-order Quarry matrix Q 2 , θ P, tra res that is the linear motion component of the position response and θ P, tra res that is the rotational motion component of the position response . It is separated into rot res ((C) in the figure). The following equation (7) is a general equation indicating that a certain component is separated into a linear motion component and a rotational motion component by the quadratic Quarry matrix Q 2 in this embodiment.

Figure 0005496717
Figure 0005496717

ペダルシステム30における位置応答の直線運動成分θP,tra resは、移動体システム50における位置応答の直線運動成分θM,tra resと共に二次のQuarry行列Q2によって乗算され、和成分θC,tra resと差成分θD,tra resに分離される(図中、(D))。次式(8)は、本実施例において、ある成分が、二次のQuarry行列Q2によって和の成分と差の成分に分離される様子を示す一般式である。 The linear motion component θ P, tra res of the position response in the pedal system 30 is multiplied by the quadratic Quarry matrix Q 2 together with the linear motion component θ M, tra res of the position response in the mobile system 50 to obtain the sum component θ C, It is separated into tra res and difference components θ D and tra res ((D) in the figure). The following equation (8) is a general equation showing how a certain component is separated into a sum component and a difference component by the quadratic Quarry matrix Q 2 in this embodiment.

Figure 0005496717
Figure 0005496717

なお、この和の成分と差の成分は、和のモード空間と差のモード空間におけるパラメータである。和のモード空間と差のモード空間については、既に(特開2009−279699号公報)等に示されているため、詳細な説明を省略する。   The sum component and the difference component are parameters in the sum mode space and the difference mode space. Since the sum mode space and the difference mode space have already been disclosed in Japanese Patent Laid-Open No. 2009-279699, etc., detailed description thereof will be omitted.

直進運動の差の成分θD,tra resは、操作システム10に対する移動体システム50の変位の遅れを示している。従って、システムへの入力信号を生成する側にフィードバックされる(図中、(E))。 The component θ D, tra res of the difference in linear motion indicates a delay in displacement of the moving body system 50 with respect to the operation system 10. Therefore, it is fed back to the side that generates the input signal to the system ((E) in the figure).

すなわち、位置制御器Cp(s)を経て、直進運動に関する加速度参照値の差の成分θ・・ D,tra resとなる。これが直進運動に関する加速度参照値の差の成分θ・・ D,tra resと共に二次のQuarry逆行列Q2 -1によって乗算されることによって、移動体システム50に入力される直線運動に関する加速度参照値θ・・ M,tra refを得る(図中、(F))。そして、これが回転運動に関する加速度参照値θ・・ M,rot refと共に二次のQuarry逆行列Q2 -1によって乗算されることによって、移動体システム50の右システム及び左システムにそれぞれ入力される加速度参照値θ・・ M,R ref、θ・・ M,L refを得る(図中、(G))。 That is, after passing through the position controller Cp (s), it becomes the component θ ·· D, tra res of the difference of the acceleration reference value relating to the linear motion. This is multiplied by the quadratic Quarry inverse matrix Q 2 −1 together with the difference component θ ·· D, tra res of the acceleration reference value relating to the linear motion, so that the acceleration reference value relating to the linear motion input to the mobile system 50 is obtained. θ ·· M, tra ref is obtained ((F) in the figure). Then, this is multiplied by the quadratic Quarry inverse matrix Q 2 −1 together with the acceleration reference value θ ·· M, rot ref for the rotational motion, whereby the acceleration input to the right system and the left system of the mobile system 50 respectively. Reference values θ ·· M, R ref and θ ·· M, L ref are obtained ((G) in the figure).

これによって、操作システム10に対する移動体システム50の変位の遅れをなくすように、移動体システム50のインホイールモータが加減速される。すなわち、変位の遅れが大きいときに移動体システム50のインホイールモータの出力が大きくなるように制御される。   As a result, the in-wheel motor of the mobile system 50 is accelerated or decelerated so as to eliminate the delay in displacement of the mobile system 50 with respect to the operation system 10. In other words, when the displacement delay is large, the output of the in-wheel motor of the mobile system 50 is controlled to be large.

また、移動体システム50に入力される加速度参照値には、直進運動に関する加速度参照値の和の成分θ・・ D,tra resが反映される。これは、推定外力の直進運動成分τ^C,tra extが力制御器Cfを経たものであり、作用・反作用の法則を成立させるために加味されている。 In addition, the acceleration reference value input to the mobile system 50 reflects the sum component θ ·· D, tra res of the acceleration reference value related to the linear motion. This is because the rectilinear motion component τ ^ C, tra ext of the estimated external force passes through the force controller C f and is taken into account to establish the law of action / reaction.

これによって、人がペダルを漕ぐ力に比して移動体システム50のインホイールモータが環境から受ける力が弱いときには、移動体システム50のインホイールモータの出力が大きくなるように制御される。   As a result, when the force received from the environment by the in-wheel motor of the mobile system 50 is weaker than the force with which the person pedals, the output of the in-wheel motor of the mobile system 50 is controlled to be large.

以上のように、移動体システム50に入力される加速度参照値θ・・ M,R ref、θ・・ M,L refは、位置の追従と作用反作用の成立の2要素が加味されており、これらが移動体システム50の動作を、人の操作を適切に反映したものとしている。 As described above, the acceleration reference values θ ·· M, R ref and θ ·· M, L ref input to the mobile system 50 take into account two elements: position tracking and action / reaction establishment. These appropriately reflect the operation of the mobile system 50 by human operation.

次に、ペダルシステム30に入力される加速度参照値θ・・ P,R ref、θ・・ P,L refの生成について説明する。 Next, generation of the acceleration reference values θ ·· P, R ref and θ ·· P, L ref input to the pedal system 30 will be described.

移動体システム50の右システム及び左システムには、加速度参照値θ・・ M,R ref、θ・・ M,L refと、外乱τM,R dis、τM,L disが入力される(図中、(H))。 Acceleration reference values θ ·· M, R ref , θ ·· M, L ref and disturbances τ M, R dis , τ M, L dis are input to the right system and the left system of the mobile system 50 ( (H) in the figure).

移動体システム50の右システム及び左システムは、図3により説明した機能により、推定外力τ^M,R ext、τ^M,L ext及び位置応答θM,R res、θM,L resを出力する(図中、(I))。 Right systems and the left systems of the mobile system 50, the functions described with reference to FIG 3, the estimated external force τ ^ M, R ext, τ ^ M, L ext and position response theta M, R res, the theta M, L res Output ((I) in the figure).

移動体システム50の推定外力τ^M,R ext、τ^M,L extは、二次のQuarry行列Q2によって、推定外力τ^M,R ext、τ^M,L extの直線運動成分であるτ^M,tra extと、推定外力の回転運動成分であるτ^M,rot extに分離される(図中、(J))。 Estimated external force tau ^ M of mobile systems 50, R ext, τ ^ M , L ext is the secondary Quarry matrix Q 2, linear motion component of the estimated external force τ ^ M, R ext, τ ^ M, L ext Τ ^ M, tra ext and τ ^ M, rot ext which is the rotational motion component of the estimated external force ((J) in the figure).

移動体システム50における推定外力の直線運動成分τ^M,tra extは、ペダルシステム30における推定外力の直線運動成分τ^P,tra extと共に二次のQuarry行列Q2によって乗算され、和成分τ^C,tra extと差成分τ^D,tra extに分離される(図中、(K))。 Linear motion component tau ^ M estimated external force in a mobile system 50, tra ext is linear motion component tau ^ P of the estimated external force in the pedal system 30 is multiplied by the secondary Quarry matrix Q 2 together with the tra ext, sum component tau It is separated into ^ C, tra ext and difference component τ ^ D, tra ext ((K) in the figure).

直進運動に関する推定外力の和成分τ^C,tra extは、ペダルシステム30と移動体システム50の作用・反作用の釣り合い程度を示している。従って、システムへの入力信号を生成する側にフィードバックされる(図中、(L))。 The sum component τ ^ C, tra ext of the estimated external force related to the linear motion indicates the degree of balance between the action and reaction of the pedal system 30 and the moving body system 50. Therefore, it is fed back to the side that generates the input signal to the system ((L) in the figure).

すなわち、力制御器Cfを経て、直進運動に関する加速度参照値の和の成分θ・・ C,tra resとなる。これが直進運動に関する加速度参照値の差の成分θ・・ D,tra resと共に二次のQuarry逆行列Q2 -1によって乗算されることによって、ペダルシステム30に入力される直線運動に関する加速度参照値θ・・ P,tra refとなる(図中、(M))。そして、これが回転運動に関する加速度参照値θ・・ P,rot refと共に二次のQuarry逆行列Q2 -1によって乗算されることによって、ペダルシステム30の右システム及び左システムにそれぞれ入力される加速度参照値θ・・ P,R ref、θ・・ P,L refを得る(図中、(N))。 In other words, the sum component θ ·· C, tra res of the acceleration reference value related to the straight-ahead movement is obtained via the force controller C f . This is multiplied by a second-order Quarry inverse matrix Q 2 −1 together with a component θ ·· D, tra res of a difference in acceleration reference value related to the straight motion, whereby the acceleration reference value θ related to the linear motion input to the pedal system 30 ..P , tra ref ((M) in the figure) Then, this is multiplied by the quadratic Quarry inverse matrix Q 2 −1 together with the acceleration reference value θ ·· P, rot ref related to the rotational motion, whereby the acceleration reference input to the right system and the left system of the pedal system 30 respectively. The values θ ·· P, R ref and θ ·· P, L ref are obtained ((N) in the figure).

これによって、ペダルシステム30と移動体システム50の作用・反作用の釣り合いをとるように、ペダルシステム30のアクチュエータが駆動される。すなわち、移動体システム50が環境から受ける外力が大きいときにアクチュエータの出力が大きくなるように制御される。   As a result, the actuator of the pedal system 30 is driven so as to balance the action / reaction of the pedal system 30 and the moving body system 50. That is, control is performed so that the output of the actuator increases when the external force received by the mobile system 50 from the environment is large.

なお、回転運動については、本実施例では、右ペダル32Aと左ペダル32Bの相対角度がπ[rad]となるように制御されているため、専らステアリングハンドル22によって操作されたものがインホイールモータの出力差として反映される。係る制御においても、直進運動と同様、位置の追従と作用反作用の成立の2要素が加味されて、移動体システム50の出力やステアリングハンドル22に出力する反力が決定される。   In the present embodiment, the rotational motion is controlled so that the relative angle between the right pedal 32A and the left pedal 32B is π [rad], and therefore, what is exclusively operated by the steering handle 22 is the in-wheel motor. It is reflected as the output difference. Also in such control, the output of the mobile body system 50 and the reaction force to be output to the steering handle 22 are determined by taking into account the two elements of the position tracking and the establishment of the action / reaction as in the case of the straight movement.

ここで、本実施例では、右ペダル32Aと左ペダル32Bの相対角度がπ[rad]となるように、θP,rot comを定めている。従って、ペダルシステム30における位置応答の回転運動成分θP,rot resや推定外力の回転運動成分τ^P,rot extはフィードバックさせていない。 Here, in this embodiment, θ P, rot com is determined so that the relative angle between the right pedal 32A and the left pedal 32B is π [rad]. Therefore, the rotational motion component θ P, rot res of the position response in the pedal system 30 and the rotational motion component τ ^ P, rot ext of the estimated external force are not fed back.

しかしながら、本発明の適用対象はこのような態様に限らず、右ペダル32Aと左ペダル32Bにかかる力の差を回転運動に反映させてもよい。こうすれば、例えば右ペダル32Aにより大きく力をかけることにより、移動体システム50を左に旋回させるような運転が可能となる。この場合、例えば位置応答の回転運動成分θP,rot resをθS,rot resθに加算等すればよい。また、ステアリングハンドル22を省略し、右ペダル32Aと左ペダル32Bにかかる力の差のみによって回転運動を実現してもよい。 However, the application target of the present invention is not limited to such an aspect, and a difference in force applied to the right pedal 32A and the left pedal 32B may be reflected in the rotational motion. By doing so, for example, by applying a large force to the right pedal 32A, it is possible to perform an operation such as turning the mobile body system 50 to the left. In this case, for example, the rotational response component θ P, rot res of the position response may be added to θ S, rot res θ. Further, the steering handle 22 may be omitted, and the rotational motion may be realized only by the difference in force applied to the right pedal 32A and the left pedal 32B.

[効果]
以上説明した本発明の第1実施例に係る移動体遠隔操作システム1によれば、ステアリングハンドル22や右ペダル32A、左ペダル32Bには、直進運動指示と回転運動指示の双方を含む操作が可能となっており、バイラテラル制御の少なくとも一部において、直進運動と回転運動のそれぞれについて独立した演算を行っているため、直進運動と回転運動についてのバイラテラル制御を正確に行うことができる。
[effect]
According to the mobile remote control system 1 according to the first embodiment of the present invention described above, the steering handle 22, the right pedal 32A, and the left pedal 32B can be operated including both a straight motion instruction and a rotational motion instruction. Thus, since at least a part of the bilateral control performs independent calculation for each of the linear motion and the rotational motion, the bilateral control for the linear motion and the rotational motion can be accurately performed.

また、二次のQuarry行列を用いて直進運動と回転運動を分離しているため、それぞれについての演算を正確且つ容易に行うことができる。   In addition, since the linear motion and the rotational motion are separated using the quadratic Quarry matrix, the calculation for each can be performed accurately and easily.

[実験]
本出願に係る発明者は、本発明の有用性を実証するための実験を行っている。以下にその結果を示す。
[Experiment]
The inventor according to the present application conducts experiments for demonstrating the usefulness of the present invention. The results are shown below.

本実験では、操作者が移動体遠隔操作システム1の操作システム10を操作し、移動体システム50が平面から人工芝マットに乗り上げた場合における、それぞれのシステムにおける位置や力の変化を計測した。図5は、移動体システム50が平面から人工芝マットに乗り上げる場面を示す外観図である。   In this experiment, when the operator operated the operation system 10 of the mobile remote control system 1 and the mobile system 50 got on the artificial turf mat from the plane, changes in position and force in each system were measured. FIG. 5 is an external view showing a scene in which the moving body system 50 rides on the artificial grass mat from the plane.

図6は、第1実施例に係る移動体遠隔操作システム1を用いた実験におけるパラメータを示す図である。図中、上記で説明されていないパラメータについて説明する。「st」は制御周期を示し、「gdis」は外乱オブザーバのカットオフ周波数を示し、「greac」は反力推定オブザーバのカットオフ周波数を示している。 FIG. 6 is a diagram showing parameters in an experiment using the mobile remote control system 1 according to the first example. In the figure, parameters not described above will be described. “S t ” indicates the control period, “g dis ” indicates the cutoff frequency of the disturbance observer, and “g reac ” indicates the cutoff frequency of the reaction force estimation observer.

実験における0[s]〜10[s]までの期間は、操作者がシステムに触れず、制御的クランク機構を構築するための期間とした。この期間におけるペダルシステム30への指令値θP,rot comは、次式(9)で表される。 The period from 0 [s] to 10 [s] in the experiment was a period for constructing the controllable crank mechanism without the operator touching the system. The command value θ P, rot com to the pedal system 30 during this period is expressed by the following equation (9).

Figure 0005496717
Figure 0005496717

実験開始から10[s]経過した後は、指令値θP,rot comをπ[rad]で固定し、自転車のペダルのように操作しやすいものとした。従って、元々同じ回転角であった右ペダル32A、左ペダル32Bの相対角度が徐々に開いていき、π[rad]に至ると相対的にロックされることになる。図7は、右ペダル32Aと左ペダル32Bの相対角度の変化を示す図である。 After 10 [s] has elapsed from the start of the experiment, the command value θ P, rot com is fixed at π [rad] so that it can be operated easily like a bicycle pedal. Therefore, the relative angles of the right pedal 32A and the left pedal 32B, which originally have the same rotation angle, gradually open and are relatively locked when reaching π [rad]. FIG. 7 is a diagram illustrating a change in the relative angle between the right pedal 32A and the left pedal 32B.

図8は、直進運動に関する、操作システム10と移動体システム50の、それぞれの位置応答及び力応答(実際は、推定値である)の変化を示している。図示するように、実験開始から16[s]程度のタイミングで移動体システム50は人工芝から反発を受けて後退している。同じタイミングで環境(人工芝マット)から移動体システム50が受ける外力、及びペダルシステム30に出力される反力は、符号が反転していることが判る。直進運動に関して、本実施例の移動体遠隔操作システム1では、位置、力共に十分正確な追従がなされていることが判る。   FIG. 8 shows changes in position response and force response (actually estimated values) of the operation system 10 and the mobile system 50 with respect to the straight movement. As shown in the figure, the mobile system 50 is retreated from the artificial turf at a timing of about 16 [s] from the start of the experiment. It can be seen that the signs of the external force received by the moving body system 50 from the environment (artificial grass mat) and the reaction force output to the pedal system 30 at the same timing are reversed. It can be seen that with respect to the straight movement, the mobile remote control system 1 according to the present embodiment is sufficiently accurately following both the position and the force.

また、図9は、回転運動に関する、操作システム10と移動体システム50の、それぞれの位置応答及び力応答(実際は、推定値である)の変化を示している。図示するように、移動体システム50は人工芝から反発を受けて後退したタイミングで、環境から移動体システム50が受ける外力(この場合、回転力)、及びステアリングシステム10に出力される反力は、符号が反転していることが判る。回転運動に関しても、本実施例の移動体遠隔操作システム1では、位置、力共に十分正確な追従がなされていることが判る。   Moreover, FIG. 9 has shown the change of each position response and force response (actually it is an estimated value) of the operation system 10 and the mobile body system 50 regarding rotational motion. As shown in the figure, the external force (in this case, rotational force) received by the mobile body system 50 from the environment and the reaction force output to the steering system 10 at the timing when the mobile body system 50 retreats after receiving a reaction from the artificial turf. It can be seen that the sign is inverted. Regarding the rotational motion, it can be seen that the mobile remote control system 1 of the present embodiment is sufficiently accurate in both position and force.

[制御の他の例]
なお、二次のQuarry行列を用いて直進運動と回転運動を分離して行うバイラテラル制御においては、直進運動と回転運動に関して、位置制御と力制御の組み合わせを任意に選択可能である。
[Other examples of control]
In bilateral control in which linear motion and rotational motion are separated using a quadratic Quarry matrix, a combination of position control and force control can be arbitrarily selected for linear motion and rotational motion.

図10は、直進運動と回転運動の双方について位置制御を行う場合のブロック線図であり、図11は、直進運動と回転運動の双方について力制御を行う場合のブロック線図であり、図12は、直進運動について位置制御を行い、回転運動について力制御を行う場合のブロック線図であり、図13は、直進運動について力制御を行い、回転運動について位置制御を行う場合のブロック線図である。なお、図10〜図13においては、和と差のモード空間については図示を省略している。   FIG. 10 is a block diagram in the case where position control is performed for both linear motion and rotational motion, and FIG. 11 is a block diagram in the case where force control is performed for both linear motion and rotational motion. Fig. 13 is a block diagram in the case where position control is performed for linear motion and force control is performed for rotational motion. Fig. 13 is a block diagram in the case where force control is performed for linear motion and position control is performed for rotational motion. is there. In FIGS. 10 to 13, the sum and difference mode spaces are not shown.

このように、二次のQuarry行列を用いて直進運動と回転運動を分離してバイラテラル制御を行う場合、直進運動と回転運動のそれぞれについて非干渉な制御体系を構築することができる。   As described above, when bilateral control is performed by separating the linear motion and the rotational motion using the quadratic Quarry matrix, a non-interfering control system can be constructed for each of the linear motion and the rotational motion.

<<第2実施例>>
以下、図面を参照し、本発明の第2実施例に係る環境情報収集システムについて説明する。本実施例の環境情報収集システムは、第1実施例の移動体遠隔操作システムを複数個備え、各移動体遠隔操作システムにおいて取得された環境情報(環境から受けた反力等)を情報収集サーバで収集し、情報収集サーバにおいてマッピング情報を生成するものである。
<< Second Example >>
Hereinafter, an environment information collecting system according to a second embodiment of the present invention will be described with reference to the drawings. The environmental information collection system of the present embodiment includes a plurality of mobile remote control systems of the first embodiment, and information collection servers collect environmental information (such as reaction force received from the environment) acquired in each mobile remote control system. And the mapping information is generated in the information collection server.

図14は、本発明の第2実施例に係る環境情報収集システム200のシステム構成例である。図示するように、環境情報収集システム200は、複数個の移動体遠隔操作システム1#1〜1#nと、情報管理サーバ300と、を備える。   FIG. 14 is a system configuration example of an environment information collection system 200 according to the second embodiment of the present invention. As shown in the figure, the environment information collection system 200 includes a plurality of mobile remote operation systems 1 # 1 to 1 # n and an information management server 300.

各移動体遠隔操作システムは、第1実施例で説明したように、操作システム10と移動体システム50の間でバイラテラル制御を行う。バイラテラル制御は、制御装置60により実行される。制御装置60は、操作システム10と移動体システム10のいずれかに併設されてもよいし、別体であってもよい。   Each mobile remote control system performs bilateral control between the operation system 10 and the mobile system 50 as described in the first embodiment. Bilateral control is executed by the control device 60. The control device 60 may be provided in either the operation system 10 or the mobile body system 10 or may be a separate body.

更に、第2実施例では、各移動体遠隔操作システムは、路面状態提示端末70を備える。   Furthermore, in the second embodiment, each mobile remote control system includes a road surface state presentation terminal 70.

また、第2実施例に係る移動体システム50には、GPS(Global Positioning System)受信機59が搭載される。なお、GPSに代えて、GLONASSや、Galileoに係る装置を用いてもよい。   In addition, a GPS (Global Positioning System) receiver 59 is mounted on the mobile system 50 according to the second embodiment. Instead of GPS, a device related to GLONASS or Galileo may be used.

GPS受信機59は、GPSアンテナによってGPS衛星が送信する電波を受信し、これを復調して当該電波に含まれる航法メッセージを取り出す。航法メッセージは、衛星軌道に関する情報や衛星時計の補正値、電離層の補正係数、衛星自身の動作状態を示すヘルスメッセージ等を含んでいる。   The GPS receiver 59 receives a radio wave transmitted from a GPS satellite by a GPS antenna, demodulates it, and extracts a navigation message included in the radio wave. The navigation message includes information on the satellite orbit, the correction value of the satellite clock, the correction coefficient of the ionosphere, the health message indicating the operation state of the satellite itself, and the like.

そして、GPS受信機59は、複数のGPS衛星からの航法メッセージを解析し、移動体システム50の位置(緯度、経度、及び高度をいう)を特定する。具体的には、航法メッセージに含まれる衛星軌道の情報等から各GPS衛星のワールド座標系(例えばWGS84)における位置(Xs,Ys,Zs)を算出し、電波の到達時間(到達時刻−発信時刻)に光速を乗じて各GPS衛星と移動体システム50との間の擬似距離を算出し、複数のGPS衛星について算出される擬似距離及び位置を用いて、三角測量の原理により移動体システム50の位置を算出する。なお、係るGPS演算を行うのは、制御装置60側であっても構わない。   Then, the GPS receiver 59 analyzes navigation messages from a plurality of GPS satellites, and specifies the position of the mobile system 50 (referring to latitude, longitude, and altitude). Specifically, the position (Xs, Ys, Zs) of each GPS satellite in the world coordinate system (for example, WGS84) is calculated from the satellite orbit information included in the navigation message, and the arrival time of radio waves (arrival time-transmission time) ) Is multiplied by the speed of light to calculate a pseudorange between each GPS satellite and the mobile system 50, and using the pseudorange and position calculated for a plurality of GPS satellites, the principle of triangulation is used. Calculate the position. The GPS calculation may be performed on the control device 60 side.

図15は、本発明の第2実施例に係る移動体遠隔操作システム200が有する制御系の構成要素を示すブロック図である。制御装置60は、第1実施例で説明したようなオブザーバの機能を有しており、操作システム10や移動体システム50の位置エンコーダから入力される値に基づいて、推定外乱や推定外力を算出している。そして、これらの算出値に基づいて操作システム10のアクチュエータや移動体システム50のインホイールモータに各種参照値を出力することにより、バイラテラル制御を行う。   FIG. 15 is a block diagram showing components of a control system included in the mobile remote control system 200 according to the second embodiment of the present invention. The control device 60 has an observer function as described in the first embodiment, and calculates an estimated disturbance and an estimated external force based on values input from the position encoders of the operation system 10 and the moving body system 50. doing. Then, bilateral control is performed by outputting various reference values to the actuator of the operation system 10 and the in-wheel motor of the moving body system 50 based on these calculated values.

路面状態提示端末70は、例えば液晶ディスプレイ装置であり、制御装置60によって表示画面が制御される。   The road surface state presentation terminal 70 is, for example, a liquid crystal display device, and the display screen is controlled by the control device 60.

制御装置60は、上記のオブザーバ機能やバイラテラル制御機能に加えて、マッピング情報管理のための機能を有している。   The control device 60 has a function for managing mapping information in addition to the above observer function and bilateral control function.

まず、マッピング情報管理機能のうち情報収集・提供機能について説明する。この機能は、オブザーバ機能において算出された推定外乱や推定外力を、その時点においてGPS受信機59により特定された移動体システム50の位置と共に(或いは位置を連ねた走行経路と共に)、情報管理サーバ300に送信する。   First, the information collecting / providing function of the mapping information management function will be described. This function uses the estimated disturbance or estimated external force calculated by the observer function together with the position of the mobile system 50 specified by the GPS receiver 59 at that time (or along with the travel route connecting the positions), and the information management server 300. Send to.

各移動体遠隔装置システムと情報管理サーバ300との情報の送受信は、例えば携帯電話やPHS等の無線通信ネットワークやインターネット等を介して行われる。また、これに限らず、各移動体遠隔装置システムと情報管理サーバ300が通信線によって接続されても構わない。なお、各移動体遠隔装置システムの操作システム10、制御装置60、及び路面状態提示端末70と情報管理サーバ300は、同じ施設内に設置される場合もあり得る。この場合、移動体システム50のみが施設外を移動し、操作システム10と移動体システム50の情報送受信は無線通信で行われる。   Transmission / reception of information between each mobile remote device system and the information management server 300 is performed via a wireless communication network such as a mobile phone or PHS, the Internet, or the like. Not limited to this, each mobile remote device system and the information management server 300 may be connected by a communication line. In addition, the operation system 10, the control device 60, the road surface state presentation terminal 70, and the information management server 300 of each mobile remote device system may be installed in the same facility. In this case, only the mobile system 50 moves outside the facility, and information transmission / reception between the operation system 10 and the mobile system 50 is performed by wireless communication.

情報管理サーバ300は、各移動体遠隔装置システムから受信した情報を統合し、所定のマップ上にマッピングされた推定外乱や推定外力の情報(以下、マッピング情報と称する)を生成する。   The information management server 300 integrates information received from each mobile remote device system, and generates estimated disturbance and estimated external force information (hereinafter referred to as mapping information) mapped on a predetermined map.

次に、マッピング情報管理機能のうち路面状態提示機能について説明する。制御装置60は、地図データが記憶された記憶装置62を備える。そして、所望のタイミングで情報管理サーバ300からマッピング情報を取得し、当該移動体遠隔装置システムを操作する人に路面状態を提示する。   Next, the road surface state presentation function of the mapping information management function will be described. The control device 60 includes a storage device 62 in which map data is stored. Then, mapping information is acquired from the information management server 300 at a desired timing, and the road surface state is presented to the person who operates the mobile remote device system.

路面状態の提示は、例えば、地図データから生成される模擬画像上に、外乱や外力を生じさせる障害物の位置をアイコン等によって表示する。   In the presentation of the road surface state, for example, the position of an obstacle that causes a disturbance or an external force is displayed by an icon or the like on a simulated image generated from map data.

これによって、移動体遠隔装置システムを操作する人は、移動体システム50の進路上に障害物等が存在するか否かを検知することができ、スムーズに移動体システム50を移動させることができる。   Thus, a person operating the mobile remote device system can detect whether an obstacle or the like is present on the path of the mobile system 50 and can move the mobile system 50 smoothly. .

以上説明した本実施例の環境情報収集システム200によれば、他のシステムにおいて収集された外乱や外力を生じさせる障害物の位置等に関する情報を、移動体遠隔装置システムの操作者に提供することができる。この結果、当該操作する人は、移動体システム50の進路上に障害物等が存在するか否かを検知することができ、スムーズに移動体システム50を移動させることができる。   According to the environmental information collection system 200 of the present embodiment described above, information on the position of an obstacle that causes disturbance or external force collected in another system is provided to the operator of the mobile remote device system. Can do. As a result, the person who operates can detect whether there is an obstacle or the like on the path of the mobile system 50 and can move the mobile system 50 smoothly.

以上、本発明を実施するための最良の形態について実施例を用いて説明したが、本発明はこうした実施例に何等限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々の変形及び置換を加えることができる。   The best mode for carrying out the present invention has been described above with reference to the embodiments. However, the present invention is not limited to these embodiments, and various modifications can be made without departing from the scope of the present invention. And substitutions can be added.

1 移動体遠隔操作システム
10 操作システム
20 ステアリングシステム
30 ペダルシステム
22 ステアリングハンドル
24 ステアリングアクチュエータ
32A 右ペダル
32B 左ペダル
34A、34B ペダルアクチュエータ
50 移動体システム
52 本体部
54A 右の主車輪
54B 左の主車輪
56A、56B インホイールモータ
58 補助車輪
59 GPS受信機
60 制御装置
62 記憶装置
70 路面状態提示端末
100 システム
102 アクチュエータ
104 外乱オブザーバ
106 外力推定オブザーバ
200 環境情報収集システム
300 情報管理サーバ
DESCRIPTION OF SYMBOLS 1 Mobile body remote operation system 10 Operation system 20 Steering system 30 Pedal system 22 Steering handle 24 Steering actuator 32A Right pedal 32B Left pedal 34A, 34B Pedal actuator 50 Mobile body system 52 Main body part 54A Right main wheel 54B Left main wheel 56A 56B In-wheel motor 58 Auxiliary wheel 59 GPS receiver 60 Control device 62 Storage device 70 Road surface state presentation terminal 100 System 102 Actuator 104 Disturbance observer 106 External force estimation observer 200 Environmental information collection system 300 Information management server

Claims (5)

人が操作を行う操作デバイスを有する操作システムと、
前記操作システムに対してなされた人の操作に基づいて駆動される移動体システムと、
を備え、
前記操作デバイスには、前記移動体システムが環境から受けた反力を再現するためのアクチュエータが取り付けられ、前記操作システムと前記移動体システムとの間でバイラテラル制御が行われる移動体遠隔操作システムであって、
前記操作デバイスには、直進運動指示と回転運動指示の双方を含む操作が可能となっており、
前記バイラテラル制御の前記操作システムと、前記移動体システムと、において二次のQuarry行列を用いて直進運動と、回転運動と、に分離する演算を行い、
前記演算によって分離された前記操作システムの直線運動の成分と、前記演算によって分離された前記移動体システムの直線運動の成分と、を二次のQuarry行列で乗算することを特徴とする、
移動体遠隔操作システム。
An operation system having an operation device for human operation;
A mobile system driven based on a human operation performed on the operation system;
With
An actuator for reproducing the reaction force received by the mobile system from the environment is attached to the operating device, and a mobile remote control system in which bilateral control is performed between the operating system and the mobile system Because
The operation device can be operated including both a linear motion instruction and a rotational motion instruction,
In the operation system of the bilateral control and the mobile system, a calculation is performed to separate a linear motion and a rotational motion using a quadratic Quarry matrix,
The second-order Quarry matrix multiplies the linear motion component of the operating system separated by the computation and the linear motion component of the mobile system separated by the computation ,
Mobile remote control system.
前記操作デバイスは、相対角度の目標値をπ[rad]として制御される一対のペダルを含む、
請求項に記載の移動体遠隔操作システム。
The operation device includes a pair of pedals controlled with a target value of a relative angle as π [rad].
The mobile remote control system according to claim 1 .
前記操作デバイスは、回転運動を指示する操作が可能なステアリング手段を含む、
請求項1または2に記載の移動体遠隔操作システム。
The operation device includes a steering means capable of instructing a rotational movement,
The mobile remote control system according to claim 1 or 2 .
前記移動体システムは、左右独立して駆動可能な一対の車輪を含む、
請求項1ないしのいずれか1項に記載の移動体遠隔操作システム。
The mobile system includes a pair of wheels that can be driven independently on the left and right sides.
The mobile remote control system according to any one of claims 1 to 3 .
請求項1ないしのいずれか1項に記載の移動体遠隔操作システムを複数個備え、
各移動体遠隔操作システムは、自己が有する移動体システムの位置を特定可能に構成されており、
各移動体遠隔操作システムにおいて取得された環境情報と、該環境情報が取得された際の移動体システムの位置とを収集し、位置に対応づけられた環境情報を生成する情報収集サーバを備えることを特徴とする、
環境情報収集システム。
A plurality of mobile remote control systems according to any one of claims 1 to 4 ,
Each mobile remote control system is configured to be able to identify the position of the mobile system that it has,
An information collection server is provided that collects environmental information acquired in each mobile remote control system and the position of the mobile system when the environmental information is acquired, and generates environmental information associated with the position. Characterized by the
Environmental information collection system.
JP2010056240A 2010-03-12 2010-03-12 Mobile remote control system, environmental information collection system Active JP5496717B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2010056240A JP5496717B2 (en) 2010-03-12 2010-03-12 Mobile remote control system, environmental information collection system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010056240A JP5496717B2 (en) 2010-03-12 2010-03-12 Mobile remote control system, environmental information collection system

Publications (2)

Publication Number Publication Date
JP2011189438A JP2011189438A (en) 2011-09-29
JP5496717B2 true JP5496717B2 (en) 2014-05-21

Family

ID=44794901

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010056240A Active JP5496717B2 (en) 2010-03-12 2010-03-12 Mobile remote control system, environmental information collection system

Country Status (1)

Country Link
JP (1) JP5496717B2 (en)

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08319631A (en) * 1995-05-24 1996-12-03 Yanmar Diesel Engine Co Ltd Safety operation structure of working equipment
JP3564696B2 (en) * 1998-12-25 2004-09-15 トヨタ自動車株式会社 Vehicle steering control device
GB2372020A (en) * 2001-02-07 2002-08-14 Lucas Industries Ltd Haptic controller for electrically-assisted power steering in road vehicles
JP4613330B2 (en) * 2001-04-17 2011-01-19 学校法人慶應義塾 Master-slave device, control method, and computer program
JP2004009188A (en) * 2002-06-05 2004-01-15 Keio Gijuku Master device and master slave device
JPWO2005069095A1 (en) * 2004-01-20 2007-08-23 株式会社日立製作所 Bilateral servo controller
JP4701400B2 (en) * 2006-07-31 2011-06-15 国立大学法人長岡技術科学大学 Motion learning system and control method thereof
JP2008119757A (en) * 2006-11-08 2008-05-29 Ntt Docomo Inc Master-slave device, master device, slave device, control method, and computer program
JP2009279699A (en) * 2008-05-21 2009-12-03 Nagaoka Univ Of Technology Position-force reproducing method and position-force reproducing device
JP5008611B2 (en) * 2008-06-27 2012-08-22 カルソニックカンセイ株式会社 Vehicle display device

Also Published As

Publication number Publication date
JP2011189438A (en) 2011-09-29

Similar Documents

Publication Publication Date Title
CN107816976B (en) Method and device for determining position of approaching object
JP6852638B2 (en) Self-driving vehicle dispatch system, self-driving vehicle, and vehicle dispatch method
US20200049835A1 (en) Satellite signal calibration system
US20190004524A1 (en) System and method for planning a vehicle path
KR102047945B1 (en) Longitudinal cascaded controller preset for autonomous vehicle control to reenter autonomous mode
JP2020534203A (en) Fault tolerance control of autonomous vehicles using multiple control lanes
CN112566835B (en) Steering control method and steering control device
JP2009536722A (en) Navigation device and method for continuous map display
US11608087B2 (en) Transitioning steering control from an autonomous vehicle to a driver
EP3805066A1 (en) Safe transition from autonomous-to-manual driving mode with assistance of autonomous driving system
CN105190356A (en) Heading, velocity, and position estimation with vehicle sensors, mobile device, and GNSS inputs
CN101395446A (en) A navigation device and method for storing and utilizing a last docked location
JP2011521211A (en) Navigation device and method for displaying a still image of an approaching location along a travel route
McKinney et al. Components of an autonomous all-terrain vehicle
JP5496717B2 (en) Mobile remote control system, environmental information collection system
JP6366182B2 (en) Remote control system and remote control method
US11447154B2 (en) Vehicle travel system
Drage Development of a navigation control system for an autonomous formula sae-electric race car
US11340075B2 (en) Information processing device, non-transitory computer readable storage medium storing program and small size vehicle
JP2021018636A (en) Vehicle remote instruction system
JP6996820B2 (en) Display device for remote control and display method for remote control
CN115556769A (en) Obstacle state quantity determination method and device, electronic device and medium
US20200117209A1 (en) Small size vehicle
WO2010040384A1 (en) Navigation apparatus having a three-dimensional display
JP7275369B2 (en) VEHICLE, VEHICLE CONTROL METHOD AND VEHICLE CONTROL PROGRAM

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130222

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20131126

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140122

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20140305

R150 Certificate of patent or registration of utility model

Ref document number: 5496717

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250