[go: up one dir, main page]

JP6751588B2 - Control device for autonomous driving and autonomous driving method - Google Patents

Control device for autonomous driving and autonomous driving method Download PDF

Info

Publication number
JP6751588B2
JP6751588B2 JP2016094812A JP2016094812A JP6751588B2 JP 6751588 B2 JP6751588 B2 JP 6751588B2 JP 2016094812 A JP2016094812 A JP 2016094812A JP 2016094812 A JP2016094812 A JP 2016094812A JP 6751588 B2 JP6751588 B2 JP 6751588B2
Authority
JP
Japan
Prior art keywords
traveling
construction machine
autonomous driving
vibrating roller
construction
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2016094812A
Other languages
Japanese (ja)
Other versions
JP2017204089A (en
Inventor
三郎 片山
三郎 片山
浩章 青木
浩章 青木
稔之 石井
稔之 石井
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.)
Taisei Corp
Original Assignee
Taisei 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 Taisei Corp filed Critical Taisei Corp
Priority to JP2016094812A priority Critical patent/JP6751588B2/en
Publication of JP2017204089A publication Critical patent/JP2017204089A/en
Application granted granted Critical
Publication of JP6751588B2 publication Critical patent/JP6751588B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Description

本発明は、本発明は、建設機械の自律走行用制御装置および自律走行方法に関する。 The present invention relates to an autonomous driving control device for a construction machine and an autonomous driving method.

災害復旧工事等では、作業員の安全性を確保することを目的として、無人化施工が採用される場合がある。無人化施工は、現場から送られてくる映像を、複数のモニタ画面で確認しながらオペレータが建設機械を遠隔操作するのが一般的である。この方法では、オペレータは作業箇所周囲の状況を直接五感で感じながら操作する事が出来ないので、オペレータの技量によって作業の品質が異なる場合がある。また、複数の画像取得のための装置と通信環境が必要となる。 In disaster recovery work, unmanned work may be adopted for the purpose of ensuring the safety of workers. In unmanned construction, it is common for the operator to remotely control the construction machine while checking the images sent from the site on multiple monitor screens. In this method, the operator cannot operate while directly feeling the situation around the work place with all five senses, so that the quality of work may differ depending on the skill of the operator. In addition, a device and a communication environment for acquiring a plurality of images are required.

また、他の無人化施工方法として、人間の五感に代わるセンサ類を建設機械に搭載しておき、作業開始命令を与えることにより、予め設定された計画線に沿って建設機械を走行させる自律制御式の無人化施工方法が開発されている(例えば、非特許献1参照)。 In addition, as another unmanned construction method, sensors that replace the five human senses are mounted on the construction machine, and a work start command is given to autonomously control the construction machine to run along a preset planned line. A type of unmanned construction method has been developed (see, for example, Non-Patent Dedication 1).

非特許文献1に記載される技術では、転圧路の走行に関して、走行する始点と目標点を結ぶ直線を複数に分割し、近傍の分割点に建設機械の方向が向くように制御する。そして、その分割点を通過後にその次に近い分割点に向けて方向制御を行い、これを繰り返すことで最終目標点へと走行していく。 In the technique described in Non-Patent Document 1, regarding the traveling of the compaction path, the straight line connecting the traveling start point and the target point is divided into a plurality of parts, and the construction machine is controlled so as to face the nearby division points. Then, after passing through the division point, the direction is controlled toward the next closest division point, and by repeating this, the vehicle travels to the final target point.

栗原 庸聡、外3名、「振動ローラの自律走行の実証」、大成建設技術センター報、大成建設株式会社技術センター、2014年12月1日、第47号、No56Yo Satoshi Kurihara, 3 outsiders, "Demonstration of autonomous driving of vibrating rollers", Taisei Corporation Technology Center Bulletin, Taisei Corporation Technology Center, December 1, 2014, No. 47, No56

しかし、非特許文献1に記載される技術では、一つの分割点を通過後に次の分割点に目標を移して制御をおこなうため、振動ローラの様な構造の建設機械ではステアリング動作に遅れが発生する。その為、本来走行させたい線上を走行させることが難しく、ある一定の範囲内で蛇行走行をしてしまうという問題があった。
この問題点について、図7を参照して説明する。例えば、図7(a)に示すように、振動ローラが一つ目の第1分割点に向かって走行していたとする。そして、振動ローラが第1分割点を通過した時点で、第1分割点からその次に近い二つ目の第2分割点に振動ローラの目標を変更し、ステアリングの修正を行う(図7(b)参照)。この際、走行しながらステアリングの修正動作を行うために遅れが発生し、計画線に戻れずに蛇行してしまう(図7(c)参照)。これにより、図7(d)に示すように、振動ローラは蛇行走行を繰り返すことになる。
なお、一定量蛇行してしまうことは、走行精度の観点からある程度は生じるものであるが、走行精度を維持しながらも人間が操作したように走行が滑らかな制御が望まれている。
However, in the technique described in Non-Patent Document 1, since the target is moved to the next division point and controlled after passing through one division point, a delay occurs in the steering operation in a construction machine having a structure such as a vibrating roller. To do. Therefore, it is difficult to run on the line that is originally desired to run, and there is a problem that meandering runs within a certain range.
This problem will be described with reference to FIG. For example, as shown in FIG. 7A, it is assumed that the vibrating roller is traveling toward the first partition point. Then, when the vibrating roller passes the first dividing point, the target of the vibrating roller is changed from the first dividing point to the second second dividing point closest to the first dividing point, and the steering is corrected (FIG. 7 (FIG. 7). b) See). At this time, a delay occurs due to the correction operation of the steering while traveling, and the vehicle cannot return to the planned line and meanders (see FIG. 7C). As a result, as shown in FIG. 7D, the vibrating roller repeats meandering.
It should be noted that meandering by a certain amount occurs to some extent from the viewpoint of running accuracy, but it is desired to control the running smoothly as if operated by a human while maintaining the running accuracy.

このような観点から、本発明は、走行精度を維持しながらも滑らかに走行可能な自律走行用制御装置および自律走行方法を提供することを課題とする。 From such a viewpoint, it is an object of the present invention to provide an autonomous driving control device and an autonomous driving method capable of smoothly traveling while maintaining traveling accuracy.

振動ローラのようなアーティキュレート機構を有する建設機械は、案内輪である前輪が走行した軌跡上を後輪が走行するという特徴がある。
本発明の発明者は、このようなアーティキュレート機構の特性上、運転中の操縦者(搭乗による操縦および遠隔操作による操縦を含む)の意識は前輪にあり、前輪を基準にして操縦することで蛇行の少ない走行を実現していることに着目した。具体的には、前輪の位置の目標としているものは、隣の車線との間にできる轍であり、操縦者は、この轍と前輪の走行ラインとが所定のラップ長を確保しながら隣の車線と平行になるようにハンドル操作を行う。本発明は、人間の操縦による建設機械の走行を自律走行で実現させるものである。
A construction machine having an articulating mechanism such as a vibrating roller is characterized in that the rear wheels travel on the trajectory on which the front wheels, which are guide wheels, travel.
Due to the characteristics of such an articulating mechanism, the inventor of the present invention has the consciousness of the driver during driving (including maneuvering by boarding and maneuvering by remote control) in the front wheels, and by maneuvering with reference to the front wheels. We paid attention to the fact that it realized driving with less meandering. Specifically, the target of the position of the front wheels is a rut formed between the rut and the adjacent lane, and the pilot can use the rut and the running line of the front wheels next to each other while ensuring a predetermined lap length. Operate the steering wheel so that it is parallel to the lane. The present invention realizes the running of a construction machine by human control by autonomous running.

