[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

JP2023088367A - Autonomous construction robot control device, autonomous construction robot control system, and control method for autonomous construction robot - Google Patents

Autonomous construction robot control device, autonomous construction robot control system, and control method for autonomous construction robot Download PDF

Info

Publication number
JP2023088367A
JP2023088367A JP2021203031A JP2021203031A JP2023088367A JP 2023088367 A JP2023088367 A JP 2023088367A JP 2021203031 A JP2021203031 A JP 2021203031A JP 2021203031 A JP2021203031 A JP 2021203031A JP 2023088367 A JP2023088367 A JP 2023088367A
Authority
JP
Japan
Prior art keywords
construction
autonomous
construction machine
robot
unit
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
JP2021203031A
Other languages
Japanese (ja)
Inventor
直寛 濁川
Naohiro Nigirikawa
美治 浅香
Miharu Asaka
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.)
Shimizu Construction Co Ltd
Shimizu Corp
Original Assignee
Shimizu Construction Co Ltd
Shimizu 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 Shimizu Construction Co Ltd, Shimizu Corp filed Critical Shimizu Construction Co Ltd
Priority to JP2021203031A priority Critical patent/JP2023088367A/en
Publication of JP2023088367A publication Critical patent/JP2023088367A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Operation Control Of Excavators (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

To provide an autonomous construction robot control device which enables an autonomous robot to grasp an ambient environment.SOLUTION: An autonomous construction robot control device comprises: a sensor data acquisition unit for acquiring waveform data from a sensor which is provided in a target region where a construction is performed and detects vibration; an analysis unit for analyzing a frequency included in the waveform data acquired by the sensor data acquisition unit, and estimating an operation status of a construction machine operated in the target region; and a control unit for outputting to an autonomous construction robot a control signal for operating the robot so as not to interfere with the construction machine based on the operation status of the construction machine.SELECTED DRAWING: Figure 1

Description

本発明は、自律型建設ロボット制御装置、自律型建設ロボット制御システム、自律型建設ロボットの制御方法に関する。 The present invention relates to an autonomous construction robot control device, an autonomous construction robot control system, and an autonomous construction robot control method.

工事現場の管理業務に自律型ロボットを導入し、管理業務の効率化を図る取り組みが進んでいる。ロボットを自律走行させるために自己位置推定が用いられる場合がある。自己位置推定は、工事現場を巡回して網羅的に施工データを取得する上で重要である。
GPS(Global Positioning System)に代表される人工衛星からの電波が届かない閉鎖空間において自己位置推定を行う場合、屋内測位技術が用いられる。屋内測位には様々な測位方法があり、その目的、要求精度、計測エリアの状態、およびコストによって適した測位方法が異なる。最近では複数の測位技術を組み合わせた「ハイブリッド測位」によって屋内測位の高精度化を図る取り組みが主流になりつつある。
また、自己位置推定と地図作成を同時に行うSLAM(Simultaneous Localization andMapping)技術を用いることで、トンネル孔内での無人建設機械の自動運転が実現されつつある。
Efforts are underway to introduce autonomous robots into construction site management work to improve the efficiency of management work. Self-localization may be used to autonomously drive robots. Self-position estimation is important for patrolling construction sites and acquiring construction data comprehensively.
Indoor positioning technology is used when self-position estimation is performed in a closed space where radio waves from artificial satellites such as GPS (Global Positioning System) do not reach. There are various positioning methods for indoor positioning, and suitable positioning methods differ depending on the purpose, required accuracy, measurement area conditions, and cost. Recently, efforts to increase the accuracy of indoor positioning by combining multiple positioning technologies are becoming mainstream.
In addition, by using SLAM (Simultaneous Localization and Mapping) technology that performs self-location estimation and map creation at the same time, automatic operation of unmanned construction machines in tunnel holes is being realized.

SLAM技術を利用して無人建設機械等の自律型ロボットを運転する場合、自律型ロボットが外界の状況を把握する必要がある。外界の状況を把握する場合、LiDAR(レーザースキャナ)、カメラ、およびToF(Time Of Flight)センサーなどのセンサーが用いられる。これらのセンサーは、外界の三次元空間の様子を表す点群データを取得するものである。 When operating an autonomous robot such as an unmanned construction machine using SLAM technology, it is necessary for the autonomous robot to grasp the situation of the external world. Sensors such as LiDAR (laser scanner), cameras, and ToF (Time Of Flight) sensors are used to grasp the situation of the external world. These sensors acquire point cloud data representing the three-dimensional space of the outside world.

これらの技術とは別に、建築中の建造物内部の進捗状況を把握するためのシステムも提案されている(例えば、特許文献1)。 Apart from these techniques, a system for grasping the progress status inside a building under construction has also been proposed (for example, Patent Document 1).

特開2020-160563号公報JP 2020-160563 A

しかしながら、例えば、逆打ち工法の地下空間に自律型ロボットを導入する場合、同じ地下空間において稼働する他の建設機械との接触を避けるために、建設機械の位置情報に加えて稼働状況を把握する必要がある。従来のSLAM技術を実装した自律型ロボットの場合、静止しながら(位置情報を変えずに)旋回する建設機械に対して危険予知が十分できずに、建設機械のバケットやアームと衝突(干渉)する懸念がある。
なお、特許文献1のシステムは、人が建設中の建造物内部の進捗情報を把握することができるが、自律型ロボットが把握するためのものではない。
However, for example, when an autonomous robot is introduced into the underground space of the reverse construction method, in order to avoid contact with other construction machines operating in the same underground space, it is necessary to grasp the operating status in addition to the position information of the construction machine. There is a need. In the case of an autonomous robot equipped with conventional SLAM technology, it is not possible to sufficiently predict the danger of a construction machine turning while stationary (without changing position information), and it collides (interferes) with the bucket or arm of the construction machine. There is concern that
The system of Patent Literature 1 allows a person to grasp progress information inside a building under construction, but is not intended for an autonomous robot to grasp.

本発明は、このような事情に鑑みてなされたもので、その目的は、自律型ロボットが周囲に検知対象が存在するか否かを把握することができる自律型建設ロボット制御装置、自律型建設ロボット制御システム、自律型建設ロボットの制御方法を提供することにある。 SUMMARY OF THE INVENTION The present invention has been made in view of such circumstances, and its object is to provide an autonomous construction robot control apparatus, an autonomous construction robot control apparatus, and an autonomous construction robot control apparatus that enables an autonomous robot to grasp whether or not there is an object to be detected in its surroundings. An object of the present invention is to provide a robot control system and a control method for an autonomous construction robot.

上述した課題を解決するために、本発明の一態様は、工事を行う対象領域に設けられ振動を検出するセンサーから、波形データを取得するセンサーデータ取得部と、前記センサーデータ取得部によって取得された波形データに含まれる周波数を分析し、前記対象領域において稼働する建設機械の稼働状況を推定する分析部と、前記建設機械の稼働状況に基づいて、当該建設機械と干渉しないように動作させる制御信号を自律型建設ロボットに出力する制御部と、を有する自律型建設ロボット制御装置である。 In order to solve the above-described problems, one aspect of the present invention provides a sensor data acquisition unit that acquires waveform data from a sensor that is provided in a construction target area and detects vibration, and the sensor data acquisition unit acquires waveform data. an analysis unit that analyzes the frequency contained in the waveform data obtained and estimates the operation status of the construction machine operating in the target area; and a controller for outputting a signal to the autonomous construction robot.

また、本発明の一態様は、工事を行う対象領域に設けられ振動を検出するセンサーと、前記センサーから波形データを取得するセンサーデータ取得部と、前記センサーデータ取得部によって取得された波形データに含まれる周波数を分析し、前記対象領域において稼働する建設機械の稼働状況を推定する分析部と、前記建設機械の稼働状況に基づいて、当該建設機械と干渉しないように動作させる制御信号を自律型建設ロボットに出力する制御部と、を有する自律型建設ロボット制御システムである。 Further, one aspect of the present invention includes a sensor that is provided in a target area for construction and detects vibration, a sensor data acquisition unit that acquires waveform data from the sensor, and the waveform data acquired by the sensor data acquisition unit. an analysis unit that analyzes the included frequencies and estimates the operation status of the construction machine operating in the target area; and a controller that outputs to the construction robot.

また、本発明の一態様は、コンピュータにより実行される自律型建設ロボットの制御方法であって、センサーデータ取得部が、工事を行う対象領域に設けられ振動を検出するセンサーから、波形データを取得し、分析部が、前記センサーデータ取得部によって取得された波形データに含まれる周波数を分析し、前記対象領域において稼働する建設機械の稼働状況を推定し、制御部が、前記建設機械の稼働状況に基づいて、当該建設機械と干渉しないように動作させる制御信号を自律型建設ロボットに出力する自律型建設ロボットの制御方法である。 Another aspect of the present invention is a control method for an autonomous construction robot executed by a computer, wherein the sensor data acquisition unit acquires waveform data from a sensor that detects vibration and is provided in a construction target area. The analysis unit analyzes the frequency included in the waveform data acquired by the sensor data acquisition unit to estimate the operation status of the construction machine operating in the target area, and the control unit estimates the operation status of the construction machine. A control method for an autonomous construction robot for outputting to the autonomous construction robot a control signal for operating the construction machine so as not to interfere with the construction machine.

以上説明したように、この発明によれば、自律型ロボットが周囲に検知対象が存在するか否かを把握することができ、検知対象と干渉しないように自律型ロボットを稼働させることが可能となる。 As described above, according to the present invention, the autonomous robot can determine whether or not there is a detection target in its surroundings, and can operate the autonomous robot without interfering with the detection target. Become.

一実施形態による自律型建設ロボット制御システムSの構成を示す概略図である。1 is a schematic diagram showing the configuration of an autonomous construction robot control system S according to one embodiment; FIG. 自律型建設ロボット制御装置1の構成を示す概略機能ブロック図である。1 is a schematic functional block diagram showing the configuration of an autonomous construction robot control device 1; FIG. 周波数データ記憶部12に記憶される周波数特性データの一例を示す図である。4 is a diagram showing an example of frequency characteristic data stored in a frequency data storage unit 12; FIG. 加速度センサーによって検出された波形データの一例を示す図である。It is a figure which shows an example of the waveform data detected by the acceleration sensor. 自律型建設ロボット制御装置1の動作を説明するフローチャートである。4 is a flowchart for explaining the operation of the autonomous construction robot control device 1;

以下、本発明の一実施形態による自律型建設ロボット制御装置を用いた自律型建設ロボット制御システムについて図面を参照して説明する。
図1は、この発明の一実施形態による自律型建設ロボット制御システムSの構成を示す概略図である。
工事現場KGは、自律型建設ロボットRを用いた工事を行う領域である。例えば、工事現場KGは、逆打ち工法によって形成される地下空間である。この図1において、工事現場KGを上方から見た場合について図示されている。工事現場KGの内周には山留め壁YKが形成されている。
Hereinafter, an autonomous construction robot control system using an autonomous construction robot control device according to an embodiment of the present invention will be described with reference to the drawings.
FIG. 1 is a schematic diagram showing the configuration of an autonomous construction robot control system S according to one embodiment of the present invention.
The construction site KG is an area where construction using the autonomous construction robot R is performed. For example, the construction site KG is an underground space formed by the reverse construction method. In FIG. 1, the construction site KG is illustrated from above. A retaining wall YK is formed on the inner periphery of the construction site KG.

山留め壁YKには、加速度センサーKSが複数設けられる。加速度センサーKSは、山留め壁YKの傾斜を測定する山留め傾斜計として用いられる。この加速度センサーKSは、例えば、MEMS(Micro Electro Mechanical Systems)センサーである。このような山留め傾斜計は、逆打ち工法によって形成される地下空間に設置され、山留めの傾斜状況を把握するための用いられる場合がある。この実施形態においては、加速度センサーKSを山留めの傾斜状況の把握の他に、工事現場KGである対象領域において生じる振動を検出するセンサーとしても用いる。ここでは、山留め傾斜計を現場内において生じる振動を検出する加速度センサーとして転用(兼用)することによって、山留め傾斜計とは別に加速度センサーを設ける必要がなくなるため、設置コストを削減することができる。この場合、加速度センサーKSは、工事現場KG内において生じる振動を検出する。ここで検出される振動は、工事現場KGにおいて利用される建設機械の稼働によって生じる振動も含まれる。すなわち、加速度センサーは、振動センサーとしての機能も有する。 A plurality of acceleration sensors KS are provided on the retaining wall YK. The acceleration sensor KS is used as a mountain retaining inclinometer for measuring the inclination of the mountain retaining wall YK. This acceleration sensor KS is, for example, a MEMS (Micro Electro Mechanical Systems) sensor. In some cases, such an earth retaining inclinometer is installed in an underground space formed by the upside-down construction method and used to grasp the inclination of the earth retaining. In this embodiment, the acceleration sensor KS is used as a sensor for detecting vibrations occurring in the target area, which is the construction site KG, in addition to grasping the inclination of the earth retaining. Here, by diverting (double-using) the mountain-mounted inclinometer as an acceleration sensor that detects vibrations occurring in the field, there is no need to provide an acceleration sensor separate from the mountain-mounted inclinometer, so installation costs can be reduced. In this case, the acceleration sensor KS detects vibrations occurring within the construction site KG. The vibrations detected here include vibrations caused by the operation of construction machines used at the construction site KG. That is, the acceleration sensor also has a function as a vibration sensor.

加速度センサーKSは、掘削域を囲むように、水平方向(X方向及びY方向)に一定間隔(例えば、数十mピッチ)を空けて並べられるとともに、鉛直方向に一定間隔(例えば、2mピッチ)を空けて並べられる。複数の加速度センサーKSがこのように水平方向及び高さ方向に配置されることで、工事現場KGに存在する建設機械から生じる振動源の位置を推定することができ、建設機械の稼働状況を3次元的な空間において把握することができる。すなわち、工事現場KGのどのあたりの位置において建設機械が稼働しているかを把握できるようになっている。なお、複数の加速度センサーKSが、掘削域を囲むように水平方向において異なる位置に設けられるようにした場合(高さ方向には1つのみ)には、水平方向における2次元的な空間において建設機械の位置を把握することもできる。この場合、高さ方向に複数設ける場合に比べて、設置する加速度センサーKSの数を減らすことができる。 The acceleration sensors KS are arranged horizontally (X direction and Y direction) at regular intervals (e.g., several tens of meters pitch) and vertically at regular intervals (e.g., 2 m pitch) so as to surround the excavation area. can be arranged with . By arranging a plurality of acceleration sensors KS in the horizontal direction and the height direction in this way, it is possible to estimate the position of the vibration source generated by the construction machine existing at the construction site KG, and the operating status of the construction machine can be determined in three ways. It can be grasped in dimensional space. That is, it is possible to ascertain at what position in the construction site KG the construction machine is operating. In addition, when a plurality of acceleration sensors KS are provided at different positions in the horizontal direction so as to surround the excavation area (only one in the height direction), the construction in a two-dimensional space in the horizontal direction is required. It is also possible to grasp the position of the machine. In this case, the number of installed acceleration sensors KS can be reduced compared to the case where a plurality of acceleration sensors KS are installed in the height direction.

また、工事現場KGには、複数の建設機械が存在する。工事現場KGにおいて利用される設重機としては様々な種類があるが、例えば、バックホー、ハンマーグラブ落下、ブレーカー等がある。この図1では、一例として3台の建設機械(例えばバックホー)が存在する場合について図示されている。建設機械J1と建設機械J2は稼働中であり、旋回等の動作が行われる可能性がある。建設機械J3は、工事現場KGに存在するが、動作がオフとなっており、非稼働状況となっている。
ここで、建設機械J1と建設機械J2は、稼動状態にあり、走行せず現在位置が変わらない場合であっても、旋回を行う場合には、建設機械の姿勢が変わるため、旋回範囲SHにおいてアームが他の物体と干渉する可能性が生じる。建設機械J3は、非稼動状態であり、旋回はしないため姿勢は変更されない。
また、この実施形態において、建設機械は、大型の重機であってもよいし、中型の重機であってもよい。また、位置は変更されないが姿勢が変更される可能性がある建設機械であれば、小型の建設機械であってもよい。
Moreover, a plurality of construction machines exist at the construction site KG. There are various types of heavy equipment used at the construction site KG, such as a backhoe, a hammer grab dropper, and a breaker. FIG. 1 shows, as an example, a case where there are three construction machines (for example, backhoes). The construction machine J1 and the construction machine J2 are in operation, and there is a possibility that an operation such as turning will be performed. The construction machine J3 is present at the construction site KG, but is in a non-operating state because its operation is turned off.
Here, the construction machine J1 and the construction machine J2 are in an operating state, and even if they do not travel and their current positions do not change, the posture of the construction machines changes when they turn. There is a possibility that the arm will interfere with other objects. Since the construction machine J3 is in a non-operating state and does not turn, its posture is not changed.
Moreover, in this embodiment, the construction machine may be a large-sized heavy machine or a medium-sized heavy machine. Alternatively, a small construction machine may be used as long as the construction machine does not change its position but may change its attitude.

自律型建設ロボットRは、自律的に稼働することが可能な無人建設機械である。無人建設機械は、例えば、無人で稼働することが可能であれば、例えばバックホー、ダンプトラック、ブルドーザなどのいずれであってもよい。自律型建設ロボットRがバックホーである場合、地下掘削をロボットによって実現することができる。自律型建設ロボットRがダンプトラックである場合には、搬送物の搬送を効率化することができる。
自律型建設ロボットRは、移動経路(巡回ルート)IKが外部から指定されると、その移動経路に沿って移動する。ここでは、自律型建設ロボットRは、山留め壁YKに干渉しないようにしつつ、また、各建設機械との間において干渉しないように巡回する必要がある。
The autonomous construction robot R is an unmanned construction machine that can operate autonomously. The unmanned construction machine may be, for example, a backhoe, a dump truck, a bulldozer, or the like, as long as it can operate unmanned. If the autonomous construction robot R is a backhoe, underground excavation can be realized robotically. When the autonomous construction robot R is a dump truck, it is possible to efficiently transport the goods.
When the movement route (patrol route) IK is specified from the outside, the autonomous construction robot R moves along the movement route. Here, the autonomous construction robot R needs to patrol without interfering with the retaining wall YK and with each construction machine.

図2は、自律型建設ロボット制御装置1の構成を示す概略機能ブロック図である。
自律型建設ロボット制御装置1は、自律型建設ロボットRに搭載される場合について説明するが、自律型建設ロボットRの外部に設けられ、自律型建設ロボットRと通信可能に接続されるようにしてもよい。また、自律型建設ロボット制御装置1は、サーバとして構成され、少なくとも一部に無線ネットワークを介して接続されることで、自律型建設ロボットRと通信してもよい。
FIG. 2 is a schematic functional block diagram showing the configuration of the autonomous construction robot control device 1. As shown in FIG.
The autonomous construction robot control device 1 will be described as being mounted on the autonomous construction robot R, but it is provided outside the autonomous construction robot R and connected to the autonomous construction robot R so as to be communicable. good too. Further, the autonomous construction robot control device 1 may be configured as a server, and may communicate with the autonomous construction robot R by being connected to at least a part thereof via a wireless network.

自律型建設ロボット制御装置1は、センサーデータ取得部11、周波数データ記憶部12、分析部13、物体位置推定部14、自己位置推定部15、制御部16を含む。 The autonomous construction robot control device 1 includes a sensor data acquisition section 11 , a frequency data storage section 12 , an analysis section 13 , an object position estimation section 14 , a self-position estimation section 15 and a control section 16 .

センサーデータ取得部11は、各種センサーからデータを取得する。センサーデータ取得部11が各種データを取得できる対象のセンサーとしては、加速度センサーKS、サーモグラフィカメラTH、測位センサーLI等がある。 The sensor data acquisition unit 11 acquires data from various sensors. Sensors from which the sensor data acquisition unit 11 can acquire various data include an acceleration sensor KS, a thermography camera TH, a positioning sensor LI, and the like.

センサーデータ取得部11は、工事を行う対象領域に設けられ振動を検出する加速度センサーKSから、振動を検出した検出結果である波形データを取得する。 The sensor data acquisition unit 11 acquires waveform data, which is a detection result of detecting vibration, from an acceleration sensor KS that is provided in a construction target area and detects vibration.

また、センサーデータ取得部11は、サーモグラフィカメラTHにおいて生成される温度分布データを取得する。このサーモグラフィカメラTHは、自律型建設ロボットRに設けられ、自律型建設ロボットRの周囲に存在する物体から放射される赤外線を分析し、その分析結果から温度分布を表す温度分布データを生成する。自律型建設ロボット制御装置1が自律型建設ロボットRに搭載される場合、サーモグラフィカメラTHは、自律型建設ロボット制御装置1に設けられていてもよい。 Also, the sensor data acquisition unit 11 acquires temperature distribution data generated in the thermography camera TH. The thermography camera TH is provided in the autonomous construction robot R, analyzes infrared rays emitted from objects existing around the autonomous construction robot R, and generates temperature distribution data representing the temperature distribution from the analysis results. When the autonomous construction robot control device 1 is mounted on the autonomous construction robot R, the thermography camera TH may be provided in the autonomous construction robot control device 1 .

また、センサーデータ取得部11は、測位センサーLIから測位データを取得する。ここで測位センサーLIは、例えば、LiDER(Light Detection and Ranging)、Tof(Time Of Flight)センサー、カメラ、ジャイロセンサ等のうちいずれか1つであってもよい。測位センサーLIがLiDARである場合、測位センサーLIは、周囲の三次元空間を存在する物体までの距離を測定した点群データを生成する。測位センサーLIは、自律型建設ロボットRに搭載される。また、自律型建設ロボット制御装置1が自律型建設ロボットRに搭載される場合、測位センサーLIは、自律型建設ロボット制御装置1に搭載されてもよい。 Further, the sensor data acquisition unit 11 acquires positioning data from the positioning sensor LI. Here, the positioning sensor LI may be, for example, any one of LiDER (Light Detection and Ranging), Tof (Time Of Flight) sensor, camera, gyro sensor, and the like. When the positioning sensor LI is LiDAR, the positioning sensor LI generates point cloud data that measures the distance to objects existing in the surrounding three-dimensional space. The positioning sensor LI is mounted on the autonomous construction robot R. Further, when the autonomous construction robot control device 1 is mounted on the autonomous construction robot R, the positioning sensor LI may be mounted on the autonomous construction robot control device 1 .

周波数データ記憶部12は、建設機械の稼働状況と、当該稼働状況に応じた周波数特性とを周波数特性データとして記憶する。ここで図3は、周波数データ記憶部12に記憶される周波数特性データの一例を示す図である。周波数特性データには、建設機械の種類と、建設機械の稼働状況と、周波数と、振動レベルを含む。
建設機械の種類は、いずれの建設機械であるかその種別を表す。建設機械の種類は、例えば、バックホー、ハンマーグラブ、ブレーカー等がある。
建設機械の稼働状況は、建設機械がどのような稼働をしているかを表す。例えば、バックホーの稼働状況には、旋回、アームを上げる、アームを下げる、等がある。
周波数は、建設機械の稼働に伴って生じる振動の主要な周波数を表す。例えば、「バックホー」が「旋回」している際に生じる主要な周波数は、「f11からf12」であることを表す。このような振動は、建設機械が稼働することによって生じる振動が地面を伝わって山留め壁YKに伝達され、加速度センサーKSに検出される。また、建設機械が稼働することによって生じる振動が空気を介して加速度センサーKSに伝わり、加速度センサーKSによって検出される場合もある。
このような周波数は、建設機械や稼動状況によって主要な周波数が異なる。この周波数は、建設機械が稼働している状況毎に、加速度センサーKSによって振動を事前に測定しておく。そして、周波数データ記憶部12は、建設機械が稼働している状況毎に、加速度センサーKSによって事前に測定された測定結果を建設機械の種類と稼働状況とを対応付けて記憶している。
振動レベルは、建設機械の稼働に伴って生じる振動の大きさをレベルによって表す。例えば、「バックホー」が「旋回」している際に生じる振動レベルは、「a11からa12」であることを表す。このような振動レベルは、建設機械や稼働状況によって異なる。この振動レベルは、機械が稼働している状況毎に、加速度センサーKSによって事前に測定された測定結果を建設機械の種類と稼働状況と周波数とに対応付けて記憶している。
The frequency data storage unit 12 stores the operation status of the construction machine and the frequency characteristic according to the operation status as frequency characteristic data. FIG. 3 is a diagram showing an example of frequency characteristic data stored in the frequency data storage unit 12. As shown in FIG. The frequency characteristic data includes the type of construction machine, the operating status of the construction machine, frequency, and vibration level.
The type of construction machine represents the type of construction machine. Types of construction machines include, for example, backhoes, hammer grabs, and breakers.
The operating status of the construction machine represents how the construction machine is operating. For example, the operation status of the excavator includes turning, raising the arm, lowering the arm, and the like.
The frequency represents the dominant frequency of vibration that occurs with the operation of the construction machine. For example, the dominant frequencies that occur when a 'backhoe' is 'turning' represent 'f11 to f12'. Such vibrations are caused by the operation of the construction machine and are transmitted through the ground to the retaining wall YK and detected by the acceleration sensor KS. In addition, vibrations caused by the operation of the construction machine may be transmitted to the acceleration sensor KS through the air and detected by the acceleration sensor KS.
Such frequencies differ in main frequencies depending on construction machines and operating conditions. For this frequency, the vibration is measured in advance by the acceleration sensor KS for each situation in which the construction machine is working. The frequency data storage unit 12 stores the measurement results obtained in advance by the acceleration sensor KS in association with the type of construction machine and the operating situation for each situation in which the construction machine is operating.
The vibration level represents the magnitude of vibration caused by the operation of the construction machine. For example, the vibration level generated when the "backhoe" is "turning" is "a11 to a12". Such vibration levels vary depending on construction machines and operating conditions. The vibration level is stored in association with the type of construction machine, the operating situation, and the frequency, which are measured in advance by the acceleration sensor KS, for each operating situation of the machine.

周波数データ記憶部12は、記憶媒体、例えば、HDD(Hard Disk Drive)、フラッシュメモリ、EEPROM(Electrically Erasable Programmable Read Only Memory)、RAM(Random Access read/write Memory)、ROM(Read Only Memory)、またはこれらの記憶媒体の任意の組み合わせによって構成される。
この周波数データ記憶部12は、例えば、不揮発性メモリを用いることができる。
The frequency data storage unit 12 includes a storage medium such as a HDD (Hard Disk Drive), flash memory, EEPROM (Electrically Erasable Programmable Read Only Memory), RAM (Random Access read/write Memory), ROM (Read Only Memory). Memory), or It is configured by any combination of these storage media.
A non-volatile memory, for example, can be used for the frequency data storage unit 12 .

