JP2018192891A - State management system for work machine - Google Patents

State management system for work machine Download PDF

Info

Publication number
JP2018192891A
JP2018192891A JP2017097650A JP2017097650A JP2018192891A JP 2018192891 A JP2018192891 A JP 2018192891A JP 2017097650 A JP2017097650 A JP 2017097650A JP 2017097650 A JP2017097650 A JP 2017097650A JP 2018192891 A JP2018192891 A JP 2018192891A
Authority
JP
Japan
Prior art keywords
vehicle body
work machine
management system
zero moment
moment point
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2017097650A
Other languages
Japanese (ja)
Other versions
JP6789880B2 (en
Inventor
棟 梁
Dong Liang
棟 梁
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.)
Kubota Corp
Original Assignee
Kubota 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 Kubota Corp filed Critical Kubota Corp
Priority to JP2017097650A priority Critical patent/JP6789880B2/en
Publication of JP2018192891A publication Critical patent/JP2018192891A/en
Application granted granted Critical
Publication of JP6789880B2 publication Critical patent/JP6789880B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Agricultural Machines (AREA)
  • Lifting Devices For Agricultural Implements (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

To facilitate grasping of a state of a vehicle body, that is, a state of a work machine.SOLUTION: A state management system for a work machine comprises a computation unit for computing a zero moment point in a vehicle body that is capable of installing a work device and capable of traveling, and a display unit capable of displaying information on the zero moment point computed by the computation unit. The display unit displays a stable area determined for the vehicle body and the zero moment point. The state management system for a work machine comprises a first determination unit for determining whether or not the zero moment point computed by the computation part falls outside the stable area determined for the vehicle body. When the zero moment point falls outside the stable area, the display unit gives a warning about the fact that the zero point is outside the stable area.SELECTED DRAWING: Figure 1

Description

本発明は、例えば、車体のゼロモーメントポイントを求めることができる作業機の状態管理システムに関する。   The present invention relates to a state management system for a work machine that can determine a zero moment point of a vehicle body, for example.

従来、作業を行う作業機において、車体のバランスを検出する技術として、特許文献１に示す技術が知られている。特許文献１では、車体の進行方向に対して左又は右の重量バランスを検出している。   2. Description of the Related Art Conventionally, a technique disclosed in Patent Document 1 is known as a technique for detecting the balance of a vehicle body in a working machine that performs work. In Patent Document 1, the left or right weight balance is detected with respect to the traveling direction of the vehicle body.

特開平９−３０９４６５号公報JP 9-309465 A

上述したように、特許文献１では、歪み計をトラクタの車体に取付けることによって当該トラクタのバランスを検出しているものの、トラクタの車体の全体のバランスを把握することは困難であるのが実情である。
そこで、本発明は上記問題点に鑑み、車体の状態を簡単に把握することができる作業機の状態管理システムを提供することを目的とする。 As described above, in Patent Document 1, although the balance of the tractor is detected by attaching a strain gauge to the tractor body, it is difficult to grasp the overall balance of the tractor body. is there.
In view of the above problems, an object of the present invention is to provide a working machine state management system that can easily grasp the state of a vehicle body.

この技術的課題を解決するための本発明の技術的手段は、以下に示す点を特徴とする。
作業機の状態管理システムは、作業装置が装着可能で且つ走行可能な車体におけるゼロモーメントポイントを演算する演算部と、前記演算部で演算されたゼロモーメントポイントに基づいて作業機の安定に関する情報を表示可能な表示部と、を備えている。
前記表示部は、前記車体に対して定められた安定領域と、前記ゼロモーメントポイントとを表示する。 The technical means of the present invention for solving this technical problem is characterized by the following points.
The work machine state management system calculates a zero moment point in a vehicle body on which the work device can be mounted and travels, and information on the stability of the work machine based on the zero moment point calculated by the calculation unit. A display unit capable of display.
The display unit displays a stable region defined for the vehicle body and the zero moment point.

作業機の状態管理システムは、前記演算部で演算したゼロモーメントポイントが、前記車体に対して定められた安定領域から外れているか否かを判断する第１判断部を備え、前記表示部は、前記ゼロモーメントポイントが前記安定領域から外れた場合に、前記ゼロポイントが前記安定領域から外れたことに対する警告を行う。
前記表示部は、前記ゼロモーメントポイントが前記安定領域から外れた場合に、前記ゼロモーメントポイントを前記安定領域内に戻す方法を表示する。 The work machine state management system includes a first determination unit that determines whether or not the zero moment point calculated by the calculation unit is out of a stable region defined for the vehicle body, and the display unit includes: When the zero moment point is out of the stable region, a warning is given to the fact that the zero point is out of the stable region.
The display unit displays a method of returning the zero moment point to the stable region when the zero moment point is out of the stable region.

前記車体は、前記ゼロモーメントポイントが前記安定領域から外れた場合に、前記ゼロモーメントポイントが前記安定領域から外れたことを外部に報知する報知部を有している。
作業機の状態管理システムは、前記演算部で演算したゼロモーメントポイントに基づいて、前記車体にウエイトが装着されているか否かを判断する第２判断部を備え、前記表示部は、前記車体に前記ウエイトが装着されていない場合に、前記ウエイトが装着されていないことに対する警告を行う。 The vehicle body includes an informing unit for informing the outside that the zero moment point is out of the stable region when the zero moment point is out of the stable region.
The work machine state management system includes a second determination unit that determines whether a weight is attached to the vehicle body based on the zero moment point calculated by the calculation unit, and the display unit is attached to the vehicle body. When the weight is not attached, a warning is given to the fact that the weight is not attached.

前記演算部は、前記車体に設けた車体状態検出部によって検出した第１荷重及びモーメントに基づいて、前記ゼロモーメントポイントを演算する。
前記演算部は、前記車体に連結された作業装置に設けられた装置状態検出部によって検出した第２荷重及びモーメントに基づいて、前記ゼロモーメントポイントを演算する。
作業機の状態管理システムは、前記車体に対する車体状態検出部の位置と、前記作業装置に対する装置状態検出部の位置とに基づいて、前記安定領域を演算する領域演算部を備えている。 The calculation unit calculates the zero moment point based on a first load and a moment detected by a vehicle state detection unit provided on the vehicle body.
The calculation unit calculates the zero moment point based on a second load and a moment detected by an apparatus state detection unit provided in a work device connected to the vehicle body.
The work machine state management system includes a region calculation unit that calculates the stable region based on a position of the vehicle body state detection unit with respect to the vehicle body and a position of the device state detection unit with respect to the work device.

前記演算部、前記表示部は前記作業機に設けられている。
前記演算部、前記表示部は携帯端末に設けられている。 The calculation unit and the display unit are provided in the working machine.
The calculation unit and the display unit are provided in a mobile terminal.

本発明によれば、車体の状態、即ち、作業機の状態を簡単に把握することができる。   According to the present invention, the state of the vehicle body, that is, the state of the work machine can be easily grasped.

第１実施形態における作業機の状態管理システムの全体図である。1 is an overall view of a state management system for a work machine in a first embodiment. ＺＭＰと、臨界領域Ｑ１、安定領域Ｑ２、床反力との関係を示す図である。It is a figure which shows the relationship between ZMP, critical region Q1, stable region Q2, and floor reaction force. 状態表示画面Ｍ１の一例を示す図である。It is a figure which shows an example of the status display screen M1. 車体のＺＭＰが臨界領域Ｑ１に位置している状態を示す図である。It is a figure which shows the state which ZMP of a vehicle body is located in the critical area | region Q1. 車体ＺＭＰが臨界領域Ｑ１の境界に位置している状態を示す図である。It is a figure which shows the state in which the vehicle body ZMP is located in the boundary of the critical area | region Q1. 車体のＺＭＰが臨界領域Ｑ１の外側に位置している状態を示す図である。It is a figure which shows the state which ZMP of a vehicle body is located in the outer side of the critical area | region Q1. 第２実施形態における作業機の状態管理システムの全体図である。It is a general view of the state management system of the working machine in 2nd Embodiment. 車体に作業装置及びウエイトを装着した状態を示す図である。It is a figure which shows the state which mounted | wore the vehicle body with the working device and the weight. 第３実施形態における作業機の状態管理システムの全体図である。It is a general view of the state management system of the working machine in 3rd Embodiment. トラクタに作業装置を連結した平面図に、臨界領域Ｑ４及び安定領域Ｑ５を示した図である。It is the figure which showed critical region Q4 and stable region Q5 in the top view which connected the working device to the tractor. トラクタの操舵時における臨界領域Ｑ４及び安定領域Ｑ５の関係を示す図である。It is a figure which shows the relationship between the critical area | region Q4 and the stable area | region Q5 at the time of steering of a tractor. 作業機の状態管理システムを変形した変形例を示している。The modification which changed the state management system of the working machine is shown. トラクタの走行系の動力伝達の概略図である。It is the schematic of the power transmission of the traveling system of a tractor. トラクタの全体図である。It is a general view of a tractor.

以下、本発明の実施の形態を図面に基づいて説明する。
［第１実施形態］
図１は、作業機の状態管理システムの全体図を示している。作業機は、トラクタ、コンバイン、田植機、バックホー、スキッドステアローダ、コンパクトトラックローダ等である。トラクタ1を例に挙げ
作業機について説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
[First Embodiment]
FIG. 1 shows an overall view of a work machine state management system. The work machines are tractors, combines, rice transplanters, backhoes, skid steer loaders, compact truck loaders, and the like. The working machine will be described by taking the tractor 1 as an example.

図１１に示すように、トラクタ１は、走行装置７を有する車両（車体）３と、原動機４と、変速装置５とを備えている。走行装置７は、前輪７Ｆ及び後輪７Ｒを有する装置である。走行装置７は、クローラ型の装置であってもよい。原動機４は、ディーゼルエンジン、電動モータ等であって、この実施形態ではディーゼルエンジンで構成されている。変速装置５は、変速によって走行装置７の推進力を切換可能であると共に、走行装置７の前進、後進の切換が可能である。   As shown in FIG. 11, the tractor 1 includes a vehicle (vehicle body) 3 having a traveling device 7, a prime mover 4, and a transmission 5. The traveling device 7 is a device having a front wheel 7F and a rear wheel 7R. The traveling device 7 may be a crawler type device. The prime mover 4 is a diesel engine, an electric motor, or the like, and in this embodiment is constituted by a diesel engine. The transmission 5 can switch the propulsive force of the traveling device 7 by shifting, and can also switch the traveling device 7 forward and backward.

また、車体３の後部には、３点リンク機構等で構成された連結部８が設けられている。連結部８には、作業装置２が着脱可能である。作業装置２を連結部８に連結することによって、車体３によって作業装置２を牽引することができる。作業装置２は、耕耘する耕耘装置、肥料を散布する肥料散布装置、農薬を散布する農薬散布装置、収穫を行う収穫装置、牧草等の刈取を行う刈取装置、牧草等の拡散を行う拡散装置、牧草等の集草を行う集草装置、牧草等の成形を行う成形装置等である。なお、図１１では、作業装置２として成形装置を取り付けた例を示している。   Further, a connecting portion 8 constituted by a three-point link mechanism or the like is provided at the rear portion of the vehicle body 3. The working device 2 can be attached to and detached from the connecting portion 8. By connecting the working device 2 to the connecting portion 8, the working device 2 can be pulled by the vehicle body 3. The working device 2 includes a tilling device for plowing, a fertilizer spraying device for spraying fertilizer, a pesticide spraying device for spraying agricultural chemicals, a harvesting device for harvesting, a harvesting device for cutting grass, a diffusion device for spreading grass, A grass collecting device for collecting grass and the like, and a molding device for forming grass and the like. In addition, in FIG. 11, the example which attached the shaping | molding apparatus as the working apparatus 2 is shown.

また、トラクタ１は、車体３に設けられた運転席１０と、操縦装置１１を備えている。運転席１０及び操縦装置１１は、車体３に設けられたキャビン１２内に配置されている。操縦装置１１は、例えば、ステアリング等で構成されていて、操縦装置１１を操縦することによってトラクタ１の進行方向を変更可能である。
図１０は、トラクタ（車体）の走行系の動力伝達の概略図を示している。図１０に示すように、前輪７Ｆは、第１デフ装置２０Ｆに回転自在に支持された前車軸２１Ｆに取付けられ、後輪７Ｒは、第２デフ装置２０Ｒに回転自在に支持された後車軸２１Ｒに取付けられている。第１デフ装置２０Ｆには、変速装置５の前部から突出する第１伝動軸２２Ｆの動力が伝達され、第２デフ装置２０Ｒには、変速装置５の後部に至る第２伝動軸２２Ｒの動力が伝達される。第１伝動軸２２Ｆ及び第２伝動軸２２Ｒには、原動機４の出力軸の動力が伝達され、第１伝動軸２２Ｆ及び第２伝動軸２２Ｒは回転自在となっている。なお、上述した実施形態では、第１伝動軸２２Ｆ及び第２伝動軸２２Ｒの両方に原動機４の動力
が伝達する４ＷＤについて説明したが、第２伝動軸２２Ｒのみに原動機４の動力が伝達する２ＷＤであってもよい。 The tractor 1 includes a driver's seat 10 provided on the vehicle body 3 and a control device 11. The driver's seat 10 and the control device 11 are disposed in a cabin 12 provided in the vehicle body 3. The steering device 11 is configured by, for example, steering, and the traveling direction of the tractor 1 can be changed by steering the steering device 11.
FIG. 10 shows a schematic diagram of power transmission in the traveling system of the tractor (vehicle body). As shown in FIG. 10, the front wheel 7F is attached to a front axle 21F that is rotatably supported by the first differential device 20F, and the rear wheel 7R is a rear axle 21R that is rotatably supported by the second differential device 20R. Installed on. The power of the first transmission shaft 22F protruding from the front portion of the transmission 5 is transmitted to the first differential device 20F, and the power of the second transmission shaft 22R reaching the rear portion of the transmission 5 is transmitted to the second differential device 20R. Is transmitted. The power of the output shaft of the prime mover 4 is transmitted to the first transmission shaft 22F and the second transmission shaft 22R, and the first transmission shaft 22F and the second transmission shaft 22R are freely rotatable. In the above-described embodiment, the 4WD in which the power of the prime mover 4 is transmitted to both the first transmission shaft 22F and the second transmission shaft 22R has been described. However, the 2WD in which the power of the prime mover 4 is transmitted only to the second transmission shaft 22R. It may be.

車体３には、複数の車体状態検出部２４が設けられている。複数の車体状態検出部２４は、少なくとも車体３に掛かる第１荷重（床反力）及びモーメントを検出する装置であって、３軸方向（Ｘ軸方向、Ｙ軸方向、Ｚ軸方向）の第１荷重及びモーメントが検出可能な６分力型のロードセルで構成されている。この実施形態では、Ｘ軸方向を車体３の走行方向（進行方向）、Ｙ軸方向を車体３の幅方向（左又は右方向）、Ｚ軸方向を走行方向及び幅方向に直交する方向（上又は下方向）とし説明を進める。   The vehicle body 3 is provided with a plurality of vehicle body state detection units 24. The plurality of vehicle body state detection units 24 are devices for detecting at least a first load (floor reaction force) and a moment applied to the vehicle body 3, and are arranged in three axial directions (X-axis direction, Y-axis direction, Z-axis direction). It consists of a 6-component load cell that can detect 1 load and moment. In this embodiment, the X-axis direction is the traveling direction (traveling direction) of the vehicle body 3, the Y-axis direction is the width direction (left or right direction) of the vehicle body 3, and the Z-axis direction is orthogonal to the traveling direction and the width direction (upward). (Or down).

複数の車体状態検出部２４は、車体３の左の前部の支持点（左の前輪７Ｆ）に対応する第１状態検出部２４ａと、車体３の右の前部の支持点（右の前輪７Ｆ）に対応する第２状態検出部２４ｂと、車体３の左の後部の支持点（左の後輪７Ｒ）に対応する第３状態検出部２４ｃと、車体３の右の後部の支持点（右の後輪７Ｒ）に対応する第４状態検出部２４ｄとを含んでいる。第１状態検出部２４ａは、前車軸２１Ｆの左側に取付けられ、第２状態検出部２４ｂは、前車軸２１Ｆの右側に取付けられている。第３状態検出部２４ｃは、後車軸２１Ｒの左側に取付けられ、第４状態検出部２４ｄは、後車軸２１Ｒの右側に取付けられている。第１状態検出部２４ａ、第２状態検出部２４ｂ、第３状態検出部２４ｃ、第４状態検出部２４ｄの取付場所は上述した例に限定されず、前輪７Ｆ、後輪７Ｒに取付けてもよいし、その他の場所に取付けてもよい。   The plurality of vehicle body state detection units 24 include a first state detection unit 24a corresponding to a left front support point (left front wheel 7F) of the vehicle body 3, and a right front support point (right front wheel) of the vehicle body 3. 7F), a second state detection unit 24c corresponding to the left rear support point of the vehicle body 3 (left rear wheel 7R), and a right rear support point of the vehicle body 3 ( And a fourth state detector 24d corresponding to the right rear wheel 7R). The first state detection unit 24a is attached to the left side of the front axle 21F, and the second state detection unit 24b is attached to the right side of the front axle 21F. The third state detector 24c is attached to the left side of the rear axle 21R, and the fourth state detector 24d is attached to the right side of the rear axle 21R. The mounting locations of the first state detection unit 24a, the second state detection unit 24b, the third state detection unit 24c, and the fourth state detection unit 24d are not limited to the above-described examples, and may be mounted on the front wheels 7F and the rear wheels 7R. However, it may be installed in other places.