前記課題を解決する本発明に係る自律走行用制御装置は、自律走行する建設機械を制御する自律走行用制御装置である。前記建設機械は、前輪および後輪を有するアーティキュレート機構を備える。
自律走行制御を行うための前記建設機械の基準点は、進行方向側の車輪の回転軸の中心位置または回転軸の中心位置を通る鉛直線上に設けられており、前記建設機械の進行方向は、進行方向側の車輪の向きである。
この自律走行用制御装置は、走行基準線から前記建設機械までの距離が予め決められた第1閾値よりも大きい場合に、前記走行基準線に近づくように当該建設機械の進行方向を修正する制御信号を出力する。
また、自律走行用制御装置は、前記第1閾値と同じまたは当該第1閾値よりも小さい値である第2閾値よりも前記走行基準線から前記建設機械までの距離が小さくなった場合に、走行基準線に対して前記建設機械の進行方向を平行にするための制御信号を出力する。
The autonomous driving control device according to the present invention that solves the above problems is an autonomous driving control device that controls a construction machine that autonomously travels. The construction machine comprises an articulating mechanism having front and rear wheels.
The reference point of the construction machine for performing autonomous traveling control is provided on a vertical line passing through the center position of the rotation axis of the wheel on the traveling direction side or the center position of the rotation axis, and the traveling direction of the construction machine is set. This is the direction of the wheels on the traveling direction side.
When the distance from the travel reference line to the construction machine is larger than a predetermined first threshold value, the autonomous driving control device corrects the traveling direction of the construction machine so as to approach the travel reference line. Output a signal.
Further, the autonomous travel control device travels when the distance from the travel reference line to the construction machine is smaller than the second threshold value which is the same as or smaller than the first threshold value. A control signal for making the traveling direction of the construction machine parallel to the reference line is output.

また、本発明に係る自律走行方法は、建設機械を自律走行させる自律走行方法である。前記建設機械は、前輪および後輪を有するアーティキュレート機構を備える。
自律走行制御を行うための前記建設機械の基準点は、進行方向側の車輪の回転軸の中心位置または回転軸の中心位置を通る鉛直線上に設けられており、前記建設機械の進行方向は、進行方向側の車輪の向きである。
この自律走行方法では、走行基準線から前記建設機械までの距離が予め決められた第1閾値よりも大きい場合に、前記走行基準線に近づくように当該建設機械の進行方向を修正する。
また、前記第1閾値と同じまたは当該第1閾値よりも小さい値である第2閾値よりも前記走行基準線から前記建設機械までの距離が小さくなった場合に、走行基準線に対して前記建設機械の進行方向を平行にする。
Further, the autonomous driving method according to the present invention is an autonomous driving method in which a construction machine is autonomously driven. The construction machine comprises an articulating mechanism having front and rear wheels.
The reference point of the construction machine for performing autonomous traveling control is provided on a vertical line passing through the center position of the rotation axis of the wheel on the traveling direction side or the center position of the rotation axis, and the traveling direction of the construction machine is set. This is the direction of the wheels on the traveling direction side.
In this autonomous driving method, when the distance from the traveling reference line to the construction machine is larger than a predetermined first threshold value, the traveling direction of the construction machine is corrected so as to approach the traveling reference line.
Further, when the distance from the traveling reference line to the construction machine is smaller than the second threshold value which is the same as or smaller than the first threshold value, the construction is performed with respect to the traveling reference line. Make the traveling direction of the machine parallel.

本発明によれば、走行基準線から一定の位置を走行するので走行精度が維持される。また、走行路(走行基準線)の途中に通過しなければならない地点(中間点)が決まっていないので、蛇行量が従来に比べて相対的に小さく、走行が滑らかである。 According to the present invention, since the vehicle travels at a certain position from the travel reference line, the travel accuracy is maintained. Further, since the point (intermediate point) that must be passed in the middle of the traveling path (traveling reference line) is not determined, the meandering amount is relatively small as compared with the conventional case, and the traveling is smooth.

本発明によれば、走行精度を維持しながらも滑らかに走行可能である。 According to the present invention, it is possible to run smoothly while maintaining running accuracy.

本発明の実施形態に係る自律走行方法を説明するための図であり、(a)は自律走行方法を用いる無人化施工システムの全体図であり、(b)は無人化施工を行う転圧エリアの例示である。It is a figure for demonstrating the autonomous driving method which concerns on embodiment of this invention, (a) is the whole view of the unmanned construction system which uses the autonomous driving method, (b) is the compaction area which performs unmanned construction. Is an example of. 本発明の実施形態に係る自律走行方法に用いる振動ローラの外観図である。It is external drawing of the vibrating roller used in the autonomous driving method which concerns on embodiment of this invention. 振動ローラのアーティキュレート機構の概略図であり、(a)は直進時の状態を示し、(b)は旋回時の状態を示す。It is a schematic diagram of the articulation mechanism of the vibrating roller, (a) shows the state at the time of going straight, and (b) shows the state at the time of turning. 振動ローラの自律制御システムを説明するためのブロック図である。It is a block diagram for demonstrating the autonomous control system of a vibrating roller. 本発明の実施形態に係る自律走行方法を説明するための図である。It is a figure for demonstrating the autonomous driving method which concerns on embodiment of this invention. 従来技術における自律走行方法および本発明における自律走行方法の走行実験の結果を示す図であり、(a)は従来技術における自律走行方法により制御を行った走行実験の結果であり、(b)は本発明における自律走行方法により制御を行った走行実験の結果である。It is a figure which shows the result of the driving experiment of the autonomous driving method in the prior art and the autonomous driving method in this invention, (a) is the result of the driving experiment which controlled by the autonomous driving method in the prior art, (b) is This is the result of a traveling experiment controlled by the autonomous driving method in the present invention. 従来技術における自律走行の課題を説明するための図であり、(a)〜(d)は各工程を示す。It is a figure for demonstrating the problem of autonomous driving in the prior art, and (a)-(d) show each process.

以下、本発明の実施をするための形態を、適宜図面を参照しながら詳細に説明する。
各図は、本発明を十分に理解できる程度に、概略的に示してあるに過ぎない。よって、本発明は、図示例のみに限定されるものではない。また、参照する図面における部材の寸法は、説明を明確にするために誇張して表現されている場合がある。なお、各図において、共通する構成要素や同様な構成要素については、同一の符号を付し、それらの重複する説明を省略する。
Hereinafter, embodiments for carrying out the present invention will be described in detail with reference to the drawings as appropriate.
Each figure is only schematically shown to the extent that the present invention can be fully understood. Therefore, the present invention is not limited to the illustrated examples. In addition, the dimensions of the members in the referenced drawings may be exaggerated for the sake of clarity. In each figure, common components and similar components are designated by the same reference numerals, and duplicate description thereof will be omitted.

≪本実施形態に係る自律走行方法≫
自律走行方法とは、建設機械にセンサ類を搭載させて、予め設定された計画線に沿って建設機械を走行させることを言う。本実施形態では、建設機械の自律走行に伴い無人化された施工も同時行うので「無人化施工」と呼ぶ場合もある。本実施形態に係る自律走行方法を用いた無人化施工システムMを図1(a)に示す。
<< Autonomous driving method according to this embodiment >>
The autonomous driving method means that the construction machine is equipped with sensors and the construction machine is driven along a preset planned line. In this embodiment, unmanned construction is also performed at the same time as the construction machine runs autonomously, so it may be called "unmanned construction". FIG. 1A shows an unmanned construction system M using the autonomous driving method according to the present embodiment.

無人化施工システムMは、建設機械を自律走行させて施工現場の地面を締め固めるものである。無人化施工システムMは、施工現場を自律走行しながら地面を転圧する振動ローラ1と、施工現場に立設されるトータルステーション2と、施工現場から離れた位置にある操作室内に設置されたホストPC(Personal Computer)3とを備えて構成されている。振動ローラ1、トータルステーション2およびホストPC3は、無線通信を用いて通信可能である。なお、振動ローラ1は建設機械の一例であり、建設機械の種類はこれに限定されるものではない。 The unmanned construction system M autonomously runs a construction machine to compact the ground at the construction site. The unmanned construction system M includes a vibrating roller 1 that rolls the ground while autonomously traveling on the construction site, a total station 2 that stands on the construction site, and a host PC installed in an operation room located away from the construction site. (Personal Computer) 3 is provided. The vibrating roller 1, the total station 2, and the host PC 3 can communicate using wireless communication. The vibrating roller 1 is an example of a construction machine, and the type of the construction machine is not limited to this.