分析部13は、周波数分析部131と、温度データ分析部132とを有する。分析部13は、センサーデータ取得部11から得られるデータについて各種分析を行う。
周波数分析部131は、センサーデータ取得部11によって取得された波形データに含まれる周波数を分析し、対象領域において稼働する建設機械の稼働状況を推定する。例えば、周波数分析部131は、分析を行うことで波形データに含まれる周波数を抽出し、その抽出された周波数のうち主要な周波数について、周波数データ記憶部12を参照し、抽出された周波数に該当する稼働状況を読み出すことによって、建設機械の稼働状況を推定する。主要な周波数としては、特徴のある周波数成分を用いるようにしてもよい。特徴のある周波数成分は、例えば、他の周波数成分よりも一定以上の加速度がある周波数成分を用いるようにしてもよい。
ここで分析部13は、周波数分析部131によって周波数を分析するだけでなく、波形データの振幅に基づいて、振動レベルを検出し、振動レベルと、周波数分析部131の分析結果に基づく主要な周波数との組み合わせに基づいて、周波数データ記憶部12を参照し、この組み合わせに対応する建設機械の種類と稼動状況を読み出すことで、建設機械の稼働状況を推定するようにしてもよい。これにより、推定精度を向上させることができる。
The analysis unit 13 has a frequency analysis unit 131 and a temperature data analysis unit 132 . The analysis unit 13 performs various analyzes on the data obtained from the sensor data acquisition unit 11 .
The frequency analysis unit 131 analyzes the frequencies included in the waveform data acquired by the sensor data acquisition unit 11, and estimates the operation status of the construction machine operating in the target area. For example, the frequency analysis unit 131 extracts frequencies included in the waveform data by performing analysis, refers to the frequency data storage unit 12 for main frequencies among the extracted frequencies, and determines whether the extracted frequencies correspond to the frequencies. The operating status of the construction machine is estimated by reading out the operating status of the construction machine. A characteristic frequency component may be used as the main frequency. As the characteristic frequency component, for example, a frequency component with a certain or more acceleration than other frequency components may be used.
Here, the analysis unit 13 not only analyzes the frequency by the frequency analysis unit 131, but also detects the vibration level based on the amplitude of the waveform data, and detects the vibration level and the main frequency based on the analysis result of the frequency analysis unit 131. By referring to the frequency data storage unit 12 and reading out the type and operation status of the construction machine corresponding to this combination, the operation status of the construction machine may be estimated. This makes it possible to improve the estimation accuracy.