また、複数の車体状態検出部２４は、それぞれ第１荷重及びモーメントを直接検出可能なロードセルから構成されていたが、前輪７Ｆ、後輪７Ｒの空気圧から第１荷重及びモーメントを求める装置であってもよい。
図１に示すように、トラクタ１は、制御装置３０と、表示装置３１とを備えている。制御装置３０は、トラクタ１に関する制御を行う装置である。制御装置３０は、例えば、トラクタ１の作業系に関する制御を行ったり、トラクタ１の走行系の制御を行う。 In addition, each of the plurality of vehicle body state detection units 24 includes a load cell that can directly detect the first load and the moment, but is a device that obtains the first load and the moment from the air pressure of the front wheel 7F and the rear wheel 7R. Also good.
As shown in FIG. 1, the tractor 1 includes a control device 30 and a display device 31. The control device 30 is a device that performs control related to the tractor 1. For example, the control device 30 performs control related to the work system of the tractor 1 or controls the traveling system of the tractor 1.

制御装置３０には、クランク位置を検出するセンサ３２ａ、カム位置を検出するセンサ３２ｂ、原動機４の回転数（エンジン回転数）を検出するセンサ３２ｃ、アクセルの設定値を検出するセンサ３２ｄが接続されている。制御装置３２は、センサ３２ａ〜３２ｃ等で検出されたクランク位置、カム位置、エンジン回転数等の信号に基づいて求めた制御信号を、インジェクタ、コモンレール、サプライポンプ等に出力することで、原動機（エンジン）４を制御する。なお、インジェクタの制御では燃料噴射量、噴射時期、燃料噴射率が示された制御信号を当該インジェクタに出力する。また、サプライポンプやコモンレールの制御では燃料噴射圧等が示された信号を、当該サプライポンプやコモンレールに出力する。制御装置３０は、センサ３２ｄで検出された設定値に基づいて、エンジン回転数を制御する。制御装置３０による原動機４の制御は一例であり、限定されない。   Connected to the control device 30 are a sensor 32a for detecting the crank position, a sensor 32b for detecting the cam position, a sensor 32c for detecting the rotational speed (engine rotational speed) of the prime mover 4, and a sensor 32d for detecting the set value of the accelerator. ing. The control device 32 outputs a control signal obtained based on signals such as a crank position, a cam position, and an engine speed detected by the sensors 32a to 32c to an injector, a common rail, a supply pump, etc. The engine 4 is controlled. In the control of the injector, a control signal indicating the fuel injection amount, the injection timing, and the fuel injection rate is output to the injector. In the control of the supply pump and common rail, a signal indicating the fuel injection pressure and the like is output to the supply pump and common rail. The control device 30 controls the engine speed based on the set value detected by the sensor 32d. The control of the prime mover 4 by the control device 30 is an example and is not limited.

また、制御装置３０には、例えば、運転席１０に設けられ且つ昇降を操作する昇降操作部材３３と、油圧制御弁３４とが接続されている。制御装置３０は、昇降操作部材３３が上昇側に操作されると、油圧制御弁３４に昇降の制御信号を出力して当該油圧制御弁３４の開度を設定し、当該油圧制御弁３４により作動する油圧シリンダ３５を伸長させ、連結部８を上昇させる。一方、制御装置３０は、昇降操作部材３３が下降側に操作されると、油圧制御弁３４に昇降の制御信号を出力して当該油圧制御弁３４の開度を設定し、当該油圧制御弁３４により作動する油圧シリンダ３５を収縮させ、連結部８を下降させる。即ち、制御装置３０は、連結部８の昇降動作を制御することができる。   In addition, for example, an elevating operation member 33 provided in the driver's seat 10 and operating the elevating operation and a hydraulic control valve 34 are connected to the control device 30. When the elevating operation member 33 is operated to the ascending side, the control device 30 outputs an elevating control signal to the hydraulic control valve 34 to set the opening degree of the hydraulic control valve 34 and is operated by the hydraulic control valve 34. The hydraulic cylinder 35 to be extended is extended and the connecting portion 8 is raised. On the other hand, when the elevating operation member 33 is operated to the lower side, the control device 30 outputs an elevating control signal to the hydraulic control valve 34 to set the opening degree of the hydraulic control valve 34, and the hydraulic control valve 34. The hydraulic cylinder 35 actuated by is contracted and the connecting portion 8 is lowered. That is, the control device 30 can control the lifting / lowering operation of the connecting portion 8.

表示装置３１は、運転席１０の近傍に設けられ、トラクタ１等に関する様々な情報を表示する装置である。トラクタ１の走行時等にオペレータが表示装置３１を見ることによって、トラクタ１の走行状態を把握したり、トラクタ１の様々な設定値を確認することができる。また、表示装置３１は、制御装置３０と接続していて。当該制御装置３０と様々な情報を送受信することができる。   The display device 31 is a device that is provided near the driver's seat 10 and displays various information related to the tractor 1 and the like. When the operator looks at the display device 31 when the tractor 1 is traveling, the traveling state of the tractor 1 can be grasped and various set values of the tractor 1 can be confirmed. The display device 31 is connected to the control device 30. Various information can be transmitted to and received from the control device 30.

作業機の状態管理システムは、演算部４０Ａを備えている。演算部４０Ａは、制御装置３０に設けられた電気・電子部品、当該制御装置３０等に組み込まれたプログラム等から構成されている。或いは、演算部４０Ａは、表示装置３１に設けられた電気・電子部品、
当該表示装置３１等に組み込まれたプログラム等から構成されている。図１では、演算部４０Ａが制御装置３０に設けられている例を示している。 The work machine state management system includes a calculation unit 40A. The arithmetic unit 40A is composed of electrical / electronic components provided in the control device 30, programs installed in the control device 30 and the like. Alternatively, the calculation unit 40A is an electric / electronic component provided in the display device 31,
It consists of a program or the like incorporated in the display device 31 or the like. FIG. 1 illustrates an example in which the calculation unit 40A is provided in the control device 30.

演算部４０Ａは、車体３におけるゼロモーメントポイント（ＺＭＰ）を演算する。具体的には、演算部４０Ａは、車体３の支持点の第１荷重（床反力）、例えば、第１状態検出部２４ａ、第２状態検出部２４ｂ、第３状態検出部２４ｃ、第４状態検出部２４ｄで検出された第１荷重及びモーメントに基づいて、２次元で示されるＺＭＰを求める。さらに詳しくは、演算部４０Ａは、式（１）に基づき、ＺＭＰを求める。   The calculation unit 40A calculates a zero moment point (ZMP) in the vehicle body 3. Specifically, the calculation unit 40A has a first load (floor reaction force) at the support point of the vehicle body 3, for example, a first state detection unit 24a, a second state detection unit 24b, a third state detection unit 24c, and a fourth. Based on the first load and moment detected by the state detection unit 24d, ZMP shown in two dimensions is obtained. More specifically, the calculation unit 40A obtains ZMP based on Expression (1).

Figure 2018192891
Figure 2018192891

図２Ａは、ＺＭＰと、臨界領域Ｑ１、安定領域Ｑ２、複数の車状態検出部２４（２４ａ、２４ｂ，２４ｃ、２４ｄ）で検出した床反力との関係を示した図である。図２Ａに示すように、ｆ1Zは第１状態検出部２４ａで検出された床反力、ｆ2Zは第２状態検出部２４ｂで検出された床反力、ｆ3Zは第３状態検出部２４ｃで検出された床反力、ｆ4Zは第４状態検出部２４ａで検出された床反力である。ＰXは、ゼロモーメントにおけるＸ軸方向の位置（Ｘ座標）、Ｐyは、ゼロモーメントにおけるＹ軸方向の位置（Ｙ座標）である。Ｐixは、ｉ番目の支持点におけるＸ軸周りのモーメントであり、Ｐiyは、ｉ番目の支持点におけるＹ軸周りのモーメントである。 FIG. 2A is a diagram showing a relationship between ZMP, the critical region Q1, the stable region Q2, and the floor reaction force detected by the plurality of vehicle state detection units 24 (24a, 24b, 24c, 24d). As shown in FIG. 2A, f 1Z is the floor reaction force detected by the first state detection unit 24a, f 2Z is the floor reaction force detected by the second state detection unit 24b, and f 3Z is the third state detection unit 24c. , F 4Z is the floor reaction force detected by the fourth state detection unit 24a. P X is a position in the X-axis direction (X coordinate) at zero moment, and P y is a position in the Y-axis direction (Y coordinate) at zero moment. P ix is a moment around the X axis at the i th support point, and P iy is a moment around the Y axis at the i th support point.

臨界領域Ｑ１は、車体３の支持点、即ち、複数の車状態検出部２４を設置した位置を結ぶ領域であって、Ｘ軸方向及びＹ軸方向の２次元で表される。安定領域Ｑ２は、トラクタ１（車体３）が走行時において、姿勢が安定する領域、例えば、安定して走行する領域であり、臨界領域Ｑ１から所定距離、内側へシフトした領域である。臨界領域Ｑ１と安定領域Ｑ２とを除く領域、即ち、臨界領域Ｑ１を構成する輪郭線と、安定領域Ｑ２を構成する輪郭線との間の領域は、不安定になり易い不安定領域Ｑ３である。   The critical region Q1 is a region connecting the support points of the vehicle body 3, that is, the positions where the plurality of vehicle state detection units 24 are installed, and is represented in two dimensions in the X-axis direction and the Y-axis direction. The stable region Q2 is a region where the posture is stable when the tractor 1 (vehicle body 3) travels, for example, a region where the tractor 1 (vehicle body 3) travels stably, and is a region shifted inward by a predetermined distance from the critical region Q1. The region excluding the critical region Q1 and the stable region Q2, that is, the region between the contour line forming the critical region Q1 and the contour line forming the stable region Q2, is an unstable region Q3 that tends to be unstable. .

なお、図３Ａ、３Ｂ、３Ｃは、車体３の安定についての理論的な状態を示している。図３Ａに示すように、トラクタ１（車体３）の全床反力（Ｆ＝ＺＭＰ）が臨界領域Ｑ１内（Ｆ＝Ｆ１＋Ｆ２＝Ｇ、Ｔ＝０、Ｆ１：前支持点の床反力、Ｆ２：後支持点の床反力、Ｔ：トルク、Ｇ：重力）である場合は、車体３は安定する。図３Ｂに示すように、車体３の全床反力（Ｆ＝ＺＭＰ）が臨界領域Ｑ１の境界にある場合（Ｆ＝Ｆ１＝Ｇ、Ｔ＝０）である場合は、車体３は不安定である。また、図３Ｃに示すように、車体３の全床反力（Ｆ＝ＺＭＰ）が臨界領域Ｑ１を超えて外側にある場合（Ｆ＝Ｆ１＝Ｇ、Ｔ≠０）である場合は、車体３は転倒する。即ち、この実施形態では、少なくとも安定領域Ｑ２は、臨界領域Ｑ１よりも内側に設定しているため、より車体３が安定する構成となっている。   3A, 3B, and 3C show theoretical states regarding the stability of the vehicle body 3. FIG. As shown in FIG. 3A, the total floor reaction force (F = ZMP) of the tractor 1 (vehicle body 3) is within the critical region Q1 (F = F1 + F2 = G, T = 0, F1: floor reaction force at the front support point, F2 : The floor reaction force of the rear support point, T: torque, G: gravity), the vehicle body 3 is stabilized. As shown in FIG. 3B, when the total floor reaction force (F = ZMP) of the vehicle body 3 is at the boundary of the critical region Q1 (F = F1 = G, T = 0), the vehicle body 3 is unstable. is there. Further, as shown in FIG. 3C, when the total floor reaction force (F = ZMP) of the vehicle body 3 is outside the critical region Q1 (F = F1 = G, T ≠ 0), the vehicle body 3 Falls. That is, in this embodiment, at least the stable region Q2 is set inside the critical region Q1, so that the vehicle body 3 is more stable.

安定領域Ｑ２は、制御装置３０又は表示装置３１に予め記憶されている。安定領域Ｑ２は、臨界領域Ｑ１を超えない範囲で表示装置３１を用いて設定してもよい。
表示装置（表示部）３１は、演算部４０Ａで演算されたゼロモーメントポイントに基づいて安定に関する情報を表示する。図２Ｂに示すように、表示装置３１をオペレータが操作すると、当該表示装置３１は、状態表示画面Ｍ１を表示する。状態表示画面Ｍ１は、臨界領域Ｑ１、安定領域Ｑ２及びＺＭＰを２次元で表示する。図２Ｂに示すように、状態表示画面Ｍ１は、臨界領域Ｑ１だけでなく、前輪７Ｆ、後輪７Ｒを示す図形７Ｄを表示してもよい。 The stable region Q2 is stored in advance in the control device 30 or the display device 31. The stable region Q2 may be set using the display device 31 within a range not exceeding the critical region Q1.
The display device (display unit) 31 displays information on stability based on the zero moment point calculated by the calculation unit 40A. As shown in FIG. 2B, when the operator operates the display device 31, the display device 31 displays a status display screen M1. The state display screen M1 displays the critical region Q1, the stable region Q2, and ZMP in two dimensions. As shown in FIG. 2B, the state display screen M1 may display not only the critical region Q1, but also a graphic 7D showing the front wheels 7F and the rear wheels 7R.

詳しくは、オペレータがトラクタ１に乗車し、トラクタ１の走行を開始すると、表示装置３１は、状態表示画面Ｍ１を表示し、当該状態表示画面Ｍ１のフィールドに、臨界領域Ｑ１及び安定領域Ｑ２を表示する。また、表示装置３１は、演算部４０Ａによって演算したＺＭＰを逐次取得し、取得したＺＭＰ示すポインタ部Ｐ１を表示する。したがって、オペレータは、トラクタ１を走行させている状況下で表示装置３１に示されたＺＭＰ（ポイ
ンタ部Ｐ１）を見ることによって、トラクタ１の走行状態を把握することができる。特に、トラクタ１を斜面に沿って走行している場合は、オペレータは現在のトラクタ１が安定して斜面を走行できているか否かを表示装置３１により把握することができる。 Specifically, when the operator gets on the tractor 1 and starts to travel the tractor 1, the display device 31 displays the state display screen M1, and displays the critical region Q1 and the stable region Q2 in the fields of the state display screen M1. To do. In addition, the display device 31 sequentially acquires the ZMP calculated by the calculation unit 40A and displays the pointer unit P1 indicating the acquired ZMP. Therefore, the operator can grasp the traveling state of the tractor 1 by looking at the ZMP (pointer unit P1) shown on the display device 31 in a situation where the tractor 1 is traveling. In particular, when the tractor 1 is traveling along a slope, the operator can grasp whether or not the current tractor 1 can stably travel on the slope by the display device 31.

図１に示すように、作業機の状態管理システムは、第１判断部４１を備えていてもよい。第１判断部４１は、制御装置３０に設けられた電気・電子部品、当該制御装置３０等に組み込まれたプログラム等から構成されている。或いは、第１判断部４１は、表示装置３１に設けられた電気・電子部品、当該表示装置３１等に組み込まれたプログラム等から構成されている。図１では、第１判断部４１が制御装置３０に設けられている例を示している。   As illustrated in FIG. 1, the work machine state management system may include a first determination unit 41. The first determination unit 41 includes an electric / electronic component provided in the control device 30, a program incorporated in the control device 30 and the like. Or the 1st judgment part 41 is comprised from the program etc. which were incorporated in the electrical / electronic component provided in the display apparatus 31, the said display apparatus 31, etc. FIG. FIG. 1 illustrates an example in which the first determination unit 41 is provided in the control device 30.

第１判断部４１は、例えば、トラクタ１の走行が開始されると、安定領域Ｑ２を制御装置３０又は表示装置３１から取得すると共に、演算部４０Ａが演算したＺＭＰを取得する。そして、第１判断部４１は、取得したＺＭＰが安定領域Ｑ２から外れているか否かを判断する、即ち、取得したＺＭＰが安定領域Ｑ２内にあるか否かを判断する。第１判断部４１は、演算部４０Ａが演算したＺＭＰが不安定領域Ｑ３に入った場合、ＺＭＰが安定領域Ｑ２から外れたと判断する。一方で、第１判断部４１は、演算部４０Ａが演算したＺＭＰが安定領域Ｑ２内である場合、ＺＭＰが安定領域Ｑ２から外れていないと判断する。   For example, when the traveling of the tractor 1 is started, the first determination unit 41 acquires the stable region Q2 from the control device 30 or the display device 31, and acquires the ZMP calculated by the calculation unit 40A. Then, the first determination unit 41 determines whether or not the acquired ZMP is out of the stable region Q2, that is, determines whether or not the acquired ZMP is within the stable region Q2. When the ZMP calculated by the calculation unit 40A enters the unstable region Q3, the first determination unit 41 determines that the ZMP has deviated from the stable region Q2. On the other hand, when the ZMP calculated by the calculation unit 40A is within the stable region Q2, the first determination unit 41 determines that the ZMP has not deviated from the stable region Q2.

表示装置３１は、ＺＭＰが安定領域Ｑ２から外れている場合、ＺＭＰが安定領域Ｑ２から外れたことに対する警告を行う。表示装置３１は、ＺＭＰが安定領域Ｑ２から外れていることを表示することで警告を行う。例えば、表示装置３１にＬＥＤ等のランプ又はランプに相当する図形を表示する。表示装置３１は、ＺＭＰが安定領域Ｑ２内にある場合には、ランプ又は図形を緑色に点灯し、ＺＭＰが安定領域Ｑ２内にない場合にはランプ又は図形を赤色に点灯させる。或いは、ＺＭＰが安定領域Ｑ２から外れた場合には、表示装置３１の画面に文字で「安定領域Ｑ２から外れています」という警告を表示する。ＺＭＰが安定領域Ｑ２から外れている警告の表示は、状態表示画面Ｍ１に表示してもよいし、状態表示画面Ｍ１とは異なる画面で表示してもよい。また、表示装置３１に接続されているスピーカを用いて音を発生させることでＺＭＰが安定領域Ｑ２から外れていることを警告してもよい。上述した表示装置３１の警告は、一例であり限定されない。   When the ZMP is out of the stable region Q2, the display device 31 warns that the ZMP is out of the stable region Q2. The display device 31 issues a warning by displaying that the ZMP is out of the stable region Q2. For example, a lamp such as an LED or a figure corresponding to the lamp is displayed on the display device 31. When the ZMP is within the stable region Q2, the display device 31 lights the lamp or the figure in green, and when ZMP is not within the stable region Q2, the lamp or the figure is lit in red. Alternatively, when the ZMP is out of the stable region Q2, a warning “I am out of the stable region Q2” is displayed on the screen of the display device 31 with characters. The warning that ZMP is out of the stable region Q2 may be displayed on the status display screen M1, or may be displayed on a screen different from the status display screen M1. Further, it may be warned that the ZMP is out of the stable region Q2 by generating sound using a speaker connected to the display device 31. The warning of the display apparatus 31 mentioned above is an example, and is not limited.

また、表示装置３１は、ＺＭＰが安定領域Ｑ２から外れた場合に、ＺＭＰを安定領域Ｑ２内に戻す方法を表示してもよい。トラクタ１の走行中にＺＭＰが安定領域Ｑ２から外れた場合、例えば、表示装置３１は、「エンジン回転数を下げて下さい」と表示する。エンジン回転数を下げることで、トラクタ１の走行速度が低下したり、トラクタ１に装着した作業装置２の作動速度を低下したり、トラクタ１の走行時における加速度を低下させることができ、トラクタ１の走行状態を安定化させることができる。なお、第１判断部４１は、ＺＭＰが安定領域Ｑ２から外れた経過時間を求め、経過時間が閾値以上（数秒以上）になった場合に、表示装置３１がＺＭＰを安定領域Ｑ２内に戻す方法を表示してもよい。また、表示装置３１は、ＺＭＰが安定領域Ｑ２から外れた場合に、ＺＭＰを安定領域Ｑ２内に戻す方法として、「アクセルを緩めて下さい」、「アクセルレバーを下げて下さい」といった具体的な操作方法を表示してもよい。また、制御装置３０は、ＺＭＰが安定領域Ｑ２から外れた場合に、操縦装置１１の操舵角を自動的に設定することによって、トラクタ１を操舵し、ＺＭＰを安定領域Ｑ２に戻してもよい。   In addition, the display device 31 may display a method for returning the ZMP to the stable region Q2 when the ZMP is out of the stable region Q2. When the ZMP deviates from the stable region Q2 while the tractor 1 is traveling, for example, the display device 31 displays “Please lower the engine speed”. By reducing the engine speed, the traveling speed of the tractor 1 can be reduced, the operating speed of the work device 2 attached to the tractor 1 can be reduced, and the acceleration during the traveling of the tractor 1 can be reduced. It is possible to stabilize the running state. The first determination unit 41 obtains the elapsed time when the ZMP has deviated from the stable region Q2, and when the elapsed time is equal to or greater than a threshold (several seconds or more), the display device 31 returns the ZMP to the stable region Q2. May be displayed. In addition, when the ZMP is out of the stable region Q2, the display device 31 has a specific operation such as “relax the accelerator” or “lower the accelerator lever” as a method of returning the ZMP to the stable region Q2. A method may be displayed. The control device 30 may steer the tractor 1 and automatically return the ZMP to the stable region Q2 by automatically setting the steering angle of the steering device 11 when the ZMP deviates from the stable region Q2.

トラクタ１（車体３）は、報知部４２を備えていてもよい。報知部４２は、ＺＭＰが安定領域Ｑ２から外れた場合に、ＺＭＰが安定領域Ｑ２から外れたことを外部に報知する装置である。報知部４２は、前照灯、作業灯などであって、制御装置３０の制御信号によって作動する。ＺＭＰが安定領域Ｑ２から外れていると第１判断部４１が判断した場合に、制御装置３０は報知部４２に制御信号を出力し、当該報知部４２は、前照灯、作業灯等を点灯又は点滅させる。なお、報知部４２は、音を出力するスピーカであってもよし、外部機器にＺＭＰが安定領域Ｑ２から外れたことを外部に報知する通信装置であってもよいし、その他の装置であってもよい。また、ＺＭＰが安定領域Ｑ２から外れた場合に、操縦装置１１の操舵角を制御装置３０によって制御することによって、トラクタ１を安定領域Ｑ２
［第２実施形態］
図４は、第２実施形態における作業機の状態管理システムを示している。第２実施形態では、第１実施形態と異なる構成について説明する。第２実施形態で示した構成の全部又は一部を、第１実施形態又は他の実施形態に適用してもよい。 The tractor 1 (vehicle body 3) may include a notification unit 42. The notification unit 42 is a device that notifies the outside that the ZMP is out of the stable region Q2 when the ZMP is out of the stable region Q2. The notification unit 42 is a headlamp, a work lamp, or the like, and operates according to a control signal from the control device 30. When the first determination unit 41 determines that the ZMP is out of the stable region Q2, the control device 30 outputs a control signal to the notification unit 42, and the notification unit 42 lights a headlamp, a work lamp, and the like. Or blink. The notification unit 42 may be a speaker that outputs sound, a communication device that notifies the external device that the ZMP has deviated from the stable region Q2, or other devices. Also good. Further, when the ZMP deviates from the stable region Q2, the tractor 1 is controlled by controlling the steering angle of the steering device 11 with the control device 30, thereby making the tractor 1 stable region Q2.
[Second Embodiment]
FIG. 4 shows a state management system for a work machine in the second embodiment. In the second embodiment, a configuration different from the first embodiment will be described. All or part of the configuration shown in the second embodiment may be applied to the first embodiment or other embodiments.

図４に示すように、作業機の状態管理システムは、第２判断部４３を備えている。第２判断部４３は、制御装置３０に設けられた電気・電子部品、当該制御装置３０等に組み込まれたプログラム等から構成されている。或いは、第２判断部４３は、表示装置３１に設けられた電気・電子部品、当該表示装置３１等に組み込まれたプログラム等から構成されている。図４では、第２判断部４３が制御装置３０に設けられている例を示している。   As illustrated in FIG. 4, the work machine state management system includes a second determination unit 43. The second determination unit 43 includes an electric / electronic component provided in the control device 30, a program incorporated in the control device 30 and the like. Or the 2nd judgment part 43 is comprised from the program etc. which were integrated in the electrical / electronic component provided in the display apparatus 31, the said display apparatus 31, etc. FIG. FIG. 4 illustrates an example in which the second determination unit 43 is provided in the control device 30.

第２判断部４３は、演算部４０Ａで演算したＺＭＰに基づいて、車体３にウエイト（重量物）が装着されているか否かを判断する。車体３の後部に作業装置２が装着され且つ車体３の前部にウエイトが装着されている状態では、図５に示すように、ＺＭＰは、トラクタ１の重心と略一致し、臨界領域Ｑ１が矩形状である場合には、当該ＺＭＰは、当該臨界領域Ｑ１の中心Ｏ１に位置する。逆に、車体３の前部に作業装置２が装着され且つ車体３の後部にウエイトが装着されている状態でも、ＺＭＰは、臨界領域Ｑ１の中心Ｏ１に位置する。一方で、車体３の前部又は後部に作業装置２が装着されている状態で、車体３にウエイトが装着されていない場合、ＺＭＰは、臨界領域Ｑ１の中心Ｏ１よりも前方又は後方に位置する。   The second determination unit 43 determines whether a weight (heavy object) is attached to the vehicle body 3 based on the ZMP calculated by the calculation unit 40A. In a state where the working device 2 is mounted on the rear portion of the vehicle body 3 and the weight is mounted on the front portion of the vehicle body 3, as shown in FIG. 5, the ZMP substantially coincides with the center of gravity of the tractor 1, and the critical region Q1 is In the case of a rectangular shape, the ZMP is located at the center O1 of the critical region Q1. Conversely, even when the working device 2 is attached to the front portion of the vehicle body 3 and the weight is attached to the rear portion of the vehicle body 3, the ZMP is located at the center O1 of the critical region Q1. On the other hand, when the working device 2 is attached to the front part or the rear part of the vehicle body 3 and no weight is attached to the vehicle body 3, the ZMP is located forward or rearward of the center O1 of the critical region Q1. .

第２判断部４３は、車体３の前部又は後部に作業装置２が装着されている状態で、ＺＭＰが臨界領域Ｑ１よりも閾値Ｄ１以上離れている場合に、車体３にウエイトが装着されていないと判断する。一方、第２判断部４３は、車体３の前部又は後部に作業装置２が装着されている状態で、ＺＭＰが臨界領域Ｑ１よりも閾値Ｄ１未満である場合に、車体３にウエイトが装着されていると判断する。   The second determination unit 43 has a weight attached to the vehicle body 3 when the working device 2 is attached to the front part or the rear part of the vehicle body 3 and the ZMP is separated from the critical region Q1 by the threshold value D1 or more. Judge that there is no. On the other hand, the second determination unit 43 attaches a weight to the vehicle body 3 when the working device 2 is attached to the front part or the rear part of the vehicle body 3 and the ZMP is less than the threshold value D1 than the critical region Q1. Judge that

なお、車体３に作業装置２が装着されているか否かは、例えば、車体３の車載ネットワークに出力された作業装置２の情報に基づいて行う。例えば、作業装置２が車体３に連結され、当該作業装置２の情報が制御装置３０に入力された場合、第２判断部４３は、作業装置２が装着されていると判断する。一方、作業装置２の情報が制御装置３０に入力されなかった場合、第２判断部４３は、作業装置２が装着されていないと判断する。   Whether the work device 2 is attached to the vehicle body 3 is determined based on, for example, information on the work device 2 output to the in-vehicle network of the vehicle body 3. For example, when the work device 2 is connected to the vehicle body 3 and information on the work device 2 is input to the control device 30, the second determination unit 43 determines that the work device 2 is mounted. On the other hand, when the information on the work device 2 is not input to the control device 30, the second determination unit 43 determines that the work device 2 is not attached.

或いは、車体３に作業装置２が装着されているか否かは、表示装置３１に入力された情報に基づいて行ってもよい。例えば、オペレータが入力インタフェース等を用いて、表示装置３１に作業装置２が装着されたことを入力した場合、第２判断部４３は、作業装置２が装着されていると判断する。一方、オペレータが表示装置３１に作業装置２が装着されたことを入力しなかった場合、第２判断部４３は、作業装置２が装着されていないと判断する。   Alternatively, whether or not the work device 2 is attached to the vehicle body 3 may be determined based on information input to the display device 31. For example, when the operator inputs that the work device 2 is mounted on the display device 31 using an input interface or the like, the second determination unit 43 determines that the work device 2 is mounted. On the other hand, when the operator does not input that the work device 2 is mounted on the display device 31, the second determination unit 43 determines that the work device 2 is not mounted.

或いは、車体３に作業装置２が装着されているか否かは、作業装置２の装着の有無を検出する検出装置を設けて、検出装置による検出結果に基づいて判断してもよい。検出装置は、カメラ等の撮像装置、赤外線センサ等の光学センサ等である。
表示装置３１は、車体３にウエイトが装着されていない場合に、ウエイトが装着されていないことに対する警告を行う。例えば、トラクタ１の原動機４の始動後、第２判断部４３によって車体３にウエイトが装着されていないと判断された場合、表示装置３１は、「ウエイトが装着されていません」、「ウエイトの装着状態を確認してください」等の表示をする。表示装置３１は、当該表示装置３１に接続されているスピーカを用いて音を発生させることでＺＭＰが安定領域Ｑ２から外れていることを警告してもよい。 Alternatively, whether or not the work device 2 is mounted on the vehicle body 3 may be determined based on the detection result of the detection device by providing a detection device that detects whether or not the work device 2 is mounted. The detection device is an imaging device such as a camera, an optical sensor such as an infrared sensor, or the like.
When the weight is not attached to the vehicle body 3, the display device 31 issues a warning that the weight is not attached. For example, after starting the prime mover 4 of the tractor 1, when the second determination unit 43 determines that no weight is attached to the vehicle body 3, the display device 31 displays “the weight is not attached”, “the weight is not attached”, Please check the wearing state ”. The display device 31 may warn that the ZMP is out of the stable region Q2 by generating sound using a speaker connected to the display device 31.

なお、トラクタ１にジャイロセンサ、加速度センサ等を有する慣性装置を設け、当該慣性装置によってトラクタ１（車体３）の水平であるか否かを検出したうえで、車体３にウエイトが装着されているかいないかを判断してもよい。即ち、第２判断部４３は、車体３の前部又は後部に作業装置２が装着され且つトラクタ１（車体３）が水平である場合に、車体３にウエイトが装着されているか否かを判断する。このようにすれば、トラクタ１が水平状態である場合に、作業装置２が装着されているか否かを判断することができ、ウエイトが装着されていない場合に適正な警告を行うことができる。
［第３実施形態］
図６は、第３実施形態における作業機の状態管理システムを示している。第３実施形態では、第１実施形態又は第２実施形態と異なる構成について説明する。第３実施形態で示した構成の全部又は一部を、第１実施形態、第２実施形態に適用してもよい。 Whether the tractor 1 is provided with an inertial device having a gyro sensor, an acceleration sensor or the like, and whether the tractor 1 (vehicle body 3) is horizontal or not is detected by the inertial device, and whether the weight is attached to the vehicle body 3 You may judge whether it is. That is, the second determination unit 43 determines whether the weight is attached to the vehicle body 3 when the work device 2 is attached to the front part or the rear part of the vehicle body 3 and the tractor 1 (vehicle body 3) is horizontal. To do. In this way, when the tractor 1 is in the horizontal state, it can be determined whether or not the work device 2 is mounted, and an appropriate warning can be given when the weight is not mounted.
[Third Embodiment]
FIG. 6 shows a state management system for a work machine in the third embodiment. In the third embodiment, a configuration different from the first embodiment or the second embodiment will be described. All or part of the configuration shown in the third embodiment may be applied to the first embodiment and the second embodiment.

作業機の状態管理システムは、演算部４０Ｂを備えている。演算部４０Ｂは、制御装置３０に設けられた電気・電子部品、当該制御装置３０等に組み込まれたプログラム等から構成されている。或いは、演算部４０Ｂは、制御装置３０に設けられた電気・電子部品、当該制御装置３０等に組み込まれたプログラム等から構成されている。図６では、演算部４０Ｂが制御装置３０に設けられている例を示している。   The work machine state management system includes a calculation unit 40B. The calculation unit 40B is configured by electric / electronic components provided in the control device 30, programs installed in the control device 30 and the like. Alternatively, the calculation unit 40B is configured by an electric / electronic component provided in the control device 30, a program incorporated in the control device 30 or the like. FIG. 6 illustrates an example in which the calculation unit 40B is provided in the control device 30.

演算部４０Ｂは、装置状態検出部５０によって検出した第２荷重及びモーメントに基づいて、ＺＭＰを演算する。図７に示すように、装置状態検出部５０は、作業装置２に設けられている。装置状態検出部５０は、少なくとも作業装置２に掛かる第２荷重（床反力）及びモーメントを検出する装置であって、３軸方向（Ｘ軸方向、Ｙ軸方向、Ｚ軸方向）の第２荷重及びモーメントが検出可能な６分力型のロードセルで構成されている。   The calculation unit 40B calculates ZMP based on the second load and moment detected by the device state detection unit 50. As shown in FIG. 7, the device state detection unit 50 is provided in the work device 2. The device state detection unit 50 is a device that detects at least a second load (floor reaction force) and a moment applied to the work device 2, and is a second in three axial directions (X-axis direction, Y-axis direction, Z-axis direction). It is composed of a 6-component load cell that can detect the load and moment.

また、作業装置２は、車体３（連結部）と連結するフレーム５１と、第１車輪５２と、第２車輪５３と、第１車輪５２及び第２車輪５３を支持する車軸５４とを有している。装置状態検出部５０は、第１車輪５３に対応する第５状態検出部５０ａと、第２車輪５４に対応する第６状態検出部５０ｂとを含んでいる。第５状態検出部５０ａは、車軸５４の左側に取付けられ、第６状態検出部５０ｂは、車軸５４の右側に取付けられている。第５状態検出部５０ａ及び第６状態検出部５０ｂの取付場所は上述した例に限定されず、第１車輪５２と、第２車輪５３に取付けてもよいし、その他の場所に取付けてもよい。   Further, the work device 2 includes a frame 51 that is connected to the vehicle body 3 (connecting portion), a first wheel 52, a second wheel 53, and an axle 54 that supports the first wheel 52 and the second wheel 53. ing. The device state detection unit 50 includes a fifth state detection unit 50 a corresponding to the first wheel 53 and a sixth state detection unit 50 b corresponding to the second wheel 54. The fifth state detection unit 50 a is attached to the left side of the axle 54, and the sixth state detection unit 50 b is attached to the right side of the axle 54. The attachment location of the fifth state detection unit 50a and the sixth state detection unit 50b is not limited to the above-described example, and may be attached to the first wheel 52 and the second wheel 53, or may be attached to other places. .

図７に示すように、臨界領域Ｑ４は、車体３の支持点と、作業装置２の支持点とで囲まれる領域であって、第１状態検出部２４ａ、第２状態検出部２４ｂ、第５状態検出部５０ａ、第６状態検出部５０ｂとを結ぶ領域である。安定領域Ｑ５は、臨界領域Ｑ４から所定距離、内側へシフトした領域である。臨界領域Ｑ４と安定領域Ｑ５とを除く領域は、不安定になり易い不安定領域Ｑ６である。安定領域Ｑ５は、制御装置３０又は表示装置３１に予め記憶されている。安定領域Ｑ５は、臨界領域Ｑ４を超えない範囲で表示装置３１を用いて設定してもよい。   As shown in FIG. 7, the critical region Q4 is a region surrounded by the support point of the vehicle body 3 and the support point of the work device 2, and includes a first state detection unit 24a, a second state detection unit 24b, and a fifth state. This is a region connecting the state detection unit 50a and the sixth state detection unit 50b. The stable region Q5 is a region shifted inward by a predetermined distance from the critical region Q4. The region excluding the critical region Q4 and the stable region Q5 is an unstable region Q6 that tends to be unstable. The stable region Q5 is stored in advance in the control device 30 or the display device 31. The stable region Q5 may be set using the display device 31 within a range not exceeding the critical region Q4.

演算部４０Ｂは、車体３及び作業装置２におけるＺＭＰを演算する。具体的には、演算部４０Ｂは、例えば、第１状態検出部２４ａ、第２状態検出部２４ｂ、第５状態検出部５０ａ、第６状態検出部５０ｂで検出された第２荷重及びモーメントに基づいて、ＺＭＰを求める。ＺＭＰの計算方法は、第１実施形態と同様である。なお、ｆ1Zは第１状態検出部２４ａで検出された床反力、ｆ2Zは第２状態検出部２４ｂで検出された床反力、ｆ3Zは第５状態検出部５０ａで検出された床反力、ｆ4Zは第６状態検出部５０ｂで検出された床反力である。以上によれば、演算部４０Ｂによって、車体３と作業装置２との両方のＺＭＰを演算することができ、車体３及び作業装置２とが安定しているか否かを判断することができる。 The calculation unit 40B calculates ZMP in the vehicle body 3 and the work device 2. Specifically, the calculation unit 40B is based on, for example, the second load and moment detected by the first state detection unit 24a, the second state detection unit 24b, the fifth state detection unit 50a, and the sixth state detection unit 50b. To obtain ZMP. The calculation method of ZMP is the same as in the first embodiment. F 1Z is a floor reaction force detected by the first state detection unit 24a, f 2Z is a floor reaction force detected by the second state detection unit 24b, and f 3Z is a floor detected by the fifth state detection unit 50a. The reaction force, f 4Z, is the floor reaction force detected by the sixth state detection unit 50b. According to the above, the ZMP of both the vehicle body 3 and the work device 2 can be calculated by the calculation unit 40B, and it can be determined whether or not the vehicle body 3 and the work device 2 are stable.

図６に示すように、作業機の状態管理システムは、領域演算部４４を備えていてもよい。領域演算部４４は、制御装置３０に設けられた電気・電子部品、当該制御装置３０等に組み込まれたプログラム等から構成されている。或いは、領域演算部４４は、表示装置３１に設けられた電気・電子部品、当該表示装置３１等に組み込まれたプログラム等から構成されている。図６では、領域演算部４４が制御装置３０に設けられている例を示している。   As illustrated in FIG. 6, the work machine state management system may include an area calculation unit 44. The area calculation unit 44 includes an electric / electronic component provided in the control device 30, a program incorporated in the control device 30, and the like. Or the area | region calculating part 44 is comprised from the electrical / electronic component provided in the display apparatus 31, the program etc. which were incorporated in the said display apparatus 31 grade | etc.,. FIG. 6 shows an example in which the region calculation unit 44 is provided in the control device 30.

領域演算部４４は、車体３に対する車体状態検出部２４の位置と、作業装置２に対する装置状態検出部５０の位置とに基づいて、安定領域Ｑ５を演算する。図７に示すように、車体３と作業装置２とが直線上に並ぶ場合は、臨界領域Ｑ４が矩形であり、安定領域Ｑ５も矩形である。図８に示すように、トラクタ１が操舵して、車体３と作業装置２とが直線上に並ばなくなった場合、臨界領域Ｑ４は変形する。領域演算部４４は、トラクタ１が操舵した場合等に、当該トラクタ１と作業装置２との角度（トラクタ１の連結部８に対するフレーム５１の角度）θに基づいて、臨界領域Ｑ４を求め、求めた臨界領域Ｑ４に基づい
て安定領域Ｑ５を求める。 The region calculation unit 44 calculates the stable region Q5 based on the position of the vehicle body state detection unit 24 with respect to the vehicle body 3 and the position of the device state detection unit 50 with respect to the work device 2. As shown in FIG. 7, when the vehicle body 3 and the work device 2 are arranged on a straight line, the critical region Q4 is rectangular and the stable region Q5 is also rectangular. As shown in FIG. 8, when the tractor 1 is steered and the vehicle body 3 and the work device 2 are not aligned on a straight line, the critical region Q4 is deformed. When the tractor 1 is steered or the like, the region calculation unit 44 obtains and obtains a critical region Q4 based on the angle θ between the tractor 1 and the work device 2 (the angle of the frame 51 with respect to the connecting portion 8 of the tractor 1) θ. The stable region Q5 is obtained based on the critical region Q4.

以上によれば、領域演算部４４によってトラクタ１（車体３）と作業装置２との位置関係に基づいて、安定領域Ｑ５を演算することができ、演算した安定領域Ｑ５とＺＭＰとを比較することにより、例えば、トラクタ１で作業装置２を牽引しながら作業を行っている際に、トラクタ１及び作業装置２が安定して走行しているかを把握することができる。特に、領域演算部４４によって、トラクタ１が操舵した場合に、安定領域Ｑ５を求めているため、当該トラクタ１を左又は右に操舵した場合に、トラクタ１及び作業装置２が安定して走行できているかを把握することができる。   According to the above, the stable region Q5 can be calculated based on the positional relationship between the tractor 1 (vehicle body 3) and the work device 2 by the region calculation unit 44, and the calculated stable region Q5 and ZMP are compared. Thus, for example, when the work device 2 is being pulled by the tractor 1, it is possible to grasp whether the tractor 1 and the work device 2 are traveling stably. In particular, when the tractor 1 is steered by the region calculation unit 44, the stable region Q5 is obtained. Therefore, when the tractor 1 is steered to the left or right, the tractor 1 and the work device 2 can travel stably. You can figure out what you are doing.

また、上述した作業機の状態管理システムには、演算部４０Ａ、４０Ｂ、第１判断部４１、第２判断部４３、領域演算部４４を、トラクタ１の機器（制御装置３０、表示装置３１）に設けているが、演算部４０Ａ、４０Ｂ、第１判断部４１、第２判断部４３、領域演算部４４の少なくとも１つを端末に設けてもよいし、ＺＭＰに関する情報を表示する表示部を端末に設けてもよい。   Further, in the above-described work machine state management system, the calculation units 40A and 40B, the first determination unit 41, the second determination unit 43, and the region calculation unit 44 are connected to the equipment of the tractor 1 (the control device 30 and the display device 31). However, at least one of the calculation units 40A and 40B, the first determination unit 41, the second determination unit 43, and the region calculation unit 44 may be provided in the terminal, and a display unit that displays information about ZMP is provided. You may provide in a terminal.

例えば、図９は、作業機の状態管理システムの一例を示している。図９に示すように、作業機の状態管理システムは、通信装置５５と、端末５６とを備えている。通信装置５５は、トラクタ１に設けられ、トラクタ１のデータ（情報）を当該トラクタ１の外部に出力したり、外部のデータをトラクタ１に取り込む装置である。通信装置５５は、ＷｉＦｉ（商標）、ＢＬＥ等の近距離無線通信が可能である。また、通信装置５５は、携帯電話通信網、データ通信網、携帯電話通信網等によって無線通信を行う装置であってもよい。   For example, FIG. 9 shows an example of a work machine state management system. As shown in FIG. 9, the work machine state management system includes a communication device 55 and a terminal 56. The communication device 55 is a device that is provided in the tractor 1, outputs data (information) of the tractor 1 to the outside of the tractor 1, and takes in external data into the tractor 1. The communication device 55 can perform short-range wireless communication such as WiFi (trademark) and BLE. The communication device 55 may be a device that performs wireless communication through a mobile phone communication network, a data communication network, a mobile phone communication network, or the like.

端末５６は、携帯端末、管理端末等である。携帯端末は、トラクタ１に乗車するオペレータ等が所持可能であって、比較的演算能力の高いスマートフォン（多機能携帯電話）、タブレット、ＰＤＡ等である。管理端末は、トラクタ１を管理する管理者が所有するパーソナルコンピュータ（ＰＣ）であって固定型のコンピュータである。
携帯端末、管理端末のいずれであっても、端末５６は、通信装置５５と無線通信可能である。例えば、携帯端末５５は、車体状態検出部２４が検出した情報が受信可能である。端末５６は、ＺＭＰに関して制御装置３０と同様の構成又は機能を有しており、例えば、演算部４０Ａと、第１判断部４１と、表示部４７とを備えている。演算部４０Ａ及び第１判断部４１は、上述した実施形態と同様である。表示部４７は、上述した表示装置３１と同様の構成又は機能を有している。 The terminal 56 is a mobile terminal, a management terminal, or the like. The portable terminal is a smartphone (multifunctional mobile phone), tablet, PDA, or the like that can be carried by an operator who rides on the tractor 1 and has a relatively high computing ability. The management terminal is a personal computer (PC) owned by an administrator who manages the tractor 1 and is a fixed computer.
The terminal 56 can wirelessly communicate with the communication device 55 regardless of whether it is a portable terminal or a management terminal. For example, the mobile terminal 55 can receive information detected by the vehicle body state detection unit 24. The terminal 56 has the same configuration or function as the control device 30 regarding ZMP, and includes, for example, a calculation unit 40A, a first determination unit 41, and a display unit 47. The calculation unit 40A and the first determination unit 41 are the same as those in the above-described embodiment. The display unit 47 has the same configuration or function as the display device 31 described above.

図９に示した作業機の状態管理システムでは、端末５６が携帯端末である場合、オペレータ等が操縦している時に携帯端末を見ることにより、トラクタ１が安定して走行しているかを簡単に把握することができる。また、端末５６が管理端末である場合、トラクタ１を管理する管理者が当該トラクタ１から離れた場所で、トラクタ１が安定して走行中であるか否かを簡単に把握することができる。   In the work machine state management system shown in FIG. 9, when the terminal 56 is a portable terminal, it is easy to determine whether the tractor 1 is traveling stably by looking at the portable terminal when an operator or the like is operating. I can grasp it. Further, when the terminal 56 is a management terminal, it is possible to easily grasp whether or not the manager who manages the tractor 1 is traveling stably at a place away from the tractor 1.

今回開示された実施の形態はすべての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味及び範囲内でのすべての変更が含まれることが意図される。   The embodiment disclosed this time should be considered as illustrative in all points and not restrictive. The scope of the present invention is defined by the terms of the claims, rather than the description above, and is intended to include any modifications within the scope and meaning equivalent to the terms of the claims.

１ トラクタ（作業機）
２ 作業装置
３ 車両（車体）
３１ 表示装置（表示部）
４０Ａ 演算部
４０Ｂ 演算部
４１ 第１判断部
４２ 報知部
４３ 第２判断部
４４ 領域演算部
４７ 表示部
Ｑ２ 安定領域
Ｑ５ 安定領域 1 Tractor (work machine)
2 Working device 3 Vehicle (body)
31 Display device (display unit)
40A calculation unit 40B calculation unit 41 first determination unit 42 notification unit 43 second determination unit 44 region calculation unit 47 display unit Q2 stable region Q5 stable region

Claims (11)

作業装置が装着可能で且つ走行可能な車体におけるゼロモーメントポイントを演算する演算部と、
前記演算部で演算されたゼロモーメントポイントに基づいて作業機の安定に関する情報を表示可能な表示部と、
を備えている作業機の状態管理システム。 A calculation unit for calculating a zero moment point in a vehicle body on which the work device can be mounted and traveled;
A display unit capable of displaying information on the stability of the work machine based on the zero moment point calculated by the calculation unit;
A state management system for work machines. 前記表示部は、前記車体に対して定められた安定領域と、前記ゼロモーメントポイントとを表示する請求項１に記載の作業機の状態管理システム。   The work machine state management system according to claim 1, wherein the display unit displays a stable region defined for the vehicle body and the zero moment point. 前記演算部で演算したゼロモーメントポイントが、前記車体に対して定められた安定領域から外れているか否かを判断する第１判断部を備え、
前記表示部は、前記ゼロモーメントポイントが前記安定領域から外れた場合に、前記ゼロポイントが前記安定領域から外れたことに対する警告を行う請求項１又は２に記載の作業機の状態管理システム。 A first determination unit that determines whether the zero moment point calculated by the calculation unit is out of a stable region determined for the vehicle body;
The work machine state management system according to claim 1 or 2, wherein when the zero moment point is out of the stable region, the display unit warns that the zero point is out of the stable region. 前記表示部は、前記ゼロモーメントポイントが前記安定領域から外れた場合に、前記ゼロモーメントポイントを前記安定領域内に戻す方法を表示する請求項３に記載の作業機の状態管理システム。   The work machine state management system according to claim 3, wherein the display unit displays a method of returning the zero moment point to the stable region when the zero moment point is out of the stable region. 前記車体は、前記ゼロモーメントポイントが前記安定領域から外れた場合に、前記ゼロモーメントポイントが前記安定領域から外れたことを外部に報知する報知部を有している請求項３又は４に記載の作業機の状態管理システム。   The said vehicle body has the alerting | reporting part which alert | reports outside that the said zero moment point was remove | deviated from the said stable area, when the said zero moment point was removed from the said stable area. Work machine status management system. 前記演算部で演算したゼロモーメントポイントに基づいて、前記車体にウエイトが装着されているか否かを判断する第２判断部を備え、
前記表示部は、前記車体に前記ウエイトが装着されていない場合に、前記ウエイトが装着されていないことに対する警告を行う請求項１〜５のいずれかに記載の作業機の状態管理システム。 A second determination unit that determines whether a weight is attached to the vehicle body based on the zero moment point calculated by the calculation unit;
The work machine state management system according to claim 1, wherein when the weight is not attached to the vehicle body, the display unit issues a warning to the fact that the weight is not attached. 前記演算部は、前記車体に設けた車体状態検出部によって検出した第１荷重及びモーメントに基づいて、前記ゼロモーメントポイントを演算する請求項１〜６のいずれかに記載の作業機の状態管理システム。   The work machine state management system according to claim 1, wherein the calculation unit calculates the zero moment point based on a first load and a moment detected by a vehicle body state detection unit provided in the vehicle body. . 前記演算部は、前記車体に連結された作業装置に設けられた装置状態検出部によって検出した第２荷重及びモーメントに基づいて、前記ゼロモーメントポイントを演算する請求項１〜７のいずれかに記載の作業機の状態管理システム。   The said calculating part calculates the said zero moment point based on the 2nd load and moment detected by the apparatus state detection part provided in the working apparatus connected with the said vehicle body. Work machine state management system. 前記車体に対する車体状態検出部の位置と、前記作業装置に対する装置状態検出部の位置とに基づいて、前記安定領域を演算する領域演算部を備えている請求項８に記載の作業機の状態管理システム。   The work machine state management according to claim 8, further comprising: a region calculation unit that calculates the stable region based on a position of the vehicle body state detection unit with respect to the vehicle body and a position of the device state detection unit with respect to the work device. system. 前記演算部、前記表示部は前記作業機に設けられている請求項１〜９のいずれかに記載の作業機の状態管理システム。   The work machine state management system according to claim 1, wherein the calculation unit and the display unit are provided in the work machine. 前記演算部、前記表示部は携帯端末に設けられている請求項１〜９のいずれかに記載の作業機の状態管理システム。   The work machine state management system according to claim 1, wherein the calculation unit and the display unit are provided in a mobile terminal.
JP2017097650A 2017-05-16 2017-05-16 Work equipment status management system Active JP6789880B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017097650A JP6789880B2 (en) 2017-05-16 2017-05-16 Work equipment status management system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017097650A JP6789880B2 (en) 2017-05-16 2017-05-16 Work equipment status management system

Publications (2)

Publication Number Publication Date
JP2018192891A true JP2018192891A (en) 2018-12-06
JP6789880B2 JP6789880B2 (en) 2020-11-25

Family

ID=64571273

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017097650A Active JP6789880B2 (en) 2017-05-16 2017-05-16 Work equipment status management system

Country Status (1)

Country Link
JP (1) JP6789880B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023282595A1 (en) * 2021-07-08 2023-01-12 현대두산인프라코어 주식회사 Construction equipment control system and method
JP7370956B2 (en) 2020-12-24 2023-10-30 株式会社クボタ work vehicle

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0958978A (en) * 1995-08-30 1997-03-04 Hitachi Constr Mach Co Ltd Counterweight installation condition detection method, device and overload prevention device
JP2006315843A (en) * 2005-05-16 2006-11-24 Kobelco Cranes Co Ltd Crane and its weight detection device
WO2011049079A1 (en) * 2009-10-19 2011-04-28 日立建機株式会社 Operation machine
WO2011148946A1 (en) * 2010-05-24 2011-12-01 日立建機株式会社 Work machine safety device
JP2017179949A (en) * 2016-03-31 2017-10-05 コベルコ建機株式会社 Construction machine

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0958978A (en) * 1995-08-30 1997-03-04 Hitachi Constr Mach Co Ltd Counterweight installation condition detection method, device and overload prevention device
JP2006315843A (en) * 2005-05-16 2006-11-24 Kobelco Cranes Co Ltd Crane and its weight detection device
WO2011049079A1 (en) * 2009-10-19 2011-04-28 日立建機株式会社 Operation machine
WO2011148946A1 (en) * 2010-05-24 2011-12-01 日立建機株式会社 Work machine safety device
JP2017179949A (en) * 2016-03-31 2017-10-05 コベルコ建機株式会社 Construction machine

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7370956B2 (en) 2020-12-24 2023-10-30 株式会社クボタ work vehicle
WO2023282595A1 (en) * 2021-07-08 2023-01-12 현대두산인프라코어 주식회사 Construction equipment control system and method

Also Published As

Publication number Publication date
JP6789880B2 (en) 2020-11-25

Similar Documents

Publication Publication Date Title
US10183632B2 (en) Work vehicle periphery monitoring system and work vehicle
JP5337220B2 (en) Work machine display device and work machine equipped with the display device
KR102479557B1 (en) Load weighing method and system for wheel loader
CN101830225B (en) Engineering vehicle active anti-rollover control system and method
EP2821978A1 (en) Operation-state-sharing device and operation-state-sharing system
US9529347B2 (en) Operator assistance system for machine
US20150210213A1 (en) Work vehicle periphery monitoring system and work vehicle
JP2018169826A (en) Working vehicle for agricultural use
JP6789880B2 (en) Work equipment status management system
KR20170065341A (en) Excavator preventing overturn and the method of preventing overturn of excavator
JP2014192740A (en) Work vehicle operation system and work vehicle operation program
US10768622B2 (en) Automatic traveling work vehicle and method for monitoring automatic traveling work vehicle
US20240114817A1 (en) Work machine monitoring system
CN108323259B (en) Work vehicle and other vehicle monitoring system
JP2014187907A (en) Ground working vehicle cooperating with portable communication terminal, and program for portable communication terminal
JP6945353B2 (en) Self-driving work vehicle
AU2014277805A1 (en) System and method for determining ground speed of machine
US10026242B2 (en) Status information display device for wheeled work vehicle, maintenance-screen display method for wheeled work vehicle, and maintenance-screen display program for wheeled work vehicle
JP2018198583A (en) Master work vehicle cooperatively working with slave work vehicle
JP2019004731A (en) Control device of work machine, control method of work machine, and work machine
JP2017177896A (en) Working vehicle
US20240151008A1 (en) Work machine, measurement method, and system
JP6921735B2 (en) Work area management system
JP2020195402A (en) Work vehicle
CN113424521A (en) Periphery monitoring device for working machine

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190626

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200605

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200623

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200820

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20201006

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201104

R150 Certificate of patent or registration of utility model

Ref document number: 6789880

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150