<トータルステーション>
トータルステーション2は、走行する振動ローラ1を自動追尾して、振動ローラ1の位置情報を周期的(例えば、300ミリ秒)にホストPC3に対して送信する。トータルステーション2は、例えば、振動ローラ1の走行を妨害しない場所であると共に、振動ローラ1の自動追尾が常に可能な位置に設置されている。
<Total station>
The total station 2 automatically tracks the traveling vibrating roller 1 and periodically (for example, 300 milliseconds) transmits the position information of the vibrating roller 1 to the host PC 3. The total station 2 is, for example, a place that does not interfere with the running of the vibrating roller 1, and is installed at a position where automatic tracking of the vibrating roller 1 is always possible.

<ホストPC>
ホストPC3は、施工管理者により操作されるものである。施工管理者は、ホストPC3に施工条件を予め登録し、その後に施工開始の指示を入力する。これらの情報は、振動ローラ1に送信される。そして、送信が完了されると振動ローラ1による無人化施工が開始される。
また、無人化施工が行われている期間、ホストPC3は、トータルステーション2から受信した振動ローラ1の位置情報を振動ローラ1に対して送信する。
一方、ホストPC3は、振動ローラ1の機体情報を振動ローラ1から周期的に受信し、この機体情報を表示画面に表示する。機体情報は、振動ローラ1の状態が確認できるものであればよく、例えば、振動ローラ1の進行方向、速度、ステアリング角度等であってよい。施工管理者は、ホストPC3に表示される振動ローラ1の機体情報を確認することで、施工の進行状況を把握することが可能である。なお、施工管理者は、施工開始の指示を行った後は、原則として振動ローラ1に対して指示を行わない。
<Host PC>
The host PC 3 is operated by the construction manager. The construction manager registers the construction conditions in the host PC 3 in advance, and then inputs the instruction to start the construction. This information is transmitted to the vibrating roller 1. Then, when the transmission is completed, the unmanned construction by the vibrating roller 1 is started.
Further, during the period during which the unmanned construction is being performed, the host PC 3 transmits the position information of the vibrating roller 1 received from the total station 2 to the vibrating roller 1.
On the other hand, the host PC 3 periodically receives the aircraft information of the vibrating roller 1 from the vibrating roller 1 and displays the aircraft information on the display screen. The aircraft information may be any information as long as the state of the vibrating roller 1 can be confirmed, and may be, for example, the traveling direction, speed, steering angle, etc. of the vibrating roller 1. The construction manager can grasp the progress of the construction by checking the machine information of the vibrating roller 1 displayed on the host PC 3. In principle, the construction manager does not give an instruction to the vibrating roller 1 after giving an instruction to start the construction.

施工条件には、例えば、(1)転圧を行うエリア(以下、「転圧エリア」と呼ぶ)に関する転圧エリア情報、(2)転圧エリア内に設定される転圧路に関する転圧路情報、(3)転圧路を振動ローラ1が転圧する転圧条件に関する転圧条件情報などが含まれる。なお、転圧路は、振動ローラ1が走行することで転圧する領域を意味している。その為、転圧路は所定の幅を持つことになる。転圧路の基準線は、転圧路の延在方向(縦断方向)に沿う仮想線であり、振動ローラ1の自律走行の目標となる走行ルートである。基準線は、転圧路の任意の位置に設定することが可能である。本実施形態では、基準線として転圧路の中心線を採用する。 The construction conditions include, for example, (1) rolling area information regarding an area for rolling (hereinafter referred to as "rolling area"), and (2) rolling path for a rolling path set in the rolling area. Information, (3) Rolling condition information regarding the rolling condition in which the vibrating roller 1 rolls the rolling path, and the like are included. The compaction path means a region where the vibrating roller 1 travels to compact. Therefore, the compaction path has a predetermined width. The reference line of the rolling compaction path is a virtual line along the extending direction (longitudinal direction) of the rolling compaction path, and is a traveling route that is a target of autonomous traveling of the vibrating roller 1. The reference line can be set at any position on the rolling path. In this embodiment, the center line of the compaction path is adopted as the reference line.

転圧エリア情報には、転圧エリア数および各転圧エリアを特定するための座標(x,y)などが含まれる。図1(b)に示すように、矩形の転圧エリアの場合には、各転圧エリアを特定するための座標として転圧エリアの四隅の座標(x,y)が与えられる。
転圧路情報には、転圧路数、各転圧路を特定するための座標(x,y)および車線変更幅などが含まれる。図1(b)に示すように、上下方向に直線状に転圧する場合には、各転圧路を特定するための座標として各転圧路の中心線の両端の座標(x,y)が与えられ、また、車線変更幅として隣り合う転圧路の中心線同士の離間距離が与えられる。
The compaction area information includes the number of compaction areas and the coordinates (x, y) for specifying each compaction area. As shown in FIG. 1 (b), in the case of a rectangular compaction area, the coordinates (x, y) of the four corners of the compaction area are given as the coordinates for specifying each compaction area.
The rolling path information includes the number of rolling paths, the coordinates (x, y) for specifying each rolling path, the lane change width, and the like. As shown in FIG. 1 (b), when rolling in a straight line in the vertical direction, the coordinates (x, y) at both ends of the center line of each rolling path are used as the coordinates for specifying each rolling path. Also, as the lane change width, the distance between the center lines of the adjacent compaction paths is given.

転圧条件情報には、各転圧路における転圧回数、転圧エリアへの進入点の座標および転圧エリアからの退出点の座標などが含まれる。図1(b)に示すように、矩形の転圧エリアの左側に設定される転圧路から右側に向かって順次転圧する場合には、例えば、転圧エリアへの進入点として最左端の転圧路の中心線の一方の端点の座標(x,y)が与えられ、転圧エリアからの退出点として最右端の転圧路の中心線の一方の(x,y)が与えられる。 The compaction condition information includes the number of compactions in each compaction path, the coordinates of the entry point to the compaction area, the coordinates of the exit point from the compaction area, and the like. As shown in FIG. 1 (b), in the case of sequentially rolling from the rolling path set on the left side of the rectangular rolling area toward the right side, for example, the leftmost rolling as an approach point to the rolling area. The coordinates (x, y) of one end point of the center line of the compaction path are given, and one end point (x, y) of the center line of the rightmost compaction path is given as the exit point from the compaction area.

<振動ローラ>
図2を参照して、振動ローラ1(省略して「ローラ」と呼ぶ場合がある)の構成について説明する。振動ローラ1は、車体10と、車体10の前後に取り付けられた二つの鉄輪11,11と、車体10の下部に配置されたアーティキュレート機構12と、車体10の上部に設置された全周プリズム13および通信アンテナ14と、自律走行用制御装置15と、機体情報取得手段S(図4参照)とで構成されている。振動ローラ1は、鉄輪11,11の回転方向を変更することで、前進および後進が可能である。
<Vibration roller>
The configuration of the vibrating roller 1 (may be abbreviated as “roller”) will be described with reference to FIG. The vibrating roller 1 includes a vehicle body 10, two iron wheels 11 and 11 attached to the front and rear of the vehicle body 10, an articulating mechanism 12 arranged at the bottom of the vehicle body 10, and an all-around prism installed at the top of the vehicle body 10. It is composed of 13 and a communication antenna 14, an autonomous driving control device 15, and an aircraft information acquisition means S (see FIG. 4). The vibrating roller 1 can move forward and backward by changing the rotation directions of the iron wheels 11 and 11.

車体10は、振動ローラ1の本体となるものである。車体10は、内部に図示しない駆動手段を収容する。以下では、「ローラの方位角G」といった場合には、車体10の向きを意味する。
鉄輪11は、図示しない振動を発生する装置を備え、振動しながら回転することで地面を転圧する。以下では、前側の鉄輪11を前輪11aと呼び、後側の鉄輪11を後輪11bと呼ぶ場合がある。前輪11aは前進時における自律走行の制御の基準になり、また、後輪は後進時における自律走行の制御の基準になる。詳細は後記する。
The vehicle body 10 is the main body of the vibrating roller 1. The vehicle body 10 houses a driving means (not shown) inside. In the following, when the term "roller azimuth G" is used, it means the orientation of the vehicle body 10.
The iron ring 11 includes a device that generates vibration (not shown), and rolls on the ground by rotating while vibrating. In the following, the front iron wheel 11 may be referred to as a front wheel 11a, and the rear iron wheel 11 may be referred to as a rear wheel 11b. The front wheels 11a serve as a reference for controlling autonomous driving when moving forward, and the rear wheels serve as a reference for controlling autonomous driving when moving backward. Details will be described later.