このように、周波数分析部131は、工事現場内に設置された加速度センサーによって取得された波形データに基づいて、建設機械の稼働状況を把握することができる。振動源が建設機械の作業に基づくものである場合には、振動源における起振力の大きさや周波数は、建設機械の種類や作業形態によって様々である。そこで、取得した波形の周波数分析によって、稼働状況に加えて位置および種類(バックホーの旋回、ハンマーグラブ落下、ブレーカーの打撃等)を特定することができる。 In this way, the frequency analysis unit 131 can grasp the operation status of the construction machine based on the waveform data acquired by the acceleration sensor installed in the construction site. When the vibration source is based on the work of the construction machine, the magnitude and frequency of the vibrating force in the vibration source vary depending on the type of construction machine and the work mode. Therefore, by frequency analysis of the acquired waveform, it is possible to specify the position and type (revolving of the backhoe, dropping of the hammer grab, hitting of the breaker, etc.) in addition to the operation status.

ここで、図4は、加速度センサーKSによって検出された波形データの一例を示す図である。この図4において、横軸は時間(sec)を表し、縦軸は加速度(G)を表す。ここでは、工事現場KGにおいて各種建設機械が稼働していない状況(非稼働)において測定された波形データ(符号401)と、工事現場KGにおいてある建設機械が稼働している状況において測定された波形データとが重ねられた場合について図示されている。工事現場KGにおいて建設機械が非稼働である場合、波形データが示す加速度は、一定レベル程度以内に収まる。一方、工事現場KGにおいていずれかの建設機械が稼働している場合には、その建設機械が稼働することによって生じる加速度が含まれるため、非稼働である場合の加速度よりも高い加速度が測定される。そのため、非稼働における加速度を元に基準範囲(符号403)を予め定めておき、分析部13は、この予め定められた基準範囲と、波形データとを比較し、波形データに含まれる加速度が基準範囲を超える場合には、建設機械が稼働していると判定することができ、波形データに含まれる加速度が基準範囲を超えない場合には、建設機械が稼働していないと判定することができる。
周波数分析部131は、波形データに含まれる加速度が基準範囲を超えると判定された場合、基準範囲を超えた加速度が検出された際の波形データの振動に含まれる周波数成分を分析することで、稼動状況にある建設機械を特定することができる。
Here, FIG. 4 is a diagram showing an example of waveform data detected by the acceleration sensor KS. In FIG. 4, the horizontal axis represents time (sec) and the vertical axis represents acceleration (G). Here, waveform data (reference numeral 401) measured while various construction machines are not operating at the construction site KG (non-operating), and waveform data measured while a certain construction machine is operating at the construction site KG. Data are superimposed on each other. When the construction machine is not in operation at the construction site KG, the acceleration indicated by the waveform data falls within a certain level. On the other hand, if any construction machine is in operation at the construction site KG, the acceleration generated by the construction machine being in operation is included, so the measured acceleration is higher than the acceleration when the construction machine is not in operation. . Therefore, a reference range (reference numeral 403) is determined in advance based on the acceleration during non-operation, and the analysis unit 13 compares the predetermined reference range with the waveform data, and the acceleration included in the waveform data is used as the reference. If it exceeds the range, it can be determined that the construction machine is operating, and if the acceleration contained in the waveform data does not exceed the reference range, it can be determined that the construction machine is not operating. .
When it is determined that the acceleration included in the waveform data exceeds the reference range, the frequency analysis unit 131 analyzes the frequency component included in the vibration of the waveform data when the acceleration exceeding the reference range is detected. Construction machines in operation can be specified.

