[go: up one dir, main page]

JP2018030417A - Sailing body control device, sailing body control method and program for sailing body control - Google Patents

Sailing body control device, sailing body control method and program for sailing body control Download PDF

Info

Publication number
JP2018030417A
JP2018030417A JP2016162849A JP2016162849A JP2018030417A JP 2018030417 A JP2018030417 A JP 2018030417A JP 2016162849 A JP2016162849 A JP 2016162849A JP 2016162849 A JP2016162849 A JP 2016162849A JP 2018030417 A JP2018030417 A JP 2018030417A
Authority
JP
Japan
Prior art keywords
reaction force
instruction
control unit
magnitude
inappropriate
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2016162849A
Other languages
Japanese (ja)
Other versions
JP6805629B2 (en
Inventor
悠暉 菅原
Yuki Sugawara
悠暉 菅原
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.)
NEC Corp
Original Assignee
NEC Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by NEC Corp filed Critical NEC Corp
Priority to JP2016162849A priority Critical patent/JP6805629B2/en
Publication of JP2018030417A publication Critical patent/JP2018030417A/en
Application granted granted Critical
Publication of JP6805629B2 publication Critical patent/JP6805629B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Navigation (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a sailing body control device, a sailing body control method and a program for sailing body control, which can prompt an operator to safer operation.SOLUTION: A sailing body control device 200 comprises: an operation part 210 for inputting an instruction concerning the sailing of a sailing body; a reaction force application part 230 for applying reaction force, which is the force against the inputted instruction, to the operation part 210; and a determination part 220 for determining whether or not the instruction is inadequate, on the basis of a result which is collected by a measurement part connected to the sailing body and includes the environment around the sailing body. The reaction force application part 230 makes the magnitude of the reaction force larger when the instruction is determined to be inadequate.SELECTED DRAWING: Figure 5

Description

本発明は、航走体制御装置、航走体制御方法および航走体制御用のプログラムに関する。   The present invention relates to a traveling body control device, a traveling body control method, and a traveling body control program.

船舶等の航走体は、操縦者による操作によって速力や針路等が指示され、当該指示に応じて水上や水中を航走する。そのような航走体では、誤操作が行われ得る。例えば、航走体が水中で所定の角度よりも下向きに航走した場合に、航走体が海底に衝突したり、限界深度を超えたりすることがある。また、航走体が高速で航走中に、急な針路変更を指示された場合には、急激な針路変更が行われるので、不測の事態が生じ得る。   A traveling body such as a ship is instructed by a pilot to operate at a speed, a course, and the like, and travels on and under water according to the instruction. In such a vehicle, an erroneous operation can be performed. For example, when a traveling body travels below a predetermined angle in water, the traveling body may collide with the seabed or exceed the limit depth. In addition, if a sudden course change is instructed while the traveling body is traveling at a high speed, an unexpected situation may occur because a sudden course change is performed.

さらに、そのような航走体では、針路の前方に障害物がある場合でも、操縦者に注意を促すことなく障害物に向けて進んでしまうという問題がある。また、操縦桿の操舵感が常時一定であるので、航走体を長時間操縦する場合には、操縦者に大きな負担が掛かるという問題がある。   Further, such a traveling body has a problem that even if there is an obstacle in front of the course, the vehicle travels toward the obstacle without alerting the operator. In addition, since the control feeling of the control stick is always constant, there is a problem that a heavy burden is imposed on the operator when the navigation body is controlled for a long time.

特許文献1には、外力検出装置の検出結果に応じて、横転の危険性を報知する横転危険警告装置が記載されている。   Patent Document 1 describes a rollover danger warning device that notifies the risk of rollover according to the detection result of an external force detection device.

特許文献2には、機体速度等の機体状態量とグリップの回転位置とに応じて、追加の反力をグリップに加える操舵補助装置が記載されている。   Patent Literature 2 describes a steering assist device that applies an additional reaction force to a grip in accordance with a body state quantity such as a body speed and a rotational position of the grip.

特許文献1に記載されている横転危険警告装置、および特許文献2に記載されている操舵補助装置は、車両に加わる外力の大きさや機体の速度等を計測し、計測の結果に基づいて不測の事態に繋がる指示の入力がなされたか否かを判定する。そして、不測の事態に繋がる指示の入力がなされたと判定した場合には、その旨を報知したり追加の反力をグリップに加えたりして不測の事態の発生防止を図っている。   The rollover danger warning device described in Patent Document 1 and the steering assist device described in Patent Document 2 measure the magnitude of external force applied to the vehicle, the speed of the fuselage, and the like, and are unexpected based on the measurement results. It is determined whether or not an instruction related to the situation has been input. And when it determines with the instruction | indication which leads to an unforeseen situation having been made, that fact is alert | reported or additional reaction force is added to a grip and the occurrence of unforeseen situation is aimed at.

国際公開第2015/133339号International Publication No. 2015/133339 特開2011−235711号公報JP 2011-235711 A 特開2014−46801号公報JP 2014-46801 A 特開2009−233082号公報JP 2009-233082 A

しかし、特許文献1に記載されている横転危険警告装置、および特許文献2に記載されている操舵補助装置では、不測の事態に繋がる指示の入力がなされたか否かの判定に、車両や機体の周囲の状況や環境等が考慮されていない。よって、精度高く不測の事態に繋がる指示の入力がなされたか否かを判定することができないので、不測の事態に繋がる指示の入力がなされた旨の報知や、グリップにおける反力の加増を適切に行えない場合がある。したがって、不測の事態が発生する可能性が高まる。   However, in the rollover warning device described in Patent Document 1 and the steering assist device described in Patent Document 2, it is necessary to determine whether or not an instruction that leads to an unexpected situation has been input. The surrounding situation and environment are not considered. Therefore, since it is impossible to determine whether or not an instruction that leads to an unexpected situation has been made with high accuracy, it is possible to appropriately notify that the instruction that leads to an unexpected situation has been entered and increase the reaction force in the grip. It may not be possible. Therefore, the possibility of an unexpected situation increases.

そこで、本発明は、操縦者により安全な操縦を促すことができる航走体制御装置、航走体制御方法および航走体制御用のプログラムを提供することを目的とする。   SUMMARY OF THE INVENTION An object of the present invention is to provide a traveling body control device, a traveling body control method, and a traveling body control program that can prompt a pilot to perform safe steering.

上記目的を達成するために、本発明の一態様における航走体制御装置は、航走体の航走に関する指示を入力する操縦手段と、入力された前記指示に反する力である反力を前記操縦手段に加える反力印加手段と、前記航走体に接続された計測手段が計測した、前記航走体の周囲の環境を含む結果に基づき、前記指示が不適切であるか否かを判定する判定手段とを備え、前記反力印加手段は、前記指示が不適切であると判定された場合には、前記反力の大きさをより大きくすることを特徴とする。   In order to achieve the above object, a traveling body control device according to an aspect of the present invention provides a steering unit that inputs instructions relating to the traveling of a traveling body, and a reaction force that is a force against the input instructions. It is determined whether or not the instruction is inappropriate based on a result including a reaction force applying means applied to the control means and a measurement means connected to the traveling body and including an environment around the traveling body. Determination means, and the reaction force application means increases the magnitude of the reaction force when the instruction is determined to be inappropriate.

上記目的を達成するために、本発明の一態様における航走体制御方法は、航走体の航走に関する指示を入力し、入力された前記指示に反する力である反力を加え、前記航走体に接続された計測手段が計測した、前記航走体の周囲の環境を含む結果に基づき、前記指示が不適切であるか否かを判定し、前記指示が不適切であると判定された場合には、前記反力の大きさをより大きくすることを特徴とする。   In order to achieve the above object, a traveling body control method according to one aspect of the present invention inputs an instruction related to traveling of a traveling body, adds a reaction force that is a force against the input instruction, and Based on the result of the measurement unit connected to the traveling body and including the environment surrounding the traveling body, it is determined whether or not the instruction is inappropriate, and the instruction is determined to be inappropriate. In this case, the magnitude of the reaction force is further increased.

上記目的を達成するために、本発明の一態様における航走体制御用のプログラムは、航走体制御装置のコンピュータに、航走体の航走に関する指示を入力する処理と入力された前記指示に反する力である反力を加える処理と、前記航走体に接続された計測手段が計測した、前記航走体の周囲の環境を含む結果に基づき、前記指示が不適切であるか否かを判定する処理と、前記指示が不適切であると判定された場合には、前記反力の大きさをより大きくする処理とを実行させることを特徴とする。   In order to achieve the above object, a program for controlling a traveling vehicle according to an aspect of the present invention includes a process for inputting an instruction related to traveling of a traveling vehicle to the computer of the traveling vehicle control device, and the input instruction. It is determined whether or not the instruction is inappropriate based on a process including applying a reaction force, which is a counteracting force, and a result including a surrounding environment measured by the measurement unit connected to the traveling body. A process for determining and a process for increasing the magnitude of the reaction force are executed when it is determined that the instruction is inappropriate.

本発明によれば、操縦者により安全な操縦を促すことができる。   According to the present invention, it is possible to promote safer maneuvering by the operator.

第1の実施形態における航走体制御装置の構成例を示すブロック図である。It is a block diagram which shows the structural example of the navigation body control apparatus in 1st Embodiment. 第1の実施形態における操縦部に掛かる反力の大きさを調整する処理の例を示すフローチャートである。It is a flowchart which shows the example of the process which adjusts the magnitude | size of the reaction force applied to the control part in 1st Embodiment. 第1の実施形態における操縦部に設定され得る反力の大きさの例を示す説明図である。It is explanatory drawing which shows the example of the magnitude | size of the reaction force which can be set to the control part in 1st Embodiment. 第1の実施形態における操縦部に設定され得る反力の大きさの例を示す説明図である。It is explanatory drawing which shows the example of the magnitude | size of the reaction force which can be set to the control part in 1st Embodiment. 第2の実施形態における航走体制御装置の構成例を示すブロック図である。It is a block diagram which shows the structural example of the navigation body control apparatus in 2nd Embodiment. 第2の実施形態における航走体制御装置の動作例を示すフローチャートである。It is a flowchart which shows the operation example of the navigation body control apparatus in 2nd Embodiment.

(第1の実施形態)
第1の実施形態について図面を参照して説明する。
(First embodiment)
A first embodiment will be described with reference to the drawings.

図1は、本実施形態における航走体制御装置100の構成例を示すブロック図である。図1に示すように、航走体制御装置100は、操縦部110と、変換制御部140と、変換部150とを備える。そして、変換制御部140には、センサ部120と、記憶部130とが接続される。ここで、記憶部130は、航走体制御装置100の内部に設置されてもよいし、外部に設置されてもよい。なお、航走体制御装置100は、例えば、水上や水中を航走する船舶等の航走体に搭載される。そして、センサ部120は、航走体に設置される。   FIG. 1 is a block diagram illustrating a configuration example of a navigation vehicle control apparatus 100 according to the present embodiment. As shown in FIG. 1, the traveling body control device 100 includes a control unit 110, a conversion control unit 140, and a conversion unit 150. The conversion control unit 140 is connected to the sensor unit 120 and the storage unit 130. Here, the memory | storage part 130 may be installed in the navigation body control apparatus 100, and may be installed in the exterior. The traveling body control device 100 is mounted on a traveling body such as a ship that travels on the water or in the water. And the sensor part 120 is installed in a navigation body.

操縦部110は、航走体の速力や針路(進行方向)等の変更が指示された場合に、当該指示に基づき航走体のスクリュ(図示せず)や舵(図示せず)等を制御して、航走体の速力や針路を変更する。操縦部110は、例えば、ハンドル(ステアリングホイール)等の操縦輪やジョイスティック等の操縦桿である。操縦部110がハンドルやジョイスティックである場合には、例えば、操縦者によってハンドルが回転されたりジョイスティックが傾倒されたりすることで、速力や針路の変更が指示される。   When a change in speed or course (traveling direction) of the navigation body is instructed, the control unit 110 controls the screw (not shown), rudder (not shown), or the like of the navigation body based on the instruction. Then, change the speed and course of the navigation body. The control unit 110 is, for example, a control wheel such as a steering wheel (steering wheel) or a joystick. In the case where the control unit 110 is a handle or a joystick, for example, the steering wheel is rotated or the joystick is tilted by the operator, thereby instructing a change in speed or course.

センサ部120は、例えば、航走体の速力や、航走体の針路、海中における航走体の深度等を計測し、計測した結果(以下、「計測結果」と記載する)を変換制御部140に入力する。ここで、センサ部120は、例えば、速力センサや、深度センサ、針路センサ、舵角センサ、オイラー角センサ、ポテンショメータ、ロータリーエンコーダ等の複数のセンサ等を組み合わせて構成されている。また、センサ部120にはソナーが含まれていてもよい。この場合には、センサ部120は、航走体の針路前方ξ[m]以内に、他の船舶や、水中生物、地形に起因する障害物等があることを検知することができる。なお、計測結果には、少なくとも、航走体の速力を示す情報(以下、「速力情報」と記載する)と、航走体の針路前方における他の船舶や障害物等の有無を示す情報(以下、「周囲環境情報」)とが含まれる。なお、計測手段による計測には、例えば、センサ部120による障害物等の検知も含まれる。また、針路は、航走体の中心から、航走体の先頭を指向する方向であってもよい。具体的には、例えば、航走体が船舶である場合に、航走体の中心から船首を指向する方向であってもよい。   The sensor unit 120 measures, for example, the speed of the traveling body, the course of the traveling body, the depth of the traveling body in the sea, and the measurement result (hereinafter referred to as “measurement result”) as a conversion control unit. 140 is entered. Here, the sensor unit 120 is configured by combining a plurality of sensors such as a speed sensor, a depth sensor, a course sensor, a rudder angle sensor, an Euler angle sensor, a potentiometer, and a rotary encoder, for example. The sensor unit 120 may include sonar. In this case, the sensor unit 120 can detect that there are other ships, aquatic organisms, obstacles due to topography, and the like within the course forward ξ [m] of the traveling body. The measurement result includes at least information indicating the speed of the navigation body (hereinafter referred to as “speed information”) and information indicating the presence or absence of other ships or obstacles in front of the course of the navigation body ( Hereinafter, “ambient environment information”) is included. Note that the measurement by the measurement unit includes, for example, detection of an obstacle or the like by the sensor unit 120. Further, the course may be a direction from the center of the traveling body to the head of the traveling body. Specifically, for example, when the navigation body is a ship, the direction from the center of the navigation body toward the bow may be used.

そして、変換制御部140は、センサ部120から入力された計測結果に基づき、例えば、航走体が速力α[kt]以上の速力で航走しているか否かや、操縦部110に指示された角度(以下、「操作角」と記載する)がδ[deg]以上であるか否か、水中における航走体の深度がη[m]以上であるか否か、航走体の針路を下方に向ける操作角がε[deg]以上であるか否か等を判断する。   Then, based on the measurement result input from the sensor unit 120, the conversion control unit 140 is instructed by the control unit 110, for example, whether or not the traveling body is traveling at a speed equal to or higher than the speed α [kt]. Whether the angle of the vehicle (hereinafter referred to as “operation angle”) is δ [deg] or more, whether the depth of the vehicle in water is η [m] or more, It is determined whether or not the operation angle directed downward is ε [deg] or more.

記憶部130には、航海情報が記憶されている。ここで、航海情報とは、慣性航法装置から入力された航走体の現在位置を海図において示す情報である。なお、航海情報は、航走体が水上を航走している場合や航走体に含まれるアンテナが水上に出ている場合に、衛星測位システムを用いて測位された航走体の現在位置を海図において示す情報であってもよい。   The storage unit 130 stores voyage information. Here, the navigation information is information indicating the current position of the traveling body input from the inertial navigation device in a chart. Navigation information is based on the current position of the navigation body measured using the satellite positioning system when the navigation body is traveling on the water or when the antenna included in the navigation body is on the water. May be information shown in a nautical chart.

変換制御部140は、操縦部110が操作されたことに応じて、センサ部120から入力された計測結果と、記憶部130から読み出した航海情報とに基づき、操縦者によって操縦部110に入力された指示が不適切な指示であるか否かを判定する。変換制御部140は、操縦者によって不適切な指示が入力されたと判定した場合には、その旨を示す異常情報を変換部150に入力する。また、変換制御部140は、操縦者によって不適切な指示が入力されていないと判定した場合には、その旨を示す通常情報と、計測結果とを変換部150に入力する。   The conversion control unit 140 is input to the control unit 110 by the pilot based on the measurement result input from the sensor unit 120 and the navigation information read from the storage unit 130 in response to the operation of the control unit 110. It is determined whether the received instruction is inappropriate. If the conversion control unit 140 determines that an inappropriate instruction has been input by the operator, the conversion control unit 140 inputs abnormality information indicating that fact to the conversion unit 150. If the conversion control unit 140 determines that an inappropriate instruction has not been input by the pilot, the conversion control unit 140 inputs normal information indicating that fact and a measurement result to the conversion unit 150.

変換部150は、変換制御部140からの入力に基づき、操縦部110に加える反力の大きさを調整したり、操縦部110を振動させたりする。ここで、反力とは、操縦者による指示を示す操縦部110になされた操作を、妨げようとする力である。例えば、操縦部110がハンドルである場合には、反力は、操縦者がハンドルの回転を妨げる力である。また、例えば、操縦部110がジョイスティックである場合には、反力は、操縦者がジョイスティックを倒すことを妨げる力である。変換部150は、例えば、空気ばねのように空気圧を利用したり、電磁石において電流の向きや大きさを変更したりして、操縦部110に加える反力の大きさや方向を調整したり、操縦部110を振動させたりする。   The conversion unit 150 adjusts the magnitude of the reaction force applied to the control unit 110 or vibrates the control unit 110 based on the input from the conversion control unit 140. Here, the reaction force is a force that hinders an operation performed on the control unit 110 indicating an instruction from the operator. For example, when the control unit 110 is a handle, the reaction force is a force that prevents the driver from rotating the handle. For example, when the control unit 110 is a joystick, the reaction force is a force that prevents the operator from defeating the joystick. The conversion unit 150 adjusts the magnitude and direction of the reaction force applied to the control unit 110 by using air pressure, such as an air spring, or changing the direction and magnitude of current in the electromagnet, The part 110 is vibrated.

ここで、不適切な指示が入力された旨を示す異常情報が変換制御部140から入力された場合には、変換部150は、操縦部110を振動させる。そして、変換部150は、操縦部110に加える反力の大きさを、後述する危険回避用の反力の大きさに設定する。   Here, when abnormality information indicating that an inappropriate instruction has been input is input from the conversion control unit 140, the conversion unit 150 vibrates the control unit 110. Then, the conversion unit 150 sets the magnitude of the reaction force applied to the control unit 110 to the magnitude of the reaction force for danger avoidance described later.

それに対して、不適切な指示が入力されていない旨を示す通常情報と計測結果とが変換制御部140から入力された場合には、変換部150は、操縦部110に加える反力の大きさを、入力された計測結果に含まれる速力情報が示す航走体の速力に応じた後述の大きさに設定する。   On the other hand, when normal information indicating that an inappropriate instruction has not been input and a measurement result are input from the conversion control unit 140, the conversion unit 150 determines the magnitude of the reaction force applied to the control unit 110. Is set to a size described later according to the speed of the traveling body indicated by the speed information included in the input measurement result.

次に、航走体制御装置100の動作について、図面を参照して説明する。   Next, the operation of the vehicle control apparatus 100 will be described with reference to the drawings.

ここで、図2は、航走体が水上航走を行う場合に、操縦部110に掛かる反力の大きさを調整する処理の例を示すフローチャートである。また、図3および図4は、図2に示す操縦部110に掛かる反力の大きさを調整する処理において、操縦部110に加え得る反力の大きさの例を示す説明図である。   Here, FIG. 2 is a flowchart illustrating an example of a process for adjusting the magnitude of the reaction force applied to the control unit 110 when the traveling body performs surface navigation. 3 and 4 are explanatory diagrams showing examples of the magnitude of the reaction force that can be applied to the control section 110 in the process of adjusting the magnitude of the reaction force applied to the control section 110 shown in FIG.

なお、図3および図4に示す例における変数等は、次のように定義される。(1):xは、航走体の現在の速力を示す。ここで、Xを航走体の最大速力とした場合には、xとXとの間には、x≦Xという関係が成り立つ。(2):f(x)=pは本動作例開始時点で操縦部110に加えられている反力の大きさであり、図3および図4において点線で示されている。なお、当該反力の大きさpは定数である。(3):f(x)=cは、不適切な指示が入力されたと判定された場合に操縦部110に加える反力の大きさであり、図3において一点鎖線で示されている。ここで、f(x)=cは、危険回避用の反力の大きさを表す。なお、当該反力の大きさcは、p<cが成り立つ定数である。(4):f(x)=ax+bは、不適切な指示が入力されていないと判定された場合に、航走体の速力xがα[kt]以上のときに操縦部110に加える反力の大きさであり、図3においてx≧αの範囲の実線で示されている。ここで、当該反力の大きさax+bと、前述の反力の大きさpとの間には、p≦ax+bが成り立つ。また、aα+b=pが成り立つ。なお、aおよびbは、任意の値である。(5):f(x)=dは、不適切な指示が入力されていないと判定された場合に、航走体の速力xがα[kt]未満のときに操縦部110に掛かる反力の大きさであり、図3においてx<αの範囲の実線で示されている。なお、当該反力の大きさdは、d≦pが成り立つ定数である。(6)f(x)=cとf(x)=ax+bとの間には、max(ax+b)≦cという関係が成り立つ。なお、max(ax+b)は、α≦x≦Xの範囲において、f(x)=ax+bの最大値をいう。(7):f(x)=ax+bとf(x)=dの間には、d≦min(ax+b)という関係が成立つ。なお、min(ax+b)は、α≦x≦Xの範囲において、f(x)=ax+bの最小値をいう。   The variables and the like in the examples shown in FIGS. 3 and 4 are defined as follows. (1): x represents the current speed of the vehicle. Here, when X is the maximum speed of the vehicle, the relationship x ≦ X is established between x and X. (2): f (x) = p is the magnitude of the reaction force applied to the control unit 110 at the start of this operation example, and is indicated by a dotted line in FIGS. The magnitude p of the reaction force is a constant. (3): f (x) = c is the magnitude of the reaction force applied to the control unit 110 when it is determined that an inappropriate instruction has been input, and is indicated by a one-dot chain line in FIG. Here, f (x) = c represents the magnitude of the reaction force for avoiding danger. The magnitude c of the reaction force is a constant that satisfies p <c. (4): f (x) = ax + b is a reaction force applied to the control unit 110 when it is determined that an inappropriate instruction has not been input and the speed x of the traveling body is greater than or equal to α [kt]. 3 and is indicated by a solid line in the range of x ≧ α in FIG. Here, p ≦ ax + b is established between the magnitude of the reaction force ax + b and the magnitude of the reaction force p described above. Further, aα + b = p holds. Note that a and b are arbitrary values. (5): f (x) = d is a reaction force applied to the control unit 110 when the speed x of the traveling body is less than α [kt] when it is determined that an inappropriate instruction has not been input. 3 and is indicated by a solid line in the range of x <α in FIG. The magnitude d of the reaction force is a constant that satisfies d ≦ p. (6) A relationship of max (ax + b) ≦ c is established between f (x) = c and f (x) = ax + b. Note that max (ax + b) is the maximum value of f (x) = ax + b in the range of α ≦ x ≦ X. (7): The relationship d ≦ min (ax + b) is established between f (x) = ax + b and f (x) = d. Note that min (ax + b) is the minimum value of f (x) = ax + b in the range of α ≦ x ≦ X.

(ステップS101:センサ部120および変換制御部140の処理)
変換制御部140は、操縦部110が操作されたことに応じて、センサ部120が、航走体の速力や、航走体の針路、海中における航走体の深度等を計測した計測結果を取り込む。
(Step S101: Processing of Sensor Unit 120 and Conversion Control Unit 140)
In response to the operation of the control unit 110, the conversion control unit 140 displays the measurement results obtained by the sensor unit 120 measuring the speed of the traveling body, the course of the traveling body, the depth of the traveling body in the sea, and the like. take in.

また、変換制御部140は、記憶部130に記憶されている航海情報を読み出す。   In addition, the conversion control unit 140 reads the navigation information stored in the storage unit 130.

(ステップS102:変換制御部140の処理)
変換制御部140は、センサ部120から入力された計測結果と、記憶部130から読み出した航海情報とに基づき、操縦部110に入力された指示が不適切な指示であるか否かを判定する。そして、変換制御部140が不適切な指示が入力されたと判定した場合には(ステップS102のYes)、ステップS103の処理に移行する。それに対して、変換制御部140が不適切な指示が入力されていないと判定した場合には(ステップS102のNo)、ステップS105の処理に移行する。
(Step S102: Processing of Conversion Control Unit 140)
The conversion control unit 140 determines whether the instruction input to the control unit 110 is an inappropriate instruction based on the measurement result input from the sensor unit 120 and the navigation information read from the storage unit 130. . If the conversion control unit 140 determines that an inappropriate instruction has been input (Yes in step S102), the process proceeds to step S103. On the other hand, when the conversion control unit 140 determines that an inappropriate instruction has not been input (No in step S102), the process proceeds to step S105.

ここで、例えば、変換制御部140は、計測結果に基づき、航走体が速力α[kt]以上の速力xで航走中に、操縦部110においての操作角がδ[deg]以上の操作がなされたと判断した場合に、不適切な指示が入力されたと判定する。また、例えば、変換制御部140は、計測結果に基づき、海中における航走体の深度がη[m]以上であるときに、航走体の針路を下方に向かせる操縦部110においての操作角がε[deg]以上の操作がなされたと判断した場合に、不適切な指示が入力されたと判定する。また、例えば、変換制御部140は、航走体の針路が、前方ξ[m]以内に、他の船舶や、水中生物、地形に基づく障害物等がある方向になったと判断した場合に、不適切な指示が入力されたと判定する。また、例えば、変換制御部140は、計測結果および航海情報に基づき、航走体の針路が離岸流が発生する危険海域に向けられたと判断した場合に、不適切な指示が入力されたと判定する。なお、例えば、そのような針路等の変更が行われなかった場合には、変換制御部140は、不適切な指示が入力されたと判定しない。   Here, for example, based on the measurement result, the conversion control unit 140 operates an operation with an operation angle of δ [deg] or more in the control unit 110 while the traveling body is traveling at a speed x of speed α [kt] or more. If it is determined that an incorrect instruction has been input, it is determined that an inappropriate instruction has been input. Further, for example, the conversion control unit 140 operates based on the measurement result when the depth of the traveling body in the sea is η [m] or more, the operation angle in the control unit 110 that causes the course of the traveling body to be directed downward. When it is determined that an operation equal to or greater than ε [deg] has been performed, it is determined that an inappropriate instruction has been input. For example, when the conversion control unit 140 determines that the course of the navigation body is in a direction with other ships, underwater creatures, obstacles based on landforms, or the like within the forward ξ [m], It is determined that an inappropriate instruction has been input. Further, for example, the conversion control unit 140 determines that an inappropriate instruction has been input when it is determined that the course of the traveling body is directed to a dangerous sea area where a rip current is generated based on the measurement result and the navigation information. To do. For example, when such a course change has not been performed, the conversion control unit 140 does not determine that an inappropriate instruction has been input.

(ステップS103:変換制御部140および変換部150の処理)
変換制御部140は、不適切な指示が入力されたと判定した場合には(ステップS102のYes)、異常情報を変換部150に入力する。そして、変換部150は、当該入力に応じて、空気圧を利用したり電磁石における電流の向きや大きさを変更したりして、操縦部110を振動させる。これによって、操縦者に不適切な指示が入力された旨を報知することができる。
(Step S103: Processing of Conversion Control Unit 140 and Conversion Unit 150)
If the conversion control unit 140 determines that an inappropriate instruction has been input (Yes in step S102), the conversion control unit 140 inputs abnormality information to the conversion unit 150. Then, the conversion unit 150 vibrates the control unit 110 by using air pressure or changing the direction and magnitude of the current in the electromagnet according to the input. As a result, it is possible to notify the operator that an inappropriate instruction has been input.

(ステップS104:変換部150の処理)
さらに、変換部150は、ステップS103の処理で異常情報が入力されたことに応じて、図3に示すように、操縦部110に掛ける反力の大きさをpからcに変更する。すなわち、操縦部110に加えられる反力の大きさは、不適切な指示が入力されたと変換制御部140によって判定される以前の大きさpよりも大きいcに変更される。そのような構成により、不適切な指示が継続的に入力されること抑制することができるので、操縦者による安全な操縦を促すことができる。
(Step S104: Processing of Conversion Unit 150)
Further, the conversion unit 150 changes the magnitude of the reaction force applied to the control unit 110 from p to c as shown in FIG. 3 in response to the input of the abnormality information in the process of step S103. That is, the magnitude of the reaction force applied to the control unit 110 is changed to c that is larger than the previous size p determined by the conversion control unit 140 that an inappropriate instruction has been input. With such a configuration, it is possible to prevent an inappropriate instruction from being continuously input, and thus it is possible to prompt a safe operation by the operator.

なお、操縦部110に加えられる反力の大きさを調整する処理は、例えば、所定の時間間隔で行われる。   In addition, the process which adjusts the magnitude | size of the reaction force applied to the control part 110 is performed at a predetermined time interval, for example.

(ステップS105:変換制御部140および変換部150の処理)
変換制御部140は、不適切な指示が入力されていないと判定した場合には(ステップS102のNo)、通常情報と計測結果とを変換部150に入力する。変換部150は、入力された計測結果に含まれている速力情報に基づき、航走体の速力xがα[kt]以上であるか否かを判断する。そして、変換部150が航走体の速力xがα[kt]以上であると判断した場合には(ステップS105のYes)、ステップS106の処理に移行する。それに対して、変換部150が航走体の速力xがα[kt]未満であると判断した場合には(ステップS105のNo)、ステップS107の処理に移行する。なお、αは、任意の値である。
(Step S105: Processing of Conversion Control Unit 140 and Conversion Unit 150)
If the conversion control unit 140 determines that an inappropriate instruction has not been input (No in step S102), the conversion control unit 140 inputs the normal information and the measurement result to the conversion unit 150. The conversion unit 150 determines whether or not the speed x of the traveling body is equal to or greater than α [kt] based on the speed information included in the input measurement result. When the conversion unit 150 determines that the speed x of the traveling body is greater than or equal to α [kt] (Yes in step S105), the process proceeds to step S106. On the other hand, when the conversion unit 150 determines that the speed x of the traveling body is less than α [kt] (No in step S105), the process proceeds to step S107. Α is an arbitrary value.

(ステップS106:変換部150の処理)
変換部150は、航走体の速力xがα[kt]以上であると判断した場合に(ステップS105のYes)、操縦部110に加える反力の大きさをpからf(x)=ax+bに変更する。よって、航走体の速力xがα[kt]以上である場合には、操縦部110に加える反力は、航走体の速力xが速くなればなるほど、大きくなる。
(Step S106: Processing of Conversion Unit 150)
When the conversion unit 150 determines that the speed x of the vehicle is greater than α [kt] (Yes in step S105), the conversion unit 150 changes the magnitude of the reaction force applied to the control unit 110 from p to f (x) = ax + b. Change to Therefore, when the speed x of the traveling body is greater than or equal to α [kt], the reaction force applied to the control unit 110 increases as the speed x of the traveling body increases.

(ステップS107:変換部150の処理)
変換部150は、航走体の速力xがα[kt]未満であると判断した場合には(ステップS105のNo)、操縦部110に掛かる反力の大きさをpからdに変更する。よって、航走体の速力xがα[kt]未満である場合には、操縦部110に加えられる反力は、より小さな反力dになる。
(Step S107: Processing of Conversion Unit 150)
When the conversion unit 150 determines that the speed x of the traveling body is less than α [kt] (No in step S105), the conversion unit 150 changes the magnitude of the reaction force applied to the control unit 110 from p to d. Therefore, when the speed x of the traveling body is less than α [kt], the reaction force applied to the control unit 110 becomes a smaller reaction force d.

そして、ステップS106の処理およびステップS107の処理の後、操縦部110における反力の大きさを調整する処理が終了する。なお、操縦部110における反力の大きさを調整する処理は、例えば、所定の時間間隔で行われる。   And the process which adjusts the magnitude | size of the reaction force in the control part 110 is complete | finished after the process of step S106 and the process of step S107. In addition, the process which adjusts the magnitude | size of the reaction force in the control part 110 is performed at a predetermined time interval, for example.

ここで、前述のステップS106の処理およびステップS107の処理では、航走体の速力xに応じて、操縦部110に加える反力の大きさが調整される。そのような構成により、航走体の速力xに応じた適切な反力が操縦部110に加えられるので、操縦者の過重な負担を回避することができる。   Here, in the process of step S106 and the process of step S107 described above, the magnitude of the reaction force applied to the control unit 110 is adjusted according to the speed x of the traveling body. With such a configuration, an appropriate reaction force according to the speed x of the traveling body is applied to the control unit 110, so that an excessive burden on the driver can be avoided.

なお、f(x)=ax+bに用いられるaおよびbと、f(x)=cに用いられるcと、f(x)=dに用いられるdと、判断に用いられる速力α[kt]とを調整することで、図2に示す航走体が水上航走を行う場合に操縦部110に加える反力の大きさを調整する処理を、航走体が水中を航走する場合にも適用することができる。   It should be noted that a and b used for f (x) = ax + b, c used for f (x) = c, d used for f (x) = d, and speed α [kt] used for determination 2, the process of adjusting the magnitude of the reaction force applied to the control unit 110 when the traveling body shown in FIG. can do.

以上のように、本実施形態における変換制御部140は、周囲環境情報や航海情報等の航走体の周囲の状況や環境を示す情報等に基づき、不適切な指示が入力されたか否かを判定する。そして、不適切な指示が入力されたと変換制御部140が判定した場合には、変換部150は、操縦部110を振動させる。さらに、変換部150は、操縦部110に加える反力を、不適切な指示が入力されたと変換制御部140が判定する以前の大きさよりも大きくする。よって、不適切な指示が入力された旨の報知と、不適切な指示が継続して入力されることの防止をより高精度に行うことができるので、操縦者に、より安全な操縦を促すことができる。   As described above, the conversion control unit 140 according to the present embodiment determines whether or not an inappropriate instruction has been input based on information such as the surrounding environment information and the navigation information, which indicates the situation and environment around the vehicle. judge. When the conversion control unit 140 determines that an inappropriate instruction has been input, the conversion unit 150 vibrates the control unit 110. Furthermore, the conversion unit 150 makes the reaction force applied to the control unit 110 larger than the size before the conversion control unit 140 determines that an inappropriate instruction has been input. Therefore, since it is possible to perform notification that an inappropriate instruction has been input and to prevent the inappropriate instruction from being continuously input with higher accuracy, the driver is encouraged to operate more safely. be able to.

さらに、本実施形態によれば、変換部150は、不適切な指示が入力されていないと変換制御部140が判定した場合には、航走体の速力に応じた適切な大きさの反力を操縦部110に加える。そのような構成によって、操縦者の負担を軽減することができ、誤った操縦が行われる可能性を低減することができるので、操縦者に、より安全な操縦を促すことができる。   Furthermore, according to the present embodiment, when the conversion control unit 140 determines that an inappropriate instruction has not been input, the conversion unit 150 has a reaction force having an appropriate magnitude according to the speed of the vehicle. Is added to the control unit 110. With such a configuration, the burden on the operator can be reduced, and the possibility that an erroneous operation is performed can be reduced, so that the operator can be encouraged to perform safer operation.

なお、本実施形態においては、操縦部110の操作角に閾値が設けられていてもよい。その理由について説明する。本実施形態によれば、操縦部110に加えられた力が微小であっても、当該力に基づき操縦部110に操作がなされて、航走体の針路が変更されてしまう虞がある。すなわち、操縦者の意図しない指示が入力されてしまう虞がある。そこで、操縦部110の操作角に閾値を設け、操縦部110における操作角が設定された閾値を超えた場合に、航走体のスクリュや舵等が操作角に応じて制御されるように構成されていてもよい。そのような構成によれば、所定の大きさの以上の力に応じた操作角の操作が行われない限り、航走体制御装置100には指示が入力されない。よって、操縦者の意図しない指示が入力されることを防止することができるので、より安全な操縦を実現することができる。なお、閾値の設定を解除したり、変更したりするためのボタン等が操縦部110等に設けられていてもよい。そのような構成によれば、状況に応じて航走体の移動を高い精度で制御することができる。   In the present embodiment, a threshold value may be provided for the operation angle of the control unit 110. The reason will be described. According to the present embodiment, even if the force applied to the control unit 110 is very small, there is a possibility that the control unit 110 is operated based on the force and the course of the traveling body is changed. That is, there is a possibility that an instruction not intended by the operator is input. Therefore, a threshold is provided for the operation angle of the control unit 110, and when the operation angle in the control unit 110 exceeds the set threshold, the screw, rudder, etc. of the traveling body are controlled according to the operation angle. May be. According to such a configuration, an instruction is not input to the navigation control apparatus 100 unless an operation angle corresponding to a predetermined magnitude or more of force is operated. Therefore, since it is possible to prevent an instruction not intended by the operator from being input, safer steering can be realized. It should be noted that a button or the like for canceling or changing the threshold setting may be provided on the control unit 110 or the like. According to such a configuration, the movement of the traveling body can be controlled with high accuracy according to the situation.

また、不適切な指示が入力されたと変換制御部140が判定した場合に、変換部150が、操縦部110を振動させたがこれに限定されない。例えば、変換部150は、音声を発するようにスピーカ(図示せず)を制御したり、発光するように発光体(図示せず)を制御したりすることで、操縦者に不適切な指示が入力された旨を報知してもよい。   In addition, when the conversion control unit 140 determines that an inappropriate instruction has been input, the conversion unit 150 vibrates the control unit 110, but the present invention is not limited to this. For example, the conversion unit 150 controls a speaker (not shown) so as to emit a sound, or controls a light emitter (not shown) so as to emit light, thereby giving an inappropriate instruction to the operator. You may alert | report that it was input.

また、本実施形態においては、不適切な指示が入力されたと判定された場合に操縦部110に加えられる反力を、航走体の速力xを変数とする1次関数や2次関数に基づいて決定するように構成されていてもよい。同様に、不適切な指示が入力されたと変換制御部140が判定した場合に、航走体の速力xがα[kt]未満のときに操縦部110に加えられる反力も、航走体の速力xを変数とする1次関数や2次関数に基づいて決定するように構成されていてもよい。そのような構成により、航走体の速力に応じた航走体の運動特性の変化に応じて、操縦部110に加える反力の大きさが適宜変更されるので、より安全な操縦を実現することができる。   In the present embodiment, the reaction force applied to the control unit 110 when it is determined that an inappropriate instruction is input is based on a linear function or a quadratic function with the speed x of the traveling body as a variable. May be configured to be determined. Similarly, when the conversion control unit 140 determines that an inappropriate instruction has been input, the reaction force applied to the control unit 110 when the speed x of the traveling body is less than α [kt] is also the speed of the traveling body. It may be configured to determine based on a linear function or a quadratic function with x as a variable. With such a configuration, the magnitude of the reaction force applied to the control unit 110 is appropriately changed according to the change in the motion characteristics of the traveling body in accordance with the speed of the traveling body, thereby realizing safer steering. be able to.

また、本実施形態において、変換部150は、操縦部110の操作角が大きくなればなるほど、操縦部110に加える反力の大きさが大きくなるように構成されてもよい。ここで、操縦部110が縦横の2方向に傾倒可能なジョイスティックである場合には、変換部150は、操縦部110が倒された方向に応じて、操縦部110に掛かる反力の大きさを調整してもよい。なお、この場合、変換部150は、センサ部120から変換制御部140に入力された計測結果に基づき、操縦部110の操作角や、操縦部110が倒された方向等を判断する。   In the present embodiment, the conversion unit 150 may be configured such that the greater the operation angle of the control unit 110, the greater the reaction force applied to the control unit 110. Here, when the control unit 110 is a joystick that can be tilted in two directions, vertical and horizontal, the conversion unit 150 determines the magnitude of the reaction force applied to the control unit 110 according to the direction in which the control unit 110 is tilted. You may adjust. In this case, the conversion unit 150 determines the operation angle of the control unit 110, the direction in which the control unit 110 is tilted, and the like based on the measurement result input from the sensor unit 120 to the conversion control unit 140.

また、本実施形態において、変換制御部140は、操縦部110に加える反力の大きさをf(x)=ax+bまたはdとする基準(航走体の速力α[kt])を、センサ部120から入力された計測結果に基づく水中における航走体の深度に応じて、適宜変更するように構成されていてもよい。   Further, in the present embodiment, the conversion control unit 140 uses the sensor unit as a reference (the speed α [kt] of the traveling body) that sets the magnitude of the reaction force applied to the control unit 110 as f (x) = ax + b or d. It may be configured to appropriately change according to the depth of the underwater vehicle based on the measurement result input from 120.

ここで、本実施形態においては、危険回避用の反力の大きさや、航走体の速力に応じた反力の大きさを、例えば、f(x,y)=ex+fy+gのような2変数関数に基づいて決定するように構成されていてもよい。また、f(x,y,z)=ex+fy+hz+gのような3変数関数に基づいて決定するように構成されていてもよい。なお、xは、例えば、航走体の速力である。また、yは、例えば、操縦部110の操作角である。zは、例えば、航走体の姿勢を表すオイラー角(姿勢角ともいう)である。また、反力の大きさが2変数関数に基づいて決定するように構成されている場合には、gは、x=0かつy=0の場合に操縦部110に加えられる反力の大きさである。また、反力の大きさが3変数関数に基づいて決定するように構成されている場合には、gは、x=0、y=0かつz=0の場合に操縦部110に加えられる反力の大きさである。また、e、f、hは、任意の値である。この場合、変換部150は、センサ部120から変換制御部140に入力された計測結果に基づき、x、y、zの値を決定する。そのような構成により、例えば、航走体の姿勢角が大きくなればなるほど、操縦部110に加える反力の大きさが大きくなるので、より安全な操縦を促すことができる。また、センサ部120が計測した複数の結果に基づく、より適切な大きさの反力が操縦部110に加えられるので、より安全な操縦を実現することができる。   Here, in the present embodiment, the magnitude of the reaction force for avoiding danger and the magnitude of the reaction force according to the speed of the traveling body are expressed by, for example, a two-variable function such as f (x, y) = ex + fy + g. May be configured to be determined based on Moreover, you may be comprised so that it may determine based on 3 variable functions like f (x, y, z) = ex + fy + hz + g. In addition, x is the speed of a navigation body, for example. Moreover, y is an operation angle of the control part 110, for example. z is, for example, an Euler angle (also referred to as an attitude angle) representing the attitude of the traveling body. When the reaction force is determined based on a two-variable function, g is the reaction force applied to the control unit 110 when x = 0 and y = 0. It is. When the magnitude of the reaction force is determined based on a three-variable function, g is a reaction applied to the control unit 110 when x = 0, y = 0, and z = 0. It is the magnitude of force. E, f, and h are arbitrary values. In this case, the conversion unit 150 determines x, y, and z values based on the measurement result input from the sensor unit 120 to the conversion control unit 140. With such a configuration, for example, as the attitude angle of the navigation body increases, the magnitude of the reaction force applied to the control unit 110 increases, and thus safer steering can be promoted. In addition, since a reaction force having a more appropriate magnitude based on a plurality of results measured by the sensor unit 120 is applied to the control unit 110, safer control can be realized.

なお、本実施形態において、変換制御部140は、センサ部120から入力された計測結果と、記憶部130から読み出した航海情報とに基づき、操縦部110に不適切な指示が入力されたか否かを判定したが、これに限定されない。例えば、変換制御部140は、センサ部120から入力された計測結果のみに基づき、操縦部110に不適切な指示が入力されたか否かを判定してもよい。そのような構成によれば、記憶部130を変換制御部140に接続させなくてよいので、航走体の構成の簡素化を実現することができる。   In the present embodiment, the conversion control unit 140 determines whether or not an inappropriate instruction is input to the control unit 110 based on the measurement result input from the sensor unit 120 and the voyage information read from the storage unit 130. However, the present invention is not limited to this. For example, the conversion control unit 140 may determine whether or not an inappropriate instruction is input to the control unit 110 based only on the measurement result input from the sensor unit 120. According to such a configuration, it is not necessary to connect the storage unit 130 to the conversion control unit 140, so that the configuration of the traveling body can be simplified.

なお、本実施形態において、変換制御部140は、記憶部130から航海情報を読み出したが、これに限定されない。例えば、変換制御部140は、備えているキャッシュメモリ(図示せず)に適宜航海情報が記憶されるように構成されていてもよい。そのような構成の場合には、例えば、変換制御部140は、キャッシュメモリに記憶されている航海情報によって示される範囲外に航走体が移動したり、記憶部130に記憶されている航海情報が更新されたりしたときに、記憶部130から航海情報を読み出す。   In the present embodiment, the conversion control unit 140 reads the voyage information from the storage unit 130, but is not limited to this. For example, the conversion control unit 140 may be configured such that navigation information is stored as appropriate in a cache memory (not shown) provided. In the case of such a configuration, for example, the conversion control unit 140 moves the navigation body outside the range indicated by the navigation information stored in the cache memory, or the navigation information stored in the storage unit 130. Is updated, the navigation information is read from the storage unit 130.

なお、本願発明は、船舶等の航走体だけでなく、ROV(Remotely Operated Vehicle)や、無線操作によって操縦される飛行体、船舶シミュレータ、自動車等に適用することもできる。   The present invention can be applied not only to a navigating body such as a ship, but also to an ROV (Remotely Operated Vehicle), a flying body operated by radio operation, a ship simulator, an automobile, and the like.

(第2の実施形態)
本発明の第2の実施形態について図面を参照して説明する。
(Second Embodiment)
A second embodiment of the present invention will be described with reference to the drawings.

図5は、本実施形態における航走体制御装置200の構成例を示すブロック図である。図5に示す例では、航走体制御装置200は、操縦部210と、判定部220と、反力印加部230とを備える。   FIG. 5 is a block diagram illustrating a configuration example of the navigation vehicle control apparatus 200 according to the present embodiment. In the example illustrated in FIG. 5, the traveling body control device 200 includes a control unit 210, a determination unit 220, and a reaction force application unit 230.

ここで、航走体制御装置200は、例えば、水上や水中を航走する船舶等の航走体に搭載される。操縦部210は、例えば、図1に示す本発明の第1の実施形態における操縦部110に相当する。また、判定に220は、例えば、図1に示す本発明の第1の実施形態における変換制御部140に相当する。また、反力印加部230は、例えば、図1に示す本発明の第1の実施形態における変換部150に相当する。   Here, the traveling body control device 200 is mounted on a traveling body such as a ship that travels on water or in water. The control unit 210 corresponds to, for example, the control unit 110 in the first embodiment of the present invention shown in FIG. Further, the determination 220 corresponds to, for example, the conversion control unit 140 in the first embodiment of the present invention shown in FIG. Moreover, the reaction force application unit 230 corresponds to, for example, the conversion unit 150 in the first embodiment of the present invention illustrated in FIG.

操縦部210は、航走体の航走に関する指示を入力する。なお、操縦部210には、当該指示に反する力である反力が反力印加部230によって加えられている。   The control unit 210 inputs an instruction related to the traveling of the traveling body. Note that a reaction force, which is a force against the instruction, is applied to the control unit 210 by the reaction force application unit 230.

判定部220は、航走体に接続された計測部(図示せず)が計測した、航走体の周囲の環境を含む結果に基づき、航走体の航走に関する指示が不適切であるか否かを判定する
反力印加部230は、航走体の航走に関する指示が不適切であると判定された場合には、操縦部210に加えられている反力の大きさをより大きくする。
The determination unit 220 determines whether the instruction regarding the traveling of the traveling body is inappropriate based on the result including the environment around the traveling body, which is measured by a measurement unit (not shown) connected to the traveling body. The reaction force application unit 230 determines the magnitude of the reaction force applied to the control unit 210 when it is determined that the instruction regarding the traveling of the vehicle is inappropriate. .

次に、航走体制御装置200の動作例を図6を参照して説明する。図6は、航走体制御装置200の動作例を示すフローチャートである。   Next, an operation example of the traveling vehicle control apparatus 200 will be described with reference to FIG. FIG. 6 is a flowchart showing an operation example of the navigation vehicle controller 200.

(S201:操縦部210における処理)
操縦部210は、航走体の航走に関する指示を入力する。
(S201: Processing in the control unit 210)
The control unit 210 inputs an instruction related to the traveling of the traveling body.

(S202:判定部220における処理)
判定部220は、航走体に接続された計測部が計測した、航走体の周囲の環境を含む結果に基づき、航走体への指示が不適切であるか否かを判定する。
(S202: Processing in Determination Unit 220)
The determination unit 220 determines whether an instruction to the traveling body is inappropriate based on a result including a surrounding environment of the traveling body, which is measured by a measurement unit connected to the traveling body.

(S203:反力印加部230における処理)
反力印加部230は、航走体の航走に関する指示が不適切であると判定された場合には、操縦部210に加えられている反力の大きさをより大きくする。
(S203: Processing in Reaction Force Application Unit 230)
The reaction force application unit 230 increases the magnitude of the reaction force applied to the control unit 210 when it is determined that the instruction regarding the traveling of the traveling body is inappropriate.

本実施形態によれば、判定部220は、計測部が計測した、航走体の周囲の環境を含む結果に基づき、航走体の航走に関する指示が不適切であるか否かを判定する。そのような構成により、判定部220は、航走体の航走に関する指示が不適切であるか否かをより精度高く判定することができる。そして、反力印加部230は、航走体の航走に関する指示が不適切であると判定された場合には、操縦部210に加えられている反力の大きさをより大きくする。   According to the present embodiment, the determination unit 220 determines whether or not the instruction regarding the traveling of the traveling body is inappropriate based on the result of the measurement unit that includes the environment around the traveling body. . With such a configuration, the determination unit 220 can determine with high accuracy whether or not an instruction regarding the traveling of the traveling body is inappropriate. Then, the reaction force application unit 230 increases the magnitude of the reaction force applied to the control unit 210 when it is determined that the instruction regarding the traveling of the traveling body is inappropriate.

したがって、本実施形態においても、本発明の第1の実施形態と同様な効果も奏することができる。   Therefore, also in this embodiment, the same effect as the 1st embodiment of the present invention can be produced.

以上、本発明の各実施形態を説明したが、本発明は、上記した各実施形態に限定されるものではなく、本発明の基本的技術的思想を逸脱しない範囲で、更なる変形や、置換、調整を加えることができる。また、各実施形態を適宜組み合わせて実施してもよい。   Although the embodiments of the present invention have been described above, the present invention is not limited to the above-described embodiments, and further modifications and substitutions are possible without departing from the basic technical idea of the present invention. You can make adjustments. Moreover, you may implement combining each embodiment suitably.

なお、上記の特許文献の各開示を、本書に引用をもって繰り込むものとする。本発明の全開示(請求の範囲を含む)の枠内において、さらにその基本的技術思想に基づいて、実施形態の変更・調整が可能である。また、本発明の請求の範囲の枠内において種々の開示要素の多様な組み合わせ、ないし選択が可能である。すなわち、本発明は、請求の範囲を含む全開示、技術的思想にしたがって当業者であればなし得る各種変形、修正を含むことは勿論である。   It should be noted that the disclosures of the above patent documents are incorporated herein by reference. Within the scope of the entire disclosure (including claims) of the present invention, the embodiment can be changed and adjusted based on the basic technical concept. Various combinations and selections of various disclosed elements are possible within the scope of the claims of the present invention. That is, the present invention of course includes various variations and modifications that can be made by those skilled in the art according to the entire disclosure including the claims and the technical idea.

100 航走体制御装置
110 操縦部
120 センサ部
130 記憶部
140 変換制御部
150 変換部
200 航走体制御装置
210 操縦部
220 判定部
230 反力印加部
DESCRIPTION OF SYMBOLS 100 Navigation body control apparatus 110 Steering part 120 Sensor part 130 Storage part 140 Conversion control part 150 Conversion part 200 Navigation body control apparatus 210 Steering part 220 Determination part 230 Reaction force application part

Claims (9)

航走体の航走に関する指示を入力する操縦手段と、
入力された前記指示に反する力である反力を前記操縦手段に加える反力印加手段と、
前記航走体に接続された計測手段が計測した、前記航走体の周囲の環境を含む計測結果に基づき、前記指示が不適切であるか否かを判定する判定手段とを備え、
前記反力印加手段は、前記指示が不適切であると判定された場合には、前記反力の大きさをより大きくする
ことを特徴とする航走体制御装置。
A control means for inputting instructions regarding the navigation of the vehicle,
Reaction force applying means for applying a reaction force, which is a force against the input instruction, to the steering means;
Determination means for determining whether or not the instruction is inappropriate based on a measurement result including an environment around the navigation body measured by a measurement means connected to the navigation body;
The vehicle control apparatus according to claim 1, wherein the reaction force application means increases the magnitude of the reaction force when it is determined that the instruction is inappropriate.
前記判定手段は、更に前記航走体の位置を海図において示す情報に基づき、前記指示が不適切であるか否かを判定する
ことを特徴とする請求項1に記載の航走体制御装置。
2. The navigation body control device according to claim 1, wherein the determination unit further determines whether or not the instruction is inappropriate based on information indicating a position of the navigation body in a chart. 3.
前記反力印加手段は、前記指示が不適切でないと判定された場合には、前記結果に基づき前記航走体の速力を特定すると共に当該速力に応じて前記反力の大きさを変更する
ことを特徴とする請求項1又は請求項2に記載の航走体制御装置。
The reaction force application means, when it is determined that the instruction is not appropriate, specifies the speed of the navigation body based on the result and changes the magnitude of the reaction force according to the speed. The navigation body control device according to claim 1 or 2, wherein
前記反力印加手段は、前記指示が不適切でないと判定された場合に前記航走体の速力が所定の値以上であったときに、前記反力の大きさを前記航走体の速力を変数とする1次関数の式に基づき算出したより大きな値に変更する
ことを特徴とする請求項1乃至3のいずれか1項に記載の航走体制御装置。
The reaction force applying means determines the magnitude of the reaction force when the speed of the traveling body is equal to or greater than a predetermined value when it is determined that the instruction is not appropriate. The navigation body control device according to any one of claims 1 to 3, wherein the navigation body control device is changed to a larger value calculated based on an expression of a linear function as a variable.
前記反力印加手段は、前記指示が不適切でないと判定された場合に前記航走体の速力が所定の値未満であったときに、前記反力の大きさを当該判定以前から前記操縦手段に加えられている大きさ以下の大きさに変更する
ことを特徴とする請求項1乃至4のいずれか1項に記載の航走体制御装置。
The reaction force applying means determines the magnitude of the reaction force from before the determination when the speed of the traveling body is less than a predetermined value when it is determined that the instruction is not inappropriate. The navigation body control device according to any one of claims 1 to 4, wherein the navigation body control device is changed to a size equal to or smaller than a size added to the vehicle.
前記反力印加手段は、前記指示が不適切であると判定された場合に、前記反力の大きさを当該判定以前から前記操縦手段に加えられている大きさよりも大きい大きさに変更する
ことを特徴とする請求項1乃至5のいずれか1項に記載の航走体制御装置。
When it is determined that the instruction is inappropriate, the reaction force applying means changes the magnitude of the reaction force to a magnitude larger than that applied to the steering means before the determination. The navigation body control device according to any one of claims 1 to 5, wherein:
請求項1乃至6のいずれか1項に記載の航走体制御装置を備えることを特徴とする航走体。 A traveling body comprising the traveling body control device according to any one of claims 1 to 6. 航走体の航走に関する指示を入力し、
入力された前記指示に反する力である反力を加え、
前記航走体に接続された計測手段が計測した、前記航走体の周囲の環境を含む計測結果に基づき、前記指示が不適切であるか否かを判定し、
前記指示が不適切であると判定された場合には、前記反力の大きさをより大きくする
ことを特徴とする航走体制御方法。
Enter instructions regarding the navigation of the vehicle,
Apply a reaction force that is against the input instruction,
Based on the measurement result including the environment around the navigation body measured by the measurement means connected to the navigation body, determine whether the instruction is inappropriate,
The navigation body control method characterized by increasing the magnitude of the reaction force when it is determined that the instruction is inappropriate.
コンピュータに、
航走体の航走に関する指示を入力する処理と
入力された前記指示に反する力である反力を加える処理と、
前記航走体に接続された計測手段が計測した、前記航走体の周囲の環境を含む結果に基づき、前記指示が不適切であるか否かを判定する処理と、
前記指示が不適切であると判定された場合には、前記反力の大きさをより大きくする処理と
を実行させるための航走体制御用のプログラム。
On the computer,
A process of inputting an instruction relating to the traveling of the vehicle, a process of applying a reaction force that is a force against the input instruction,
A process of determining whether or not the instruction is inappropriate based on a result including an environment around the navigation body measured by a measurement unit connected to the navigation body;
A program for controlling a traveling body for executing a process of increasing the magnitude of the reaction force when it is determined that the instruction is inappropriate.
JP2016162849A 2016-08-23 2016-08-23 Vehicle control device, vehicle control method and program for vehicle control Active JP6805629B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016162849A JP6805629B2 (en) 2016-08-23 2016-08-23 Vehicle control device, vehicle control method and program for vehicle control

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016162849A JP6805629B2 (en) 2016-08-23 2016-08-23 Vehicle control device, vehicle control method and program for vehicle control

Publications (2)

Publication Number Publication Date
JP2018030417A true JP2018030417A (en) 2018-03-01
JP6805629B2 JP6805629B2 (en) 2020-12-23

Family

ID=61304332

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016162849A Active JP6805629B2 (en) 2016-08-23 2016-08-23 Vehicle control device, vehicle control method and program for vehicle control

Country Status (1)

Country Link
JP (1) JP6805629B2 (en)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6147449U (en) * 1984-08-31 1986-03-29 スズキ株式会社 Outboard motor output control device
US20030150366A1 (en) * 2002-02-13 2003-08-14 Kaufmann Timothy W. Watercraft steer-by-wire system
JP2004220422A (en) * 2003-01-16 2004-08-05 Denso Corp Contact prevention system of vehicle
JP2005014710A (en) * 2003-06-25 2005-01-20 Nissan Motor Co Ltd Drive assist device for vehicle and vehicle having drive assist device for vehicle
JP2007050823A (en) * 2005-08-19 2007-03-01 Yamaha Marine Co Ltd Behavior control device for small vessel
JP2008001205A (en) * 2006-06-21 2008-01-10 Jtekt Corp Steering device for ship
JP2008094256A (en) * 2006-10-12 2008-04-24 Yamaha Marine Co Ltd Water vehicle
JP2010092245A (en) * 2008-10-07 2010-04-22 Hiroshima Ichi Safety navigation network system for vessel
WO2010116509A1 (en) * 2009-04-09 2010-10-14 トヨタ自動車株式会社 Maneuver assisting device

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6147449U (en) * 1984-08-31 1986-03-29 スズキ株式会社 Outboard motor output control device
US20030150366A1 (en) * 2002-02-13 2003-08-14 Kaufmann Timothy W. Watercraft steer-by-wire system
JP2004220422A (en) * 2003-01-16 2004-08-05 Denso Corp Contact prevention system of vehicle
JP2005014710A (en) * 2003-06-25 2005-01-20 Nissan Motor Co Ltd Drive assist device for vehicle and vehicle having drive assist device for vehicle
JP2007050823A (en) * 2005-08-19 2007-03-01 Yamaha Marine Co Ltd Behavior control device for small vessel
JP2008001205A (en) * 2006-06-21 2008-01-10 Jtekt Corp Steering device for ship
JP2008094256A (en) * 2006-10-12 2008-04-24 Yamaha Marine Co Ltd Water vehicle
JP2010092245A (en) * 2008-10-07 2010-04-22 Hiroshima Ichi Safety navigation network system for vessel
WO2010116509A1 (en) * 2009-04-09 2010-10-14 トヨタ自動車株式会社 Maneuver assisting device

Also Published As

Publication number Publication date
JP6805629B2 (en) 2020-12-23

Similar Documents

Publication Publication Date Title
JP6390762B2 (en) A method for controlling the motion of a ship near an object
US12165522B1 (en) Marine propulsion control system and method with collision avoidance override
US11600184B2 (en) Marine propulsion control system and method
JP5932362B2 (en) Hull Control Device, Hull Control Program, and Hull Control Method
EP3406516B1 (en) Ship maneuvering device and ship provided therewith
JP2014076758A (en) Method and system for estimating movement center of ship
US12162581B2 (en) Steering control system for personal watercrafts
JP5442071B2 (en) Ship maneuvering control apparatus, automatic ship maneuvering control system, ship maneuvering control method, and program
JP5191199B2 (en) Ship propulsion device control device, cruise support system using the same, and vessel
JP2015085866A (en) Turning progress level display device, automatic steering device and turning progress level display method
JP6805629B2 (en) Vehicle control device, vehicle control method and program for vehicle control
JP2015063181A (en) Posture angle control device
JP2017178214A (en) Navigation control method and apparatus
KR20230119321A (en) Obstacle avoidance apparatus and method for autonomous navigation of a ship
JP6780528B2 (en) Position holding method and moving body
JP2009132257A (en) Method, program, and device for maneuvering control, and automatic maneuvering control system
US11402838B1 (en) System for and method of controlling watercraft
JP7068602B2 (en) Joystick device, its control output method and program
JP4302435B2 (en) Navigation method and control device
JP5566426B2 (en) Ship maneuvering control apparatus, automatic ship maneuvering control system, ship maneuvering control method, and program
JP6928370B2 (en) Hull control device, hull, how to operate the hull
JPH0966894A (en) Emergency escape support method and apparatus for high speed sailing body such as high speed vessel
JP2005322156A (en) Movement control device of mobile object
KR20150088476A (en) Thurster torque control device and method using joystick

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190716

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200619

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200707

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200902

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201117

R150 Certificate of patent or registration of utility model

Ref document number: 6805629

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150