アーティキュレート機構12は、振動ローラ1を旋回させるための機構であり、車体10の下部に設置される。アーティキュレート機構12は、前輪11aを回転自在に保持する前輪保持部12aと、後輪11bを回転自在に保持する後輪保持部12bと、前輪保持部12aおよび後輪保持部12bを連結するセンターピン12cと、前輪保持部12aと後輪保持部12bとの間に介設されるステアリングシリンダ(図示せず)とを備えている。自律走行用制御装置15から進行方向を修正する制御指令(ステアリング角度θを制御指令角度とする制御指令)を受信すると、ステアリング角度θに応じてステアリングシリンダが伸縮する。そして、ステアリングシリンダが伸縮すると、センターピン12cを中心に前輪保持部12aが屈折し、それに伴い前輪11aの方向が変化する。 The articulating mechanism 12 is a mechanism for turning the vibrating roller 1 and is installed in the lower part of the vehicle body 10. The articulating mechanism 12 is a center that connects a front wheel holding portion 12a that rotatably holds the front wheels 11a, a rear wheel holding portion 12b that rotatably holds the rear wheels 11b, and a front wheel holding portion 12a and a rear wheel holding portion 12b. It includes a pin 12c and a steering cylinder (not shown) interposed between the front wheel holding portion 12a and the rear wheel holding portion 12b. When a control command for correcting the traveling direction (a control command with the steering angle θ as the control command angle) is received from the autonomous traveling control device 15, the steering cylinder expands and contracts according to the steering angle θ. Then, when the steering cylinder expands and contracts, the front wheel holding portion 12a is refracted around the center pin 12c, and the direction of the front wheel 11a changes accordingly.

図2に示す全周プリズム13は、トータルステーション2の追尾対象となるものである。ここで、前輪11aに後輪11bが追従するというアーティキュレート機構12の特性を考慮して、自立走行制御を行う基準点を振動ローラ1が進んでいる側の鉄輪11の回転軸の中心位置または回転軸の中心位置を通る鉛直線上に設けることが好ましい。その為、本実施形態では、全周プリズム13の位置を振動ローラ1が進んでいる側の鉄輪11の回転軸の中心位置の真上になるように演算により補正を行うことにする。つまり、振動ローラ1は、前後進を繰り返す往復走行により所定の回数だけ転圧を行うので、前進時には前輪11aが基準点となり、後進時には後輪11bが基準点となるように補正を行う。そして、振動ローラ1の制御を行う際に基準となる方向(基準方向)は、基準点を設定した側の鉄輪11(前輪11aまたは後輪11b)の向きθJとする。 The all-around prism 13 shown in FIG. 2 is a tracking target of the total station 2. Here, in consideration of the characteristic of the articulating mechanism 12 that the rear wheels 11b follow the front wheels 11a, the center position of the rotation axis of the iron wheel 11 on the side where the vibrating roller 1 is advancing with respect to the reference point for performing self-sustaining traveling control or It is preferable to provide it on a vertical line passing through the center position of the rotation axis. Therefore, in the present embodiment, the position of the all-around prism 13 is corrected by calculation so as to be directly above the center position of the rotation axis of the iron ring 11 on the side where the vibrating roller 1 is advancing. That is, since the vibrating roller 1 rolls a predetermined number of times by reciprocating traveling repeatedly forward and backward, the correction is performed so that the front wheels 11a serve as a reference point when moving forward and the rear wheels 11b serve as a reference point when moving backward. The reference direction (reference direction) when controlling the vibrating roller 1 is the direction θJ of the iron wheel 11 (front wheel 11a or rear wheel 11b) on the side where the reference point is set.

図3を参照して、振動ローラ1の自立走行制御を行う際の基準点および基準方向について説明する。振動ローラ1は、上記説明した通り前後進を行うことが可能であるが、ここでは前進する場合を想定して説明を行う。その為、基準点としてのプリズムの位置は、前輪11aの回転軸の中心位置に補正される。なお、詳細は後記するが、振動ローラ1の車体10の向き(方位角G(deg))は、姿勢検出センサS1(図4参照)によって検出される。また、アーティキュレート機構12のステアリング角度θ(deg)は、ステア角度検出センサS3(図4参照)によって検出される。 With reference to FIG. 3, a reference point and a reference direction when performing independent traveling control of the vibrating roller 1 will be described. The vibrating roller 1 can move forward and backward as described above, but here, the description will be made assuming the case of moving forward. Therefore, the position of the prism as a reference point is corrected to the center position of the rotation axis of the front wheel 11a. Although details will be described later, the orientation (azimuth angle G (deg)) of the vehicle body 10 of the vibrating roller 1 is detected by the attitude detection sensor S1 (see FIG. 4). Further, the steering angle θ (deg) of the articulating mechanism 12 is detected by the steering angle detection sensor S3 (see FIG. 4).

図3(a)に示すように、直進時(ステアリング角度θが0°の状態)では、前輪保持部12aおよび後輪保持部12bが進行方向に対して直線状になっているので、前輪11aおよび後輪11bの回転軸が平行になる。つまり、振動ローラ1の方位角G(車体10の向き)と前輪11aの向きθJとは同じ方向になる。 As shown in FIG. 3A, when traveling straight ahead (when the steering angle θ is 0 °), the front wheel holding portion 12a and the rear wheel holding portion 12b are linear with respect to the traveling direction, so that the front wheels 11a And the rotation axes of the rear wheels 11b are parallel. That is, the azimuth angle G (direction of the vehicle body 10) of the vibrating roller 1 and the direction θJ of the front wheels 11a are in the same direction.

一方、図3(b)に示すように、右旋回時(ステアリング角度θが0°でない状態)では、センターピン12cを中心にして前輪保持部12aが進行方向に対して右側に屈折し、それに伴い前輪11aの右側が後輪11bに近接する方向に傾斜する。左旋回時の場合も同様にして、センターピン12cを中心にして前輪保持部12aが進行方向に対して左側に屈折し、それに伴い前輪11aの左側が後輪11bに近接する方向に傾斜する。これにより、前輪11aおよび後輪11bが同じ軌跡を通過する。この場合、振動ローラ1の方位角G(車体10の向き)と前輪11aの向きθJとは違う方向になる。旋回時における振動ローラ1の前輪11aの向きθJは、地面と前輪11aとの間の摩擦を無視した場合、振動ローラ1の方位角G(deg)にステアリング角度θ(deg)を加算(または減算)した値になる。 On the other hand, as shown in FIG. 3B, when turning to the right (when the steering angle θ is not 0 °), the front wheel holding portion 12a is refracted to the right with respect to the traveling direction around the center pin 12c. Along with this, the right side of the front wheel 11a inclines in a direction close to the rear wheel 11b. Similarly, when turning to the left, the front wheel holding portion 12a bends to the left with respect to the traveling direction with the center pin 12c as the center, and the left side of the front wheel 11a inclines in a direction close to the rear wheel 11b accordingly. As a result, the front wheels 11a and the rear wheels 11b pass through the same locus. In this case, the azimuth angle G of the vibrating roller 1 (direction of the vehicle body 10) and the direction θJ of the front wheels 11a are different. The direction θJ of the front wheel 11a of the vibrating roller 1 during turning adds (or subtracts) the steering angle θ (deg) to the azimuth angle G (deg) of the vibrating roller 1 when the friction between the ground and the front wheel 11a is ignored. ).

なお、図示しないが、後進時における基準点は、後輪11bの回転軸の中心位置または回転軸の中心位置を通る鉛直線上に設定される。つまり、後進時においては、全周プリズム13の位置が後輪11bの回転軸の中心位置または回転軸の中心位置を通る鉛直線上に補正される。また、後進時における振動ローラ1の後輪11bの向き(基準方向)θJは、直進時,旋回時に関わらず振動ローラ1の方位角G(車体10の向き)の反対方向になる。 Although not shown, the reference point when moving backward is set on a vertical line passing through the center position of the rotation axis of the rear wheel 11b or the center position of the rotation axis. That is, when moving backward, the position of the all-around prism 13 is corrected on a vertical line passing through the center position of the rotation axis of the rear wheel 11b or the center position of the rotation axis. Further, the direction (reference direction) θJ of the rear wheel 11b of the vibrating roller 1 when moving backward is the opposite direction of the azimuth angle G (direction of the vehicle body 10) of the vibrating roller 1 regardless of whether it is going straight or turning.