温度データ分析部132は、センサーデータ取得部11から得られる温度分布データに基づいて、検知対象が存在するか否かを検出する。例えば、温度データ分析部132は、温度分布データを分析することで、建設機械が稼動しているか否か、工事現場KGにおいて活動している人(作業者、技術者等)がいるか否かを検出する。
温度データ分析部132は、温度分布データにおいて、人の体温に該当する温度分布がある場合、人物が存在するものとして検出する。これにより、自律型建設ロボットRの周囲に人がいることを検出することができる。
The temperature data analysis unit 132 detects whether or not there is a detection target based on the temperature distribution data obtained from the sensor data acquisition unit 11 . For example, the temperature data analysis unit 132 analyzes the temperature distribution data to determine whether the construction machine is in operation and whether there are people (workers, engineers, etc.) working at the construction site KG. To detect.
The temperature data analysis unit 132 detects that a person exists when there is a temperature distribution corresponding to the body temperature of a person in the temperature distribution data. This makes it possible to detect that there are people around the autonomous construction robot R.

温度データ分析部132は、温度分布データにおいて、建設機械が稼働している場合における温度に該当する温度分布がある場合、稼働中の建設機械が存在するものとして検出する。これにより、自律型建設ロボットRの周囲に稼働中の建設機械があることを検出することができる。
建設機械が稼動している場合、周囲の気温よりも一定以上高い温度となる場合(エンジンから発生する熱や、モータから発生する熱等に応じた温度)があり、その温度が閾値以上である場合には、建設機械が稼動中であると判定することができる。
If the temperature distribution data has a temperature distribution corresponding to the temperature when the construction machine is in operation, the temperature data analysis unit 132 detects that the construction machine is in operation. As a result, it is possible to detect that there are construction machines in operation around the autonomous construction robot R. FIG.
When construction machinery is in operation, the temperature may be higher than the ambient air temperature by a certain amount (the temperature corresponding to the heat generated by the engine or the heat generated by the motor, etc.), and the temperature is above the threshold. In this case, it can be determined that the construction machine is in operation.

物体位置推定部14は、分析部13の分析結果に基づいて、建設機械の位置を推定し、推定結果に基づく位置情報を生成する。
例えば、物体位置推定部14は、建設機械の位置を、周波数分析部131の分析結果に基づいて推定する。ここでは、複数の加速度センサーKSのそれぞれから得られた波形データのうち、同じ建設機械の稼働状況が得られた時刻の時刻差と、各加速度センサーKSの位置とに基づいて、工事現場KGにおける建設機械の位置を推定する。例えば、物体位置推定部14は、各加速度センサーKSから得られる波形データに含まれる周波数を分析し、その主要な周波数に基づいて、周波数データ記憶部12を参照して建設機械の種類と稼動状況とを推定する。そして、物体位置推定部14は、それぞれの各加速度センサーKSに基づいて同じ建設機械の種類と稼動状況の組み合わせが推定されている場合には、その主要な周波数が到来した時刻の差と、各加速度センサーKSの位置との関係から、建設機械の位置を推定することができる。ここでは、波形データに含まれる周波数だけでなく、振動レベルも用いて建設機械の種類と稼動状況を推定するようにしてもよい。このように物体位置推定部14は、複数の加速度センサーが設けられた位置と、複数の加速度センサーによってそれぞれ検出された波形データとに基づいて、建設機械の位置を推定することができる。
The object position estimation unit 14 estimates the position of the construction machine based on the analysis result of the analysis unit 13 and generates position information based on the estimation result.
For example, the object position estimator 14 estimates the position of the construction machine based on the analysis result of the frequency analyzer 131 . Here, among the waveform data obtained from each of the plurality of acceleration sensors KS, based on the time difference between the times when the operation status of the same construction machine is obtained and the position of each acceleration sensor KS, Estimate the location of construction equipment. For example, the object position estimating unit 14 analyzes the frequencies contained in the waveform data obtained from each acceleration sensor KS, and refers to the frequency data storage unit 12 based on the major frequencies to determine the type of construction machine and its operating status. to estimate Then, when the combination of the same type of construction machine and the operation status is estimated based on each acceleration sensor KS, the object position estimation unit 14 calculates the difference between the arrival times of the main frequencies and each The position of the construction machine can be estimated from the relationship with the position of the acceleration sensor KS. Here, not only the frequency contained in the waveform data but also the vibration level may be used to estimate the type and operating status of the construction machine. In this manner, the object position estimating section 14 can estimate the position of the construction machine based on the positions where the multiple acceleration sensors are provided and the waveform data detected by the multiple acceleration sensors.

また、物体位置推定部14は、人の位置を、温度データ分析部132の分析結果に基づいて、推定するようにしてもよい。
例えば、物体位置推定部14は、温度データ分析部132によって人の体温に該当する温度分布が検出された場合、温度分布データから、人の体温に該当する領域を抽出し、その領域が存在する方向及び領域の大きさから、人が存在する位置を推定する。ここでは、人の平均的な身長と、サーモグラフィカメラTHからの距離とに応じて、人が存在するとして検出される画像上の領域の大きさが決まる。そのため、物体位置推定部14は、人の体温が検出された領域の大きさに基づいて、サーモグラフィカメラTHまでの距離を推定することができ、当該人の体温が検出された領域が撮像された方向も考慮することで、人が存在すると推定される位置を特定することができる。
Also, the object position estimation unit 14 may estimate the position of the person based on the analysis result of the temperature data analysis unit 132 .
For example, when the temperature data analysis unit 132 detects a temperature distribution corresponding to human body temperature, the object position estimating unit 14 extracts a region corresponding to human body temperature from the temperature distribution data and determines whether the region exists. From the direction and size of the area, the position where the person exists is estimated. Here, the size of the area on the image where the person is detected as being present is determined according to the average height of the person and the distance from the thermography camera TH. Therefore, the object position estimation unit 14 can estimate the distance to the thermography camera TH based on the size of the area where the body temperature of the person is detected, and the area where the body temperature of the person is detected is imaged. By also considering the direction, it is possible to specify the position where a person is estimated to be present.

また、物体位置推定部14は、建設機械の位置を、温度データ分析部132の分析結果と温度データ分析部132によって分析された結果とに基づいて、推定するようにしてもよい。
物体位置推定部14は、温度分布データのうち、稼働中の建設機械が存在することが検出された領域(例えば画素の位置)と、サーモグラフィカメラTHの撮影方向とから、稼働中の建設機械の方向を推定することができる。
ここで、物体位置推定部14は、測位データに含まれる点群データの分布から、建設機械の形状に該当する領域を抽出し、その点群データが表す距離と、点群データが得られた方向とに基づいて、建設機械が存在する位置を推定する。そして、その建設機械が存在するとして推定された位置が、温度データ分析部132によって分析された稼働中の建設機械の方向及び分布状況(分布の広さ)と一致するか否かを判定し、一致する場合には、建設機械が存在するとして推定された位置において、建設機械が稼働中であると推定することができる。
The object position estimation unit 14 may also estimate the position of the construction machine based on the analysis result of the temperature data analysis unit 132 and the analysis result of the temperature data analysis unit 132 .
The object position estimating unit 14 estimates the position of the construction machine in operation based on the temperature distribution data in which the presence of the construction machine in operation is detected (for example, the position of the pixel) and the photographing direction of the thermography camera TH. Direction can be estimated.
Here, the object position estimation unit 14 extracts an area corresponding to the shape of the construction machine from the distribution of the point cloud data included in the positioning data, and obtains the distance represented by the point cloud data and the point cloud data. Estimate the position where the construction machine is located based on the direction. Then, it is determined whether or not the estimated position of the construction machine matches the direction and distribution (width of distribution) of the construction machine in operation analyzed by the temperature data analysis unit 132, If they match, it can be estimated that the construction machine is in operation at the location where the construction machine is estimated to be.

自己位置推定部15は、センサーデータ取得部11から出力される、測位センサーLIの測定結果に基づいて、自律型建設ロボット制御装置1が制御する対象の自律型建設ロボットRの位置を推定する。自己位置推定部15は、SLAM(Simultaneous Localization andMapping)技術を用いることで、測位センサーLIによって得られた測定結果から、自己位置を推定することができる。ここでは、測位センサーLIとしてLiDARを用いてSLAMによって自己位置を推定する技術について、LiDAR SLAMと呼ばれる場合がある。また、測位センサーLIとしてTofセンサーを用いてSLAMによって自己位置を推定する技術について、Depth SLAMと呼ばれることがある。また、測位センサーLIとしてカメラを用いてSLAMによって自己位置を推定する技術について、Visual SLAMと呼ばれる場合がある。 The self-position estimation unit 15 estimates the position of the autonomous construction robot R to be controlled by the autonomous construction robot controller 1 based on the measurement result of the positioning sensor LI output from the sensor data acquisition unit 11 . The self-location estimation unit 15 can estimate the self-location from the measurement results obtained by the positioning sensor LI by using SLAM (Simultaneous Localization and Mapping) technology. Here, the technique of estimating the self-location by SLAM using LiDAR as the positioning sensor LI may be referred to as LiDAR SLAM. Also, the technique of estimating the self-position by SLAM using a Tof sensor as the positioning sensor LI may be called depth SLAM. Also, the technique of estimating the self-position by SLAM using a camera as the positioning sensor LI may be called Visual SLAM.

制御部16は、自律型建設ロボットRに対して各種制御信号を出力する。制御部16は、ルート生成部161を有する。
ルート生成部161は、自律型建設ロボットRの周囲に検知対象が存在する場合には、当該検知対象と干渉しないように動作させる制御信号を自律型建設ロボットRに出力する。検知対象としては、稼働している建設機械と人とのうち少なくともいずれか1つである。
例えばルート生成部161は、建設機械の稼働状況に基づいて、稼働している建設機械が存在する場合には、当該稼働している建設機械に干渉しないように自律型建設ロボットRに制御信号を出力する。稼働している建設機械がバックホーである場合、制御部16は、自律型建設ロボットRがバックホーの旋回範囲に入らないように制御することで、バックホーに干渉しないように制御することができる。
また、ルート生成部161は、温度データ分析部132の分析結果に基づいて、周囲に人が存在すると検出された場合に、当該人に干渉しないように自律型建設ロボットRに制御信号を出力する。周囲に人が存在する場合、制御部16は、自律型建設ロボットRが人から一定の距離の範囲内に入らないように制御することで、人に干渉しないように制御することができる。
The control unit 16 outputs various control signals to the autonomous construction robot R. The control unit 16 has a route generation unit 161 .
When a detection target exists around the autonomous construction robot R, the route generation unit 161 outputs a control signal to the autonomous construction robot R so as not to interfere with the detection target. At least one of an operating construction machine and a person is to be detected.
For example, if there is a construction machine in operation based on the operating status of the construction machine, the route generation unit 161 sends a control signal to the autonomous construction robot R so as not to interfere with the construction machine in operation. Output. When the construction machine in operation is a backhoe, the control unit 16 can control the autonomous construction robot R not to interfere with the backhoe by controlling the autonomous construction robot R not to enter the turning range of the backhoe.
In addition, when the route generation unit 161 detects that there is a person nearby based on the analysis result of the temperature data analysis unit 132, the route generation unit 161 outputs a control signal to the autonomous construction robot R so as not to interfere with the person. . When there are people around, the control unit 16 can control the autonomous construction robot R not to interfere with the people by controlling the autonomous construction robot R not to come within a certain distance from the people.

干渉しないように制御する場合、ルート生成部161は、稼働している建設機械の推定された位置、または、検出された人に干渉しない移動経路を稼働状況に応じて生成し、生成した移動経路を表す制御信号を出力する。
また、干渉しないように制御する場合、制御部16は、稼働している建設機械または人に干渉しない移動経路を生成するのではなく、自律型建設ロボット制御装置1の移動または稼働(旋回、アームの上下動等)を一時停止することで、干渉しないようにしてもよい。例えば、稼働している建設機械または人が自律型建設ロボットRの近傍を通る場合には、自律型建設ロボットRは、自律型建設ロボットRの移動経路から建設機械または人が通り過ぎた後に、一時停止を解除することで、移動を継続するようにしてもよい。これにより、稼働している建設機械(移動している建設機械)または人と干渉しないようにしつつ、移動することができる。ここでは、干渉しないように一時停止するだけでなく、自律型建設ロボットRの移動速度を減速させるようにし、稼働している建設機械または人がいることが継続して検知された場合に、移動を一時停止するようにしてもよい。
When performing control so as not to interfere, the route generation unit 161 generates a movement route that does not interfere with the estimated position of the construction machine in operation or the detected person according to the operation status, and the generated movement route Outputs a control signal representing
Further, when performing control so as not to interfere, the control unit 16 does not generate a movement path that does not interfere with the operating construction machine or a person, but instead moves or operates the autonomous construction robot control device 1 (turning, arm movement, etc.). ) may be temporarily stopped to prevent interference. For example, when an operating construction machine or a person passes by the autonomous construction robot R, the autonomous construction robot R temporarily moves from the movement path of the autonomous construction robot R after the construction machine or the person passes by. You may make it continue a movement by canceling a stop. As a result, it is possible to move without interfering with working construction machines (moving construction machines) or people. Here, not only is the autonomous construction robot R temporarily stopped so as not to interfere, but also the movement speed of the autonomous construction robot R is decelerated. may be paused.

上述したセンサーデータ取得部11、分析部13、物体位置推定部14、自己位置推定部15、制御部16は、例えばCPU(中央処理装置)等の処理装置若しくは専用の電子回路で構成されてよい。 The above-described sensor data acquisition unit 11, analysis unit 13, object position estimation unit 14, self-position estimation unit 15, and control unit 16 may be configured by a processing device such as a CPU (central processing unit) or a dedicated electronic circuit. .

図5は、自律型建設ロボット制御装置1の動作を説明するフローチャートである。
自律型建設ロボット制御装置1は、例えば、自律型建設ロボットRに搭載され、自律型建設ロボットRに対して電源が投入されたことに応じて、処理を実行する。
自律型建設ロボット制御装置1のセンサーデータ取得部11は、各センサーから測定結果を取得する(ステップS101)。
センサーデータ取得部11によって測定結果が取得されると、分析部13は、センサーデータ取得部11によって得られた測定結果に基づいて分析を行う。ここでは、分析部13は、自律型建設ロボットRの周囲に人物がいるか否か、工事現場KG内において稼働中の建設機械があるか否かを分析する(ステップS102)。
分析部13は、自律型建設ロボットRの周囲に人物がいないと検出された場合であって、かつ、工事現場KG内において稼働中の建設機械がないと検出された場合には、処理をステップ101に移行する(ステップS103-NO)。
FIG. 5 is a flowchart for explaining the operation of the autonomous construction robot control device 1. As shown in FIG.
The autonomous construction robot control device 1 is mounted on, for example, the autonomous construction robot R, and executes processing when the autonomous construction robot R is powered on.
The sensor data acquisition unit 11 of the autonomous construction robot control device 1 acquires measurement results from each sensor (step S101).
When the sensor data acquisition unit 11 acquires the measurement results, the analysis unit 13 performs analysis based on the measurement results acquired by the sensor data acquisition unit 11 . Here, the analysis unit 13 analyzes whether or not there is a person around the autonomous construction robot R, and whether or not there is a construction machine in operation within the construction site KG (step S102).
When the analysis unit 13 detects that there is no person around the autonomous construction robot R and that there is no construction machine in operation within the construction site KG, the analysis unit 13 advances the process to step 101 (step S103-NO).

一方、分析部13は、自律型建設ロボットRの周囲に人がいると検出された場合と、工事現場KG内において稼働中の建設機械があると検出された場合とのうち少なくともいずれか一方が検出された場合には(ステップS103-YES)、物体位置推定部14に対して、検知対象が検知されたことを通知する。物体位置推定部14は、検出された検知対象の位置を推定する(ステップS104)。例えば、物体位置推定部14は、分析部13の分析結果において人が検出された場合には、人が存在する位置を推定し、分析部13の分析結果において稼働している建設機械があることが検知された場合には、稼働している建設機械の位置を推定する。 On the other hand, the analysis unit 13 determines whether at least one of the case where it is detected that there are people around the autonomous construction robot R and the case where it is detected that there is a construction machine in operation at the construction site KG is detected. If detected (step S103-YES), the object position estimation unit 14 is notified that the detection target has been detected. The object position estimation unit 14 estimates the detected position of the detection target (step S104). For example, when a person is detected in the analysis result of the analysis unit 13, the object position estimation unit 14 estimates the position where the person is present, and the analysis result of the analysis unit 13 indicates that there is a construction machine in operation. is detected, the position of the construction machine in operation is estimated.

一方、自己位置推定部15は、LiDARによって測定されたデータを一定時間毎にセンサーデータ取得部11から取得し、自律型建設ロボットRの自己位置を推定する。 On the other hand, the self-position estimation unit 15 acquires data measured by LiDAR from the sensor data acquisition unit 11 at regular intervals, and estimates the self-position of the autonomous construction robot R.

制御部16のルート生成部161は、物体位置推定部14によって検知対象の位置が推定されると、検知対象に干渉しないような移動経路を生成し(ステップS105)、生成された移動経路を自律型建設ロボットRに出力する(ステップS106)。自律型建設ロボットRは、制御部16から出力された移動経路に基づいて移動する。
一方、制御部16は、自律型建設ロボットRの動作を終了するか否かを判定し(ステップS107)、自律型建設ロボットRの動作を終了する場合には、自律型建設ロボット制御装置1の処理を終了し(ステップS107-YES)、自律型建設ロボットRの動作を終了しない場合には、処理をステップS101に移行する。
When the position of the detection target is estimated by the object position estimation unit 14, the route generation unit 161 of the control unit 16 generates a movement route that does not interfere with the detection target (step S105). Output to the mold construction robot R (step S106). The autonomous construction robot R moves based on the movement route output from the control unit 16 .
On the other hand, the control unit 16 determines whether or not to end the operation of the autonomous construction robot R (step S107). If the process is terminated (step S107-YES) and the operation of the autonomous construction robot R is not terminated, the process proceeds to step S101.

