JP6915442B2 - Motion information display system for moving objects - Google Patents
Motion information display system for moving objects Download PDFInfo
- Publication number
- JP6915442B2 JP6915442B2 JP2017155540A JP2017155540A JP6915442B2 JP 6915442 B2 JP6915442 B2 JP 6915442B2 JP 2017155540 A JP2017155540 A JP 2017155540A JP 2017155540 A JP2017155540 A JP 2017155540A JP 6915442 B2 JP6915442 B2 JP 6915442B2
- Authority
- JP
- Japan
- Prior art keywords
- acceleration
- moving body
- angular velocity
- information mark
- display
- 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
Links
- 230000001133 acceleration Effects 0.000 claims description 375
- 230000002194 synthesizing effect Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 11
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 10
- 238000001514 detection method Methods 0.000 description 4
- 238000006073 displacement reaction Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 238000000034 method Methods 0.000 description 4
- 230000009182 swimming Effects 0.000 description 2
- 239000012530 fluid Substances 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
- Position Input By Displaying (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本発明は、移動体の3軸の加速度(サージ加速度、スウェイ加速度、ヒーブ加速度)を含む運動情報を表示する移動体の運動情報表示システムに関するものである。 The present invention relates to a moving body motion information display system that displays motion information including three-axis acceleration (surge acceleration, sway acceleration, heave acceleration) of the moving body.
移動体の遠隔操作方法としては、移動体に搭載した撮像装置により移動体前方の環境を撮像して遠隔地のオペレータに送信し、オペレータ側では移動体より受信した画像情報をモニタに表示して、この画像を目視しながらジョイスティック、十字キー等の操作部にて移動体の目標速度、方向等を指令する手法が多く採用されている。 As a remote operation method of the moving body, the environment in front of the moving body is imaged by the imaging device mounted on the moving body and transmitted to the operator at a remote place, and the operator side displays the image information received from the moving body on the monitor. , A method of commanding a target speed, direction, etc. of a moving body by an operation unit such as a joystick or a cross key while visually observing this image is often adopted.
また、移動体に搭載されたセンサによって取得した情報を、前記モニタに表示することも提案されている(たとえば、特許文献1参照)。 It has also been proposed to display the information acquired by the sensor mounted on the moving body on the monitor (see, for example, Patent Document 1).
なお、遠隔操作方式の移動体としては、陸上を移動する形式の移動体のほかに、ROV(Remotely operated vehicle)といわれる水中を遊泳する形式の移動体や、無人航空機やドローンといわれる空中を飛行する形式の移動体が知られている。 As remote-controlled mobiles, in addition to mobiles that move on land, ROVs (Remotely operated vehicles) that swim in water, and unmanned aerial vehicles and drones that fly in the air. There are known mobiles in the form of a vehicle.
ところで、遠隔操作方式の移動体のうち、特許文献1に示されているような陸上を移動する形式の移動体は、地面や床面に常に接していて、この地面や床面との摩擦を利用して、静止状態における位置保持、および、前進、後退、左右への旋回などの移動を行っている。
By the way, among the remote-controlled moving bodies, the moving body of the type that moves on land as shown in
そのため、陸上を移動する形式の移動体の場合は、その使用環境に気流が存在していても、その気流が外乱として作用して、移動体に意図しない前後方向や左右方向の加速度が生じることは少ない。したがって、陸上を移動する形式の移動体は、意図しない加速度の影響で、移動体が目標位置から前後方向や、左右方向にずれるということはほとんどない。 Therefore, in the case of a moving body that moves on land, even if there is an air flow in the usage environment, the air flow acts as a disturbance, causing unintended acceleration in the front-back direction and the left-right direction of the moving body. Is few. Therefore, in a moving body that moves on land, the moving body rarely shifts from the target position in the front-rear direction or the left-right direction due to the influence of unintended acceleration.
そのため、陸上を移動する形式の移動体の遠隔操作では、移動体に生じる加速度の情報はそれほど重要な意味を持たない。 Therefore, in the remote control of a moving body in the form of moving on land, the information on the acceleration generated in the moving body is not so important.
これに対し、水中を遊泳する形式の移動体や、空中を飛行する形式の移動体は、使用環境に存在する流体の流れである水流や気流の影響を外乱として受けると、遠隔操作による移動体のホバリングによる定点保持中や、移動中であっても、移動体には、意図しない左右方向、上下方向、前後方向の加速度が生じたり、加速度の変化が生じたりすることがある。このような意図しない加速度の発生や、加速度の変化の発生は、移動体の位置や運動の制御性の低下につながる。 On the other hand, a moving body that swims in water or a moving body that flies in the air is a moving body that is remotely controlled when it is affected by the water flow or airflow, which is the flow of fluid existing in the usage environment. Even while holding a fixed point by hovering or moving, the moving body may experience unintended left-right, up-down, and front-back accelerations or changes in acceleration. The occurrence of such unintended acceleration or change in acceleration leads to a decrease in controllability of the position and movement of the moving body.
そのため、水中を遊泳する形式の移動体や、空中を飛行する形式の移動体のような3次元空間を移動する移動体については、移動体に生じる3軸の加速度(サージ加速度、スウェイ加速度、ヒーブ加速度)を知ることが、遠隔操作によって移動体の位置や運動を制御する場合に重要になる。 Therefore, for a moving body that moves in three-dimensional space, such as a moving body that swims in water or a moving body that flies in the air, the three-axis acceleration (surge acceleration, sway acceleration, heave) that occurs in the moving body Knowing the acceleration) is important when controlling the position and movement of a moving object by remote control.
なお、移動体に加速度センサを搭載して3軸の加速度(サージ加速度、スウェイ加速度、ヒーブ加速度)を検出し、その検出結果を遠隔操作装置側で、個々に数値で表示するようにすれば、オペレータが、移動体に生じる左右方向、上下方向、前後方向の各加速度を知ることはできると考えられる。 If an acceleration sensor is mounted on the moving body to detect accelerations of three axes (surge acceleration, sway acceleration, heave acceleration) and the detection results are individually displayed numerically on the remote control device side, It is considered that the operator can know each acceleration in the left-right direction, the up-down direction, and the front-back direction generated in the moving body.
しかし、移動体の左右方向、上下方向、前後方向の各加速度について、個々の数値を単に表示する構成では、オペレータは、移動体の遠隔操作を行いながら、表示された3つの数値を読み取る必要が生じてしまう。更に、オペレータは、読み取った3つの数値を基に、3軸の加速度(サージ加速度、スウェイ加速度、ヒーブ加速度)の合成によって移動体に作用する影響を推定しなければならない。 However, in a configuration in which individual numerical values are simply displayed for each acceleration in the horizontal, vertical, and front-rear directions of the moving body, the operator needs to read the three displayed numerical values while remotely controlling the moving body. It will occur. Furthermore, the operator must estimate the effect on the moving body by synthesizing the accelerations of the three axes (surge acceleration, sway acceleration, and heave acceleration) based on the three numerical values read.
そこで、本発明は、3次元空間を移動する移動体について、移動体の3軸の加速度(サージ加速度、スウェイ加速度、ヒーブ加速度)の情報を、数値に依らずに統合して表示することができる、移動体の運動情報表示システムを提供しようとするものである。 Therefore, the present invention can integrate and display information on the accelerations (surge acceleration, sway acceleration, heave acceleration) of the three axes of the moving body for the moving body moving in the three-dimensional space, regardless of the numerical value. , It is intended to provide a motion information display system for a moving body.
本発明は、前記課題を解決するために、移動体に、前記移動体の3軸の加速度を検出する加速度センサと、通信装置と、を備え、前記移動体の遠隔操作装置に、前記移動体の前記通信装置との通信を行う通信装置と、表示制御装置と、表示部と、を備え、前記表示制御装置は、加速度情報表示機能として、前記表示部の画面に、加速度情報マークを表示する機能と、前記表示部の画面に設定された二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで検出される前記移動体の左右方向の加速度に対応してX軸方向に変位させる機能と、前記表示部の画面に設定された前記二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで検出される前記移動体の上下方向の加速度に対応してY軸方向に変位させる機能と、前記表示部の画面に表示する前記加速度情報マークのサイズを、前記加速度センサで検出される前記移動体の前後方向の加速度に対応して拡大、縮小する機能と、を備える移動体の運動情報表示システムとする。 In order to solve the above problems, the present invention provides the moving body with an acceleration sensor for detecting the acceleration of the three axes of the moving body and a communication device, and the remote control device of the moving body is provided with the moving body. The display control device includes a communication device that communicates with the communication device, a display control device, and a display unit, and the display control device displays an acceleration information mark on the screen of the display unit as an acceleration information display function. With the function and the two-dimensional coordinates set on the screen of the display unit, the position of the center of the acceleration information mark is set in the X-axis direction corresponding to the lateral acceleration of the moving body detected by the acceleration sensor. With the function of shifting to and the two-dimensional coordinates set on the screen of the display unit, the position of the center of the acceleration information mark corresponds to the vertical acceleration of the moving body detected by the acceleration sensor. A function to displace in the Y-axis direction and a function to enlarge or reduce the size of the acceleration information mark displayed on the screen of the display unit in accordance with the acceleration in the front-rear direction of the moving body detected by the acceleration sensor. And, it is a moving body motion information display system.
前記表示制御装置の前記加速度情報表示機能は、前記表示部の画面に設定された前記二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで前記移動体の左向きの加速度が検出されるときには、X軸の正の方向に変位させ、前記加速度センサで前記移動体の右向きの加速度が検出されるときには、X軸の負の方向に変位させる機能と、前記表示部の画面に設定された前記二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで前記移動体の下向きの加速度が検出されるときには、Y軸の正の方向に変位させ、前記加速度センサで前記移動体の上向きの加速度が検出されるときには、Y軸の負の方向に変位させる機能と、前記表示部の画面に表示する前記加速度情報マークを、前記加速度センサで前記移動体の前向きの加速度が検出されるときには、サイズを拡大し、前記加速度センサで前記移動体の後向きの加速度が検出されるときには、サイズを縮小する機能と、を備える構成としてある。 The acceleration information display function of the display control device measures the position of the center of the acceleration information mark at the two-dimensional coordinates set on the screen of the display unit, and the acceleration sensor determines the leftward acceleration of the moving body. When detected, it is displaced in the positive direction of the X-axis, and when the acceleration sensor detects the rightward acceleration of the moving body, it is displaced in the negative direction of the X-axis, and the screen of the display unit is displayed. When the acceleration sensor detects the downward acceleration of the moving body, the position of the center of the acceleration information mark is displaced in the positive direction of the Y-axis at the set two-dimensional coordinates, and the acceleration sensor. When the upward acceleration of the moving body is detected, the function of shifting the moving body in the negative direction and the acceleration information mark displayed on the screen of the display unit are displayed by the acceleration sensor in the forward direction of the moving body. The configuration includes a function of increasing the size when an acceleration is detected and a function of reducing the size when the acceleration sensor detects a backward acceleration of the moving body.
前記移動体に、前記移動体のヨー角方向の角速度とピッチ角方向の角速度を検出する角速度センサを備え、前記表示制御装置は、角速度情報表示機能として、前記角速度センサで検出された前記移動体のヨー角方向の角速度とピッチ角方向の角速度とを合成して前記移動体の回頭方向、および、該回頭方向の角速度を求める機能と、得られた前記回頭方向とその角速度の大きさに対応して、前記加速度情報表示機能で中心の位置とサイズが設定された前記加速度情報マークに接する位置と、該加速度情報マークに対する扁平する量が定められた角速度情報マークを生成する機能と、生成された前記角速度情報マークを、前記加速度情報マークに付属させて、前記表示部の画面に表示する機能と、を備える構成としてある。 The moving body is provided with an angular velocity sensor that detects an angular velocity in the yaw angle direction and an angular velocity in the pitch angle direction of the moving body, and the display control device has the moving body detected by the angular velocity sensor as an angular velocity information display function. Corresponds to the function of synthesizing the angular velocity in the yaw angle direction and the angular velocity in the pitch angular direction to obtain the turning direction of the moving body and the angular velocity in the turning direction, and the obtained turning direction and the magnitude of the angular velocity. Then, a function to generate an angular velocity information mark in which the position in contact with the acceleration information mark whose center position and size are set by the acceleration information display function and the amount of flattening with respect to the acceleration information mark are determined is generated. The angular velocity information mark is attached to the acceleration information mark and displayed on the screen of the display unit.
前記移動体に備える前記角速度センサが、前記移動体のロール角方向の角速度を検出する機能を備え、前記表示制御装置の角速度情報表示機能は、前記表示部の画面に、前記角速度センサで検出された前記移動体のロール角方向の角速度に対応して角度姿勢が変化する別の角速度情報マークを表示する機能を備えた構成としてある。 The angular velocity sensor provided in the moving body has a function of detecting the angular velocity in the roll angle direction of the moving body, and the angular velocity information display function of the display control device is detected by the angular velocity sensor on the screen of the display unit. The configuration is provided with a function of displaying another angular velocity information mark whose angular velocity changes according to the angular velocity in the roll angular direction of the moving body.
本発明の移動体の運動情報表示システムによれば、移動体の3軸の加速度の情報を、数値に依らずに統合して表示することができる。 According to the motion information display system of the moving body of the present invention, the acceleration information of the three axes of the moving body can be integrated and displayed regardless of the numerical value.
以下、本発明を実施するための形態を図面を参照して説明する。 Hereinafter, embodiments for carrying out the present invention will be described with reference to the drawings.
図1乃至図8は、本発明の移動体の運動情報表示システムの実施形態として、水中を遊泳する形式の移動体と、移動体の遠隔操作を行う遠隔操作装置を備える構成に適用した例を示すものである。 1 to 8 show an example of an embodiment of the motion information display system for a moving body of the present invention, which is applied to a configuration including a moving body swimming in water and a remote control device for remotely controlling the moving body. It shows.
図1は、本実施形態の移動体の運動情報表示システムを示すもので、図1(a)は全体の構成を示す概略図、図1(b)は、表示部の画面に表示される情報を示す概要図である。 1A and 1B show a motion information display system for a moving body according to the present embodiment, FIG. 1A is a schematic view showing an overall configuration, and FIG. 1B is information displayed on a screen of a display unit. It is a schematic diagram which shows.
図2は、移動体の左右方向、上下方向、前後方向の加速度がゼロの場合に表示部に表示される情報を示す図である。図3は、移動体に左右方向の加速度が生じている場合に表示部に表示される情報を示すもので、図3(a)は、左向きの加速度が生じている状態を示す図、図3(b)は、右向きの加速度が生じている状態を示す図である。図4は、移動体に上下方向の加速度が生じている場合に表示部に表示される情報を示すもので、図4(a)は、下向きの加速度が生じている状態を示す図、図4(b)は、上向きの加速度が生じている状態を示す図である。図5は、移動体に左右方向の加速度と上下方向の加速度が共に生じている場合に、表示部に表示される情報の一例を示す図である。図6は、移動体に前後方向の加速度が生じている場合に表示部に表示される情報を、表示部の画面の一部を切り出して示すもので、図6(a)は、前向きの加速度が生じている状態を示す図、図6(b)は、後向きの加速度が生じている状態を示す図である。図7は、移動体にヨー角方向の角速度と、ピッチ角方向の角速度が生じている場合に表示部の表示される情報を、表示部の画面の一部を切り出して示すもので、図7(a)は、ヨー角方向の角速度とピッチ角方向の角速度が合成された角速度が生じている状態を示す図、図7(b)は、ヨー角方向の角速度のみが生じている状態を示す図、図7(c)は、ピッチ角方向の角速度のみが生じている状態を示す図である。図8は、移動体にロール角方向の角速度が生じている場合に表示部に表示される情報を示す図である。 FIG. 2 is a diagram showing information displayed on the display unit when the acceleration in the horizontal direction, the vertical direction, and the front-rear direction of the moving body is zero. FIG. 3 shows information displayed on the display unit when the moving body is accelerating in the left-right direction, and FIG. 3A is a diagram showing a state in which the moving body is accelerating to the left. (B) is a diagram showing a state in which rightward acceleration is generated. FIG. 4 shows information displayed on the display unit when the moving body is accelerating in the vertical direction, and FIG. 4A is a diagram showing a state in which downward acceleration is occurring. (B) is a diagram showing a state in which an upward acceleration is generated. FIG. 5 is a diagram showing an example of information displayed on the display unit when both the horizontal acceleration and the vertical acceleration are generated in the moving body. FIG. 6 shows information displayed on the display unit when the moving body is accelerating in the front-rear direction by cutting out a part of the screen of the display unit. FIG. 6A shows forward acceleration. 6 (b) is a diagram showing a state in which a rearward acceleration is generated. FIG. 7 shows information displayed on the display unit when the moving body has an angular velocity in the yaw angle direction and an angular velocity in the pitch angle direction by cutting out a part of the screen of the display unit. (A) is a diagram showing a state in which an angular velocity in the yaw angular direction and an angular velocity in the pitch angular velocity are combined, and FIG. 7 (b) is a state in which only the angular velocity in the yaw angular direction is generated. FIG. 7 (c) is a diagram showing a state in which only the angular velocity in the pitch angle direction occurs. FIG. 8 is a diagram showing information displayed on the display unit when the moving body has an angular velocity in the roll angular direction.
本実施形態の移動体の運動情報表示システムは、図1(a)に示すように、水中を遊泳する形式の移動体1の機体2に、加速度センサ3と、角速度センサ4と、通信装置5とを備え、移動体1の遠隔操作を行う遠隔操作装置6に、通信装置7と、表示制御装置8と、表示部9とを備えた構成とされている。更に、表示制御装置8は、図1(b)に示すように、表示部9の画面に、移動体1の運動情報を示すマークとしての加速度情報マーク11と、角速度情報マーク12a,12bを表示させる機能を備えている。
As shown in FIG. 1A, the motion information display system of the mobile body of the present embodiment includes an
移動体1は、前後方向であるロール軸方向、左右方向であるピッチ軸方向、上下方向であるヨー軸方向が定められた機体2を備えている。
The moving
加速度センサ3は、移動体1の機体2に搭載されて、移動体1の左右方向の加速度であるスウェイ加速度Aと、上下方向の加速度であるヒーブ加速度Bと、前後方向の加速度であるサージ加速度Cを検出する機能を備えている。
The
角速度センサ4は、移動体1の機体2に搭載されて、移動体1のヨー角方向の角速度であるヨー角速度Dと、ピッチ角方向の角速度であるピッチ角速度Eと、ロール角方向の角速度であるロール角速度Fを検出する機能を備えている。
The angular velocity sensor 4 is mounted on the
なお、加速度センサ3は、スウェイ加速度Aとヒーブ加速度Bとサージ加速度Cについて、すべてを検出する3軸の加速度センサを用いてもよいし、個別に検出する1軸の加速度センサを3つ組み合わせて用いてもよいし、任意の2軸の加速度センサと残る1軸の加速度センサとを組み合わせて用いてもよい。
The
角速度センサ4は、ヨー角速度Dとピッチ角速度Eとロール角速度Fについて、すべてを検出する3軸の角速度センサを用いてもよいし、個別に検出する1軸の角速度センサを3つ組み合わせて用いてもよいし、任意の2軸の角速度センサと残る1軸の角速度センサとを組み合わせて用いてもよい。 The angular velocity sensor 4 may use a 3-axis angular velocity sensor that detects all of the yaw angular velocity D, the pitch angular velocity E, and the roll angular velocity F, or may use a combination of three single-axis angular velocity sensors that detect individually. Alternatively, any two-axis angular velocity sensor and the remaining one-axis angular velocity sensor may be used in combination.
また、説明の便宜上、加速度センサ3と角速度センサ4は別に記載しているが、加速度センサ3と角速度センサ4は、いわゆる6軸センサとして一体化されていてもよいし、それぞれの検出対象であるスウェイ加速度A、ヒーブ加速度B、サージ加速度Cと、ヨー角速度D、ピッチ角速度E、ロール角速度Fとを、任意の組み合わせで検出する形式のセンサを用いるようにしてもよい。したがって、加速度センサ3と角速度センサ4は、合計で1個から6個までのセンサ数を取り得る。
Further, for convenience of explanation, the
移動体1の機体2に備えた通信装置5は、加速度センサ3と角速度センサ4に接続されている。更に、通信装置5は、ケーブル10を介して、遠隔操作装置6に備えた通信装置7に有線接続されている。この状態で、通信装置5は、加速度センサ3で検出されたスウェイ加速度A、ヒーブ加速度B、サージ加速度Cの検出結果の信号と、角速度センサ4で検出されたヨー角速度D、ピッチ角速度E、ロール角速度Fの検出結果の信号とを受け取ると、受け取った信号を、遠隔操作装置6側の通信装置7へ送る機能を備えている。
The
遠隔操作装置6の通信装置7は、通信装置5からスウェイ加速度A、ヒーブ加速度B、サージ加速度Cの信号、および、ヨー角速度D、ピッチ角速度E、ロール角速度Fの信号を受け取ると、受け取った信号を、表示制御装置8へ送る機能を備えている。
When the
表示部9は、いわゆるディスプレイ(モニタ)であり、表示制御装置8から受け取る表示指令Gに従い、表示を行う機能を備えている。
The
次に、表示制御装置8の機能の説明と共に、本実施形態の移動体の運動情報表示システムの作用、効果について説明する。
Next, along with the explanation of the function of the
表示制御装置8は、移動体1の運動状態に関連しない基本的な機能として、表示部9に、図1(b)に示すように、画面に二次元座標13と、基準マークとしての基準円14とを表示する表示指令Gを与える機能を備えている。
The
表示部9の画面に表示させる二次元座標13は、図1(b)の図面上、左右方向の軸はX軸、上下方向の軸はY軸とする。X軸に沿う方向は、移動体1の機体2の左右方向に対応している。Y軸に沿う方向は、機体2の上下方向に対応している。なお、これらの対応の具体的な内容については後述する。また説明の便宜上、表示部9の画面に表示される二次元座標13については、画面の実際の向きや角度姿勢に関わらず、X軸の正の方向を右方向、負の方向の左方向といい、Y軸の正の方向を上方向、負の方向を下方向という。
The two-
表示部9の画面に表示させる基準円14は、二次元座標13の原点を中心とし、設定された半径寸法rの円であり、後述する加速度情報マーク11および角速度情報マーク12a,12bとは識別可能な色や線種に設定されている。なお、図1(b)では、図示する便宜上、基準円は二点鎖線で示してある(以降の各図においても同様)。
The
表示制御装置8は、更に、移動体1の運動状態に関連する加速度情報表示機能および角速度情報表示機能を備えている。
The
ここで、先ず、表示制御装置8における加速度情報表示機能について説明する。
Here, first, the acceleration information display function in the
表示制御装置8は、加速度情報表示機能では、通信装置7を介して受け取るスウェイ加速度A、ヒーブ加速度B、サージ加速度Cの信号を基に、以下の第1から第5の制御ルールに従って、加速度情報マーク11の位置とサイズを設定する。更に、表示制御装置8は、加速度情報マーク11の位置とサイズの設定が終了すると、表示部9に、加速度情報マーク11を設定された位置とサイズで画面に表示する表示指令Gを与えるようにしてある。
In the acceleration information display function, the
第1の制御ルールでは、表示制御装置8は、スウェイ加速度A、ヒーブ加速度Bの信号の値が共にゼロの場合は、図2に示すように、加速度情報マーク11の中心の位置を、二次元座標の原点に設定する。
In the first control rule, when the signal values of the sway acceleration A and the heave acceleration B are both zero, the
第2の制御ルールでは、表示制御装置8は、サージ加速度Cの信号の値がゼロの場合は、図2に示すように、加速度情報マーク11の形状を、半径寸法rの円に設定する。
In the second control rule, when the value of the signal of the surge acceleration C is zero, the
したがって、スウェイ加速度A、ヒーブ加速度B、サージ加速度Cの信号の値がすべてゼロの場合は、表示制御装置8は、前記第1の制御ルールと第2の制御ルールの双方に従うことにより、図2に示すように、加速度情報マーク11を、二次元座標13の原点を中心とする半径寸法rの円に設定する。
Therefore, when the signal values of the sway acceleration A, the heave acceleration B, and the surge acceleration C are all zero, the
したがって、この場合は、表示制御装置8からの表示指令Gに従い、表示部9では、図2に示すように、画面に、加速度情報マーク11が基準円14に重なる状態で表示される。
Therefore, in this case, according to the display command G from the
よって、表示部9の画面にて、加速度情報マーク11が基準円14に重なって表示されている場合は、移動体1について、スウェイ加速度A、ヒーブ加速度B、サージ加速度Cのいずれもが生じていないということが分かる。
Therefore, when the
第3の制御ルールでは、表示制御装置8は、スウェイ加速度Aの信号を基に、左向きの加速度が検出されている場合には、加速度情報マーク11の中心の位置を、図3(a)に示すように、二次元座標13の原点よりも右方向となる位置にシフトさせる。また、表示制御装置8は、スウェイ加速度Aの信号を基に、右向きの加速度が検出されている場合は、加速度情報マーク11の中心の位置を、図3(b)に示すように、二次元座標13の原点よりも左方向となる位置にシフトさせる。
In the third control rule, the
なお、図3(a)(b)は、サージ加速度Cの信号の値がゼロの場合、すなわち、表示制御装置8では、前記第2の制御ルールに従い、加速度情報マーク11の形状が、半径寸法rの円に設定された状態を示している。
In addition, in FIGS. 3A and 3B, when the value of the signal of the surge acceleration C is zero, that is, in the
この際、表示制御装置8では、図3(a)(b)に示すように、予め、二次元座標13のX軸上に、表示を望む左向きの加速度の最大値LMの表示位置と、表示を望む右向きの加速度の最大値RMの表示位置を設定しておく。
At this time, as shown in FIGS. 3A and 3B, the
この状態で、左向きの加速度がゼロからLMの間の値Laで検出されている場合は、表示制御装置8は、La/LMの値と、(原点から加速度情報マーク11の中心の位置までの距離)/(原点からLMまでの距離)の値が一致するように、加速度情報マーク11の中心の位置を定めるようにしてある。
In this state, when the leftward acceleration is detected by the value La between zero and LM, the
同様に、右向きの加速度がゼロからRMの間の値Raで検出されている場合は、表示制御装置8は、Ra/RMの値と、(原点から加速度情報マーク11の中心の位置までの距離)/(原点からRMまでの距離)の値が一致するように、加速度情報マーク11の中心の位置を定めるようにしてある。
Similarly, when the rightward acceleration is detected with a value Ra between zero and RM, the
なお、スウェイ加速度Aについて、前記のように表示を望む左向きの加速度の最大値LM、および、右向きの加速度の最大値RMの表示位置を設定するのは、加速度情報マーク11が、表示部9の画面の右端付近や左端付近の視認しにくい位置まで変位したり、画面に表示可能な範囲から左右方向へ逸脱したりすることを防ぐためである。
Regarding the sway acceleration A, the
したがって、この場合は、表示制御装置8からの表示指令Gに従い、表示部9では、図3(a)または図3(b)に示すように、画面に、加速度情報マーク11が、加速度情報マーク11の中心の位置が原点よりも右方向または左方向に、前記所定の変位量でシフトした状態で表示される。
Therefore, in this case, according to the display command G from the
よって、表示部9の画面にて、図3(a)に示すように、加速度情報マーク11の中心の位置が二次元座標13の原点よりも右側に位置している場合は、移動体1に左向きの加速度が生じていることが分かる。更に、図3(a)の表示からは、加速度情報マーク11の中心の位置が二次元座標13の原点から右側へシフトしている量の大小に応じて、移動体1に生じている左向きの加速度の大きさを推定することが可能になる。
Therefore, on the screen of the
また、表示部9の画面にて、図3(b)に示すように、加速度情報マーク11の中心の位置が二次元座標13の原点よりも左側に位置している場合は、移動体1に右向きの加速度が生じていることが分かる。更に、図3(b)の表示からは、加速度情報マーク11の中心の位置が二次元座標13の原点から左側へシフトしている量の大小に応じて、移動体1に生じている右向きの加速度の大きさを推定することが可能になる。
Further, on the screen of the
第4の制御ルールでは、表示制御装置8は、ヒーブ加速度Bの信号を基に、下向きの加速度が検出されている場合には、加速度情報マーク11の中心の位置を、図4(a)に示すように、二次元座標13の原点よりも上方向となる位置にシフトさせる。また、表示制御装置8は、ヒーブ加速度Bの信号を基に、上向きの加速度が検出されている場合は、加速度情報マーク11の中心の位置を、図4(b)に示すように、二次元座標13の原点よりも下方向となる位置にシフトさせる。
In the fourth control rule, the
なお、図4(a)(b)は、サージ加速度Cの信号の値がゼロの場合、すなわち、表示制御装置8では、前記第2の制御ルールに従い、加速度情報マーク11の形状が、半径寸法rの円に設定された状態を示している。
In addition, in FIGS. 4A and 4B, when the value of the signal of the surge acceleration C is zero, that is, in the
この際、表示制御装置8では、図4(a)(b)に示すように、予め、二次元座標13のY軸上に、表示を望む下向きの加速度の最大値DMの表示位置と、表示を望む上向きの加速度の最大値UMの表示位置を設定しておく。
At this time, in the
この状態で、下向きの加速度がゼロからDMの間の値Daで検出されている場合は、表示制御装置8は、Da/DMの値と、(原点から加速度情報マーク11の中心の位置までの距離)/(原点からDMまでの距離)の値が一致するように、加速度情報マーク11の中心の位置を定めるようにしてある。
In this state, when the downward acceleration is detected by the value Da between zero and DM, the
同様に、上向きの加速度がゼロからUMの間の値Uaで検出されている場合は、表示制御装置8は、Ua/UMの値と、(原点から加速度情報マーク11の中心の位置までの距離)/(原点からUMまでの距離)の値が一致するように、加速度情報マーク11の中心の位置を定めるようにしてある。
Similarly, when the upward acceleration is detected with a value Ua between zero and UM, the
なお、ヒーブ加速度Bについて、前記のように表示を望む下向きの加速度の最大値DM、および、上向きの加速度の最大値UMの表示位置を設定するのは、加速度情報マーク11の中心の位置を二次元座標13の原点から上方向や下方向へシフトさせるときの変位量に上限を設けることで、加速度情報マーク11が、表示部9の画面の上端付近や下端付近の視認しにくい位置まで変位したり、画面に表示可能な範囲から上下方向に逸脱したりすることを防ぐためである。
Regarding the heave acceleration B, the display position of the maximum value DM of the downward acceleration and the maximum value UM of the upward acceleration to be displayed as described above is set by setting the position of the center of the
したがって、この場合は、表示制御装置8からの表示指令Gに従い、表示部9では、図4(a)または図4(b)に示すように、画面に、加速度情報マーク11が、加速度情報マーク11の中心の位置が原点よりも上方向または下方向に、前記所定の変位量でシフトした状態で表示される。
Therefore, in this case, according to the display command G from the
よって、表示部9の画面にて、図4(a)に示すように、加速度情報マーク11の中心の位置が二次元座標13の原点よりも上側に位置している場合は、移動体1に下向きの加速度が生じていることが分かる。更に、図4(a)の表示からは、加速度情報マーク11の中心の位置が二次元座標13の原点から上側へシフトしている量の大小に応じて、移動体1に生じている下向きの加速度の大きさを推定することが可能になる。
Therefore, on the screen of the
また、表示部9の画面にて、図4(b)に示すように、加速度情報マーク11の中心の位置が二次元座標13の原点よりも下側に位置している場合は、移動体1に上向きの加速度が生じていることが分かる。更に、図4(b)の表示からは、加速度情報マーク11の中心の位置が二次元座標13の原点から下側へシフトしている量の大小に応じて、移動体1に生じている上向きの加速度の大きさを推定することが可能になる。
Further, on the screen of the
ところで、移動体1については、スウェイ加速度Aと、ヒーブ加速度Bとが共に検出される場合がある。この場合、表示制御装置8は、前記第3の制御ルールと第4の制御ルールの双方に従うことで、図5に示すように、二次元座標13にて、前記した第3の制御ルールで定められる原点から左右方向へシフトした位置をX座標の値とし、第4の制御ルールで定められる原点から上下方向にシフトした位置をY座標の値とする位置に、加速度情報マーク11の中心の位置を定める。
By the way, for the moving
なお、図5では、一例として、移動体1にて、左向きの加速度が値Laで検出され、下向きの加速度がDaで検出された場合に、表示制御装置8により、加速度情報マーク11の中心の位置が座標(La,Da)に設定された場合を示している。
In FIG. 5, as an example, when the leftward acceleration is detected by the value La and the downward acceleration is detected by Da in the moving
また、図5では、サージ加速度Cの信号の値がゼロの場合、すなわち、表示制御装置8では、前記第2の制御ルールに従い、加速度情報マーク11の形状が、半径寸法rの円に設定された状態を示している。
Further, in FIG. 5, when the value of the signal of the surge acceleration C is zero, that is, in the
第5の制御ルールでは、表示制御装置8は、サージ加速度Cの信号を基に、前向きの加速度が検出されている場合には、図6(a)に示すように、前記した第1の制御ルール、または、第3の制御ルールと第4の制御ルールに従って加速度情報マーク11の中心の位置が決められた状態で、加速度情報マーク11を、半径寸法rの基準円14(図1(b)参照)よりも拡大された半径寸法の円に設定する。また、表示制御装置8は、サージ加速度Cの信号を基に、後向きの加速度が検出されている場合は、前記と同様に中心の位置が決められた状態の加速度情報マーク11を、図6(b)に示すように、半径寸法rの基準円14(図1(b)参照)よりも縮小された半径寸法の円に設定する。
In the fifth control rule, when the
なお、表示制御装置8で第5の制御ルールを実施するときには、加速度情報マーク11の中心の位置は、前記した第1の制御ルール、または、第3の制御ルールと第4の制御ルールのいずれに従うかによって変化する。図6(a)(b)では、このように変化する加速度情報マーク11の中心の位置を、代表して座標(x,y)で示すと共に、表示部9の画面における座標(x,y)の周辺となる部分のみを、切り出して図示してある。また、図6(a)(b)では、加速度情報マーク11の半径寸法の設定を説明する便宜上、一点鎖線により、基準円14と同じ半径寸法rの仮想円14aを、加速度情報マーク11と同心配置で示してある。
When the fifth control rule is executed by the
更に、第5の制御ルールでは、表示制御装置8は、図6(a)に示すように、予め、表示を望む前向きの加速度の最大値FMを表示するための、加速度情報マーク11の最大の半径寸法を、たとえば、値(r+fm)として設定しておく。
Further, in the fifth control rule, as shown in FIG. 6A, the
この状態で、前向きの加速度がゼロからFMの間の値Faで検出されている場合は、表示制御装置8は、加速度情報マーク11の半径寸法を、(r+fm・(Fa/FM))で設定するようにしてある。
In this state, when the forward acceleration is detected by the value Fa between zero and FM, the
また、第5の制御ルールでは、表示制御装置8は、図6(b)に示すように、予め、表示を望む後向きの加速度の最大値BMを表示するための、加速度情報マーク11の最小の半径寸法を、たとえば、値(r−bm)として設定しておく。
Further, in the fifth control rule, as shown in FIG. 6B, the
この状態で、後向きの加速度がゼロからBMの間の値Baで検出されている場合は、表示制御装置8は、加速度情報マーク11の半径寸法を、(r−bm・(Ba/BM))で設定するようにしてある。
In this state, when the backward acceleration is detected with a value Ba between zero and BM, the
なお、前記のように表示を望む前向きの加速度の最大値FMを表示する加速度情報マーク11の最大の半径寸法の値(r+fm)を設定するのは、加速度情報マーク11のサイズが表示部9の画面に表示可能な範囲に対して過大になって、表示不可になることを防ぐためである。
The size of the
また、前記のように表示を望む後向きの加速度の最大値BMを表示する加速度情報マーク11の最小の半径寸法の値(r−bm)を設定するのは、加速度情報マーク11の表示部9の画面に表示されるサイズが過小になって、視認しにくくなる虞を防ぐためである。
Further, as described above, the value (r-bm) of the minimum radial dimension of the
なお、表示制御装置8は、前記第3の制御ルールと第4の制御ルールに従って加速度情報マーク11の中心の位置が二次元座標13の原点以外の位置に決められた場合、表示部9の画面には、その位置を中心とする半径寸法rの仮想円14aは、表示しなくてもよいが、実際に表示するようにしてもよい。このように仮想円14aを表示部9に表示した場合は、加速度情報マーク11を仮想円14aと比較することで、加速度情報マーク11の半径寸法が、基準円14の半径寸法rに対して拡大、あるいは、縮小されていることを容易に視認することができる。また、二次元座標13の原点以外の位置を中心とする仮想円14aを実際に表示する場合は、二次元座標13の原点を中心とする基準円14の表示は省略するようにしてもよい。
When the center position of the
したがって、表示制御装置8からの表示指令Gに従い、表示部9では、図6(a)または図6(b)に示すように、画面に、加速度情報マーク11が、基準円14(図1(b)参照)あるいは仮想円14aよりも拡大された半径寸法、または、縮小された半径寸法で表示される。
Therefore, in accordance with the display command G from the
よって、表示部9の画面にて、図6(a)に示すように、加速度情報マーク11が、基準円14(仮想円14a)に比して拡大されている場合は、移動体1に前向きの加速度が生じていることが分かる。更に、図6(a)の表示からは、加速度情報マーク11の半径寸法が基準円14(仮想円14a)の半径寸法rよりも拡大されている量の大小に応じて、移動体1に生じている前向きの加速度の大きさを推定することが可能になる。
Therefore, on the screen of the
また、表示部9の画面にて、図6(b)に示すように、加速度情報マーク11が、基準円14(仮想円14a)に比して縮小されている場合は、移動体1に後向きの加速度が生じていることが分かる。更に、図6(b)の表示からは、加速度情報マーク11の半径寸法が基準円14(仮想円14a)の半径寸法rよりも縮小されている量の大小に応じて、移動体1に生じている後向きの加速度の大きさを推定することが可能になる。
Further, on the screen of the
表示制御装置8は、以上の第1から第5の制御ルールを備えた加速度情報表示機能によれば、移動体1のスウェイ加速度A、ヒーブ加速度B、サージ加速度Cの信号の値を基に、表示部9の画面に、加速度情報マーク11を、スウェイ加速度Aの値とヒーブ加速度Bの値に応じて設定される位置を中心とし、且つサージ加速度Cの値に応じて設定される半径寸法を有する円として表示することができる。
According to the acceleration information display function provided with the first to fifth control rules, the
したがって、本実施形態の移動体の運動情報表示システムによれば、表示部9にて、移動体の3軸の加速度としてのスウェイ加速度Aとヒーブ加速度Bとサージ加速度Cの情報を、数値に依らずに統合して表示することができる。
Therefore, according to the motion information display system of the moving body of the present embodiment, the information of the sway acceleration A, the heave acceleration B, and the surge acceleration C as the accelerations of the three axes of the moving body is obtained by the
これにより、オペレータは、表示部9の画面に表示された加速度情報マーク11の中心の位置について、二次元座標13の原点に対する相対的な配置を目視することで、移動体1のスウェイ加速度Aとヒーブ加速度Bについて、それぞれ加速度の有無、加速度の向き、加速度の大きさを容易に把握することができる。
As a result, the operator can visually check the position of the center of the
また、オペレータは、表示部9の画面に表示された加速度情報マーク11のサイズについて、基準円14のサイズとの大小関係、仮想円14aを表示する場合は仮想円14aのサイズとの大小関係を目視することで、サージ加速度Cの有無、加速度の向き、加速度の大きさを容易に把握することができる。
Further, the operator determines the magnitude relationship between the size of the
たとえば、表示部9の画面の表示が、図1(b)のような状態であるときには、加速度情報マーク11の中心の位置が、二次元座標13の原点より左上方向にシフトした配置となっていることから、移動体1には、右向きの加速度と、下向きの加速度が生じていることが容易に把握することができる。更に、加速度情報マーク11の中心の位置が二次元座標13の原点に対して左方向にシフトしている量の情報からは、移動体に生じている右向きの加速度の大きさを推定することができる。同様に、加速度情報マーク11の中心の位置が二次元座標13の原点に対して上方向にシフトしている量の情報からは、移動体に生じている下向きの加速度の大きさを推定することができる。
For example, when the screen display of the
また、図1(b)の表示では、加速度情報マーク11のサイズが、基準円14のサイズと同等であることから、移動体1には、サージ加速度Cは生じていない、ということを容易に把握することができる。
Further, in the display of FIG. 1B, since the size of the
本実施形態では、表示部9の画面に表示される加速度情報マーク11は、移動体1のスウェイ加速度A、ヒーブ加速度B、サージ加速度Cの信号の値がすべてゼロの場合は、図2に示したように、基準円14に重なって表示されているが、この状態から、移動体1にスウェイ加速度Aやヒーブ加速度Bが生じると、表示部9の画面上では、加速度が生じた向きとは逆方向に加速度情報マーク11が変位する。
In the present embodiment, the
また、図2に示した状態から、移動体1に前向きの加速度が生じると、表示部9の画面上では、加速度情報マーク11の円が拡径する。一方、図2に示した状態から、移動体1に後向きの加速度が生じると、表示部9の画面上では、加速度情報マーク11の円が縮径する。
Further, when a forward acceleration is generated in the moving
このため、オペレータは、前記した表示部9の画面における加速度情報マーク11の位置の変化とサイズの変化を、あたかも、仮想のリングが自分の前に正対して自分と同じ慣性を有する状態で存在している状況から、自分にだけ移動体1と同様のスウェイ加速度A、ヒーブ加速度B、サージ加速度Cが生じた場合の前記仮想のリングの見え方の変化のように捉えることが可能になる。
Therefore, the operator exists in a state where the virtual ring faces the front of the virtual ring and has the same inertia as the virtual ring, as if the change in the position and the size of the
よって、オペレータは、表示部9の画面における加速度情報マーク11の位置の変化とサイズの変化を基に、移動体1のスウェイ加速度A、ヒーブ加速度B、サージ加速度Cについて、より直感的に把握することが容易になる。
Therefore, the operator more intuitively grasps the sway acceleration A, the heave acceleration B, and the surge acceleration C of the moving
次に、表示制御装置に8における角速度情報表示機能について説明する。 Next, the angular velocity information display function in 8 will be described in the display control device.
表示制御装置8は、加速度情報表示機能では、通信装置7を介して受け取るヨー角速度D、および、ピッチ角速度Eの信号を基に、以下の第6の制御ルールに従って、第1の角速度情報マーク12aの形状を設定する。更に、表示制御装置8は、第1の角速度情報マーク12aの形状の設定が終了すると、表示部9に、第1の角速度情報マーク12aを設定された形状で画面に表示する表示指令Gを与える。
In the acceleration information display function, the
また、表示制御装置8は、通信装置7を介して受け取るロール角速度Fの信号を基に、後述する第7の制御ルールに従って、図1(b)、図8に示す第2の角速度情報マーク12bの表示角度を設定する。更に、表示制御装置8は、第2の角速度情報マーク12bの表示角度の設定が終了すると、表示部9に、第2の角速度情報マーク12bを設定された表示角度で画面に表示する表示指令Gを与えるようにしてある。
Further, the
第6の制御ルールでは、表示制御装置8は、ヨー角速度Dの信号と、ピッチ角速度Eの信号を受け取ると、先ず、ヨー角速度Dとピッチ角速度Eとを合成する計算を行い、移動体1の前後方向であるロール軸方向の向きが変わる回頭方向と、その回頭方向に関する角速度とを算出する。説明の便宜上、前記算出された回頭方向、および、その回頭方向に関する角速度は、以下、回頭方向H、角速度Iと表示する。
In the sixth control rule, when the
一例として、移動体1に、ヨー角方向に関しては右向き(右回り)のヨー角速度Dが生じ、ピッチ角方向に関しては下向き(前下がり方向)のピッチ角速度Eが生じている場合、移動体1の回頭方向Hは、右斜め下向きとなる。なお、これは一つの組み合わせの例であり、移動体1のヨー角速度Dの右向き、左向きと、ピッチ角速度Eの上向き、下向きは、自在に組み合わせて合成できること、および、ヨー角速度Dとピッチ角速度Eの値の比は、任意の比でよいこと、は勿論である。
As an example, when the moving
この際、ピッチ角速度Eの信号の値がゼロの場合は、前記合成計算で得られる移動体1の回頭方向Hとその角速度Iの結果は、ヨー角速度Dに一致する。
At this time, when the value of the signal of the pitch angular velocity E is zero, the results of the turning direction H of the moving
同様に、ヨー角速度Dの値がゼロの場合は、前記合成計算で得られる移動体1の回頭方向Hとその角速度Iの結果は、ピッチ角速度Eに一致する。
Similarly, when the value of the yaw angular velocity D is zero, the results of the turning direction H of the moving
次に、表示制御装置8は、図7(a)(b)(c)に示すように、前述した加速度情報表示機能によって中心の位置とサイズが決定された円形の加速度情報マーク11を基準として、前記合成計算で得た移動体1の回頭方向Hとその角速度Iの結果を基に、楕円形の第1の角速度情報マーク12aを生成する。この第1の角速度情報マーク12aを生成する規則は、後述する。
Next, as shown in FIGS. 7A, 7B, and 7C, the
なお、表示制御装置8の加速度情報表示機能では、設定される加速度情報マーク11の中心の位置は、スウェイ加速度A、ヒーブ加速度Bの信号の値に応じて異なる位置を取り得るものであり、また、加速度情報マーク11のサイズも、サージ加速度Cの信号の値に応じて異なる半径寸法を取り得るものである。そのため、図7(a)(b)(c)では、加速度情報表示機能で設定された中心の位置とサイズを備える円形の加速度情報マーク11については、中心の位置を座標(x1,y1)で代表して示すと共に、表示部9の画面における座標(x1,y1)の周辺となる部分のみを、切り出して図示してある。また、加速度情報マーク11のサイズは、直径の寸法の値をd1で代表して示してある。この場合、加速度情報マーク11の直径の寸法d1は、移動体1のサージ加速度Cの値に応じて、基準円14の直径の値(2r)に対し、同じ値、より大きい値、より小さい値のいずれも取り得る。
In the acceleration information display function of the
表示制御装置8は、第1の角速度情報マーク12aを生成する場合は、先ず、図7(a)に示すように、加速度情報マーク11について、前記合成計算で得た移動体1の回頭方向Hに沿う方向の直径15を特定する。なお、図7(a)は、回頭方向Hが、二点鎖線で示す如き右斜め下向きの場合について示してある。
When the
次に、表示制御装置8は、図7(a)に示すように、長径の寸法が加速度情報マーク11の直径の寸法d1と同様で、且つ角速度Iの値が大きくなるに従って短径の寸法が小さくなり、更に、短径の方向が回頭方向Hに平行な楕円形として、第1の角速度情報マーク12aを生成する。
Next, as shown in FIG. 7A, the
この際、表示制御装置8は、第1の角速度情報マーク12aの楕円形の短径の寸法については、表示を望む角速度Iの最大値IMを表示する場合の短径の最小値imを、予め設定しておく。
At this time, the
この状態で、表示制御装置8は、角速度IがゼロからIMの間の値Iaとなっている場合は、第1の角速度情報マーク12aの短径の寸法を、(d1−(d1−im)×(Ia/IM))で設定するようにしてある。
In this state, when the angular velocity I is a value Ia between zero and IM, the
なお、第1の角速度情報マーク12aは、短径の最小値imがゼロに設定されていてもよい。この場合は、角速度Iの値がIM以上になると、第1の角速度情報マーク12aは、加速度情報マーク11の前記所定の直径15に対して直交する直線になる。
The minimum value im of the minor axis of the first angular
更に、表示制御装置8は、以上の処理により楕円形が決まる第1の角速度情報マーク12aについて、図7(a)に示すように、第1の角速度情報マーク12aの短径における回頭方向Hとは逆側の端部の位置が、加速度情報マーク11の前記所定の直径15における回頭方向Hとは逆側の端部に重なるように、位置を定める。
Further, the
この際、前記したように、ピッチ角速度Eの信号の値がゼロの場合は、移動体1の回頭方向Hとその角速度Iの結果は、ヨー角速度Dに一致する。よって、この場合、たとえば、ヨー角速度Dが右向きに生じている場合は、図7(b)に示すように、第1の角速度情報マーク12aは、左端が、加速度情報マーク11の左端に重なる配置となる。
At this time, as described above, when the value of the signal of the pitch angular velocity E is zero, the results of the turning direction H of the moving
また、前記したように、ヨー角速度Dの値がゼロの場合は、移動体1の回頭方向Hとその角速度Iの結果は、ピッチ角速度Eに一致する。よって、この場合、たとえば、ピッチ角速度Eが下向きに生じている場合は、図7(c)に示すように、第1の角速度情報マーク12aは、上端が、加速度情報マーク11の上端に重なる配置となる。
Further, as described above, when the value of the yaw angular velocity D is zero, the results of the turning direction H of the moving
したがって、表示制御装置8からの表示指令Gに従い、表示部9では、図7(a)(b)(c)に示すように、画面に、加速度情報マーク11に付属して第1の角速度情報マーク12aが表示される。
Therefore, according to the display command G from the
第7の制御ルールでは、表示制御装置8は、ロール角速度Fの信号の値がゼロの場合は、たとえば、図8に示すように、表示部9の画面に、二次元座標13の座標軸上に配置されるよう角度姿勢を定めた第2の角速度情報マーク12bを表示させる。説明の便宜上、このときの第2の角速度情報マーク12bの状態を、初期状態という。
In the seventh control rule, when the value of the signal of the roll angular velocity F is zero, the
移動体1に、ロール角方向に関して左向きのロール角速度Fが生じている場合は、表示制御装置8は、図8に一点鎖線で示すように、第2の角速度情報マーク12bを、二次元座標13の原点を中心に初期状態よりも左方向、すなわち、反時計回り方向に回転させた角度姿勢に設定する。
When the moving
一方、移動体1に、ロール角方向に関して右向きのロール角速度Fが生じている場合は、表示制御装置8は、図8に二点鎖線で示すように、第2の角速度情報マーク12bを、二次元座標13の原点を中心に初期状態よりも右方向、すなわち、時計回り方向に回転させた角度姿勢に設定する。
On the other hand, when the moving
なお、表示制御装置8は、ロール角速度Fが左向きまたは右向きに生じている場合の角速度の大きさと、第2の角速度情報マーク12bを初期状態から左右へ回転させた角度姿勢とする場合の回転角度とは、相関性を持たせている。
The
したがって、表示制御装置8からの表示指令Gに従い、表示部9では、図1(b)や図8のように、画面に、第2の角速度情報マーク12bが、移動体1のロール角速度Fの値に応じた角度姿勢で表示される。
Therefore, in accordance with the display command G from the
したがって、本実施形態の移動体の運動情報表示システムによれば、表示部9にて、移動体の3軸の角速度としてのヨー角速度Dとピッチ角速度Eとロール角速度Fの情報を、数値に依らずに表示することができる。
Therefore, according to the motion information display system of the moving body of the present embodiment, the information of the yaw angular velocity D, the pitch angular velocity E, and the roll angular velocity F as the angular velocities of the three axes of the moving body is obtained by the
これにより、オペレータは、表示部9の画面に表示された第1の角速度情報マーク12aが加速度情報マーク11に接している位置と、第1の角速度情報マーク12aの加速度情報マーク11に比して扁平している量を目視することで、移動体1の回頭方向Hと、その方向への角速度Iを容易に把握することができる。また、オペレータは、この回頭方向Hと角速度Iの左右方向成分と上下方向成分の比率を推定することにより、移動体1のヨー角速度Dと、ピッチ角速度Eについて、それぞれの有無、向き、大きさを容易に推定することができる。
As a result, the operator can compare the position where the first angular
また、オペレータは、表示部9の画面に表示された第2の角速度情報マーク12bの角度姿勢を目視することにより、移動体1のロール角速度Fの有無、方向、大きさを容易に把握することができる。
Further, the operator can easily grasp the presence / absence, direction, and size of the roll angular velocity F of the moving
たとえば、表示部9の画面の表示が、図1(b)のような状態であるときには、第1の角速度情報マーク12aからは、移動体1に右斜め下向きの回頭方向Hについて角速度Iが生じていることが分かる。また、この回頭方向Hの角速度は、左右方向成分が上下方向成分に比して大きいので、移動体1には、ヨー角方向の右向きに、ピッチ角方向の下向きよりも大きな角速度が生じていることが分かる。
For example, when the screen display of the
また、図1(b)における第2の角速度情報マーク12bからは、移動体1にロール角方向の右向きの角速度が生じていることが分かる。
Further, from the second angular
したがって、水中を遊泳する形式の移動体1を遠隔操作して、ホバリングによる定点保持や、移動を行わせるときに、移動体1の使用環境に時間の経過に伴い変化する水の流れや、場所ごとに異なる水の流れが存在していると、移動体1には、意図しない左右方向、上下方向、前後方向の加速度が生じるが、本実施形態の移動体の運動情報表示システムによれば、そのような加速度の変化を、オペレータが把握し易くすることができる。
Therefore, when the
更に、ケーブル10が接続されている形式の移動体1では、遠隔操作による移動体1の移動時に、ケーブル10が障害物に接触したり、障害物に引っ掛かりを生じたりすると、移動方向とは逆方向の加速度が生じるが、本実施形態の移動体の運動情報表示システムを用いることで、そのような加速度の変化も、オペレータが捉えやすくすることができる。
Further, in the moving
よって、本実施形態の移動体の運動情報表示システムを用いることにより、遠隔操作によって移動体の位置や運動を制御する場合について、制御性の向上化を図る効果も期待できる。 Therefore, by using the motion information display system of the moving body of the present embodiment, the effect of improving the controllability can be expected when the position and movement of the moving body are controlled by remote control.
なお、本発明は、前記実施形態にのみ限定されるものではない。 The present invention is not limited to the above embodiment.
たとえば、加速度情報マーク11は、円形とする例を示したが、多角形であってもよい。この場合、第1の角速度情報マーク12aは、加速度情報マーク11を扁平させた形状とすればよい。
For example, although the
また、第2の角速度情報マーク12bは、表示部9の画面にて、二次元座標13の原点を中心とする左右方向への回転による角度姿勢の変化を容易に把握することができれば、多角形やその他、任意の形状であってもよい。
Further, the second angular
表示制御装置8は、表示部9の画面に設定された二次元座標13にて、加速度情報マーク11の中心の位置を、移動体1のスウェイ加速度Aに対応してX軸方向に変位させる機能を備えていれば、加速度情報マーク11の中心の位置を、移動体1のスウェイ加速度Aの左向き、右向きと同方向に変位させる処理を行うものとしてもよい。
The
表示制御装置8は、表示部9の画面に設定された二次元座標13にて、加速度情報マーク11の中心の位置を、移動体1のヒーブ加速度Bに対応してY軸方向に変位させる機能を備えていれば、加速度情報マーク11の中心の位置を、移動体1のヒーブ加速度Bの上向き、下向きと同方向に変位させる処理を行うものとしてもよい。
The
表示制御装置8は、表示部9の画面にて、加速度情報マーク11のサイズを、移動体1のサージ加速度Cに対応して拡大、縮小する機能を備えていれば、移動体1に前向きの加速度が生じたときに加速度情報マーク11のサイズを縮小し、移動体1に後向きの加速度が生じたときに加速度情報マーク11のサイズを拡大する処理を行うものとしてもよい。
If the
表示制御装置8は、表示部9の画面に、加速度情報マーク11と共に、各角速度情報マーク12a,12bを表示する機能を備えることが好ましいが、角速度情報マーク12aまたは角速度情報マーク12bのいずれか一方、または、双方の表示機能を省略してもよい。この場合であっても、本発明の移動体の運動情報表示システムは、移動体の3軸の加速度の情報を、数値に依らずに統合して表示することができる、という効果を得ることが可能である。
The
表示部9には、移動体1に搭載された撮像装置で撮影された映像を、加速度情報マーク11、各角速度情報マーク12a,12b、二次元座標13、基準円14、仮想円14aに重畳して表示してもよい。このようにすれば、オペレータは、移動体1に搭載された撮像装置で撮影された映像を見ながら、移動体1に生じる3軸方向の加速度や3軸方向の角速度の情報を容易に把握することが可能になる。
On the
移動体1側の通信装置5と、遠隔操作装置6側の通信装置7は、互いに通信を行うことができれば、ケーブル10を介した有線での通信方式に代えて、音響通信や無線通信や光通信、その他任意の通信方式を採用してもよい。
If the
図1(a)に示した移動体1の形状や構成は、一例であり、本発明の移動体の運動情報表示システムを適用する移動体1の形状や構成は、変更してよい。
The shape and configuration of the moving
本発明の移動体の運動情報表示システムは、3次元空間を移動する形式の移動体であれば、空中を飛行する形式の移動体や、その他、水中を遊泳する形式の移動体1以外の任意の形式の移動体に適用してもよい。
The motion information display system of the moving body of the present invention is arbitrary except for the moving body in the form of flying in the air and the moving
その他本発明の要旨を逸脱しない範囲内で種々変更を加え得ることは勿論である。 Of course, various other changes can be made without departing from the gist of the present invention.
1 移動体、3 加速度センサ、4 角速度センサ、5 通信装置、6 遠隔操作装置、7 通信装置、8 表示制御装置、9 表示部、11 加速度情報マーク、12a 第1の角速度情報マーク(角速度情報マーク)、12b 第2の角速度情報マーク(別の角速度情報マーク)、13 二次元座標、A スウェイ加速度(加速度)、B ヒーブ加速度(加速度)、C サージ加速度(加速度)、D ヨー角速度(角速度)、E ピッチ角速度(角速度)、F ロール角速度(角速度)、H 回頭方向、I 角速度 1 mobile body, 3 acceleration sensor, 4 angular velocity sensor, 5 communication device, 6 remote control device, 7 communication device, 8 display control device, 9 display unit, 11 acceleration information mark, 12a 1st angular velocity information mark (angular velocity information mark) ), 12b 2nd angular velocity information mark (another angular velocity information mark), 13 2D coordinates, A sway acceleration (acceleration), B heave acceleration (acceleration), C surge acceleration (acceleration), D yaw angular velocity (angular velocity), E pitch angular velocity (angular velocity), F roll angular velocity (angular velocity), H turning direction, I angular velocity
Claims (3)
前記移動体の3軸の加速度を検出する加速度センサと、
通信装置と、を備え、
前記移動体の遠隔操作装置に、
前記移動体の前記通信装置との通信を行う通信装置と、
表示制御装置と、
表示部と、を備え、
前記表示制御装置は、加速度情報表示機能として、
前記表示部の画面に、加速度情報マークを表示する機能と、
前記表示部の画面に設定された二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで検出される前記移動体の左右方向の加速度に対応してX軸方向に変位させる機能と、
前記表示部の画面に設定された前記二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで検出される前記移動体の上下方向の加速度に対応してY軸方向に変位させる機能と、
前記表示部の画面に表示する前記加速度情報マークのサイズを、前記加速度センサで検出される前記移動体の前後方向の加速度に対応して拡大、縮小する機能とを備え、
前記表示制御装置の前記加速度情報表示機能は、
前記表示部の画面に設定された前記二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで前記移動体の左向きの加速度が検出されるときには、X軸の正の方向に変位させ、前記加速度センサで前記移動体の右向きの加速度が検出されるときには、X軸の負の方向に変位させる機能と、
前記表示部の画面に設定された前記二次元座標にて、前記加速度情報マークの中心の位置を、前記加速度センサで前記移動体の下向きの加速度が検出されるときには、Y軸の正の方向に変位させ、前記加速度センサで前記移動体の上向きの加速度が検出されるときには、Y軸の負の方向に変位させる機能と、
前記表示部の画面に表示する前記加速度情報マークを、前記加速度センサで前記移動体の前向きの加速度が検出されるときには、サイズを拡大し、前記加速度センサで前記移動体の後向きの加速度が検出されるときには、サイズを縮小する機能と、を備える
ることを特徴とする移動体の運動情報表示システム。 For mobiles,
An acceleration sensor that detects the acceleration of the three axes of the moving body, and
Equipped with a communication device,
To the remote control device of the moving body
A communication device that communicates with the communication device of the mobile body, and
Display control device and
With a display
The display control device has an acceleration information display function.
A function to display the acceleration information mark on the screen of the display unit,
With the two-dimensional coordinates set on the screen of the display unit, the position of the center of the acceleration information mark is displaced in the X-axis direction in accordance with the lateral acceleration of the moving body detected by the acceleration sensor. Function and
With the two-dimensional coordinates set on the screen of the display unit, the position of the center of the acceleration information mark is displaced in the Y-axis direction in response to the vertical acceleration of the moving body detected by the acceleration sensor. And the function to make
It has a function of enlarging or reducing the size of the acceleration information mark displayed on the screen of the display unit in accordance with the acceleration in the front-rear direction of the moving body detected by the acceleration sensor .
The acceleration information display function of the display control device is
With the two-dimensional coordinates set on the screen of the display unit, the position of the center of the acceleration information mark is set to the positive direction of the X-axis when the acceleration sensor detects the leftward acceleration of the moving body. A function to displace and displace in the negative direction of the X-axis when the acceleration sensor detects the rightward acceleration of the moving body.
With the two-dimensional coordinates set on the screen of the display unit, the position of the center of the acceleration information mark is set in the positive direction of the Y-axis when the acceleration sensor detects the downward acceleration of the moving body. A function of displacing and displacing in the negative direction of the Y-axis when the acceleration sensor detects an upward acceleration of the moving body.
When the acceleration sensor detects the forward acceleration of the moving body, the size of the acceleration information mark displayed on the screen of the display unit is enlarged, and the backward acceleration of the moving body is detected by the acceleration sensor. A movement information display system for a moving body, which is characterized by having a function of reducing the size when the vehicle is used.
前記移動体のヨー角方向の角速度とピッチ角方向の角速度を検出する角速度センサを備え、
前記表示制御装置は、角速度情報表示機能として、
前記角速度センサで検出された前記移動体のヨー角方向の角速度とピッチ角方向の角速度とを合成して前記移動体の回頭方向、および、該回頭方向の角速度を求める機能と、
得られた前記回頭方向とその角速度の大きさに対応して、前記加速度情報表示機能で中心の位置とサイズが設定された前記加速度情報マークに接する位置と、該加速度情報マークに対する扁平する量が定められた角速度情報マークを生成する機能と、
生成された前記角速度情報マークを、前記加速度情報マークに付属させて、前記表示部の画面に表示する機能と、を備える
請求項1記載の移動体の運動情報表示システム。 To the moving body
It is provided with an angular velocity sensor that detects the angular velocity in the yaw angle direction and the angular velocity in the pitch angular direction of the moving body.
The display control device has an angular velocity information display function.
A function of synthesizing the angular velocity in the yaw angle direction and the angular velocity in the pitch angular direction of the moving body detected by the angular velocity sensor to obtain the turning direction of the moving body and the angular velocity in the turning direction.
Corresponding to the obtained turning direction and the magnitude of the angular velocity, the position in contact with the acceleration information mark whose center position and size are set by the acceleration information display function and the amount of flattening with respect to the acceleration information mark are A function to generate a specified angular velocity information mark and
The motion information display system for a moving body according to claim 1 , further comprising a function of attaching the generated angular velocity information mark to the acceleration information mark and displaying it on the screen of the display unit.
前記表示制御装置の角速度情報表示機能は、前記表示部の画面に、前記角速度センサで検出された前記移動体のロール角方向の角速度に対応して角度姿勢が変化する別の角速度情報マークを表示する機能を備えた
請求項2記載の移動体の運動情報表示システム。 The angular velocity sensor provided in the moving body has a function of detecting the angular velocity in the roll angle direction of the moving body.
The angular velocity information display function of the display control device displays another angular velocity information mark whose angular velocity changes according to the angular velocity in the roll angular direction of the moving body detected by the angular velocity sensor on the screen of the display unit. With the ability to
The movement information display system for a moving body according to claim 2.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017155540A JP6915442B2 (en) | 2017-08-10 | 2017-08-10 | Motion information display system for moving objects |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017155540A JP6915442B2 (en) | 2017-08-10 | 2017-08-10 | Motion information display system for moving objects |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019036025A JP2019036025A (en) | 2019-03-07 |
JP6915442B2 true JP6915442B2 (en) | 2021-08-04 |
Family
ID=65637393
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2017155540A Active JP6915442B2 (en) | 2017-08-10 | 2017-08-10 | Motion information display system for moving objects |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6915442B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20240196062A1 (en) * | 2021-04-16 | 2024-06-13 | Panasonic Intellectual Property Management Co., Ltd. | Video display system and video display method |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3234633B2 (en) * | 1992-06-19 | 2001-12-04 | シャープ株式会社 | Information processing device |
JPH0717492A (en) * | 1993-07-01 | 1995-01-20 | Japan Aviation Electron Ind Ltd | Remote controller type unmanned helicopter mechanism |
JP2006138710A (en) * | 2004-11-11 | 2006-06-01 | Honda Motor Co Ltd | Meter device for vehicle |
JP6122381B2 (en) * | 2013-11-29 | 2017-04-26 | 本田技研工業株式会社 | Monitor device |
-
2017
- 2017-08-10 JP JP2017155540A patent/JP6915442B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2019036025A (en) | 2019-03-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
ES2902469T3 (en) | Methods and systems for the control of the movement of flying devices | |
US20190042003A1 (en) | Controller with Situational Awareness Display | |
US11194407B2 (en) | Controller with situational awareness display | |
JP4012749B2 (en) | Remote control system | |
CN107235013A (en) | Automotive positioning pan and tilt head | |
JP2022136318A (en) | Robot control device, robot system, robot control method, and robot control program | |
JP7023492B2 (en) | Follow-up image presentation system for moving objects | |
EP3653488B1 (en) | Methods and systems for controlling propulsion of a marine vessel to enhance proximity sensing in a marine environment | |
JP2013534339A (en) | Drive command based vision system control system and method for target tracking | |
JP2019059314A (en) | Flight control device, method and program | |
KR101132713B1 (en) | Device for control of moving robot, moving robot system having the same and method for control of moving robot | |
JP6915442B2 (en) | Motion information display system for moving objects | |
EP3276306B1 (en) | Navigating an unmanned aerial vehicle | |
JP2017102242A (en) | Information display system | |
JPWO2020166178A1 (en) | Information processing equipment, information processing methods and programs | |
JP5092300B2 (en) | Head motion tracker device | |
JP2019176418A (en) | Management system of work vehicle | |
JP2019175312A (en) | Management system for working vehicle | |
JP5174636B2 (en) | Remote control system and remote control device | |
WO2019172335A1 (en) | Flight control device, method, program, and storage medium | |
JP7128497B2 (en) | Image display system for working machines | |
KR102564594B1 (en) | 3D reconstruction device, 3D reconstruction system, 3D reconstruction method, and 3D reconstruction program | |
JP7243141B2 (en) | Movement route generation device, movement route generation method, and computer program | |
JP6707224B2 (en) | Information processing apparatus, information processing apparatus program, head mounted display, and display system | |
JP7379253B2 (en) | Behavior estimation system and behavior estimation method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20190325 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20190326 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200408 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210324 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210406 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210528 |
|
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: 20210615 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210628 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6915442 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |