JP2024000308A - Vehicle overturn avoidance device, work vehicle system, vehicle overturn avoidance method, and vehicle overturn avoidance program - Google Patents

Vehicle overturn avoidance device, work vehicle system, vehicle overturn avoidance method, and vehicle overturn avoidance program Download PDF

Info

Publication number
JP2024000308A
JP2024000308A JP2022099029A JP2022099029A JP2024000308A JP 2024000308 A JP2024000308 A JP 2024000308A JP 2022099029 A JP2022099029 A JP 2022099029A JP 2022099029 A JP2022099029 A JP 2022099029A JP 2024000308 A JP2024000308 A JP 2024000308A
Authority
JP
Japan
Prior art keywords
vehicle
angle
route
work vehicle
slope
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.)
Pending
Application number
JP2022099029A
Other languages
Japanese (ja)
Inventor
循 青木
Jun Aoki
和信 林
Kazunobu Hayashi
悦男 木島
Etsuo Kijima
修一 佐野
Shuichi Sano
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.)
National Agriculture and Food Research Organization
IHI Agri Tech Corp
Original Assignee
National Agriculture and Food Research Organization
IHI Agri Tech 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 National Agriculture and Food Research Organization, IHI Agri Tech Corp filed Critical National Agriculture and Food Research Organization
Priority to JP2022099029A priority Critical patent/JP2024000308A/en
Publication of JP2024000308A publication Critical patent/JP2024000308A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Guiding Agricultural Machines (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide an overturn avoidance device or the like that can facilitate work by making a work vehicle stably travel on a slope.
SOLUTION: When position information and vehicle angle information of a work vehicle on a slope S are recorded, and a travel path K in one specific lateral movement travel which records the information is set as a first path K1, and a virtual travel path K adjacent to the first path K1 in an inclined direction of the slope S which the work vehicle may enter next to the first path K1 when performing the lateral movement travel is set as a second path K2, a computer comprises: a risk area estimation unit which estimates an area on the second path K2 including an angle decreasing corresponding position Py on the second path K2 adjacent to an angle decreasing position Px on the first path K1 in the inclined direction of the slope S as a risk area RA having a risk that the work vehicle overturns; and a risk information transmission unit which generates and transmits risk information that the work vehicle has approached the risk area RA when the work vehicle approaches the risk area RA on the second path K2.
SELECTED DRAWING: Figure 2
COPYRIGHT: (C)2024,JPO&INPIT

Description

本発明は車両転倒回避装置、作業車両システム、車両転倒回避方法、および車両転倒回避プログラムに関する。 The present invention relates to a vehicle overturn avoidance device, a work vehicle system, a vehicle overturn avoidance method, and a vehicle overturn avoidance program.

従来、法面などの斜面において草刈り作業を行う際には、リモコン式の自走式草刈機が用いられることがある。この種の草刈機を用いることにより遠隔操作によって草刈作業を行うことができるため、不安定で危険な斜面において作業者が草刈作業を行う必要がなくなり、事故を防ぐことができるだけでなく作業の省力化が可能となり、人手不足の問題も解決し得る。 BACKGROUND ART Conventionally, when mowing work on slopes such as slopes, remote-controlled self-propelled mowers are sometimes used. By using this type of mower, mowing work can be done by remote control, which eliminates the need for workers to mow grass on unstable and dangerous slopes, which not only prevents accidents but also saves labor. The problem of labor shortages can also be solved.

ところで上述したリモコン式の自走式草刈機を使用する場合には、作業者(オペレータ)が斜面から離れた位置から、斜面における地表面の状況を確認しながら草刈作業を行うことになる。このため例えば斜面に雑草が繁殖していると、作業者が地表面の状況を把握することが難しく、仮に草刈機の谷側の走行部(履帯や車輪)が地表面の窪みに侵入してしまうようなことがあると草刈機全体が谷側へ大きく傾き、草刈機が転倒したり斜面から転落したりするおそれがある。 By the way, when using the above-mentioned remote-controlled self-propelled mower, the operator performs mowing work from a position away from the slope while checking the condition of the ground surface on the slope. For this reason, for example, if weeds grow on a slope, it is difficult for workers to grasp the condition of the ground surface. If the mower is accidentally stowed away, the entire mower will tilt significantly toward the valley, and there is a risk that the mower may tip over or fall down the slope.

ここで例えば特許文献1には、田植機等の作業車両において、車体の傾きが所定の危険角度以上になった際に走行装置の駆動を停止するシステムが記載されている。 For example, Patent Document 1 describes a system for stopping the drive of a traveling device in a working vehicle such as a rice transplanter when the tilt of the vehicle body exceeds a predetermined dangerous angle.

特開2019-47731号公報JP2019-47731A

しかしながら特許文献1に記載されたシステムのように車体の傾きを検知してから走行装置の駆動を停止させるようにすると、急な地表面の変化によって急激に車体が傾くような状況においては必ずしも車体の転倒や転落を回避することができない場合がある。特に急斜面に大きな窪みが存在し、この窪みに走行装置が進入してしまうような場合には、特許文献1に記載のシステムでは対応が難しいことが想定される。 However, if the system described in Patent Document 1 detects the inclination of the vehicle body and then stops the driving of the traveling gear, the vehicle body will not necessarily be able to tilt in a situation where the vehicle body is suddenly tilted due to a sudden change in the ground surface. may not be able to avoid falls or falls. In particular, if there is a large depression on a steep slope and the traveling device enters the depression, it is assumed that the system described in Patent Document 1 will be difficult to deal with.

そこで本発明は、斜面上で作業車両を安定して走行させ、作業を円滑化することができる車両転倒回避装置、車両転倒回避方法、車両転倒回避プログラム、および車両転倒回避装置を備えた作業車両システムを提供する。 Therefore, the present invention provides a vehicle overturn avoidance device, a vehicle overturn avoidance method, a vehicle overturn avoidance program, and a work vehicle equipped with the vehicle overturn avoidance device, which can run a work vehicle stably on a slope and facilitate work. provide the system.

本発明の一態様に係る車両転倒回避装置は、計算機を有し、斜面の傾斜方向に交差する等高線に沿って該斜面を移動する横移動走行を、前記傾斜方向に順次繰り返す作業車両の転倒を回避する車両転倒回避装置であって、前記計算機は、前記作業車両の前記斜面上における位置の情報(以下、位置情報)を、該作業車両の前記横移動走行中に取得する位置情報取得部と、前記横移動走行における前記斜面上の位置毎に、該作業車両の重心を通って車幅方向に延びる幅方向仮想線の水平面に対する車両傾斜角度の情報(以下、車両角度情報)を取得する角度情報取得部と、前記位置情報および前記車両角度情報を記録する情報記録部と、記録された前記位置情報および前記車両角度情報を参照し、前記横移動走行を行っている走行経路における前記斜面の基準となる傾斜角度(以下、斜面基準角度)に対して、前記車両傾斜角度が小さくなっている前記斜面上の前記位置を角度減少位置として判定する角度減少位置判定部と、前記位置情報および前記車両角度情報を記録した特定の一つの前記横移動走行における前記走行経路を第一経路とし、該第一経路に対して前記傾斜方向に隣接して前記作業車両が該第一経路の次に前記横移動走行する際に進入する可能性のある仮想的な前記走行経路を第二経路としたとき、前記第一経路の前記角度減少位置に対して前記傾斜方向に隣接する前記第二経路上の位置(以下、角度減少対応位置)を含む前記第二経路上の領域を、前記作業車両が転倒するリスクのあるリスク領域であると推定するリスク領域推定部と、前記作業車両が前記第二経路上の前記リスク領域に近接した際に、該作業車両がリスク領域に近接したとのリスク情報を生成して発信するリスク情報発信部と、を備えている。 A vehicle overturn avoidance device according to an aspect of the present invention includes a computer, and prevents a work vehicle from overturning by sequentially repeating lateral movement traveling on a slope along contour lines intersecting the slope direction in the slope direction. In the vehicle overturn avoidance device, the computer includes a position information acquisition unit that acquires information on a position of the work vehicle on the slope (hereinafter referred to as position information) while the work vehicle is moving laterally. , an angle at which information on a vehicle inclination angle (hereinafter referred to as vehicle angle information) with respect to a horizontal plane of a width direction virtual line extending in the vehicle width direction through the center of gravity of the work vehicle is acquired for each position on the slope during the lateral movement traveling; an information acquisition unit; an information recording unit that records the position information and the vehicle angle information; and an information recording unit that records the position information and the vehicle angle information; an angle reduction position determination unit that determines the position on the slope where the vehicle inclination angle is smaller with respect to a reference inclination angle (hereinafter referred to as slope reference angle) as an angle reduction position; The travel route in the specific one of the lateral movement travels in which vehicle angle information is recorded is defined as a first route, and the work vehicle is adjacent to the first route in the inclination direction and next to the first route, the travel route is the first route. When the hypothetical traveling route that may be entered when traveling sideways is defined as a second route, on the second route adjacent to the angle decreasing position of the first route in the inclination direction. a risk area estimation unit that estimates an area on the second route including a position (hereinafter referred to as an angle reduction corresponding position) to be a risk area where the work vehicle is at risk of falling; and and a risk information transmission unit that generates and transmits risk information indicating that the work vehicle has approached the risk area when the work vehicle approaches the risk area.

また上記の車両転倒回避装置では、リスク領域推定部は、前記斜面基準角度と、該斜面基準角度よりも小さい前記車両傾斜角度との差分が所定の角度減少量閾値よりも大きくなっている場合の前記角度減少位置に対応する前記角度減少対応位置を含む前記第二経路上の領域を、前記リスク領域であると推定してもよい。 Further, in the above-mentioned vehicle overturn avoidance device, the risk area estimating unit is configured to detect when the difference between the slope reference angle and the vehicle inclination angle smaller than the slope reference angle is larger than a predetermined angle reduction amount threshold. An area on the second route including the angle reduction corresponding position corresponding to the angle reduction position may be estimated to be the risk area.

また上記の車両転倒回避装置では、前記角度減少量閾値に前記斜面基準角度を加えた値が、前記作業車両が転倒せずに前記横移動走行可能となる限界値である限界最大傾斜角度以下となるように、前記角度減少量閾値が設定されていてもよい。 Further, in the above-mentioned vehicle overturn avoidance device, the value obtained by adding the slope reference angle to the angle reduction amount threshold is equal to or less than the limit maximum inclination angle, which is the limit value at which the work vehicle can travel sideways without overturning. The angle reduction amount threshold may be set so that the angle decrease amount threshold value is set as follows.

また上記の車両転倒回避装置では、前記リスク領域推定部は、前記第一経路に沿って前記角度減少位置が連続しており、且つ、当該連続する距離が所定の距離閾値よりも大きい場合に、前記角度減少対応位置を含む前記第二経路上の領域を前記リスク領域であると推定してもよい。 Further, in the above-mentioned vehicle overturn avoidance device, the risk area estimating unit may perform, if the angle reduction positions are continuous along the first route and the continuous distance is greater than a predetermined distance threshold; An area on the second path including the angle reduction corresponding position may be estimated to be the risk area.

また上記の車両転倒回避装置は、前記作業車両の走行を制御するための制御信号を生成して発信する制御信号発信部をさらに備え、前記制御信号発信部は、前記作業車両が前記第二経路上の前記リスク領域に近接した際または侵入した後に、前記作業車両の走行速度を低下させるための信号を生成し発信してもよい。 The vehicle overturn avoidance device further includes a control signal transmitter that generates and transmits a control signal for controlling travel of the work vehicle, and the control signal transmitter is configured to prevent the work vehicle from traveling along the second route. A signal for reducing the traveling speed of the work vehicle may be generated and transmitted when the work vehicle approaches or enters the risk area above.

また上記の車両転倒回避装置は、前記作業車両の走行を制御するための制御信号を生成して発信する制御信号発信部をさらに備え、前記制御信号発信部は、前記作業車両が前記第二経路上の前記リスク領域に侵入した後において、前記斜面基準角度と、該斜面基準角度よりも大きい前記車両傾斜角度との差分が所定の角度増加量閾値よりも大きくなった場合に、前記作業車両を停止させるための信号を生成し発信してもよい。 The vehicle overturn avoidance device further includes a control signal transmitter that generates and transmits a control signal for controlling travel of the work vehicle, and the control signal transmitter is configured to prevent the work vehicle from traveling along the second route. After entering the risk area above, if the difference between the slope reference angle and the vehicle inclination angle that is larger than the slope reference angle becomes larger than a predetermined angle increase amount threshold, the work vehicle is A signal for stopping may be generated and transmitted.

また上記の車両転倒回避装置では、前記角度増加量閾値に前記斜面基準角度を加えた値が、前記作業車両が転倒せずに走行可能となる限界値である限界最大傾斜角度以下となるように、前記角度増加量閾値が設定されていてもよい。 Further, in the vehicle overturn avoidance device, the value obtained by adding the slope reference angle to the angle increase amount threshold is set to be less than or equal to the limit maximum slope angle that is a limit value at which the work vehicle can travel without overturning. , the angle increase amount threshold may be set.

また上記の車両転倒回避装置は、前記作業車両の走行を制御するための制御信号を生成し発信する制御信号発信部をさらに備え、前記制御信号発信部は、前記作業車両を自動で、かつ、予め定められた前記横移動走行の前記走行経路に沿って走行させるための制御信号を生成し発信してもよい。 The vehicle overturn avoidance device further includes a control signal transmitter that generates and transmits a control signal for controlling travel of the work vehicle, and the control signal transmitter automatically controls the work vehicle, and A control signal for causing the vehicle to travel along the predetermined travel route of the lateral movement travel may be generated and transmitted.

また上記の車両転倒回避装置では、前記第一経路を前記横移動走行する前記作業車両における車幅中心と、前記第二経路を前記横移動走行する前記作業車両における車幅中心との前記傾斜方向の間隔が、該作業車両の走行装置における前記車幅方向の幅寸法の1.5倍以下となるように、前記第二経路が設定されてもよい。 Further, in the above vehicle overturn avoidance device, the inclination direction between the vehicle width center of the work vehicle traveling laterally on the first route and the vehicle width center of the work vehicle traveling laterally on the second route The second route may be set such that the interval between the first and second routes is 1.5 times or less the width dimension in the vehicle width direction of the traveling device of the work vehicle.

また上記の車両転倒回避装置では、前記作業車両が前記第一経路を前記横移動走行する際の前記走行装置における前記斜面への接触軌跡の高位縁に対して、前記作業車両が前記第二経路を前記横移動走行する際の前記接触軌跡の低位縁が前記斜面の下方に位置するように、前記第二経路が設定されてもよい。 Furthermore, in the above-mentioned vehicle overturn avoidance device, the work vehicle is moved along the second route with respect to a high edge of a contact trajectory with the slope in the traveling device when the work vehicle travels laterally on the first route. The second route may be set such that the lower edge of the contact trajectory when the vehicle moves laterally is located below the slope.

本発明の一態様に係る作業車両システムは、上記の車両転倒回避装置と、前記斜面上の前記位置を検知し、検知した前記位置の前記位置情報を前記車両転倒回避装置へ発信する位置情報検知装置と、前記車両傾斜角度を検知し、検知した該車両傾斜角度の前記車両角度情報を前記車両転倒回避装置へ発信する傾斜角検知装置と、前記位置情報検知装置および前記傾斜角検知装置を搭載した作業車両と、を備える。 A work vehicle system according to one aspect of the present invention includes the above-mentioned vehicle overturn avoidance device, and position information detection that detects the position on the slope and transmits the position information of the detected position to the vehicle overturn avoidance device. device, a tilt angle detection device that detects the vehicle tilt angle and transmits the vehicle angle information of the detected vehicle tilt angle to the vehicle overturn avoidance device, the position information detection device, and the tilt angle detection device. equipped with a working vehicle.

また上記の作業車両システムでは、前記作業車両は、車幅方向に間隔をあけて配置された一対の履帯によって構成された走行装置を有していてもよい。 Further, in the work vehicle system described above, the work vehicle may include a traveling device configured by a pair of crawler tracks spaced apart from each other in the vehicle width direction.

本発明の一態様に係る車両転倒回避方法は、斜面の傾斜方向に交差する等高線に沿って該斜面を移動する横移動走行を、前記傾斜方向に順次繰り返す作業車両の転倒を回避する車両転倒回避方法であって、前記作業車両の前記斜面上における位置の情報(以下、位置情報)を、該作業車両の前記横移動走行中に取得する位置情報取得ステップと、前記横移動走行における前記斜面上の位置毎に、該作業車両の重心を通って車幅方向に延びる幅方向仮想線の水平面に対する車両傾斜角度の情報(以下、車両角度情報)を取得する角度情報取得ステップと、前記位置情報および前記車両角度情報を記録する情報記録ステップと、記録された前記位置情報および前記車両角度情報を参照し、前記横移動走行を行っている走行経路における前記斜面の基準となる傾斜角度(以下、斜面基準角度)に対して、前記車両傾斜角度が小さくなっている前記斜面上の前記位置を角度減少位置として判定する角度減少位置判定ステップと、前記位置情報および前記車両角度情報を記録した特定の一つの前記横移動走行における前記走行経路を第一経路とし、該第一経路に対して前記傾斜方向に隣接して前記作業車両が該第一経路の次に前記横移動走行する際に進入する可能性のある仮想的な前記走行経路を第二経路としたとき、前記第一経路の前記角度減少位置に対して前記傾斜方向に隣接する前記第二経路上の位置(以下、角度減少対応位置)を含む前記第二経路上の領域を、前記作業車両が転倒するリスクのあるリスク領域であると推定するリスク領域推定ステップと、前記作業車両が前記第二経路上の前記リスク領域に近接した際に、該作業車両がリスク領域に近接したとのリスク情報を生成して発信するリスク情報発信ステップと、を含む。 A vehicle overturn avoidance method according to one aspect of the present invention includes a vehicle overturn avoidance method that avoids overturning of a work vehicle by sequentially repeating a lateral movement traveling on the slope along contour lines intersecting the slope direction in the slope direction. The method includes a position information acquisition step of acquiring position information (hereinafter referred to as position information) of the work vehicle on the slope during the lateral movement of the work vehicle; an angle information acquisition step of acquiring information on a vehicle inclination angle with respect to a horizontal plane of a virtual line in the width direction extending in the vehicle width direction through the center of gravity of the work vehicle (hereinafter referred to as vehicle angle information) for each position; an information recording step of recording the vehicle angle information, and a reference slope angle (hereinafter referred to as a slope an angle decreasing position determining step of determining the position on the slope where the vehicle inclination angle is small with respect to a reference angle) as an angle decreasing position; and a specific point where the position information and the vehicle angle information are recorded. The travel route in the two lateral movements is a first route, and the work vehicle can enter adjacent to the first route in the inclination direction when traveling laterally after the first route. When the hypothetical traveling route with a characteristic is defined as a second route, a position on the second route adjacent in the inclination direction to the angle reduction position of the first route (hereinafter referred to as angle reduction corresponding position) a risk area estimating step of estimating an area on the second route including a risk area where there is a risk of the work vehicle falling; and when the work vehicle approaches the risk area on the second route. The method further includes a risk information transmission step of generating and transmitting risk information indicating that the work vehicle has approached a risk area.

本発明の一態様に係る車両転倒回避プログラムは、斜面の傾斜方向に交差する等高線に沿って該斜面を移動する横移動走行を、前記傾斜方向に順次繰り返す作業車両の転倒を回避するために、計算機を、前記作業車両の前記斜面上における位置の情報(以下、位置情報)を、該作業車両の前記横移動走行中に取得する位置情報取得手段、前記横移動走行における前記斜面上の位置毎に、該作業車両の重心を通って車幅方向に延びる幅方向仮想線の水平面に対する車両傾斜角度の情報(以下、車両角度情報)を取得する角度情報取得手段、前記位置情報および前記車両角度情報を記録する情報記録手段、記録された前記位置情報および前記車両角度情報を参照し、前記横移動走行を行っている走行経路における前記斜面の基準となる傾斜角度(以下、斜面基準角度)に対して、前記車両傾斜角度が小さくなっている前記斜面上の前記位置を角度減少位置として判定する角度減少位置判定手段、前記位置情報および前記車両角度情報を記録した特定の一つの前記横移動走行における前記走行経路を第一経路とし、該第一経路に対して前記傾斜方向に隣接して前記作業車両が該第一経路の次に前記横移動走行する際に進入する可能性のある仮想的な前記走行経路を第二経路としたとき、前記第一経路の前記角度減少位置に対して前記傾斜方向に隣接する前記第二経路上の位置(以下、角度減少対応位置)を含む前記第二経路上の領域を、前記作業車両が転倒するリスクのあるリスク領域であると推定するリスク領域推定手段、および前記作業車両が前記第二経路上の前記リスク領域に近接した際に、該作業車両がリスク領域に近接したとのリスク情報を生成して発信するリスク情報発信手段、として機能させる。 A vehicle overturn avoidance program according to one aspect of the present invention includes, in order to avoid overturning of a work vehicle, repeating a lateral movement traveling on a slope along contour lines intersecting the slope direction in the slope direction sequentially. a position information acquisition means for acquiring information on the position of the work vehicle on the slope (hereinafter referred to as position information) during the lateral movement of the work vehicle; an angle information acquisition means for acquiring information on a vehicle inclination angle with respect to a horizontal plane of a virtual line in the width direction extending through the center of gravity of the work vehicle in the vehicle width direction (hereinafter referred to as vehicle angle information); the position information and the vehicle angle information; an information recording means for recording, with reference to the recorded position information and the vehicle angle information, a reference slope angle (hereinafter referred to as slope reference angle) of the slope on the traveling route on which the lateral movement is being performed; an angle decreasing position determining means for determining the position on the slope where the vehicle inclination angle is small as an angle decreasing position; The traveling route is defined as a first route, and a virtual route adjacent to the first route in the inclination direction that the work vehicle may enter when traveling laterally after the first route. When the travel route is a second route, the second route includes a position on the second route (hereinafter referred to as an angle reduction corresponding position) adjacent in the inclination direction to the angle reduction position of the first route. risk area estimating means for estimating that the upper area is a risk area where there is a risk of the work vehicle falling; and when the work vehicle approaches the risk area on the second route, the work vehicle It functions as a risk information dissemination means that generates and disseminates risk information regarding proximity to risk areas.

上記の転倒回避装置等によれば、斜面上で作業車両を安定して走行させ、作業を円滑化することが可能となる。 According to the above-mentioned fall avoidance device and the like, it is possible to stably drive a work vehicle on a slope and facilitate work.

本発明の実施形態に係る作業車両システムの上面図である。1 is a top view of a work vehicle system according to an embodiment of the present invention. 上記作業車両システムにおける作業車両が斜面を走行する際の走行経路を示す図である。FIG. 3 is a diagram showing a travel route when the work vehicle in the work vehicle system travels on a slope. 上記作業車両システムにおける作業車両の走行経路を拡大して示す図である。FIG. 3 is an enlarged diagram showing a travel route of a work vehicle in the work vehicle system. 上記作業車両システムにおける車両転倒回避装置のハードウェア構成を示すブロック図である。FIG. 2 is a block diagram showing a hardware configuration of a vehicle overturn avoidance device in the work vehicle system. 上記作業車両システムにおける車両転倒回避装置の機能構成を示すブロック図である。FIG. 2 is a block diagram showing a functional configuration of a vehicle overturn avoidance device in the work vehicle system. 上記作業車両システムにおける作業車両が斜面上の窪みを走行している様子を走行方向から見た図である。FIG. 2 is a diagram of the work vehicle in the work vehicle system traveling in a depression on a slope, as seen from the traveling direction. 上記作業車両システムにおける車両転倒回避装置で実行されるプログラムのフローチャートであって、リスク領域の推定方法を示す図である。FIG. 3 is a flowchart of a program executed by the vehicle overturn avoidance device in the work vehicle system, and is a diagram illustrating a risk area estimation method. 上記作業車両システムにおける車両転倒回避装置で実行されるプログラムのフローチャートであって、転倒回避方法を示す図である。FIG. 3 is a flowchart of a program executed by the vehicle overturn avoidance device in the work vehicle system, and is a diagram showing an overturn avoidance method.

以下、本発明の実施形態に係る作業車両システム100について説明する。
図1に示すように作業車両システム100は、作業車両1と、作業車両1に搭載された位置情報検知装置2、傾斜角検知装置3、および警告装置4と、作業車両1の転倒を回避する車両転倒回避装置5と、車両転倒回避装置5に電気的に接続された電子制御ユニット6(ECU:Electronic Control Unit)とを備えている。
Hereinafter, a work vehicle system 100 according to an embodiment of the present invention will be described.
As shown in FIG. 1, the work vehicle system 100 includes a work vehicle 1, a position information detection device 2, an inclination angle detection device 3, and a warning device 4 mounted on the work vehicle 1, and prevents the work vehicle 1 from falling. The vehicle overturn avoidance device 5 includes a vehicle overturn avoidance device 5 and an electronic control unit (ECU) 6 electrically connected to the vehicle overturn avoidance device 5.

(作業車両)
作業車両1は、本実施形態においてはリモコン式の自走式草刈機となっている。作業車両1は、作業車両1から離れた位置に居る作業者(オペレータ)のリモコンによって遠隔操作され、自走しながら草刈り作業を行う。また作業車両1は、走行方向の前端に配置された草刈り装置8と、車幅方向に間隔をあけて配置された一対の履帯9aによって構成された走行装置9とを有している。
なお作業車両1は草刈機には限定されず、斜面Sにおいて集草作業や測量作業等を行う車両であってもよい。
(work vehicle)
In this embodiment, the work vehicle 1 is a remote-controlled self-propelled mower. The work vehicle 1 is remotely controlled by a remote control of a worker (operator) who is located at a distance from the work vehicle 1, and performs grass mowing work while moving on its own. Further, the work vehicle 1 includes a mowing device 8 disposed at the front end in the traveling direction, and a traveling device 9 constituted by a pair of crawler tracks 9a disposed at an interval in the vehicle width direction.
Note that the work vehicle 1 is not limited to a grass mower, and may be a vehicle that performs grass collection work, survey work, etc. on the slope S.

作業車両1は、図2に示すように例えば法面等の斜面Sの傾斜方向に交差する等高線に沿って斜面Sを移動する横移動走行を、斜面Sの下方から上方に向かって順次繰り返すように操作される。具体的には作業車両1は、オペレータによるリモコン操作によって斜面S上を特定の一つの横移動走行における走行経路K(第一経路K1)に沿って走行した後に、第一経路K1の終端(例えば斜面Sの端に近接する位置)においてUターンをし、第一経路K1に対して上方に隣接する横移動走行の走行経路K(第二経路K2)を走行する。そしてこのような走行を斜面Sの下方から上方に向かって繰り返し、徐々に斜面Sを登っていく。なお各横移動走行における走行経路Kの終端では、Uターンではなくスイッチバックによって走行方向を変更してもよい。 As shown in FIG. 2, the work vehicle 1 repeats lateral movement traveling on the slope S along contour lines that intersect with the inclination direction of the slope S, such as a slope, in sequence from the bottom to the top of the slope S. be operated on. Specifically, the work vehicle 1 travels along a travel route K (first route K1) in one specific lateral movement on the slope S by remote control operation by the operator, and then moves to the end of the first route K1 (for example, The vehicle makes a U-turn at a position close to the end of the slope S, and travels on a lateral travel route K (second route K2) adjacent above the first route K1. Then, such running is repeated from the bottom to the top of the slope S, gradually climbing the slope S. Note that at the end of the travel route K in each lateral movement, the travel direction may be changed by a switchback instead of a U-turn.

図3に示すように本実施形態では、作業車両1が第一経路K1を走行する際の作業車両1の履帯9aのうち山側の履帯9aの斜面Sへの接触軌跡の高位縁Kxに対して、作業車両1が第二経路K2を走行する際の谷側の履帯9aの斜面Sへの接触軌跡の低位縁Kyが下方に位置するように第二経路K2が設定されている。 As shown in FIG. 3, in this embodiment, when the work vehicle 1 travels on the first route K1, the high edge Kx of the contact trajectory of the mountain-side crawler track 9a with the slope S when the work vehicle 1 travels on the first route K1. , the second route K2 is set such that the lower edge Ky of the contact locus of the valley-side crawler belt 9a with the slope S when the work vehicle 1 travels on the second route K2 is located below.

そして第二経路K2の上方に隣接する次の横移動走行の走行経路Kについても同様に設定される。すなわち上下に隣接する二つの横移動走行の走行経路Kを見たとき、下側の走行経路Kを走行する際の走行装置9の接触軌跡の高位縁Kxに対して、作業車両1が上側の走行経路Kを走行する際の走行装置9の接触軌跡の低位縁Kyが下方に位置する。よって斜面Sの上方から走行装置9を見たとき、下側の走行経路Kを走行している場合の作業車両1と、上側の走行経路Kを走行している場合の作業車両1とを仮に斜面Sの傾斜方向に並べて配置したとすれば、これら作業車両1同士が、車幅方向にオーバーラップするように走行経路Kを設定し、このように設定された走行経路Kに沿ってオペレータが作業車両1を操作するようにしている。 The traveling route K for the next lateral movement traveling adjacent to the upper part of the second route K2 is also set in the same manner. That is, when looking at the travel routes K of two vertically adjacent horizontal movement travels, the work vehicle 1 is on the upper side with respect to the higher edge Kx of the contact locus of the traveling device 9 when traveling on the lower travel route K. The lower edge Ky of the contact trajectory of the traveling device 9 when traveling along the traveling route K is located below. Therefore, when the traveling device 9 is viewed from above the slope S, the working vehicle 1 when traveling on the lower traveling route K and the working vehicle 1 when traveling on the upper traveling route K are temporarily defined. If these work vehicles 1 are arranged side by side in the inclination direction of the slope S, a travel route K is set so that these work vehicles 1 overlap in the vehicle width direction, and an operator follows the travel route K set in this way. A work vehicle 1 is operated.

なお、上下に隣接する二つの横移動走行の走行経路Kの定義として、上側の走行経路Kを走行する作業車両1における車幅中心と、下側の走行経路Kを走行する作業車両1における車幅中心との間の斜面Sの傾斜方向の間隔w1が、少なくとも走行装置9における車幅方向の幅寸法w9の1.5倍以下であるとよく、本実施形態の場合は、w1がw9の0倍よりも大きく1倍よりも小さい値となっている。なお、このように設定される走行経路Kは仮想的な経路であって、必ずしも設定された走行経路Kの通りに実際に作業車両1が走行するとは限らない。すなわち設定された第二経路K2は、第一経路K1を作業車両1が実際に走行した後に、次に作業車両1が進入する可能性のある仮想的な経路を示す。 In addition, as a definition of two vertically adjacent travel routes K for lateral movement travel, the vehicle width center of the work vehicle 1 traveling on the upper travel route K and the vehicle width center of the work vehicle 1 traveling on the lower travel route K are defined. It is preferable that the interval w1 of the slope S in the inclination direction between the width center and the width center is at least 1.5 times the width dimension w9 of the traveling device 9 in the vehicle width direction, and in the case of the present embodiment, w1 is equal to or less than w9. The value is larger than 0 times and smaller than 1 times. Note that the traveling route K set in this way is a virtual route, and the work vehicle 1 does not necessarily actually travel along the set traveling route K. That is, the set second route K2 indicates a hypothetical route that the work vehicle 1 may enter next after the work vehicle 1 actually travels the first route K1.

(位置情報検知装置)
図1に戻って位置情報検知装置2は、斜面Sを横移動走行中に作業車両1の位置を検知し、検知した位置の情報(以下、位置情報とする)の信号を発信するものであって、例えばGNSSセンサ(Global Navigation Satellite System Sensor)等によって構成されている。位置情報検知装置2で検知される位置情報には、例えば緯度および経度の情報が含まれるが、さらに高度の情報も含まれてもよい。なお位置情報検知装置2はGNSSセンサによって構成されたものに限定されない。
(location information detection device)
Returning to FIG. 1, the position information detection device 2 detects the position of the work vehicle 1 while moving laterally on a slope S, and transmits a signal of information on the detected position (hereinafter referred to as position information). For example, it is configured by a GNSS sensor (Global Navigation Satellite System Sensor). The location information detected by the location information detection device 2 includes, for example, latitude and longitude information, but may also include altitude information. Note that the position information detection device 2 is not limited to one configured with a GNSS sensor.

(傾斜角検知装置)
傾斜角検知装置3は、作業車両1の車両傾斜角度を検知し、検知した車両傾斜角度の情報(以下、車両角度情報)の信号を発信するものであって、加速度センサや傾斜センサ等によって構成されている。ここで本実施形態において車両傾斜角度は、作業車両1の重心Gを通って車幅方向に延びる幅方向仮想線VLの水平面に対する角度を示す。
(Tilt angle detection device)
The tilt angle detection device 3 detects the vehicle tilt angle of the work vehicle 1 and transmits a signal of information on the detected vehicle tilt angle (hereinafter referred to as vehicle angle information), and is composed of an acceleration sensor, a tilt sensor, etc. has been done. Here, in this embodiment, the vehicle inclination angle indicates the angle of a width direction virtual line VL extending in the vehicle width direction through the center of gravity G of the work vehicle 1 with respect to a horizontal plane.

(警告装置)
警告装置4は、例えば警報器や警告灯によって構成され、後述するリスク領域RAへの近接や侵入を音や光によってオペレータへ認識させるものである。
(warning device)
The warning device 4 is constituted by, for example, an alarm or a warning light, and allows the operator to recognize proximity to or intrusion into a risk area RA, which will be described later, by sound or light.

(電子制御ユニット(ECU))
電子制御ユニット6は、警告装置4、詳しく後述する車両転倒回避装置5、および作業車両1に搭載されたその他の各種装置や機器に対して通信回線を介して電気的に接続されており、これらの装置や機器を電子制御するものである。より具体的に電子制御ユニット6は後述する車両転倒回避装置5からの信号を受信して警告装置4を動作させたり、作業車両1における走行装置9の動作を制御したりする。走行装置9の制御においては、電子制御ユニット6は例えば作業車両1の走行速度や走行方向を調整したり、作業車両1の走行/停止を切り替えたりする。電子制御ユニット6に接続される通信回線の規格は特に限定されるものではなく有線、無線を問わないが、例えばCAN(Controller Area Network)等が適用される。また電子制御ユニット6は作業車両1に搭載される場合に限定されず、不図示のサーバや上述したリモコン等、作業車両1と離れた位置に設けられていてもよい。
(Electronic control unit (ECU))
The electronic control unit 6 is electrically connected via a communication line to the warning device 4, the vehicle overturn avoidance device 5, which will be described in detail later, and various other devices and equipment mounted on the work vehicle 1. It is used to electronically control devices and equipment. More specifically, the electronic control unit 6 receives a signal from a vehicle overturn avoidance device 5, which will be described later, and operates the warning device 4 and controls the operation of the traveling device 9 in the work vehicle 1. In controlling the traveling device 9, the electronic control unit 6 adjusts the traveling speed and traveling direction of the working vehicle 1, and switches the working vehicle 1 between running and stopping, for example. The standard of the communication line connected to the electronic control unit 6 is not particularly limited and may be wired or wireless; for example, CAN (Controller Area Network) is applicable. Further, the electronic control unit 6 is not limited to being mounted on the work vehicle 1, and may be provided at a location away from the work vehicle 1, such as a server (not shown) or the above-mentioned remote control.

なお電子制御ユニット6はオペレータの使用するリモコンにも電気的に接続され、リモコンからの指令によって電子制御ユニット6を介して走行装置9の動作を制御することも可能となっている。この場合電子制御ユニット6は、例えば無線通信によって詳しく後述する車両転倒回避装置5に対して電気的に接続される。 The electronic control unit 6 is also electrically connected to a remote control used by the operator, and the operation of the traveling device 9 can also be controlled via the electronic control unit 6 in response to commands from the remote control. In this case, the electronic control unit 6 is electrically connected to a vehicle overturn avoidance device 5, which will be described in detail later, by, for example, wireless communication.

(車両転倒回避装置)
次に車両転倒回避装置5について説明する。本実施形態では車両転倒回避装置5は作業車両1に搭載されているが、車両転倒回避装置5は作業車両1に搭載される場合に限定されず、不図示のサーバや上述したリモコン等、作業車両1と離れた位置に設けられていてもよい。この場合車両転倒回避装置5は、例えば無線通信によって電子制御ユニット6に対して電気的に接続される。
(Vehicle fall avoidance device)
Next, the vehicle overturn avoidance device 5 will be explained. In the present embodiment, the vehicle overturn avoidance device 5 is mounted on the work vehicle 1, but the vehicle overturn avoidance device 5 is not limited to being installed on the work vehicle 1, and may be used in the work such as a server (not shown) or the above-mentioned remote control. It may be provided at a location away from the vehicle 1. In this case, the vehicle overturn avoidance device 5 is electrically connected to the electronic control unit 6 by, for example, wireless communication.

図4に示すように車両転倒回避装置5は、電子制御ユニット6における不図示のマイクロコンピュータと通信を行う計算機500を有している。この計算機は、CPU(Central Processing Unit)501と、ROM(Read Only Memory)やRAM(Random Access Memory)などのメモリ510と、HDD(Hard Disk Drive)やSSD(Solid State Drive)などの不揮発性の記憶装置520と、電源装置530と、入力インターフェース540と、出力インターフェース550と、これらを接続するバス配線560とを有している。CPU501は中央演算処理装置であって後述する車両転倒回避プログラムを実行する。メモリ510はCPU501の作業領域や記憶領域として使用され、記憶装置520はCPU501で実行されるオペレーティングシステムやプログラムや後述する作業車両1の転倒回避に用いられるデータ構造を記憶する。なお記憶装置520にはその他の各種データも蓄積されるようになっている。 As shown in FIG. 4, the vehicle overturn avoidance device 5 includes a computer 500 that communicates with a microcomputer (not shown) in the electronic control unit 6. This computer has a CPU (Central Processing Unit) 501, a memory 510 such as a ROM (Read Only Memory) or a RAM (Random Access Memory), and an HDD (Hard Disk Drive) or SSD (Solid Disk Drive). Non-volatile It has a storage device 520, a power supply device 530, an input interface 540, an output interface 550, and a bus wiring 560 connecting these. The CPU 501 is a central processing unit and executes a vehicle overturn avoidance program, which will be described later. The memory 510 is used as a work area and a storage area for the CPU 501, and the storage device 520 stores an operating system and programs executed by the CPU 501, and a data structure used to avoid overturning of the work vehicle 1, which will be described later. Note that various other data are also stored in the storage device 520.

次に図5を参照し、車両転倒回避装置5において車両転倒回避プログラムによって実現される機能構成について説明する。車両転倒回避装置5は斜面S(図2参照)を走行しながら作業を行う作業車両1の転倒を回避するための装置である。すなわち車両転倒回避装置5は、位置情報取得部50と、角度情報取得部51と、情報記録部52と、角度減少位置判定部53と、リスク領域推定部54と、リスク情報発信部55と、制御信号発信部56とを備えている。 Next, with reference to FIG. 5, the functional configuration realized by the vehicle overturn avoidance program in the vehicle overturn avoidance device 5 will be described. The vehicle overturn avoidance device 5 is a device for avoiding overturning of the work vehicle 1 that performs work while traveling on a slope S (see FIG. 2). That is, the vehicle overturn avoidance device 5 includes a position information acquisition section 50, an angle information acquisition section 51, an information recording section 52, an angle reduction position determination section 53, a risk area estimation section 54, a risk information transmission section 55, The control signal transmitting section 56 is also provided.

(位置情報取得部)
位置情報取得部50は、作業車両1の斜面S上における位置情報を、作業車両1の横移動走行中に取得する。すなわち位置情報取得部50は、作業車両1が特定の一つの横移動走行を行っている際に、上述の位置情報検知装置2によって検知された作業車両1の位置に関する位置情報をリアルタイムで受信して取得する。本実施形態においては、横移動走行の走行経路Kにおいて所定距離(例えば作業車両1における履帯9aの接地長の1/2以下)を作業車両1が進む毎に作業車両1の位置情報が取得されるようになっている。
以下、位置情報取得部50において取得される特定の一つの横移動走行の走行経路Kの走行履歴(本実施形態ではこの走行履歴が第一経路K1と定義される)上の位置を、走行方向の前方側に向かって順にP(1)、P(2)、P(3)、・・・、P(n-1)、P(n)、P(n+1)、・・・と表記する(図2参照)。
(Location information acquisition unit)
The position information acquisition unit 50 acquires position information of the work vehicle 1 on the slope S while the work vehicle 1 is moving laterally. That is, the position information acquisition unit 50 receives position information regarding the position of the work vehicle 1 detected by the above-mentioned position information detection device 2 in real time when the work vehicle 1 is performing one specific lateral movement. and obtain it. In this embodiment, the position information of the work vehicle 1 is acquired every time the work vehicle 1 travels a predetermined distance (for example, 1/2 or less of the ground contact length of the track 9a of the work vehicle 1) on the traveling route K of the lateral movement. It has become so.
Hereinafter, the position on the travel history of the travel route K of one specific lateral movement travel acquired by the position information acquisition unit 50 (in this embodiment, this travel history is defined as the first route K1) will be expressed in the travel direction. They are written as P(1), P(2), P(3), ..., P(n-1), P(n), P(n+1), ... in order toward the front side of ( (see Figure 2).

(角度情報取得部)
角度情報取得部51は、傾斜角検知装置3で検知された車両角度情報を、位置情報取得部50で位置情報を取得した斜面S上の位置毎に、リアルタイムで受信して取得する。
(Angle information acquisition unit)
The angle information acquisition unit 51 receives and acquires the vehicle angle information detected by the inclination angle detection device 3 in real time for each position on the slope S from which the position information acquisition unit 50 acquired the position information.

(情報記録部)
情報記録部52は、位置情報取得部50で取得した位置情報、および角度情報取得部51で取得した車両角度情報を記録する。
(Information Recording Department)
The information recording unit 52 records the position information acquired by the position information acquisition unit 50 and the vehicle angle information acquired by the angle information acquisition unit 51.

(角度減少位置判定部)
角度減少位置判定部53は、情報記録部52に記録された位置情報および車両角度情報を参照し、特定の一つの横移動走行を行っている走行経路K(本実施形態では例えば第一経路K1)における斜面Sの基準となる傾斜角度(以下、斜面基準角度)に対して、車両傾斜角度が部分的に小さくなっている斜面S上の位置を角度減少位置Pxとして判定して角度減少位置Pxを設定する。本実施形態において角度減少位置Pxは、第一経路K1に沿って例えば3カ所連続しており、すなわち位置P(n-1)、P(n)、P(n+1)の三点のそれぞれが角度減少位置Pxとなっている(図2参照)。
(Angle reduction position determination section)
The angle reduction position determining unit 53 refers to the position information and vehicle angle information recorded in the information recording unit 52, and determines the driving route K (in this embodiment, for example, the first route K1) on which one particular lateral movement is being performed. ), the position on the slope S where the vehicle slope angle is partially smaller than the reference slope angle of the slope S (hereinafter referred to as slope reference angle) is determined as the angle reduction position Px, and the angle reduction position Px is determined. Set. In this embodiment, the angle decreasing positions Px are, for example, three consecutive locations along the first path K1, that is, each of the three points P(n-1), P(n), and P(n+1) has an angle This is the reduced position Px (see FIG. 2).

以下、図6に示すように斜面基準角度をαとし、第一経路K1で実測された車両傾斜角度をβとし、第二経路K2において推定、または実測される車両傾斜角度をγとする。また、斜面基準角度αとしては、事前にドローン撮影やLiDAR(Light Detection And Ranging)を用いて事前に計測して初期値として角度減少位置判定部53に記憶したものを利用してもよい。また斜面基準角度αとして、角度減少位置判定部53によって判定を行っている特定の一つの横移動走行の走行経路Kの下側に隣接する走行経路Kにおいて取得した車両傾斜角度の平均値を利用してもよいし、走行経路Kでの現在の位置を起点とした所定の過去範囲における車両傾斜角度のデータ群の移動平均によってリアルタイムで算出したものを利用してもよく、斜面基準角度αの設定方法は特に限定されない。 Hereinafter, as shown in FIG. 6, the slope reference angle is assumed to be α, the vehicle inclination angle actually measured on the first route K1 is assumed to be β, and the vehicle inclination angle estimated or actually measured on the second route K2 is assumed to be γ. Furthermore, the slope reference angle α may be measured in advance using drone photography or LiDAR (Light Detection and Ranging) and stored in the angle reduction position determination unit 53 as an initial value. In addition, as the slope reference angle α, the average value of the vehicle inclination angles obtained in the travel route K adjacent to the lower side of the travel route K of one specific lateral movement run that is being determined by the angle reduction position determination unit 53 is used. Alternatively, it may be calculated in real time by a moving average of a data group of vehicle inclination angles in a predetermined past range starting from the current position on driving route K, and the slope reference angle α may be calculated in real time. The setting method is not particularly limited.

(リスク領域推定部)
図5に戻って、リスク領域推定部54は、実測値となる第一経路K1の角度減少位置Pxの斜面Sの上方に定義(想定)される第二経路K2上の位置(以下、角度減少対応位置Py)を含む第二経路K2上の領域を、作業車両1が転倒するリスクのあるリスク領域RAであると推定する。すなわち、角度減少位置Pxが判定された走行経路K(第一経路K1)に対して斜面Sの上方に隣接して作業車両1が次に横移動走行する際に進入する可能性のある仮想的な走行経路K(第二経路K2)上の少なくとも一部の領域がリスク領域RAとなる。なお角度減少位置Px以外の第一経路K1上の位置に対応する第二経路K2上の位置を非角度減少対応位置Pzと定義し、この非角度減少対応位置Pzと角度減少対応位置Pyとによって第二経路K2が定義(想定)される。
(Risk Area Estimation Department)
Returning to FIG. 5, the risk area estimating unit 54 detects a position on the second route K2 (hereinafter referred to as angle decrease The area on the second route K2 including the corresponding position Py) is estimated to be the risk area RA where there is a risk that the work vehicle 1 may fall. That is, with respect to the traveling route K (first route K1) for which the angle reduction position Px has been determined, a virtual At least a part of the area on the traveling route K (second route K2) becomes the risk area RA. Note that a position on the second path K2 corresponding to a position on the first path K1 other than the angle reduction position Px is defined as a non-angle reduction corresponding position Pz, and by this non-angle reduction corresponding position Pz and angle reduction corresponding position Py. A second route K2 is defined (assumed).

ここで本実施形態では、斜面基準角度αと、斜面基準角度αよりも小さい車両傾斜角度βとの差分:α-βが所定の角度減少量閾値θ1よりも大きくなっている場合、すなわちα-β>θ1となっている場合、角度減少位置Pxに対応する角度減少対応位置Pyを設定する。 Here, in this embodiment, when the difference between the slope reference angle α and the vehicle inclination angle β smaller than the slope reference angle α: α−β is larger than the predetermined angle reduction amount threshold θ1, that is, α− When β>θ1, an angle reduction corresponding position Py corresponding to the angle reduction position Px is set.

また本実施形態では作業車両1が転倒せずに斜面S上を等高線に沿って横移動走行可能となる限界値である限界最大傾斜角度をθmaxとしたとき、角度減少量閾値θ1に斜面基準角度αを加えた値が、限界最大傾斜角度θmax以下となるように角度減少量閾値θ1が設定される。すなわちθ1+α≦θmaxを満足する。限界最大傾斜角度θmaxは作業車両1の仕様に依存するが、例えば45度に設定される。 In addition, in this embodiment, when the limit maximum inclination angle, which is the limit value at which the work vehicle 1 can move laterally along the contour line on the slope S without overturning, is θmax, the angle reduction amount threshold θ1 is set to the slope reference angle. The angle reduction amount threshold θ1 is set so that the value obtained by adding α is equal to or less than the limit maximum inclination angle θmax. That is, θ1+α≦θmax is satisfied. Although the limit maximum inclination angle θmax depends on the specifications of the work vehicle 1, it is set to, for example, 45 degrees.

さらに本実施形態のリスク領域推定部54では、角度減少位置Pxが連続する距離dが所定の距離閾値dtよりも大きい場合に、すなわち、角度減少対応位置Pyが所定回数(本実施形態では例えば3回)以上連続する場合に、角度減少対応位置Pyを含む第二経路K2上の領域をリスク領域RAであると推定する。 Furthermore, in the risk area estimation unit 54 of this embodiment, when the distance d between consecutive angle reduction positions Px is greater than a predetermined distance threshold dt, that is, the angle reduction corresponding position Py is times), the area on the second route K2 including the angle reduction corresponding position Py is estimated to be the risk area RA.

(リスク情報発信部)
リスク情報発信部55は、作業車両1が第一経路K1の上方を横移動走行している最中に、仮想的な第二経路K2のリスク領域RAに近接した際、作業車両1がリスク領域RAに近接したとのリスク情報の信号を生成して発信する。リスク情報発信部55が発信した信号は警告装置4によって受信されて警告装置4が動作するようになっている。リスク情報発信部55は例えばリスク領域RAよりも横移動走行における走行方向の手前側1〔m〕の位置に作業車両1が到達した際に、リスク情報を発信するとよい。
(Risk Information Transmission Department)
The risk information transmission unit 55 transmits information to the risk area when the work vehicle 1 approaches the risk area RA of the virtual second route K2 while traveling horizontally above the first route K1. Generates and transmits a risk information signal indicating proximity to the RA. The signal transmitted by the risk information transmission unit 55 is received by the warning device 4, and the warning device 4 is activated. It is preferable that the risk information transmitting unit 55 transmits the risk information, for example, when the work vehicle 1 reaches a position 1 [m] closer to the front side of the risk area RA in the traveling direction in lateral movement.

(制御信号発信部)
制御信号発信部56は、作業車両1が第二経路K2のリスク領域RAに近接した際または侵入した後において、実際の作業車両1の車両傾斜角度γが斜面基準角度αよりも大きくなった場合に、作業車両1の走行速度を低下させて作業車両1を徐行、または一時停止させるための信号を生成し発信する。制御信号発信部56で生成された信号は、電子制御ユニット6によって受信されて走行装置9の動作が制御されるようになっている。なお制御信号発信部56は、作業車両1の車両傾斜角度γが斜面基準角度αよりも大きくなった場合に限らず、単に作業車両1が第二経路K2上を走行中にリスク領域RAに近接した際または侵入した後に、作業車両1の走行速度を低下させて作業車両1を徐行、または一時停止させるための信号を生成してもよい。
(Control signal transmitter)
The control signal transmitter 56 detects when the actual vehicle inclination angle γ of the work vehicle 1 becomes larger than the slope reference angle α when the work vehicle 1 approaches or enters the risk area RA of the second route K2. Then, a signal is generated and transmitted to reduce the traveling speed of the work vehicle 1 to slow down or temporarily stop the work vehicle 1. The signal generated by the control signal transmitter 56 is received by the electronic control unit 6 to control the operation of the traveling device 9. Note that the control signal transmitter 56 is not limited to the case where the vehicle inclination angle γ of the work vehicle 1 becomes larger than the slope reference angle α, but simply when the work vehicle 1 approaches the risk area RA while traveling on the second route K2. A signal may be generated to reduce the traveling speed of the work vehicle 1 to slow the work vehicle 1 or to temporarily stop the work vehicle 1 when the work vehicle 1 enters or enters the vehicle.

さらに制御信号発信部56は、リスク領域RAに侵入した後に、斜面基準角度αと、斜面基準角度αよりも大きい車両傾斜角度γとの差分:γ-αが所定の角度増加量閾値θ2よりも大きくなった場合、すなわちγ-α>θ2となっている場合において、作業車両1を停止させるための信号を生成し発信する。 Furthermore, after entering the risk area RA, the control signal transmitting unit 56 determines that the difference between the slope reference angle α and the vehicle inclination angle γ which is larger than the slope reference angle α: γ−α is larger than the predetermined angle increase amount threshold θ2. When the value becomes larger, that is, when γ-α>θ2, a signal for stopping the work vehicle 1 is generated and transmitted.

本実施形態では、角度増加量閾値θ2に斜面基準角度αを加えた値が、上記の限界最大傾斜角度θmax以下となるように角度増加量閾値θ2が設定される。すなわちθ2+α≦θmaxを満足する。 In this embodiment, the angle increase threshold θ2 is set such that the value obtained by adding the slope reference angle α to the angle increase threshold θ2 is equal to or less than the above-mentioned limit maximum inclination angle θmax. That is, θ2+α≦θmax is satisfied.

(車両転倒回避プログラム)
次に車両転倒回避プログラムのフロー、すなわち車両転倒回避方法について説明する。以下、角度減少位置Pxを判定する走行経路Kが第一経路K1であり、リスク領域RAが存在する走行経路Kが第二経路K2である場合を想定して説明するが、すべての走行経路Kにおいてフローは同様に実行される
まず図7に示すようにリスク領域RAを推定するフローについて説明する。本フローは第一経路K1上において位置P1から順に実行される。
(Vehicle rollover avoidance program)
Next, the flow of the vehicle overturn avoidance program, that is, the vehicle overturn avoidance method will be explained. The following description will be made assuming that the traveling route K for determining the angle reduction position Px is the first route K1, and the traveling route K where the risk area RA exists is the second route K2. The flow is executed in the same manner. First, the flow for estimating the risk area RA as shown in FIG. 7 will be described. This flow is sequentially executed on the first route K1 starting from the position P1.

リスク領域RAを推定するフローにおいては最初に、データ(位置情報、車両角度情報)を前回取得した位置から作業車両1が所定距離(例えば作業車両1における履帯9aの接地長の1/2以下)移動したか否かを判定する移動距離判定ステップS0を実行する。このステップS0で「YES」と判定された場合には位置情報取得ステップS1に進み、一方、ステップS0で「NO」と判定された場合には、再び移動距離判定ステップS0に戻る。 In the flow of estimating the risk area RA, first, the work vehicle 1 moves a predetermined distance (for example, 1/2 or less of the ground contact length of the track 9a of the work vehicle 1) from the position where data (position information, vehicle angle information) was acquired last time. A moving distance determining step S0 is executed to determine whether or not the vehicle has moved. If the determination in step S0 is ``YES'', the process proceeds to the position information acquisition step S1, whereas if the determination in step S0 is ``NO'', the process returns to the moving distance determination step S0 again.

次に位置情報取得ステップS1では、作業車両1が第一経路K1を横移動走行中に第一経路K1上において作業車両1の斜面S上における位置の位置情報を取得する。そして位置情報が取得された位置に対応する作業車両1の車両角度情報を取得する角度情報取得ステップS2を実行する。その後、位置情報および車両角度情報を記録する情報記録ステップS3を実行する。 Next, in a position information acquisition step S1, position information of the position of the work vehicle 1 on the slope S on the first route K1 is acquired while the work vehicle 1 is moving laterally on the first route K1. Then, an angle information acquisition step S2 is executed to acquire vehicle angle information of the work vehicle 1 corresponding to the position where the position information was acquired. After that, an information recording step S3 is executed to record position information and vehicle angle information.

次に角度減少位置判定ステップS4を実行する。このステップS4では、情報記録ステップS3で記録された情報を参照し、車両傾斜角度βが斜面基準角度αよりも小さくなっている場合に「YES」と判定する。一方で車両傾斜角度βが斜面基準角度α以上となっている場合には「NO」と判定し、この「NO」と判定された位置に対応する第二経路K2上の位置を非角度減少対応位置Pzに設定する非角度減少対応位置設定ステップS10を実行した後に、移動距離判定ステップS0に戻る。 Next, an angle decrease position determination step S4 is executed. In this step S4, the information recorded in the information recording step S3 is referred to, and if the vehicle inclination angle β is smaller than the slope reference angle α, a determination of “YES” is made. On the other hand, if the vehicle inclination angle β is greater than or equal to the slope reference angle α, it is determined as “NO”, and the position on the second route K2 corresponding to the position determined as “NO” is set to a non-angle reduction response. After executing the non-angle reduction compatible position setting step S10 of setting the position Pz, the process returns to the moving distance determining step S0.

角度減少位置判定ステップS4で「YES」と判定された場合には、角度減少位置設定ステップS5に進み、角度減少位置判定ステップS4で「YES」と判定された位置を角度減少位置Pxに設定する。そして角度減少位置設定ステップS5の次に、角度減少量判定ステップS6を実行する。このステップS6では、斜面基準角度αと車両傾斜角度βとの差分:α-βが角度減少量閾値θ1よりも大きくなっている場合には「YES」と判定する。一方で、斜面基準角度αと車両傾斜角度βとの差分:α-βが角度減少量閾値θ1以下となっている場合には「NO」と判定し、この「NO」と判定された角度減少位置Pxに対応する第二経路K2上の位置を非角度減少対応位置Pzに設定する非角度減少対応位置設定ステップS10を実行した後に、移動距離判定ステップS0に戻る。 If it is determined as "YES" in the angle reduction position determination step S4, the process proceeds to angle reduction position setting step S5, and the position determined as "YES" in the angle reduction position determination step S4 is set as the angle reduction position Px. . Then, after the angle decrease position setting step S5, an angle decrease amount determination step S6 is executed. In this step S6, if the difference between the slope reference angle α and the vehicle inclination angle β: α−β is larger than the angle reduction amount threshold θ1, the determination is “YES”. On the other hand, if the difference between the slope reference angle α and the vehicle inclination angle β: α−β is less than the angle reduction amount threshold θ1, it is determined as “NO”, and the angle reduction determined as “NO” is determined as “NO”. After executing the non-angle reduction compatible position setting step S10 in which the position on the second path K2 corresponding to the position Px is set as the non-angle reduction compatible position Pz, the process returns to the moving distance determination step S0.

角度減少量判定ステップS6で「YES」と判定された場合、この「YES」と判定された角度減少位置Pxに対応する第二経路K2上の位置を角度減少対応位置Pyに設定する角度減少対応位置設定ステップS7を実行し、角度減少距離判定ステップS8に進む。このステップS8では、第一経路K1に沿って角度減少位置Pxが連続する距離dが所定の距離閾値dtよりも大きい場合、すなわち、角度減少位置Pyが所定回数以上連続する場合に「YES」と判定する。具体的には例えば、角度減少位置Pxとなる位置P(n)、位置P(n-1)、位置P(n+1)に対応する三カ所の角度減少対応位置Pyが第二経路K2上において連続する場合に、角度減少距離判定ステップS8で「YES」と判定することになる。一方で角度減少位置Pxが連続する距離dが距離閾値dt以下である場合には「NO」と判定して移動距離判定ステップS0に戻る。 When it is determined as "YES" in the angle reduction amount determination step S6, the angle reduction response is performed to set the position on the second path K2 corresponding to the angle decrease position Px determined as "YES" as the angle reduction response position Py. The position setting step S7 is executed, and the process proceeds to the angular reduction distance determination step S8. In this step S8, if the distance d in which the angle decrease positions Px are consecutive along the first route K1 is greater than a predetermined distance threshold dt, that is, if the angle decrease positions Py are consecutive for a predetermined number of times or more, "YES" is determined. judge. Specifically, for example, three angle reduction corresponding positions Py corresponding to the position P(n), position P(n-1), and position P(n+1), which are the angle reduction positions Px, are consecutive on the second path K2. In this case, "YES" is determined in the angle reduction distance determination step S8. On the other hand, if the distance d between consecutive angle reduction positions Px is less than or equal to the distance threshold dt, the determination is "NO" and the process returns to the movement distance determination step S0.

角度減少距離判定ステップS8で「YES」と判定された場合、すなわち距離閾値dtよりも長い距離、車両傾斜角度βが斜面基準角度αよりも減少した状態が継続した場合、次にリスク領域推定ステップS9を実行する。このステップS9では、角度減少対応位置Pyを含む第二経路K2上の領域をリスク領域RAであると推定し、この領域RAにおいて斜面S上に「窪みD」が形成されているものと判断する(図6参照)。 If it is determined as "YES" in the angle reduction distance determination step S8, that is, if the distance is longer than the distance threshold dt and the state in which the vehicle inclination angle β continues to be decreased more than the slope reference angle α, the next step is the risk area estimation step. Execute S9. In this step S9, the area on the second path K2 including the angle reduction corresponding position Py is estimated to be the risk area RA, and it is determined that a "dent D" is formed on the slope S in this area RA. (See Figure 6).

以上のようなフローを実行することによって、リスク領域RA、およびリスク領域RA以外の安全領域SA(図2参照)を示すデータ構造が車両転倒回避装置5に作成され、記憶されるようになっている。 By executing the above-described flow, a data structure indicating the risk area RA and the safety area SA (see FIG. 2) other than the risk area RA is created and stored in the vehicle overturn avoidance device 5. There is.

次に図8を参照して、作業車両1の転倒を回避するフローについて説明する。本フローではまず、作業車両1が第二経路K2上のリスク領域RAに近接したか否かを判定するリスク領域近接判定ステップS11を実行する。このステップS11では作業車両1がリスク領域RAに近接した場合に「YES」と判定され、警告ステップS12に進む。このステップS12では、作業車両1がリスク領域RAに近接したとのリスク情報の信号をリスク情報発信部55で生成して発信し、リスク情報の信号を受信した電子制御ユニット6によって警告装置4を動作させてオペレータへ危険を認識させる。 Next, with reference to FIG. 8, a flow for avoiding overturning of the work vehicle 1 will be described. In this flow, first, a risk area proximity determination step S11 is executed to determine whether the work vehicle 1 has approached the risk area RA on the second route K2. In this step S11, when the work vehicle 1 approaches the risk area RA, a determination of "YES" is made, and the process proceeds to a warning step S12. In this step S12, the risk information transmitter 55 generates and transmits a risk information signal indicating that the work vehicle 1 has approached the risk area RA, and the electronic control unit 6 that has received the risk information signal activates the warning device 4. Operate it to make the operator aware of the danger.

警告ステップS12の後、角度増加判定ステップS13を実行する。このステップS13では、作業車両1の車両傾斜角度γが斜面基準角度αよりも大きくなった場合に「YES」と判定され、速度低下ステップS14に進む。このステップS14では、作業車両1の走行速度を低下させて作業車両1を徐行または一時停止させるための信号を制御信号発信部56で生成し、この制御信号を受信した電子制御ユニット6によって走行装置9を制御して作業車両1の走行速度を低下させ、作業車両1を徐行または一時停止させる。一方で、角度増加判定ステップS13で作業車両1の車両傾斜角度γが斜面基準角度α以下となった場合は「NO」と判定され、リスク領域近接判定ステップS11に戻る。 After the warning step S12, an angle increase determination step S13 is executed. In this step S13, when the vehicle inclination angle γ of the work vehicle 1 becomes larger than the slope reference angle α, the determination is “YES”, and the process proceeds to the speed reduction step S14. In this step S14, the control signal transmitter 56 generates a signal for reducing the traveling speed of the work vehicle 1 to slow down or temporarily stop the work vehicle 1, and the electronic control unit 6 that has received this control signal 9 to reduce the traveling speed of the work vehicle 1 and cause the work vehicle 1 to slow down or temporarily stop. On the other hand, if the vehicle inclination angle γ of the work vehicle 1 becomes equal to or less than the slope reference angle α in the angle increase determination step S13, the determination is "NO" and the process returns to the risk area proximity determination step S11.

そして速度低下ステップS14の後に、角度増加量判定ステップS15を実行する。このステップS15では、作業車両1が第二経路上K2のリスク領域RAに近接または侵入した後において斜面基準角度αと車両傾斜角度γとの差分:γ-αが所定の角度増加量閾値θ2よりも大きくなった場合に「YES」と判定され、車両停止ステップS16に進む。このステップS16では、作業車両1を停止させるための信号を制御信号発信部56で生成し、この制御信号を受信した電子制御ユニット6によって走行装置9を制御して作業車両1を停止させる。一方で角度増加量判定ステップS15において、斜面基準角度αと車両傾斜角度γとの差分:γ-αが所定の角度増加量閾値θ2以下となった場合には「NO」と判定され、リスク領域近接判定ステップS11に戻る。 After the speed reduction step S14, an angle increase amount determination step S15 is executed. In this step S15, after the work vehicle 1 approaches or enters the risk area RA of K2 on the second route, the difference between the slope reference angle α and the vehicle inclination angle γ: γ−α is greater than the predetermined angle increase amount threshold θ2. If the value has also become larger, the determination is ``YES'' and the process proceeds to vehicle stop step S16. In this step S16, the control signal transmitter 56 generates a signal for stopping the work vehicle 1, and the electronic control unit 6 that receives this control signal controls the traveling device 9 to stop the work vehicle 1. On the other hand, in the angle increase amount determination step S15, if the difference between the slope reference angle α and the vehicle inclination angle γ: γ - α is equal to or less than the predetermined angle increase amount threshold θ2, the determination is "NO", and the risk area is The process returns to the proximity determination step S11.

ところで、リスク領域近接判定ステップS11に戻って、作業車両1がリスク領域RAに近接していない場合には当該ステップS11で「NO」と判定され、この場合においては、まずリスク領域外角度増加判定ステップS21が実行される。このステップS21では、作業車両1の車両傾斜角度γが斜面基準角度αよりも大きくなった場合に「YES」と判定され、警告・速度低下ステップS22に進む。このステップS22では、作業車両1の警告装置4に対してリスク情報発信部55から信号が発信され、および、電子制御ユニット6に対して制御信号発信部56から信号が発信され、警告装置4によって警告が行われ、かつ、電子制御ユニット6によって作業車両1の速度を低下させて作業車両1を徐行または一時停止させる。一方でリスク領域外角度増加判定ステップS21において「NO」と判定された場合には、リスク領域近接判定ステップS11に戻る。 By the way, returning to the risk area proximity determination step S11, if the work vehicle 1 is not close to the risk area RA, the determination in step S11 is "NO", and in this case, first, the outside risk area angle increase determination is performed. Step S21 is executed. In this step S21, if the vehicle inclination angle γ of the work vehicle 1 becomes larger than the slope reference angle α, the determination is ``YES'', and the process proceeds to the warning/speed reduction step S22. In this step S22, a signal is transmitted from the risk information transmitting section 55 to the warning device 4 of the work vehicle 1, a signal is transmitted from the control signal transmitting section 56 to the electronic control unit 6, and the warning device 4 transmits a signal. A warning is issued, and the speed of the work vehicle 1 is reduced by the electronic control unit 6 to cause the work vehicle 1 to slow down or temporarily stop. On the other hand, if it is determined "NO" in the risk area outside angle increase determination step S21, the process returns to the risk area proximity determination step S11.

警告・速度低下ステップS22の後、リスク領域外増加継続判定ステップS23を実行する。このステップS23では、作業車両1の車両傾斜角度γが斜面基準角度αよりも大きくなった状態が所定距離(連続する所定回数分の位置)で継続しているか否かが判定される。具体的には例えば、リスク領域外角度増加判定ステップS21において「YES」と判定された第二経路K2上の位置を位置P(m)とし、その手前の位置P(m-1)においても作業車両1の車両傾斜角度γが斜面基準角度αよりも大きくなっているような場合に、車両傾斜角度γの増加が継続しているとして「YES」と判定され、車両停止ステップS24に進む。このステップS24では、電子制御ユニット6に対して制御信号発信部56から信号が発信され、電子制御ユニット6によって作業車両1が停止させられる。一方で、リスク領域外増加継続判定ステップS23で「NO」と判定された場合、リスク領域近接判定ステップS11に戻る。 After the warning/speed reduction step S22, an out-of-risk-area increase continuation determination step S23 is executed. In this step S23, it is determined whether the state in which the vehicle inclination angle γ of the work vehicle 1 is larger than the slope reference angle α continues for a predetermined distance (a predetermined number of consecutive positions). Specifically, for example, the position on the second path K2 for which the determination of "YES" is made in the outside risk area angle increase determination step S21 is set as the position P(m), and the work is performed also at the position P(m-1) before the position P(m). If the vehicle inclination angle γ of the vehicle 1 is larger than the slope reference angle α, it is determined that the vehicle inclination angle γ continues to increase, and the determination is "YES", and the process proceeds to vehicle stop step S24. In this step S24, a signal is transmitted from the control signal transmitter 56 to the electronic control unit 6, and the work vehicle 1 is stopped by the electronic control unit 6. On the other hand, if it is determined "NO" in the out-of-risk area increase continuation determination step S23, the process returns to the risk area proximity determination step S11.

なおリスク領域外増加継続判定ステップS23では、角度増加量判定ステップS15と同様に、斜面基準角度αと車両傾斜角度γとの差分:γ-αが所定の角度増加量閾値θ2よりも大きくなった場合に「YES」と判定し、作業車両1を停止させてもよい。 Note that in the out-of-risk area increase continuation determination step S23, similarly to the angle increase amount determination step S15, the difference between the slope reference angle α and the vehicle inclination angle γ: γ−α has become larger than the predetermined angle increase amount threshold θ2. If so, the determination may be "YES" and the work vehicle 1 may be stopped.

(作用効果)
以上説明した本実施形態の作業車両システム100によれば、車両転倒回避装置5によって特定の一つの横移動走行の走行経路K(第一経路K1)を走行しながら、作業車両1の位置および車両傾斜角度をリアルタイムで取得し、次に横移動走行する予定となっている走行経路K(第二経路K2)上におけるリスク領域RAを推定することができる。そして実際に作業車両1がリスク領域RAに近接した際には、警告によってオペレータが作業車両1の転倒の危険性を把握することができる。このため、オペレータは斜面Sの地面の状態を直接目視することができなくとも作業車両1の転倒の可能性を予測でき、作業車両1を徐行させたり停止させたりして、作業車両1の挙動を確認しつつ作業車両1による作業を行うことができる。すなわち斜面S上で作業車両1を安定して走行させ、作業を円滑化することが可能となる。
(effect)
According to the work vehicle system 100 of the present embodiment described above, the vehicle overturn avoidance device 5 is used to determine the position of the work vehicle 1 and the By acquiring the inclination angle in real time, it is possible to estimate the risk area RA on the travel route K (second route K2) on which the vehicle is scheduled to travel laterally. Then, when the work vehicle 1 actually approaches the risk area RA, the operator can grasp the danger of the work vehicle 1 falling due to the warning. Therefore, even if the operator cannot directly visually observe the ground condition of the slope S, the operator can predict the possibility of the work vehicle 1 falling, and can slow down or stop the work vehicle 1 to control the behavior of the work vehicle 1. It is possible to perform work using the work vehicle 1 while checking the following. That is, it becomes possible to run the work vehicle 1 stably on the slope S and to facilitate the work.

ここで図6に示すように第一経路K1を横移動走行中の作業車両1(1A)における走行装置9の上側のみが窪みDへ侵入してしまう場合、第一経路K1の次の走行経路Kとなる第二経路K2を作業車両1(1B)が走行中には窪みDに走行装置9の下側のみが侵入することが有り得る。この際、第一経路K1を走行中の作業車両1(1A)の車両傾斜角度βと斜面基準角度αとがβ<αを満足し、作業車両1の車両傾斜角度βが斜面Sの傾斜角度にくらべて小さい状態となる。その一方で、第二経路K2を走行中の作業車両1(1B)の車両傾斜角度γと斜面基準角度αとがγ>αを満足し、作業車両1の車両傾斜角度γが斜面Sの傾斜角度にくらべて大きい状態となる。このように第一経路K1上での車両傾斜角度βが斜面基準角度αよりも小さい角度、すなわち作業車両1が転倒しにくい側の値となっていた場合には、逆に第二経路K2上での車両傾斜角度γが斜面基準角度αよりも大きい角度、すなわち作業車両1が転倒し易い側の値となってしまう。換言すると、第一経路K1上での車両傾斜角度βと斜面基準角度αとの差分:α-βに斜面基準角度αを加えた値:2α-βが第二経路K2上での車両傾斜角度γと略一致する場合があり、転倒の危険性が高くなり得る。 Here, as shown in FIG. 6, if only the upper side of the traveling device 9 of the work vehicle 1 (1A) traveling laterally on the first route K1 enters the depression D, the next traveling route of the first route K1 While the work vehicle 1 (1B) is traveling along the second route K2, it is possible that only the lower side of the traveling device 9 enters the depression D. At this time, the vehicle inclination angle β of the work vehicle 1 (1A) traveling on the first route K1 and the slope reference angle α satisfy β<α, and the vehicle inclination angle β of the work vehicle 1 is the inclination angle of the slope S. It is in a smaller state compared to . On the other hand, the vehicle inclination angle γ of the work vehicle 1 (1B) traveling on the second route K2 and the slope reference angle α satisfy γ>α, and the vehicle inclination angle γ of the work vehicle 1 is the inclination of the slope S. It becomes larger compared to the angle. In this way, if the vehicle inclination angle β on the first route K1 is a smaller angle than the slope reference angle α, that is, a value on the side where the work vehicle 1 is less likely to fall, then on the second route K2 The vehicle inclination angle γ is larger than the slope reference angle α, that is, a value on the side where the work vehicle 1 is likely to fall. In other words, the difference between the vehicle inclination angle β on the first route K1 and the slope reference angle α: α−β plus the slope reference angle α: 2α−β is the vehicle inclination angle on the second route K2. γ may substantially match, and the risk of falling may be high.

この点、本実施形態では斜面基準角度αと車両傾斜角度βとの差分:α-βと、角度減少量閾値θ1との関係が、α-β>θ1を満足する場合の角度減少位置Pxに対応する角度減少対応位置Pyを含む第二経路K2上の領域をリスク領域RAとして推定する。特に本実施形態では、第二経路K2を横移動走行中に作業車両1の車両傾斜角度γが限界最大傾斜角度θmaxを超えてしまわないように角度減少量閾値θ1が設定されている。このため、より効果的に作業車両1の転倒を回避することができる。 In this regard, in this embodiment, the relationship between the difference between the slope reference angle α and the vehicle inclination angle β: α−β and the angle decrease amount threshold θ1 is the angle decrease position Px when α−β>θ1. The area on the second route K2 including the corresponding angle reduction corresponding position Py is estimated as the risk area RA. In particular, in this embodiment, the angle reduction amount threshold θ1 is set so that the vehicle inclination angle γ of the work vehicle 1 does not exceed the limit maximum inclination angle θmax while moving laterally on the second route K2. Therefore, overturning of the work vehicle 1 can be more effectively avoided.

さらに本実施形態では、角度減少位置Pxが連続する距離dが所定の距離閾値dtよりも大きい場合に、角度減少対応位置Pyを含む第二経路K2上の領域をリスク領域RAと推定する。このため、作業車両1の横移動走行方向に所定の大きさの窪みDが存在する場合のみに危険性を推定し、一方で、作業車両1の走行に支障のない小さな窪みDは無視して作業を継続することができ、作業効率を向上できる。 Furthermore, in this embodiment, when the distance d between consecutive angle reduction positions Px is greater than a predetermined distance threshold dt, the area on the second route K2 including the angle reduction corresponding position Py is estimated to be the risk area RA. For this reason, the danger is estimated only when there is a dent D of a predetermined size in the lateral movement direction of the work vehicle 1, and on the other hand, small dents D that do not hinder the movement of the work vehicle 1 are ignored. Work can be continued and work efficiency can be improved.

またリスク領域RAに作業車両1が近接した際には、作業車両1がリスク領域RAに近接したとのリスク情報を発信し、警告装置4によって警告を発することができる。したがってオペレータは斜面Sの窪みDに作業車両1が侵入する可能性があることを事前に把握することができ、例えば作業車両1を徐行させたり停止させたりすることが可能となる。 Further, when the work vehicle 1 approaches the risk area RA, risk information indicating that the work vehicle 1 approaches the risk area RA can be transmitted, and the warning device 4 can issue a warning. Therefore, the operator can know in advance that the work vehicle 1 may enter the depression D of the slope S, and can, for example, slow down or stop the work vehicle 1.

さらには、作業車両1がリスク領域RAに近接した際または侵入した後において、車両傾斜角度γが斜面基準角度αよりも大きくなった場合には作業車両1の走行速度を低下させ、徐行または一時停止させることができる。このため速度を緩めることなく作業車両1が窪みDに侵入して走行を継続してしまうことを回避でき、この結果、さらに効果的に、作業車両1の転倒を回避できる。 Furthermore, when the work vehicle 1 approaches or enters the risk area RA, if the vehicle inclination angle γ becomes larger than the slope reference angle α, the traveling speed of the work vehicle 1 is reduced, and the vehicle is slowed down or temporarily It can be stopped. Therefore, it is possible to avoid the work vehicle 1 from entering the depression D and continuing traveling without slowing down, and as a result, it is possible to more effectively prevent the work vehicle 1 from overturning.

また、作業車両1がリスク領域RAに侵入した後においては、斜面基準角度αと車両傾斜角度γとの差分:γ-αが角度増加量閾値θ2よりも大きくなった場合に作業車両1を停止させることができ、かつ、作業車両1の限界最大傾斜角度θmaxを超えないように角度増加量閾値θ2が設定されている。よってさらに効果的に作業車両1の転倒を回避できる。 Furthermore, after the work vehicle 1 enters the risk area RA, the work vehicle 1 is stopped when the difference between the slope reference angle α and the vehicle inclination angle γ: γ - α becomes larger than the angle increase threshold θ2. The angle increase amount threshold value θ2 is set so that the angle can be increased and the maximum inclination angle θmax of the working vehicle 1 is not exceeded. Therefore, overturning of the work vehicle 1 can be more effectively avoided.

ところで、第一経路K1と第二経路K2とが斜面Sの傾斜方向に離れた位置に設定されると、仮に第一経路K1の走行によって第二経路K2上にリスク領域RAを推定したとしても、実際に第二経路K2を走行する際にはリスク領域RAと推定された領域に作業車両1が到達した場合に、その領域には実際には窪みDが存在していない可能性がある。すなわち実際には、推定したリスク領域RAの下方に窪みDが存在してしまっている可能性があるため、リスク領域RAの推定が無駄なものになってしまう。 By the way, if the first route K1 and the second route K2 are set at positions apart in the slope direction of the slope S, even if the risk area RA is estimated on the second route K2 by traveling on the first route K1. When the working vehicle 1 reaches an area estimated to be the risk area RA when actually traveling on the second route K2, there is a possibility that the depression D does not actually exist in that area. That is, in reality, there is a possibility that the depression D exists below the estimated risk area RA, so the estimation of the risk area RA becomes useless.

この点、本実施形態では作業車両1が第一経路K1を走行する際の作業車両1の履帯9aのうち山側の履帯9aの斜面Sへの接触軌跡の高位縁Kxに対して、作業車両1が第二経路K2を走行する際の谷側の履帯9aの斜面Sへの接触軌跡の低位縁Kyが下方に位置するように第二経路K2が設定され、作業車両1同士が車幅方向にオーバーラップするように走行経路Kが設定されている。このため、リスク領域RAと推定した第二経路K2上の領域に、実際に窪みDが形成されている可能性が高くなり、リスク領域RAの推定によって、実際に作業車両1が窪みDに侵入して転倒してしまうリスクを回避できる。 In this regard, in the present embodiment, when the work vehicle 1 travels on the first route K1, the work vehicle 1 The second route K2 is set such that the lower edge Ky of the contact trajectory of the valley-side crawler track 9a with the slope S when traveling on the second route K2 is located downward, and the work vehicles 1 are moved in the vehicle width direction. Travel routes K are set so as to overlap. Therefore, there is a high possibility that the depression D is actually formed in the area on the second route K2 that is estimated to be the risk area RA, and the work vehicle 1 actually enters the depression D based on the estimation of the risk area RA. You can avoid the risk of falling.

ここで本発明は上述の実施の形態に限定されるものではなく、本発明の要旨を逸脱しない範囲内において種々変更を加え得ることは勿論である。
例えば、車両転倒回避装置5における制御信号発信部56は、作業車両1を自動で、かつ、予め定められた横移動走行の走行経路Kに沿って走行させるための制御信号を生成し発信してもよい。すなわち制御信号発信部56は、作業車両1の位置情報を取得し、予め記憶された走行経路Kに沿って実際の作業車両1の走行位置を調整するように電子制御ユニット6へ自動運転の指令を出すようにしてもよい。これにより第一経路K1を作業車両1が横移動走行中に等高線に交差する方向へ、すなわち斜面Sの傾斜方向の下方もしくは上方へ斜めに走行してしまうようなことがなくなり、第一経路K1の次に、リスク領域RAを設定した仮想的な第二経路K2からずれた経路を実際に作業車両1が走行してしまうことを回避でき、リスク領域RAの推定が意味のあるものとなり、作業車両1の転倒回避を確実に実行することができる。
Here, the present invention is not limited to the above-described embodiments, and it goes without saying that various changes can be made without departing from the gist of the present invention.
For example, the control signal transmitter 56 in the vehicle overturn avoidance device 5 generates and transmits a control signal for automatically causing the work vehicle 1 to travel along a predetermined travel route K for lateral travel. Good too. That is, the control signal transmitter 56 acquires the position information of the work vehicle 1 and issues an automatic driving command to the electronic control unit 6 to adjust the actual travel position of the work vehicle 1 along the travel route K stored in advance. It is also possible to issue . This prevents the work vehicle 1 from traveling diagonally along the first route K1 in a direction that intersects the contour line while moving laterally, that is, downward or upward in the direction of inclination of the slope S. Next, it is possible to avoid the work vehicle 1 actually traveling on a route that deviates from the virtual second route K2 where the risk area RA is set, and the estimation of the risk area RA becomes meaningful, and the work It is possible to reliably avoid overturning the vehicle 1.

また上述の実施形態では、斜面Sの傾斜方向に、下方から上方に向かって横移動走行を繰り返す場合について説明したが、これとは逆に、斜面Sの上方から下方に向かって横移動走行を繰り返すように作業車両1を走行させてもよい。この場合、第一経路K1に対して第二経路K2が下方に位置し、角度減少位置Pxに対して斜面Sの下方に角度減少対応位置Pyが配置されていることになる。そしてこの場合、第一経路K1の横移動走行によって、第二経路K2上に「凸地」としてのリスク領域RAを推定することが可能である。 Furthermore, in the above-described embodiment, a case has been described in which lateral movement is repeated from below to above in the inclination direction of the slope S. However, conversely, lateral movement is repeated from above to below on the slope S. The work vehicle 1 may be driven repeatedly. In this case, the second path K2 is located below the first path K1, and the angle reduction corresponding position Py is located below the slope S with respect to the angle reduction position Px. In this case, it is possible to estimate a risk area RA as a "convex land" on the second route K2 by lateral movement traveling on the first route K1.

また、作業車両1の走行装置9は上述に構造に限定されず、車幅方向に対をなす車輪によって構成されてもよい。 Further, the traveling device 9 of the work vehicle 1 is not limited to the above-mentioned structure, and may be configured by a pair of wheels in the vehicle width direction.

本発明の転倒回避装置等によれば、斜面上で作業車両を安定して走行させ、作業を円滑化することが可能となる。 According to the fall avoidance device and the like of the present invention, it is possible to stably drive a work vehicle on a slope and facilitate work.

1 作業車両
2 位置情報検知装置
3 傾斜角検知装置
4 警告装置
5 車両転倒回避装置
6 電子制御ユニット
9 走行装置
9a 履帯
50 位置情報取得部
51 角度情報取得部
52 情報記録部
53 角度減少位置判定部
54 リスク領域推定部
55 リスク情報発信部
56 制御信号発信部
100 作業車両システム
500 計算機
G 重心
K 走行経路
K1 第一経路
K2 第二経路
Kx 高位縁
Ky 低位縁
Px 角度減少位置
Py 角度減少対応位置
RA リスク領域
S 斜面
VL 幅方向仮想線
1 Work vehicle 2 Position information detection device 3 Inclination angle detection device 4 Warning device 5 Vehicle fall avoidance device 6 Electronic control unit 9 Traveling device 9a Track 50 Position information acquisition section 51 Angle information acquisition section 52 Information recording section 53 Angle reduction position determination section 54 Risk area estimation section 55 Risk information transmission section 56 Control signal transmission section 100 Work vehicle system 500 Computer G Center of gravity K Traveling route K1 First route K2 Second route Kx High edge Ky Low edge Px Angle reduction position Py Angle reduction corresponding position RA Risk area S Slope VL Width direction imaginary line

Claims (14)

計算機を有し、斜面の傾斜方向に交差する等高線に沿って該斜面を移動する横移動走行を、前記傾斜方向に順次繰り返す作業車両の転倒を回避する車両転倒回避装置であって、
前記計算機は、
前記作業車両の前記斜面上における位置の情報(以下、位置情報)を、該作業車両の前記横移動走行中に取得する位置情報取得部と、
前記横移動走行における前記斜面上の位置毎に、該作業車両の重心を通って車幅方向に延びる幅方向仮想線の水平面に対する車両傾斜角度の情報(以下、車両角度情報)を取得する角度情報取得部と、
前記位置情報および前記車両角度情報を記録する情報記録部と、
記録された前記位置情報および前記車両角度情報を参照し、前記横移動走行を行っている走行経路における前記斜面の基準となる傾斜角度(以下、斜面基準角度)に対して、前記車両傾斜角度が小さくなっている前記斜面上の前記位置を角度減少位置として判定する角度減少位置判定部と、
前記位置情報および前記車両角度情報を記録した特定の一つの前記横移動走行における前記走行経路を第一経路とし、該第一経路に対して前記傾斜方向に隣接して前記作業車両が該第一経路の次に前記横移動走行する際に進入する可能性のある仮想的な前記走行経路を第二経路としたとき、前記第一経路の前記角度減少位置に対して前記傾斜方向に隣接する前記第二経路上の位置(以下、角度減少対応位置)を含む前記第二経路上の領域を、前記作業車両が転倒するリスクのあるリスク領域であると推定するリスク領域推定部と、
前記作業車両が前記第二経路上の前記リスク領域に近接した際に、該作業車両がリスク領域に近接したとのリスク情報を生成して発信するリスク情報発信部と、
を備える車両転倒回避装置。
A vehicle overturn avoidance device that includes a calculator and prevents a work vehicle from overturning by sequentially repeating lateral movement traveling on the slope in the slope direction along contour lines intersecting with the slope direction, comprising:
The calculator is
a position information acquisition unit that acquires information on the position of the work vehicle on the slope (hereinafter referred to as position information) while the work vehicle is moving laterally;
Angle information for acquiring information on a vehicle inclination angle with respect to a horizontal plane of a width direction virtual line extending in the vehicle width direction through the center of gravity of the work vehicle (hereinafter referred to as vehicle angle information) for each position on the slope during the lateral movement traveling. an acquisition department;
an information recording unit that records the position information and the vehicle angle information;
With reference to the recorded position information and the vehicle angle information, the vehicle inclination angle is determined with respect to the reference inclination angle of the slope (hereinafter referred to as slope reference angle) on the traveling route on which the lateral movement is being performed. an angle decreasing position determination unit that determines the position on the slope that is becoming smaller as an angle decreasing position;
The travel route in the specific one of the lateral movement runs in which the position information and the vehicle angle information are recorded is a first route, and the work vehicle is adjacent to the first route in the inclination direction. When the hypothetical traveling route that may be entered when traveling laterally after the route is set as a second route, the said traveling route adjacent to the angle decreasing position of the first route in the inclination direction a risk area estimating unit that estimates an area on the second route including a position on the second route (hereinafter referred to as an angle reduction corresponding position) to be a risk area where there is a risk of the work vehicle falling;
a risk information transmission unit that generates and transmits risk information indicating that the work vehicle has approached the risk area when the work vehicle approaches the risk area on the second route;
A vehicle overturn avoidance device comprising:
リスク領域推定部は、
前記斜面基準角度と、該斜面基準角度よりも小さい前記車両傾斜角度との差分が所定の角度減少量閾値よりも大きくなっている場合の前記角度減少位置に対応する前記角度減少対応位置を含む前記第二経路上の領域を、前記リスク領域であると推定する請求項1に記載の車両転倒回避装置。
The risk area estimation department is
The angle reduction corresponding position corresponds to the angle reduction position where the difference between the slope reference angle and the vehicle inclination angle smaller than the slope reference angle is larger than a predetermined angle reduction amount threshold. The vehicle overturn avoidance device according to claim 1, wherein an area on the second route is estimated to be the risk area.
前記角度減少量閾値に前記斜面基準角度を加えた値が、前記作業車両が転倒せずに前記横移動走行可能となる限界値である限界最大傾斜角度以下となるように、前記角度減少量閾値が設定されている請求項2に記載の車両転倒回避装置。 The angle reduction amount threshold is set such that a value obtained by adding the slope reference angle to the angle reduction amount threshold is equal to or less than a limit maximum inclination angle that is a limit value at which the work vehicle can move laterally without overturning. The vehicle overturn avoidance device according to claim 2, wherein: is set. 前記リスク領域推定部は、
前記第一経路に沿って前記角度減少位置が連続しており、且つ、当該連続する距離が所定の距離閾値よりも大きい場合に、前記角度減少対応位置を含む前記第二経路上の領域を前記リスク領域であると推定する請求項1から3のいずれか一項に記載の車両転倒回避装置。
The risk area estimating unit includes:
If the angle reduction positions are continuous along the first route and the continuous distance is greater than a predetermined distance threshold, the area on the second route including the angle reduction corresponding position is The vehicle overturn avoidance device according to any one of claims 1 to 3, wherein the vehicle overturn avoidance device is estimated to be in a risk area.
前記作業車両の走行を制御するための制御信号を生成して発信する制御信号発信部をさらに備え、
前記制御信号発信部は、前記作業車両が前記第二経路上の前記リスク領域に近接した際または侵入した後に、前記作業車両の走行速度を低下させるための信号を生成し発信する請求項1から3のいずれか一項に記載の車両転倒回避装置。
further comprising a control signal transmitter that generates and transmits a control signal for controlling travel of the work vehicle,
From claim 1, wherein the control signal transmitter generates and transmits a signal for reducing the traveling speed of the work vehicle when the work vehicle approaches or enters the risk area on the second route. 3. The vehicle overturn avoidance device according to any one of 3.
前記作業車両の走行を制御するための制御信号を生成して発信する制御信号発信部をさらに備え、
前記制御信号発信部は、前記作業車両が前記第二経路上の前記リスク領域に侵入した後において、前記斜面基準角度と、該斜面基準角度よりも大きい前記車両傾斜角度との差分が所定の角度増加量閾値よりも大きくなった場合に、前記作業車両を停止させるための信号を生成し発信する請求項1から3のいずれか一項に記載の車両転倒回避装置。
further comprising a control signal transmitter that generates and transmits a control signal for controlling travel of the work vehicle,
The control signal transmitter is configured to determine, after the work vehicle enters the risk area on the second route, that a difference between the slope reference angle and the vehicle inclination angle that is larger than the slope reference angle is a predetermined angle. The vehicle overturn avoidance device according to any one of claims 1 to 3, wherein the vehicle overturn avoidance device generates and transmits a signal for stopping the work vehicle when the increase amount exceeds a threshold value.
前記角度増加量閾値に前記斜面基準角度を加えた値が、前記作業車両が転倒せずに走行可能となる限界値である限界最大傾斜角度以下となるように、前記角度増加量閾値が設定されている請求項6に記載の車両転倒回避装置。 The angle increase amount threshold is set such that a value obtained by adding the slope reference angle to the angle increase amount threshold is less than or equal to a limit maximum inclination angle that is a limit value at which the work vehicle can travel without overturning. The vehicle overturn avoidance device according to claim 6. 前記作業車両の走行を制御するための制御信号を生成し発信する制御信号発信部をさらに備え、
前記制御信号発信部は、前記作業車両を自動で、かつ、予め定められた前記横移動走行の前記走行経路に沿って走行させるための制御信号を生成し発信する請求項1から3のいずれか一項に記載の車両転倒回避装置。
further comprising a control signal transmitter that generates and transmits a control signal for controlling travel of the work vehicle,
4. The control signal transmitter generates and transmits a control signal for automatically causing the work vehicle to travel along the predetermined travel route of the lateral movement travel. The vehicle fall avoidance device according to item 1.
前記第一経路を前記横移動走行する前記作業車両における車幅中心と、前記第二経路を前記横移動走行する前記作業車両における車幅中心との前記傾斜方向の間隔が、該作業車両の走行装置における前記車幅方向の幅寸法の1.5倍以下となるように、前記第二経路が設定される請求項1から3のいずれか一項に記載の車両転倒回避装置。 The distance in the inclination direction between the vehicle width center of the work vehicle that travels laterally on the first route and the vehicle width center of the work vehicle that travels laterally on the second route, The vehicle overturn avoidance device according to any one of claims 1 to 3, wherein the second route is set to be 1.5 times or less the width dimension of the device in the vehicle width direction. 前記作業車両が前記第一経路を前記横移動走行する際の前記走行装置における前記斜面への接触軌跡の高位縁に対して、前記作業車両が前記第二経路を前記横移動走行する際の前記接触軌跡の低位縁が前記斜面の下方に位置するように、前記第二経路が設定される請求項9に記載の車両転倒回避装置。 When the work vehicle travels laterally on the second route, the higher edge of the contact locus of the traveling device on the slope when the work vehicle travels laterally on the first route is The vehicle overturn avoidance device according to claim 9, wherein the second path is set so that a lower edge of the contact trajectory is located below the slope. 請求項1から3のいずれか一項に記載の車両転倒回避装置と、
前記斜面上の前記位置を検知し、検知した前記位置の前記位置情報を前記車両転倒回避装置へ発信する位置情報検知装置と、
前記車両傾斜角度を検知し、検知した該車両傾斜角度の前記車両角度情報を前記車両転倒回避装置へ発信する傾斜角検知装置と、
前記位置情報検知装置および前記傾斜角検知装置を搭載した作業車両と、
を備える作業車両システム。
The vehicle overturn avoidance device according to any one of claims 1 to 3;
a position information detection device that detects the position on the slope and transmits the position information of the detected position to the vehicle overturn avoidance device;
a tilt angle detection device that detects the vehicle tilt angle and transmits the vehicle angle information of the detected vehicle tilt angle to the vehicle overturn avoidance device;
a work vehicle equipped with the position information detection device and the tilt angle detection device;
A work vehicle system equipped with
前記作業車両は、車幅方向に間隔をあけて配置された一対の履帯によって構成された走行装置を有している請求項11に記載の作業車両システム。 12. The work vehicle system according to claim 11, wherein the work vehicle has a traveling device configured by a pair of crawler tracks spaced apart from each other in the vehicle width direction. 斜面の傾斜方向に交差する等高線に沿って該斜面を移動する横移動走行を、前記傾斜方向に順次繰り返す作業車両の転倒を回避する車両転倒回避方法であって、
前記作業車両の前記斜面上における位置の情報(以下、位置情報)を、該作業車両の前記横移動走行中に取得する位置情報取得ステップと、
前記横移動走行における前記斜面上の位置毎に、該作業車両の重心を通って車幅方向に延びる幅方向仮想線の水平面に対する車両傾斜角度の情報(以下、車両角度情報)を取得する角度情報取得ステップと、
前記位置情報および前記車両角度情報を記録する情報記録ステップと、
記録された前記位置情報および前記車両角度情報を参照し、前記横移動走行を行っている走行経路における前記斜面の基準となる傾斜角度(以下、斜面基準角度)に対して、前記車両傾斜角度が小さくなっている前記斜面上の前記位置を角度減少位置として判定する角度減少位置判定ステップと、
前記位置情報および前記車両角度情報を記録した特定の一つの前記横移動走行における前記走行経路を第一経路とし、該第一経路に対して前記傾斜方向に隣接して前記作業車両が該第一経路の次に前記横移動走行する際に進入する可能性のある仮想的な前記走行経路を第二経路としたとき、前記第一経路の前記角度減少位置に対して前記傾斜方向に隣接する前記第二経路上の位置(以下、角度減少対応位置)を含む前記第二経路上の領域を、前記作業車両が転倒するリスクのあるリスク領域であると推定するリスク領域推定ステップと、
前記作業車両が前記第二経路上の前記リスク領域に近接した際に、該作業車両がリスク領域に近接したとのリスク情報を生成して発信するリスク情報発信ステップと、
を含む車両転倒回避方法。
A vehicle overturn avoidance method for avoiding overturning of a work vehicle by sequentially repeating lateral movement traveling on a slope along contour lines intersecting the slope direction in the slope direction, the method comprising:
a position information acquisition step of acquiring information on the position of the work vehicle on the slope (hereinafter referred to as position information) while the work vehicle is moving laterally;
Angle information for acquiring information on a vehicle inclination angle with respect to a horizontal plane of a width direction virtual line extending in the vehicle width direction through the center of gravity of the work vehicle (hereinafter referred to as vehicle angle information) for each position on the slope during the lateral movement traveling. an acquisition step;
an information recording step of recording the position information and the vehicle angle information;
With reference to the recorded position information and the vehicle angle information, the vehicle inclination angle is determined with respect to the reference inclination angle of the slope (hereinafter referred to as slope reference angle) on the traveling route on which the lateral movement is being performed. an angle decreasing position determination step of determining the position on the slope that is becoming smaller as an angle decreasing position;
The travel route in the specific one of the lateral movement runs in which the position information and the vehicle angle information are recorded is a first route, and the work vehicle is adjacent to the first route in the inclination direction. When the hypothetical traveling route that may be entered when traveling laterally after the route is set as a second route, the said traveling route adjacent to the angle decreasing position of the first route in the inclination direction a risk area estimating step of estimating an area on the second route including a position on the second route (hereinafter referred to as an angle reduction corresponding position) to be a risk area where there is a risk of the work vehicle overturning;
a risk information transmitting step of generating and transmitting risk information indicating that the work vehicle has approached the risk area when the work vehicle approaches the risk area on the second route;
How to avoid vehicle overturning, including:
斜面の傾斜方向に交差する等高線に沿って該斜面を移動する横移動走行を、前記傾斜方向に順次繰り返す作業車両の転倒を回避するために、計算機を、
前記作業車両の前記斜面上における位置の情報(以下、位置情報)を、該作業車両の前記横移動走行中に取得する位置情報取得手段、
前記横移動走行における前記斜面上の位置毎に、該作業車両の重心を通って車幅方向に延びる幅方向仮想線の水平面に対する車両傾斜角度の情報(以下、車両角度情報)を取得する角度情報取得手段、
前記位置情報および前記車両角度情報を記録する情報記録手段、
記録された前記位置情報および前記車両角度情報を参照し、前記横移動走行を行っている走行経路における前記斜面の基準となる傾斜角度(以下、斜面基準角度)に対して、前記車両傾斜角度が小さくなっている前記斜面上の前記位置を角度減少位置として判定する角度減少位置判定手段、
前記位置情報および前記車両角度情報を記録した特定の一つの前記横移動走行における前記走行経路を第一経路とし、該第一経路に対して前記傾斜方向に隣接して前記作業車両が該第一経路の次に前記横移動走行する際に進入する可能性のある仮想的な前記走行経路を第二経路としたとき、前記第一経路の前記角度減少位置に対して前記傾斜方向に隣接する前記第二経路上の位置(以下、角度減少対応位置)を含む前記第二経路上の領域を、前記作業車両が転倒するリスクのあるリスク領域であると推定するリスク領域推定手段、および
前記作業車両が前記第二経路上の前記リスク領域に近接した際に、該作業車両がリスク領域に近接したとのリスク情報を生成して発信するリスク情報発信手段、
として機能させるための車両転倒回避プログラム。
In order to avoid overturning of the work vehicle, which sequentially repeats lateral movement traveling on the slope along contour lines intersecting the slope direction in the slope direction, a computer is used.
position information acquisition means for acquiring information on the position of the work vehicle on the slope (hereinafter referred to as position information) while the work vehicle is moving laterally;
Angle information for acquiring information on a vehicle inclination angle with respect to a horizontal plane of a width direction virtual line extending in the vehicle width direction through the center of gravity of the work vehicle (hereinafter referred to as vehicle angle information) for each position on the slope during the lateral movement traveling. acquisition means,
information recording means for recording the position information and the vehicle angle information;
With reference to the recorded position information and the vehicle angle information, the vehicle inclination angle is determined with respect to the reference inclination angle of the slope (hereinafter referred to as slope reference angle) on the traveling route on which the lateral movement is being performed. angle decreasing position determining means for determining the position on the slope that is becoming smaller as an angle decreasing position;
The travel route in the specific one of the lateral movement runs in which the position information and the vehicle angle information are recorded is a first route, and the work vehicle is adjacent to the first route in the inclination direction. When the hypothetical traveling route that may be entered when traveling laterally after the route is set as a second route, the said traveling route adjacent to the angle decreasing position of the first route in the inclination direction risk area estimating means for estimating an area on the second route including a position on the second route (hereinafter referred to as an angle reduction corresponding position) to be a risk area where the work vehicle has a risk of falling; and the work vehicle. risk information transmission means for generating and transmitting risk information indicating that the work vehicle has approached the risk area when the work vehicle approaches the risk area on the second route;
A vehicle rollover avoidance program to function as a vehicle rollover prevention program.
JP2022099029A 2022-06-20 2022-06-20 Vehicle overturn avoidance device, work vehicle system, vehicle overturn avoidance method, and vehicle overturn avoidance program Pending JP2024000308A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2022099029A JP2024000308A (en) 2022-06-20 2022-06-20 Vehicle overturn avoidance device, work vehicle system, vehicle overturn avoidance method, and vehicle overturn avoidance program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2022099029A JP2024000308A (en) 2022-06-20 2022-06-20 Vehicle overturn avoidance device, work vehicle system, vehicle overturn avoidance method, and vehicle overturn avoidance program

Publications (1)

Publication Number Publication Date
JP2024000308A true JP2024000308A (en) 2024-01-05

Family

ID=89384652

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022099029A Pending JP2024000308A (en) 2022-06-20 2022-06-20 Vehicle overturn avoidance device, work vehicle system, vehicle overturn avoidance method, and vehicle overturn avoidance program

Country Status (1)

Country Link
JP (1) JP2024000308A (en)

Similar Documents

Publication Publication Date Title
US10088845B2 (en) System and method for behavior based control of an autonomous vehicle
US7499775B2 (en) System and method for terrain feature tracking
EP2269884B1 (en) Systems and methods for control of a vehicle
US7499774B2 (en) System and method for processing safety signals in an autonomous vehicle
EP3272195B1 (en) Work vehicle and slope travel control system for work vehicle
US7499776B2 (en) Systems and methods for control of an unmanned ground vehicle
EP3259971B1 (en) Travel support system and work vehicle
US20060089800A1 (en) System and method for multi-modal control of an autonomous vehicle
US8706363B2 (en) System and method for adjusting a boundary for a machine
US9163384B2 (en) System and method for detecting a crest
JP6734485B2 (en) Work machine
CN109318899B (en) Curve driving method, device, equipment and storage medium for automatic driving vehicle
JPWO2019187122A1 (en) Autonomous traveling work machine and control system
CN110815220A (en) Obstacle meeting processing method of fire-fighting robot
JP2024000308A (en) Vehicle overturn avoidance device, work vehicle system, vehicle overturn avoidance method, and vehicle overturn avoidance program
US11840118B2 (en) Vehicle and control method thereof
CN113427485B (en) Slip monitoring method and device for mobile robot and mobile robot
JP2019109695A (en) Service car collision warning system and service car
US20220282460A1 (en) System and method for terrain based control of self-propelled work vehicles
US20240011244A1 (en) Systems and methods for collision avoidance for shape changing machines
WO2023119290A1 (en) Automatic speed control in a vehicle
JP2021074016A (en) Work vehicle and inclined travel management system for work vehicle
KR20230024382A (en) risk management system
WO2023148777A1 (en) An apparatus for the patrolling of a manoeuvring locomotory device