以上説明した実施形態によれば、山留め壁に設けられた複数の加速度センサー(MEMSセンサー)によって取得した波形データを分析することにより、逆打ち工法の地下空間における建設機械の稼働状況、位置および種類を即時的かつ精度良く判定できる。
また、以上説明した実施形態によれば、従来のSLAM技術を用いた自己位置推定に加えて、工事現場内に設置された加速度センサーによって取得した波形データに基づいて、建設機械の稼働状況を把握することができる。そして、稼働している建設機械があると検出された場合には、移動経路が再度生成される。自律型建設ロボットRは、建設機械の稼働が判断された領域には近づかないような移動経路にそって移動するよう適宜再設定しながら、安全に現場を巡回することができる。
また、上述した実施形態においては、逆打ち工法の地下空間をはじめとする狭隘かつ建設機械が稼働しうる空間において、SLAM技術を実装した自律型ロボットを安全かつ安価に運用することができる。このような地下工事への自律型ロボットの導入が容易となるため、上述した自律型建設ロボット制御装置1によれば、管理業務の効率化および生産性向上に寄与する。
According to the embodiment described above, by analyzing the waveform data acquired by the multiple acceleration sensors (MEMS sensors) provided on the earth retaining wall, it is possible to determine the operation status, position and type of construction machinery in the underground space of the reverse construction method. can be determined immediately and accurately.
Further, according to the embodiment described above, in addition to the self-position estimation using the conventional SLAM technology, the operation status of the construction machine can be grasped based on the waveform data acquired by the acceleration sensor installed in the construction site. can do. Then, when it is detected that there is a construction machine in operation, the moving route is generated again. The autonomous construction robot R can safely patrol the site while appropriately resetting so as to move along a movement route that does not approach the area where the operation of the construction machine has been determined.
In addition, in the above-described embodiment, it is possible to safely and inexpensively operate an autonomous robot equipped with SLAM technology in a narrow space where construction machinery can operate, such as an underground space using an upside-down construction method. Since the autonomous robot can be easily introduced to such underground construction work, the autonomous construction robot control device 1 described above contributes to the efficiency of management work and the improvement of productivity.

また、上述した実施形態によれば、建設機械が稼働しているか否かの状況、稼働している位置等を把握することができるため、これら稼動状況を把握することで、地下空間における工事の進捗確認をすることもできる。 In addition, according to the above-described embodiment, it is possible to grasp the status of whether or not the construction machine is operating, the position at which it is operating, etc. Therefore, by grasping the operating status, it is possible to perform construction work in the underground space. You can also check your progress.

また、例えば、上述した実施形態では、対象領域において建設機械が稼働していることが検出された場合、自律型建設ロボット制御装置1は、自律型建設ロボットに対して一時停止させたり、対象領域を迂回するような移動経路を生成し、自律型建設ロボットに送信したりすることができる。これにより建設機械が対象領域において稼働している場合には、自律型建設ロボットは一時停止し、建設機械の姿勢が変更されない稼動状況であることが検出された場合(例えば、一定時間以上姿勢が変更されない場合)には移動を再開するようにしてもよい。 Further, for example, in the above-described embodiment, when it is detected that the construction machine is operating in the target area, the autonomous construction robot control device 1 causes the autonomous construction robot to temporarily stop or move to the target area. It is possible to generate a movement route that bypasses the , and send it to the autonomous construction robot. As a result, when the construction machine is operating in the target area, the autonomous construction robot is temporarily stopped, and when it is detected that the construction machine is in an operating state in which the posture does not change (for example, the If not changed), the movement may be resumed.