このように、全周プリズム13の位置の補正を行うことにより、トータルステーション2を介して取得する基準点の座標は、前進時の前輪11aの回転軸の中心位置または後進時の後輪11bの回転軸の中心位置である。その為、自律走行の制御において、ステアリング動作に遅れが発生しにくい。この補正を行うのは、振動ローラ1、トータルステーション2およびホストPC3の何れであってもよく、何れかの装置で演算により行われる。なお、振動ローラ1の基準点はこれに限定されるものではなく、例えばセンターピン12cの位置またはセンターピン12cを通る鉛直線上に設けてもよい。 By correcting the position of the all-around prism 13 in this way, the coordinates of the reference point acquired via the total station 2 are the center position of the rotation axis of the front wheel 11a when moving forward or the rotation of the rear wheel 11b when moving backward. The center position of the axis. Therefore, in the control of autonomous driving, the steering operation is less likely to be delayed. This correction may be performed by any of the vibrating roller 1, the total station 2, and the host PC 3, and is performed by calculation in any of the devices. The reference point of the vibrating roller 1 is not limited to this, and may be provided, for example, at the position of the center pin 12c or on a vertical line passing through the center pin 12c.

図2に通信アンテナ14は、ホストPC3との通信を行うものである。具体的には、振動ローラ1の自律走行用制御装置15は、通信アンテナ14を介してホストPC3から施工条件(転圧エリア情報、転圧路情報、転圧条件情報)、位置情報などを受信する。また、自律走行用制御装置15は、通信アンテナ14を介してホストPC3に対して振動ローラ1の機体情報を送信する。 In FIG. 2, the communication antenna 14 communicates with the host PC 3. Specifically, the autonomous driving control device 15 of the vibrating roller 1 receives construction conditions (rolling area information, rolling path information, rolling condition information), position information, and the like from the host PC 3 via the communication antenna 14. To do. Further, the autonomous driving control device 15 transmits the aircraft information of the vibrating roller 1 to the host PC 3 via the communication antenna 14.

図4を参照して、機体情報取得手段Sの構成について説明する。図4は、振動ローラ1の自律制御を実現する自律制御システムM1の概略図である。機体情報取得手段Sは、姿勢検出センサS1と、速度検出センサS2と、ステア角度検出センサS3と、前方探査センサS4とで構成されている。
姿勢検出センサS1は、振動ローラ1の方位角G(deg)を検出するものである。姿勢検出センサS1は、例えば、MEMS型ジャイロであって、車体10の内部に設置される。方位角G(deg)は、自律走行用制御装置15に受け渡され、慣性航法(INS)を用いた現在位置の算出などに用いられる。なお、トータルステーション2により取得された振動ローラ1の位置情報は、姿勢検出センサS1のドリフトの補正に用いられる。
The configuration of the aircraft information acquisition means S will be described with reference to FIG. FIG. 4 is a schematic view of an autonomous control system M1 that realizes autonomous control of the vibrating roller 1. The aircraft information acquisition means S includes an attitude detection sensor S1, a speed detection sensor S2, a steering angle detection sensor S3, and a forward exploration sensor S4.
The attitude detection sensor S1 detects the azimuth angle G (deg) of the vibrating roller 1. The posture detection sensor S1 is, for example, a MEMS type gyro and is installed inside the vehicle body 10. The azimuth angle G (deg) is passed to the autonomous driving control device 15, and is used for calculating the current position using inertial navigation (INS). The position information of the vibrating roller 1 acquired by the total station 2 is used for correcting the drift of the attitude detection sensor S1.

速度検出センサS2は、振動ローラ1が前進および後進する速度V(km/h)を検出するものである。速度検出センサS2は、例えば、鉄輪11の回転速度を検出するロータリーエンコーダであって、後輪11bに設置される。速度V(km/h)は、自律走行用制御装置15に受け渡され、慣性航法(INS)を用いた現在位置の算出などに用いられる。 The speed detection sensor S2 detects the speed V (km / h) at which the vibrating roller 1 moves forward and backward. The speed detection sensor S2 is, for example, a rotary encoder that detects the rotational speed of the iron wheel 11, and is installed on the rear wheel 11b. The speed V (km / h) is passed to the autonomous driving control device 15, and is used for calculating the current position using inertial navigation (INS).

ステア角度検出センサS3は、アーティキュレート機構12のステアリング角度θ(deg)を検出するものである。ステア角度検出センサS3は、例えば、ポテンショメータであって、アーティキュレート機構12のセンターピン12cに設置される。ステアリング角度θ(deg)は、自律走行用制御装置15に受け渡され、振動ローラ1の走行方向の修正などに用いられる。なお、ステアリングシリンダのロッドの進退量を検出するセンサをステア角度検出センサS3としてもよい。 The steering angle detection sensor S3 detects the steering angle θ (deg) of the articulating mechanism 12. The steer angle detection sensor S3 is, for example, a potentiometer and is installed at the center pin 12c of the articulation mechanism 12. The steering angle θ (deg) is passed to the autonomous driving control device 15, and is used for correcting the traveling direction of the vibrating roller 1. The sensor that detects the amount of advance / retreat of the rod of the steering cylinder may be the steering angle detection sensor S3.

前方探査センサS4は、振動ローラ1の前方方向の物体情報Q(座標)を検出するものである。前方探査センサS4は、例えば、2Dスキャナであって、車体10の前方上部に設置される。前方探査センサS4は、自律走行用制御装置15に受け渡され、障害物の回避制御に用いられる。 The forward exploration sensor S4 detects the object information Q (coordinates) in the forward direction of the vibrating roller 1. The forward exploration sensor S4 is, for example, a 2D scanner and is installed in the front upper part of the vehicle body 10. The forward exploration sensor S4 is handed over to the autonomous driving control device 15 and is used for obstacle avoidance control.

図4に示す自律走行用制御装置15は、機体情報取得手段Sが取得した情報やホストPC3から受信した情報を用いて、予め設定された計画線(転圧路の中心線)に沿った自律走行の制御を行うものである。自律走行用制御装置15は、例えば、CPU(Central Processing Unit)、ROM(Read Only Memory)、RAM(Random Access Memory)等により構成される。そして、自律走行用制御装置15による制御は、CPUがROM等に格納されたプログラムをRAMに展開することにより実現するプログラム実行処理により実現される。 The autonomous driving control device 15 shown in FIG. 4 autonomously follows a preset planned line (center line of the compaction path) using the information acquired by the aircraft information acquisition means S and the information received from the host PC 3. It controls driving. The autonomous driving control device 15 is composed of, for example, a CPU (Central Processing Unit), a ROM (Read Only Memory), a RAM (Random Access Memory), and the like. Then, the control by the autonomous driving control device 15 is realized by the program execution process realized by the CPU expanding the program stored in the ROM or the like into the RAM.

自律走行用制御装置15は、自律走行に必要なステアリング角度θを演算し、算出されたステアリング角度θを制御指令角度とする制御指令を作成し、この制御指令を周期的(例えば、100ミリsec)にアーティキュレート機構12に対して送信する。アーティキュレート機構12は、この制御指令のステアリング角度θに応じた分だけステアリングシリンダを伸縮させ、センターピン12cを中心に前輪保持部12aを屈折させる。それに伴い前輪11aの方向が変化し、振動ローラ1の進路を修正させる。 The autonomous driving control device 15 calculates the steering angle θ required for autonomous driving, creates a control command with the calculated steering angle θ as the control command angle, and periodically (for example, 100 millisec) this control command. ) Is transmitted to the articulating mechanism 12. The articulating mechanism 12 expands and contracts the steering cylinder by the amount corresponding to the steering angle θ of this control command, and bends the front wheel holding portion 12a around the center pin 12c. Along with this, the direction of the front wheels 11a changes, and the course of the vibrating roller 1 is corrected.