また、建設機械が対象領域において姿勢が変更されない稼動状況であることが検出された場合(稼働していない状況や、建設機械のランプ等が点灯しているが姿勢の変更が伴う操作が行われない状況等)には、事前に生成された移動経路に沿って移動し、対象領域において建設機械が稼働している場合には、建設機械が稼働している領域を迂回するような移動経路を生成しなおすようにしてもよい。これにより自律型建設ロボットは、対象領域において建設機械の姿勢が変更されない稼働状況である場合には、事前に決められた移動経路に沿って移動し、対象領域において建設機械が稼働している場合には、その建設機械に干渉しないように迂回して移動することができる。 In addition, when it is detected that the construction machine is in an operating state in which the posture is not changed in the target area (a situation in which the machine is not operating, or an operation involving a change in the (e.g., when construction machinery is not available), move along the movement route generated in advance, and if the construction machinery is operating in the target area, create a movement route that bypasses the area where the construction machinery is operating. It may be regenerated. As a result, the autonomous construction robot moves along a predetermined movement route when the construction machine's posture does not change in the target area, and when the construction machine is operating in the target area. can be moved around so as not to interfere with the construction machine.

なお、上述した実施形態において、周波数分析部131が周波数データ記憶部12を参照することで、稼働状況を推定する場合について説明したが、周波数分析部131は、周波数データ記憶部12を用いずに稼働状況を推定するようにしてもよい。
例えば、波形データに対して、建設機械の稼動状況を表すデータを教師ラベルとして付与し、学習装置によって、波形データと建設機械の稼動状況との関係を学習させ、学習済みモデルを生成するようにしてもよい。学習装置において学習する手法としては、機械学習、ディープラーニング等を用いてもよい。そして、周波数分析部131は、学習装置から得られる学習済みモデルに対し、センサーデータ取得部11から得られる波形データを入力することで、建設機械の稼動状況を得るようにしてもよい。
In the above-described embodiment, the frequency analysis unit 131 refers to the frequency data storage unit 12 to estimate the operating status. The operating status may be estimated.
For example, data indicating the operation status of a construction machine is attached to waveform data as a teacher label, and a learning device learns the relationship between the waveform data and the operation status of the construction machine to generate a trained model. may Machine learning, deep learning, or the like may be used as a method of learning in the learning device. Then, the frequency analysis unit 131 may obtain the operation status of the construction machine by inputting the waveform data obtained from the sensor data acquisition unit 11 to the trained model obtained from the learning device.

また、上述した実施形態において、工事現場KGは、逆打ち工法によって形成される地下空間である場合について説明したが、自律型建設ロボットRが導入される工事現場であって、加速度センサーKSを設置することが可能な現場であれば、逆打ち工法によって形成される地下空間以外であってもよい。例えば、工事現場KGは、トンネルの坑内であってもよい。 In the above-described embodiment, the case where the construction site KG is an underground space formed by the reverse construction method has been described. If it is possible to do so, it may be other than the underground space formed by the reverse construction method. For example, the construction site KG may be a tunnel pit.

上述した実施形態における自律型建設ロボット制御装置1をコンピュータで実現するようにしてもよい。その場合、この機能を実現するためのプログラムをコンピュータ読み取り可能な記録媒体に記録して、この記録媒体に記録されたプログラムをコンピュータシステムに読み込ませ、実行することによって実現してもよい。なお、ここでいう「コンピュータシステム」とは、OSや周辺機器等のハードウェアを含むものとする。また、「コンピュータ読み取り可能な記録媒体」とは、フレキシブルディスク、光磁気ディスク、ROM、CD-ROM等の可搬媒体、コンピュータシステムに内蔵されるハードディスク等の記憶装置のことをいう。さらに「コンピュータ読み取り可能な記録媒体」とは、インターネット等のネットワークや電話回線等の通信回線を介してプログラムを送信する場合の通信線のように、短時間の間、動的にプログラムを保持するもの、その場合のサーバやクライアントとなるコンピュータシステム内部の揮発性メモリのように、一定時間プログラムを保持しているものも含んでもよい。また上記プログラムは、前述した機能の一部を実現するためのものであってもよく、さらに前述した機能をコンピュータシステムにすでに記録されているプログラムとの組み合わせで実現できるものであってもよく、FPGA(Field Programmable Gate Array)等のプログラマブルロジックデバイスを用いて実現されるものであってもよい。 The autonomous construction robot control device 1 in the above-described embodiment may be realized by a computer. In that case, a program for realizing this function may be recorded in a computer-readable recording medium, and the program recorded in this recording medium may be read into a computer system and executed. It should be noted that the "computer system" referred to here includes hardware such as an OS and peripheral devices. The term "computer-readable recording medium" refers to portable media such as flexible discs, magneto-optical discs, ROMs and CD-ROMs, and storage devices such as hard discs incorporated in computer systems. Furthermore, "computer-readable recording medium" refers to a program that dynamically retains programs for a short period of time, like a communication line when transmitting a program via a network such as the Internet or a communication line such as a telephone line. It may also include something that holds the program for a certain period of time, such as a volatile memory inside a computer system that serves as a server or client in that case. Further, the program may be for realizing a part of the functions described above, or may be capable of realizing the functions described above in combination with a program already recorded in the computer system. It may be implemented using a programmable logic device such as an FPGA (Field Programmable Gate Array).

以上、この発明の実施形態について図面を参照して詳述してきたが、具体的な構成はこの実施形態に限られるものではなく、この発明の要旨を逸脱しない範囲の設計等も含まれる。 Although the embodiment of the present invention has been described in detail with reference to the drawings, the specific configuration is not limited to this embodiment, and design and the like are included within the scope of the gist of the present invention.

1…自律型建設ロボット制御装置、11…センサーデータ取得部、12…周波数データ記憶部、13…分析部、14…物体位置推定部、15…自己位置推定部、16…制御部、101…ステップ、131…周波数分析部、132…温度データ分析部、161…ルート生成部 DESCRIPTION OF SYMBOLS 1... Autonomous construction robot control apparatus 11... Sensor data acquisition part 12... Frequency data storage part 13... Analysis part 14... Object position estimation part 15... Self-position estimation part 16... Control part 101... Step , 131 ... frequency analysis unit, 132 ... temperature data analysis unit, 161 ... route generation unit

Claims (7)

工事を行う対象領域に設けられ振動を検出するセンサーから、波形データを取得するセンサーデータ取得部と、
前記センサーデータ取得部によって取得された波形データに含まれる周波数を分析し、前記対象領域において稼働する建設機械の稼働状況を推定する分析部と、
前記建設機械の稼働状況に基づいて、当該建設機械と干渉しないように動作させる制御信号を自律型建設ロボットに出力する制御部と、
を有する自律型建設ロボット制御装置。
A sensor data acquisition unit that acquires waveform data from a sensor that detects vibration and is provided in a target area for construction;
an analysis unit that analyzes the frequencies contained in the waveform data acquired by the sensor data acquisition unit and estimates the operation status of the construction machine operating in the target area;
a control unit that outputs a control signal to the autonomous construction robot to operate the construction machine so as not to interfere with the construction machine, based on the operation status of the construction machine;
An autonomous construction robot controller having
前記建設機械の稼働状況と、当該稼働状況に応じた周波数特性とを記憶する周波数データ記憶部を有し、
前記分析部は、前記周波数データ記憶部を参照し、前記分析によって得られる周波数に該当する稼働状況を取得することで前記稼働状況を推定する
請求項1に記載の自律型建設ロボット制御装置。
a frequency data storage unit that stores an operation status of the construction machine and a frequency characteristic according to the operation status;
The autonomous construction robot control device according to claim 1, wherein the analysis unit estimates the operation status by referring to the frequency data storage unit and acquiring the operation status corresponding to the frequency obtained by the analysis.
前記センサーの少なくとも1つはサーモグラフィカメラであり、
前記センサーデータ取得部は、前記サーモグラフィカメラから得られる温度分布データを取得し、
前記分析部は、前記温度分布データに基づいて、検知対象が存在するか否かを検出し、
前記制御部は、前記検知対象が存在する場合に、当該検知対象に干渉しないように自律型建設ロボットに制御信号を出力する
請求項1または請求項2に記載の自律型建設ロボット制御装置。
at least one of said sensors is a thermographic camera;
The sensor data acquisition unit acquires temperature distribution data obtained from the thermography camera,
The analysis unit detects whether or not a detection target exists based on the temperature distribution data,
3. The autonomous construction robot control device according to claim 1, wherein, when the detection target exists, the control unit outputs a control signal to the autonomous construction robot so as not to interfere with the detection target.
前記分析部の分析結果に基づいて、前記建設機械の位置を推定した位置情報を生成する物体位置推定部を有し、
前記制御部は、前記推定された位置に干渉しない移動経路を前記稼働状況に応じて生成し、生成した移動経路を表す制御信号を出力する
請求項1から請求項3のうちいずれか1項に記載の自律型建設ロボット制御装置。
an object position estimation unit that generates position information by estimating the position of the construction machine based on the analysis result of the analysis unit;
4. The control unit according to any one of claims 1 to 3, wherein the control unit generates a movement route that does not interfere with the estimated position according to the operating status, and outputs a control signal representing the generated movement route. An autonomous construction robot controller as described.
前記センサーは、前記振動に基づく加速度を検出する複数の加速度センサーであり前記対象領域を取り囲むように異なる位置に設けられ、
前記物体位置推定部は、前記複数の加速度センサーが設けられた位置と、前記複数の加速度センサーによってそれぞれ検出された波形データとに基づいて、前記建設機械の位置を推定する
請求項4に記載の自律型建設ロボット制御装置。
The sensors are a plurality of acceleration sensors that detect acceleration based on the vibration and are provided at different positions so as to surround the target area,
5. The object position estimator according to claim 4, wherein the object position estimator estimates the position of the construction machine based on the positions where the plurality of acceleration sensors are provided and waveform data respectively detected by the plurality of acceleration sensors. Autonomous construction robot controller.
工事を行う対象領域に設けられ振動を検出するセンサーと、
前記センサーから波形データを取得するセンサーデータ取得部と、
前記センサーデータ取得部によって取得された波形データに含まれる周波数を分析し、前記対象領域において稼働する建設機械の稼働状況を推定する分析部と、
前記建設機械の稼働状況に基づいて、当該建設機械に干渉しないように自律型建設ロボットに制御信号を出力する制御部と、
を有する自律型建設ロボット制御システム。
a sensor for detecting vibrations provided in the target area for construction;
a sensor data acquisition unit that acquires waveform data from the sensor;
an analysis unit that analyzes the frequencies contained in the waveform data acquired by the sensor data acquisition unit and estimates the operation status of the construction machine operating in the target area;
a control unit that outputs a control signal to the autonomous construction robot based on the operating status of the construction machine so as not to interfere with the construction machine;
An autonomous construction robot control system with
コンピュータにより実行される自律型建設ロボットの制御方法であって、
センサーデータ取得部が、工事を行う対象領域に設けられ振動を検出するセンサーから、波形データを取得し、
分析部が、前記センサーデータ取得部によって取得された波形データに含まれる周波数を分析し、前記対象領域において稼働する建設機械の稼働状況を推定し、
制御部が、前記建設機械の稼働状況に基づいて、当該建設機械と干渉しないように動作させる制御信号を自律型建設ロボットに出力する
自律型建設ロボットの制御方法。
A computer-implemented method for controlling an autonomous construction robot, comprising:
A sensor data acquisition unit acquires waveform data from a sensor that detects vibration and is provided in the target area for construction,
an analysis unit that analyzes the frequency included in the waveform data acquired by the sensor data acquisition unit and estimates the operation status of the construction machine operating in the target area;
A control method for an autonomous construction robot, wherein a control unit outputs a control signal to the autonomous construction robot so as not to interfere with the construction machine, based on the operation status of the construction machine.
JP2021203031A 2021-12-15 2021-12-15 Autonomous construction robot control device, autonomous construction robot control system, and control method for autonomous construction robot Pending JP2023088367A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2021203031A JP2023088367A (en) 2021-12-15 2021-12-15 Autonomous construction robot control device, autonomous construction robot control system, and control method for autonomous construction robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021203031A JP2023088367A (en) 2021-12-15 2021-12-15 Autonomous construction robot control device, autonomous construction robot control system, and control method for autonomous construction robot

Publications (1)

Publication Number Publication Date
JP2023088367A true JP2023088367A (en) 2023-06-27

Family

ID=86935508

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021203031A Pending JP2023088367A (en) 2021-12-15 2021-12-15 Autonomous construction robot control device, autonomous construction robot control system, and control method for autonomous construction robot

Country Status (1)

Country Link
JP (1) JP2023088367A (en)

Similar Documents

Publication Publication Date Title
US8606495B2 (en) Method and apparatus for mining vehicle safety arrangements
JP5080333B2 (en) Object recognition device for autonomous mobile objects
SE529226C2 (en) Mining vehicles and procedure for preventing a mining vehicle collision
US20160341041A1 (en) Mine vehicle and method of determining position and direction of monitored object
CN111622296B (en) Excavator safety obstacle avoidance system and method
AU2017255011A1 (en) Construction machine
CN109790702A (en) Engineering machinery
BRPI0809249A2 (en) METHOD FOR PLANNING AND IMPLEMENTING OBSTACLES FREE ROUTE FOR EXCAVATING MACHINERY.
US9305364B2 (en) Motion estimation systems and methods
JP2018185767A (en) Environment maintenance robot, and control program of the same
EP4189327A1 (en) Guidance of a transport vehicle to a loading point
JP6187499B2 (en) Self-localization method for autonomous mobile robot, autonomous mobile robot, and landmark for self-localization
WO2016065388A1 (en) A method of operating a vehicle and a vehicle operating system
JP2023088367A (en) Autonomous construction robot control device, autonomous construction robot control system, and control method for autonomous construction robot
Basavanna et al. Navigation of mobile robot through mapping using Orbbec Astra camera and ROS in an indoor environment
CN114391060A (en) Positioning of mobile equipment in an underground worksite
EP3351963B1 (en) Earth moving machine, range finder arrangement and method for 3d scanning
KR20210000593A (en) Apparatus for generating environment data neighboring construction equipment and construction equipment including the same
JP7575153B2 (en) CONTROL DEVICE, CONTROL SYSTEM, AND CONTROL METHOD
CN115326057A (en) Path planning method and device, robot and readable storage medium
JPWO2018211575A1 (en) Control device, monitoring system and monitoring method
Teh et al. Extended Dijkstra algorithm in path planning for vision based patrol robot
JP7512213B2 (en) Mobility control system and mobility control method
WO2022230880A1 (en) Control method, control system, and control device
CN110389350B (en) Earthmover, distance meter arrangement and 3D scanning method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20241031