本実施形態に係る自律走行用制御装置15による自律走行の制御について、図5を参照して説明する。ここでは、自律走行用制御装置15が制御する走行パターンとして、「転圧工程」を想定する。転圧工程は、振動ローラ1を転圧回数だけ転圧路上を往復動させるものである。自律走行用制御装置15は、転圧工程における自律走行に際して、予め転圧路の中心線を演算により求めておく。自律走行用制御装置15は、例えば、各転圧路の中心線の両端(始点、目標点)の座標(x,y)から転圧路の中心線を演算する。そして、転圧路の中心線の始点から目標点までの方向を「θT」とする。 The control of autonomous driving by the autonomous driving control device 15 according to the present embodiment will be described with reference to FIG. Here, a "rolling process" is assumed as a traveling pattern controlled by the autonomous driving control device 15. In the rolling compaction step, the vibrating roller 1 is reciprocated on the rolling compaction path as many times as the number of rolling compactions. The autonomous driving control device 15 obtains the center line of the compaction path in advance by calculation during autonomous driving in the compaction process. The autonomous driving control device 15 calculates the center line of the compaction path from the coordinates (x, y) of both ends (start point, target point) of the center line of each compaction path, for example. Then, the direction from the start point of the center line of the compaction path to the target point is defined as "θT".

また、自律走行用制御装置15は、転圧路の中心線から左右の両側に均等に広がる帯状の領域を位置ずれの許容範囲として設定する。この位置ずれの許容範囲の幅(Xcm)は、予め閾値として決められていればよく、例えば、20cm程度(転圧路の中心線から±20cm程度)にするのがよい。 Further, the autonomous driving control device 15 sets a band-shaped region that extends evenly on both the left and right sides from the center line of the compaction path as an allowable range of misalignment. The width (X cm) of the allowable range of this misalignment may be determined in advance as a threshold value, and is preferably about 20 cm (about ± 20 cm from the center line of the compaction path).

自律走行用制御装置15は、転圧工程における自律走行の制御が開始されると、転圧路の中心線の方向θTに対して進行方向側の鉄輪11(ここでは前輪11aを想定)の向きθJが平行になるように振動ローラ1を走行させる。ただし、転圧路の中心線に対して振動ローラ1の基準点の位置が一定量以上離れた場合、振動ローラ1の基準点が転圧路の中心線に戻るように前輪11aの向きを変える。そして、転圧路の中心線に対して一定量以内に振動ローラ1の基準点の位置が戻ったら、再び前輪11aの向きを転圧路の中心線の方向θTに対して平行に戻す。
なお、ここでの「平行」とは、厳密な意味での平行でなくてもよく、所定の誤差(例えば、±5°)があっても平行に含まれることにする。平行における誤差は、始点から目標点までの距離や位置ずれの許容範囲の幅などによって予め決められてもよいし、転圧路の目標点において振動ローラ1の位置ずれ量が許容範囲を維持できる程度の角度であってもよい。
When the control of autonomous driving in the compaction process is started, the autonomous driving control device 15 directs the iron wheels 11 (here, the front wheels 11a are assumed) on the traveling direction side with respect to the direction θT of the center line of the compaction path. The vibrating roller 1 is run so that θJ is parallel. However, when the position of the reference point of the vibrating roller 1 is separated by a certain amount or more from the center line of the rolling path, the direction of the front wheels 11a is changed so that the reference point of the vibrating roller 1 returns to the center line of the rolling path. .. Then, when the position of the reference point of the vibrating roller 1 returns within a certain amount with respect to the center line of the compaction path, the direction of the front wheels 11a is returned parallel to the direction θT of the center line of the compaction path.
The term "parallel" here does not have to be parallel in a strict sense, and even if there is a predetermined error (for example, ± 5 °), it is included in parallel. The error in parallel may be determined in advance by the distance from the start point to the target point, the width of the allowable range of displacement, and the amount of displacement of the vibrating roller 1 at the target point of the rolling path can maintain the allowable range. It may be an angle of degree.

例えば、ある時点において、転圧路の中心線に対する振動ローラ1の位置ずれ量が許容範囲内でなかったとする。その場合に、自律走行用制御装置15は、転圧路の中心線に近づくように振動ローラ1のステアリング角度θを修正する(図5の時刻t1参照)。この場合におけるステアリング角度θは、任意の角度であってよく、ステアリング角度θを修正した後の振動ローラ1の前輪11aの向きθJと転圧路の中心線の方向θTとが交差するものであればよい。例えば、可能な範囲でできるだけ早く転圧路の中心線に到達することを目標にした場合、最小旋回半径のステアリング角度θであってよい。これにより、振動ローラ1は、走行しながら進行方向を変更し、転圧路の中心線に向かって進行する。 For example, it is assumed that the amount of misalignment of the vibrating roller 1 with respect to the center line of the compaction path is not within the permissible range at a certain point in time. In that case, the autonomous driving control device 15 corrects the steering angle θ of the vibrating roller 1 so as to approach the center line of the compaction path (see time t 1 in FIG. 5). In this case, the steering angle θ may be any angle, and the direction θJ of the front wheels 11a of the vibrating roller 1 after the correction of the steering angle θ and the direction θT of the center line of the compaction path intersect. Just do it. For example, if the goal is to reach the centerline of the rolling path as soon as possible, the steering angle θ may be the minimum turning radius. As a result, the vibrating roller 1 changes the traveling direction while traveling, and travels toward the center line of the compaction path.

振動ローラ1がそのまま前進すると、位置ずれの許容範囲内に振動ローラ1の進行方向側の鉄輪11(ここでは前輪11a)が侵入する(図5の時刻t2参照)。その場合に、自律走行用制御装置15は、転圧路の中心線の方向θTに対して前輪11aの向きθJが平行になるように振動ローラ1のステアリング角度θを修正する。ここで、既に説明したように、前輪11aの方向θJを算出には、ステア角度検出センサS3によるアーティキュレート機構12のステアリング角度θを用いる。例えば、自律走行用制御装置15は、振動ローラ1の方位角G(deg)にステアリング角度θ(deg)を加算(または減算)した値を前輪の方向θJとして算出する。これにより、振動ローラ1は、走行しながら進行方向を変更し、前輪11の方向θJを転圧路の中心線の方向θTに向ける(図5の時刻t3参照)。 When the vibrating roller 1 advances as it is, the iron wheel 11 (here, the front wheel 11a) on the traveling direction side of the vibrating roller 1 enters within the allowable range of misalignment (see time t 2 in FIG. 5). In that case, the autonomous driving control device 15 corrects the steering angle θ of the vibrating roller 1 so that the direction θJ of the front wheels 11a is parallel to the direction θT of the center line of the compaction path. Here, as already described, the steering angle θ of the articulating mechanism 12 by the steering angle detection sensor S3 is used to calculate the direction θJ of the front wheels 11a. For example, the autonomous driving control device 15 calculates the value obtained by adding (or subtracting) the steering angle θ (deg) to the azimuth angle G (deg) of the vibrating roller 1 as the direction θJ of the front wheels. Thus, the vibration roller 1 changes the traveling direction while traveling directs direction θT of the rolling passage of the center line direction θJ of the front wheel 11 (see time t 3 in FIG. 5).

その後、自律走行用制御装置15は、振動ローラ1のステアリング角度θを「0°」に戻して、振動ローラ1を直進させる。これにより、振動ローラ1は、転圧路の中心線と平行に走行する(図5の時刻t4参照)。 After that, the autonomous driving control device 15 returns the steering angle θ of the vibrating roller 1 to “0 °” and causes the vibrating roller 1 to go straight. As a result, the vibrating roller 1 travels parallel to the center line of the compaction path (see time t 4 in FIG. 5).

振動ローラ1が転圧路の中心線と平行に走行し始めた後の制御は種々の方法が考えられる。自律走行用制御装置15は、例えば、ステアリング角度θの修正を適宜行って振動ローラ1の進行方向を微調整してもよいし、振動ローラ1の位置ずれ量が許容範囲外に前輪が外れるまでステアリング角度θの修正を行わなくてもよい。前者の場合、蛇行量を少なくするのがよく、例えば、振動ローラ1が転圧路の中心線と平行に走行していない場合と比較して制御指令の計算周期(Δt)を長く設定してもよい。また、振動ローラ1が転圧路の中心線に対して平行に含まれる所定の誤差の角度で走行している場合には、ステアリング角度θの修正を行わないようにしてもよい。 Various methods can be considered for the control after the vibrating roller 1 starts to travel parallel to the center line of the compaction path. For example, the autonomous driving control device 15 may finely adjust the traveling direction of the vibrating roller 1 by appropriately correcting the steering angle θ, or until the front wheels come off the displacement amount of the vibrating roller 1 outside the permissible range. It is not necessary to correct the steering angle θ. In the former case, it is better to reduce the amount of meandering. For example, the calculation cycle (Δt) of the control command is set longer than in the case where the vibrating roller 1 does not run parallel to the center line of the rolling compaction path. May be good. Further, when the vibrating roller 1 is traveling at an angle of a predetermined error included parallel to the center line of the rolling compaction path, the steering angle θ may not be corrected.

以上のように、本実施形態に係る自律走行用制御装置15は、転圧路の中心線(基準線)から左右の両側に広がる帯状の許容範囲内を、転圧路の中心線の方向θTに対して進行方向側の鉄輪11の向きθJが平行になるように振動ローラ1を走行させる。その為、本実施形態に係る振動ローラ1は、転圧路の中心線から一定の位置を走行するので走行精度が維持される。また、転圧路の途中に通過しなければならない地点(中間点)が決まっていないので、蛇行量が従来に比べて相対的に小さく、走行が滑らかである。 As described above, the autonomous driving control device 15 according to the present embodiment has the direction θT of the center line of the compaction path within the band-shaped allowable range extending from the center line (reference line) of the compaction path to both the left and right sides. The vibrating roller 1 is driven so that the direction θJ of the iron ring 11 on the traveling direction side is parallel to the above. Therefore, the vibrating roller 1 according to the present embodiment travels at a constant position from the center line of the compaction path, so that the traveling accuracy is maintained. Further, since the point (intermediate point) that must be passed in the middle of the compaction path is not determined, the amount of meandering is relatively small as compared with the conventional case, and the traveling is smooth.

従来技術における自律走行方法と本発明における自律走行方法とで振動ローラ1を制御した走行実験の結果を図6に示す。図6(a)は従来技術における自律走行方法により制御を行った走行実験の結果であり、図6(b)は本発明における自律走行方法により制御を行った走行実験の結果である。図6に示すグラフの横軸はデータ数(個)であり、縦軸は転圧路の中心線(基準線)からの位置ずれ量(m)である。 FIG. 6 shows the results of a traveling experiment in which the vibrating roller 1 is controlled by the autonomous driving method in the prior art and the autonomous driving method in the present invention. FIG. 6A is the result of a running experiment controlled by the autonomous driving method in the prior art, and FIG. 6B is the result of the running experiment controlled by the autonomous driving method in the present invention. The horizontal axis of the graph shown in FIG. 6 is the number of data (pieces), and the vertical axis is the amount of misalignment (m) from the center line (reference line) of the compaction path.

図6に示す走行実験は、以下の条件で行われた。
・レーン数:15レーン(階段状10m〜44m)
・走行速度:時速1km
・ラップ長:20cm
・施工回数:無振動1往復、有振動1往復
・施工範囲:832m2
図6を参照すると、従来技術の制御に比べて本発明の制御を用いた方が、転圧路の中心線(基準線)からの位置ずれ量(m)が全体的に小さいことが分かる。
The running experiment shown in FIG. 6 was carried out under the following conditions.
・ Number of lanes: 15 lanes (staircase 10m-44m)
・ Running speed: 1km / h
・ Wrap length: 20 cm
・ Number of constructions: 1 round trip without vibration, 1 round trip with vibration ・ Construction range: 832m 2
With reference to FIG. 6, it can be seen that the amount of misalignment (m) from the center line (reference line) of the compaction path is smaller overall when the control of the present invention is used as compared with the control of the prior art.

[変形例]
以上、本発明の実施形態について説明したが、本発明はこれに限定されるものではなく、特許請求の範囲の趣旨を変えない範囲で実施することができる。実施形態の変形例を以下に示す。
[Modification example]
Although the embodiments of the present invention have been described above, the present invention is not limited to this, and can be carried out within a range that does not change the gist of the claims. A modified example of the embodiment is shown below.

実施形態では、転圧路の中心線(基準線)に対する振動ローラ1の位置ずれ量が許容範囲内でなかった場合に、振動ローラ1を転圧路の中心線に戻すと共に、許容範囲内に前輪11aが入った時点で振動ローラ1の向きを転圧路の中心線と平行にしていた。つまり、一つの閾値を用いて振動ローラ1を転圧路の中心線に戻す判定と、振動ローラ1の向きを転圧路の中心線と平行にする判定との両方を行っていた。これにより、実施形態では制御が簡易なものであった。
しかしながら、これら二つの判定を別々の閾値を用いて行ってもよい。例えば、第1閾値を用いて振動ローラ1を転圧路の中心線に戻す判定を行い、第2閾値を用いて振動ローラ1の向きを転圧路の中心線と平行にする判定を行ってもよい。このようにすることで、振動ローラ1の走行位置の制御をより詳細に行うことができる。
In the embodiment, when the amount of misalignment of the vibrating roller 1 with respect to the center line (reference line) of the rolling path is not within the permissible range, the vibrating roller 1 is returned to the center line of the rolling path and within the permissible range. When the front wheel 11a entered, the direction of the vibrating roller 1 was parallel to the center line of the compaction path. That is, both the determination of returning the vibrating roller 1 to the center line of the rolling path and the determination of making the direction of the vibrating roller 1 parallel to the center line of the rolling path are performed using one threshold value. As a result, the control was simple in the embodiment.
However, these two determinations may be made using different thresholds. For example, the first threshold value is used to determine that the vibrating roller 1 is returned to the center line of the rolling path, and the second threshold value is used to determine that the direction of the vibrating roller 1 is parallel to the center line of the rolling path. May be good. By doing so, it is possible to control the traveling position of the vibrating roller 1 in more detail.

また、実施形態では、自律走行用制御装置15が制御する走行パターンとして、「転圧工程」を想定していたが、「進入工程」や「車線変更工程」に適用してもよい。進入工程は、転圧エリア外に位置する振動ローラ1を転圧エリア内に設定される転圧路に進入させるものである。車線変更工程は、振動ローラ1を次の転圧路に移動させるものである。 Further, in the embodiment, the "rolling process" is assumed as the traveling pattern controlled by the autonomous driving control device 15, but it may be applied to the "approaching process" or the "lane changing process". The approach step is to cause the vibrating roller 1 located outside the compaction area to enter the compaction path set in the compaction area. The lane change step is to move the vibrating roller 1 to the next compaction path.

また、実施形態では、転圧路に沿って自律走行を行う建設機械として振動ローラ1を例に挙げて説明を行った。しかしながら、建設機械の種類や走行路の種類はこれに限定されるものではない。自律走行を行う建設機械は、アーティキュレート機構を備えていればよく、車輪も鉄輪に限定されない。また、自律走行を行う走行路は、予め設定されたものであればよく、走行基準線も走行路の中心線に限定されない。
例えば、建設機械は、アーティキュレート機構を備えたダンプトラックでもよく、その場合の走行路は、トンネル工事を行っているトンネル坑内や採石場における搬送用道路であってよい。前者であれば、例えば、ダンプトラックは発破作業による生じたズリをトンネル坑外に搬送し、後者であれば、例えば、ダンプトラックは採石現場で採掘された岩石を採石場の場外に搬送する。
なお、走行路は直線のみならず、曲線が含まれていてもよい。曲線が含まれている場合、例えば、当該部分の走行は、複数の直線の走行路の組合せとして制御を行うようにする。
Further, in the embodiment, the vibrating roller 1 has been described as an example of a construction machine that autonomously travels along the compaction path. However, the types of construction machinery and the types of travel paths are not limited to this. Construction machines that run autonomously need only be equipped with an articulating mechanism, and the wheels are not limited to iron wheels. Further, the traveling path for autonomous driving may be a preset one, and the traveling reference line is not limited to the center line of the traveling path.
For example, the construction machine may be a dump truck provided with an articulating mechanism, and the traveling path in that case may be a transport road in a tunnel mine or a quarry where tunnel construction is being carried out. In the former case, for example, the dump truck transports the scraps generated by the blasting work to the outside of the tunnel, and in the latter case, for example, the dump truck transports the rock mined at the quarry site to the outside of the quarry site.
The traveling path may include not only a straight line but also a curved line. When a curve is included, for example, the traveling of the portion is controlled as a combination of a plurality of straight traveling paths.

なお、実施形態では、角度差の是正に必要なステアリング角度θを基準値(例えば、0°)に対する値として説明したが、現在値に対する増減分の値(ステアリング角度Δθ)であってもよい。 In the embodiment, the steering angle θ required for correcting the angle difference has been described as a value with respect to a reference value (for example, 0 °), but it may be a value for an increase or decrease with respect to the current value (steering angle Δθ).

1 振動ローラ(建設機械)
2 トータルステーション
3 ホストPC
10 車体
11a 前輪(鉄輪)
11b 後輪(鉄輪)
12 アーティキュレート機構(操向装置)
12c センターピン
13 全周プリズム
14 通信アンテナ
15 自律走行用制御装置
S1 姿勢制御センサ
S2 速度検出センサ
S3 ステア角度検出センサ
S4 前方探査センサ
1 Vibration roller (construction machine)
2 Total station 3 Host PC
10 Body 11a Front wheels (iron wheels)
11b Rear wheel (iron wheel)
12 Articulate mechanism (steering device)
12c Center pin 13 All-around prism 14 Communication antenna 15 Autonomous driving control device S1 Attitude control sensor S2 Speed detection sensor S3 Steer angle detection sensor S4 Forward exploration sensor

Claims (2)

自律走行する建設機械を制御する自律走行用制御装置であって、
前記建設機械は、前輪および後輪を有するアーティキュレート機構を備え、
自律走行制御を行うための前記建設機械の基準点は、進行方向側の車輪の回転軸の中心位置または回転軸の中心位置を通る鉛直線上に設けられており、
前記建設機械の進行方向は、進行方向側の車輪の向きであり、
走行基準線から前記建設機械までの距離が予め決められた第1閾値よりも大きい場合に、前記走行基準線に近づくように当該建設機械の進行方向を修正する制御信号を出力し、
前記第1閾値と同じまたは当該第1閾値よりも小さい値である第2閾値よりも前記走行基準線から前記建設機械までの距離が小さくなった場合に、前記走行基準線に対して前記建設機械の進行方向を平行にするための制御信号を出力する、
ことを特徴とする自律走行用制御装置。
It is a control device for autonomous driving that controls construction machinery that travels autonomously.
The construction machine comprises an articulating mechanism having front and rear wheels.
The reference point of the construction machine for performing autonomous traveling control is provided on a vertical line passing through the center position of the rotation axis of the wheel on the traveling direction side or the center position of the rotation axis.
The traveling direction of the construction machine is the direction of the wheels on the traveling direction side.
When the distance from the traveling reference line to the construction machine is larger than a predetermined first threshold value, a control signal for correcting the traveling direction of the construction machine so as to approach the traveling reference line is output.
When the distance from the traveling reference line to the construction machine is smaller than the second threshold value which is the same as or smaller than the first threshold value, the construction machine with respect to the traveling reference line. Outputs a control signal to make the traveling directions of
A control device for autonomous driving that is characterized by this.
建設機械を自律走行させる自律走行方法であって、
前記建設機械は、前輪および後輪を有するアーティキュレート機構を備え、
自律走行制御を行うための前記建設機械の基準点は、進行方向側の車輪の回転軸の中心位置または回転軸の中心位置を通る鉛直線上に設けられており、
前記建設機械の進行方向は、進行方向側の車輪の向きであり、
走行基準線から前記建設機械までの距離が予め決められた第1閾値よりも大きい場合に、前記走行基準線に近づくように当該建設機械の進行方向を修正し、
前記第1閾値と同じまたは当該第1閾値よりも小さい値である第2閾値よりも前記走行基準線から前記建設機械までの距離が小さくなった場合に、前記走行基準線に対して前記建設機械の進行方向を平行にする、
ことを特徴とする自律走行方法。
It is an autonomous driving method that makes construction machinery run autonomously.
The construction machine comprises an articulating mechanism having front and rear wheels.
The reference point of the construction machine for performing autonomous traveling control is provided on a vertical line passing through the center position of the rotation axis of the wheel on the traveling direction side or the center position of the rotation axis.
The traveling direction of the construction machine is the direction of the wheels on the traveling direction side.
When the distance from the traveling reference line to the construction machine is larger than the predetermined first threshold value, the traveling direction of the construction machine is corrected so as to approach the traveling reference line.
When the distance from the traveling reference line to the construction machine is smaller than the second threshold value which is the same as or smaller than the first threshold value, the construction machine with respect to the traveling reference line. Make the direction of travel parallel,
An autonomous driving method characterized by that.
JP2016094812A 2016-05-10 2016-05-10 Control device for autonomous driving and autonomous driving method Active JP6751588B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016094812A JP6751588B2 (en) 2016-05-10 2016-05-10 Control device for autonomous driving and autonomous driving method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016094812A JP6751588B2 (en) 2016-05-10 2016-05-10 Control device for autonomous driving and autonomous driving method

Publications (2)

Publication Number Publication Date
JP2017204089A JP2017204089A (en) 2017-11-16
JP6751588B2 true JP6751588B2 (en) 2020-09-09

Family

ID=60322962

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016094812A Active JP6751588B2 (en) 2016-05-10 2016-05-10 Control device for autonomous driving and autonomous driving method

Country Status (1)

Country Link
JP (1) JP6751588B2 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7227863B2 (en) * 2019-07-09 2023-02-22 前田建設工業株式会社 Compaction quality control system and compaction quality control method by automatic operation of vibrating rollers
CN110377041B (en) * 2019-08-08 2022-03-29 腾讯科技(深圳)有限公司 Reference line generation method and device, terminal equipment and storage medium
JP7554718B2 (en) 2021-07-16 2024-09-20 大成建設株式会社 Autonomous Driving System
JP2023141474A (en) 2022-03-24 2023-10-05 日立建機株式会社 Articulate type vehicle

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001067126A (en) * 1999-08-31 2001-03-16 Fujita Corp Traveling construction machine

Also Published As

Publication number Publication date
JP2017204089A (en) 2017-11-16

Similar Documents

Publication Publication Date Title
US9594376B2 (en) Method and system for driving a mining and/or construction machine in a safe manner without the risk of collision
JP6751588B2 (en) Control device for autonomous driving and autonomous driving method
JP6280850B2 (en) Obstacle avoidance system
CN100400360C (en) Automated continuous hauling system and method
JP2016126625A (en) Unmanned construction method and autonomous running control device
CN101713999B (en) Navigation control method of underground autonomous scraper
Alshaer et al. Path planning, modeling and simulation of an autonomous articulated heavy construction machine performing a loading cycle
CN211312127U (en) Self-propelled construction machine
KR20140130054A (en) Automated guided vehicle, system with a computer and an automated guided vehicle, method for planning a virtual track and method for operating an automated guided vehicle
CA2875313C (en) Method and system for manoeuvring a mobile mining machine in a tunnel and a mobile mining machine.
Mäkelä Overview of LHD navigation without artificial beacons
US10994775B2 (en) System and method for controlling dollies
JP2018168588A (en) Machine learning device for construction machinery, construction machinery, and machine learning method for construction machinery
CN104360687A (en) Multi-mode autonomous driving control method for underground carry scraper
US11702817B2 (en) System and method for changing orientation of machines
US11746653B2 (en) Mining system

Legal Events

Date Code Title Description
A80 Written request to apply exceptions to lack of novelty of invention

Free format text: JAPANESE INTERMEDIATE CODE: A80

Effective date: 20160524

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190319

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200303

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200228

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200427

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200817

R150 Certificate of patent or registration of utility model

Ref document number: 6751588

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150