Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP5827974B2 - Positioning control device for moving machine and positioning method for moving machine - Google Patents
[go: Go Back, main page]

JP5827974B2 - Positioning control device for moving machine and positioning method for moving machine - Google Patents

Positioning control device for moving machine and positioning method for moving machine Download PDF

Info

Publication number
JP5827974B2
JP5827974B2 JP2013100571A JP2013100571A JP5827974B2 JP 5827974 B2 JP5827974 B2 JP 5827974B2 JP 2013100571 A JP2013100571 A JP 2013100571A JP 2013100571 A JP2013100571 A JP 2013100571A JP 5827974 B2 JP5827974 B2 JP 5827974B2
Authority
JP
Japan
Prior art keywords
mobile machine
machine
information signal
signal
positioning control
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
JP2013100571A
Other languages
Japanese (ja)
Other versions
JP2014219935A (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.)
Nippon Steel Corp
Sumitomo Heavy Industries Process Equipment Co Ltd
Original Assignee
Nippon Steel and Sumitomo Metal Corp
Sumitomo Heavy Industries Process Equipment Co Ltd
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 Nippon Steel and Sumitomo Metal Corp, Sumitomo Heavy Industries Process Equipment Co Ltd filed Critical Nippon Steel and Sumitomo Metal Corp
Priority to JP2013100571A priority Critical patent/JP5827974B2/en
Publication of JP2014219935A publication Critical patent/JP2014219935A/en
Application granted granted Critical
Publication of JP5827974B2 publication Critical patent/JP5827974B2/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)
  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)

Description

本発明は、コークス炉において複数の窯に沿って設けられるレール上を走行する移動機械の位置決め制御装置及び移動機械の位置決め方法に関する。   The present invention relates to a positioning control device for a moving machine that travels on rails provided along a plurality of kilns in a coke oven, and a positioning method for the moving machine.

コークス炉には、隣接する燃焼室からの熱により石炭を乾留してコークス化する炭化室と、燃料ガスの燃焼により隣接する炭化室に熱を供給する燃焼室とが、交互に多数配列されている。そして、コークス炉では、炭化室に原料を装入する装入車、コークスを押し出す押出機、押し出されたコークスを受け取るガイド車、あるいはガイド車から払い出されたコークスを消火する消火車などのいわゆる移動機械が用いられている。移動機械は、これらの複数の窯に沿って延びるレール上において、目標停止位置に向けて移動し、その位置で停止後、所定の作業(コークスの押し出し等)を行い、次の目標停止位置に向けて再び移動する。   In a coke oven, a large number of alternating carbonization chambers that coke the coal by heat from adjacent combustion chambers and combustion chambers that supply heat to adjacent carbonization chambers by combustion of fuel gas are arranged. Yes. In the coke oven, a so-called fire car that charges the coke discharged from the guide car, an extruder that extrudes the coke, a guide car that receives the extruded coke, or a charge car that charges the coke is used. A moving machine is used. The moving machine moves toward the target stop position on the rails extending along the plurality of kilns, stops at that position, performs a predetermined work (coke extrusion, etc.), and moves to the next target stop position. Move again towards.

このため、移動機械を精度良く位置決めできる位置決め制御方法が必要とされている。従来提案されている移動機械の位置決め制御方法としては、例えば、特許文献1及び2に記載の方法が挙げられる。   For this reason, there is a need for a positioning control method that can accurately position the mobile machine. As a conventional positioning control method for a mobile machine, for example, methods described in Patent Documents 1 and 2 can be cited.

特許文献1には、コークス炉で使用される移動機の目標停止位置(窯芯)を、CCDラインセンサを用いた光学式の窯芯検出装置で検出し、移動機の位置を移動機の遊輪に設けられたパルスジェネレータで検出し、この目標停止位置に移動機を停止させる方法が開示されている。   In Patent Document 1, a target stop position (kiln core) of a mobile device used in a coke oven is detected by an optical kiln core detecting device using a CCD line sensor, and the position of the mobile device is a free wheel of the mobile device. A method is disclosed in which the mobile device is detected at the target stop position by detecting with a pulse generator provided in the system.

特許文献2には、コークス炉で使用される移動機械の移動方向に沿って布設した誘導無線線路から得た絶対位置データと、移動機械の従動輪に取り付けられたシンクロ発信器から得た相対位置データとを組み合わせて移動機械の現在位置を検出し、目標停止位置に移動機械を停止させる方法が開示されている。   Patent Document 2 discloses absolute position data obtained from an induction radio line laid along a moving direction of a mobile machine used in a coke oven, and a relative position obtained from a synchro oscillator attached to a driven wheel of the mobile machine. A method of detecting a current position of a mobile machine in combination with data and stopping the mobile machine at a target stop position is disclosed.

しかしながら、特許文献1の方法では、光学式のためコークス炉の粉塵等で位置決めできないことがある。また、特許文献2に記載の方法では、最終位置決めがシンクロ発信器によるため、移動機械の遊輪又は従動輪がスリップすることが原因で、移動機械の位置がずれて検出されることがある。そのため、これらの方法によれば、移動機械の位置を高精度に検出することができなかった。   However, in the method of Patent Document 1, since it is optical, positioning may not be possible with dust in a coke oven or the like. Further, in the method described in Patent Document 2, since the final positioning is performed by the synchro-transmitter, the position of the mobile machine may be detected as being shifted due to slippage of the idler wheel or the driven wheel of the mobile machine. Therefore, according to these methods, the position of the mobile machine cannot be detected with high accuracy.

特開平 7− 63514号公報JP 7-63514 A 特開平 9− 13040号公報Japanese Patent Laid-Open No. 9-13040

本発明は、かかる問題を鑑みてなされたもので、移動機械を高精度に位置決めすることができる移動機械の位置決め制御装置及び移動機械の位置決め方法を提供するものである。   The present invention has been made in view of such a problem, and provides a positioning control device for a moving machine and a positioning method for the moving machine that can position the moving machine with high accuracy.

本発明に係る移動機械の位置決め制御装置は、複数の窯に沿って設けられるレール上を走行する移動機械の位置決め制御装置であって、移動機械と複数の窯とが離接する離接方向であって、移動機械の走行方向と直交する離接方向における距離が一定のときの、走行方向上の特定の位置から走行方向に離れた位置に関する位置情報信号を出力する位置センサによって移動機械の走行方向上の位置を検出する位置検出部と、該位置検出部の結果を用いて移動機械を走行方向上の目的の位置に停止させるための停止指令を出力する停止指令部とを備え、位置検出部は、位置センサから出力される位置情報信号に基づき離接方向における移動機械のずれ量を算出し、算出されたその離接方向における移動機械のずれ量に応じて位置情報信号を補正する信号補正部を備えることを特徴とする。   A positioning control device for a mobile machine according to the present invention is a positioning control device for a mobile machine that travels on rails provided along a plurality of kilns, and is in a connecting / disconnecting direction in which the moving machine and the plurality of kilns are connected / disconnected. The traveling direction of the mobile machine is determined by a position sensor that outputs a position information signal regarding a position away from a specific position in the traveling direction when the distance in the separation direction perpendicular to the traveling direction of the mobile machine is constant. A position detection unit that detects the upper position, and a stop command unit that outputs a stop command for stopping the mobile machine at a target position in the traveling direction using the result of the position detection unit, Calculates the amount of displacement of the mobile machine in the separation / contact direction based on the position information signal output from the position sensor, and corrects the position information signal according to the calculated amount of displacement of the mobile machine in the separation / contact direction. Characterized in that it comprises a signal correction unit.

かかる構成によれば、信号補正部は、位置情報信号に基づき離接方向における移動機械のずれ量を算出する。そして、信号補正部は、その移動機械のずれ量に応じて位置情報信号を補正する。停止指令部は、この結果を用いて移動機械に停止指令を出力する。そのため、位置検出部は、離接方向における移動機械のずれに対応しつつ走行方向の位置を検出しているため、移動機械を高精度に位置決めする。   According to this configuration, the signal correction unit calculates the amount of displacement of the moving machine in the separation / contact direction based on the position information signal. Then, the signal correction unit corrects the position information signal according to the shift amount of the mobile machine. The stop command unit outputs a stop command to the mobile machine using this result. Therefore, the position detection unit detects the position in the traveling direction while corresponding to the displacement of the moving machine in the separation / contact direction, and thus positions the moving machine with high accuracy.

また、本実施形態に係る移動機械の位置決め制御装置の他態様として、位置センサは、移動機械の位置を絶対位置で検出する第1の位置センサと、移動機械の位置を特定の位置との相対位置で検出する第2の位置センサと、を備え、移動機械の位置を演算する位置情報信号を、第1の位置センサから出力される位置情報信号から第2の位置センサから出力される位置情報信号に切り替える信号切替部を備えていることが好ましい。   As another aspect of the positioning control apparatus for a mobile machine according to the present embodiment, the position sensor is a first position sensor that detects the position of the mobile machine as an absolute position, and the position of the mobile machine is relative to a specific position. A position information signal for calculating the position of the mobile machine, and a position information signal output from the second position sensor from a position information signal output from the first position sensor. It is preferable that a signal switching unit that switches to a signal is provided.

かかる構成によれば、第1の位置センサから出力される位置情報信号に基づいて目的の位置近傍まで移動機械を移動させた後の適切な時点で、信号切替部が第1の位置センサから出力される位置情報信号から第2の位置センサから出力される位置情報信号に切り替えて、高精度な位置決め制御に切り替える。つまり、移動機械を高精度に位置決めする必要があるときに限定して制御することにより、制御に係る処理能力に対する負担を低減することができる。   According to this configuration, the signal switching unit outputs the signal from the first position sensor at an appropriate time after moving the moving machine to the vicinity of the target position based on the position information signal output from the first position sensor. The position information signal that is output is switched to the position information signal that is output from the second position sensor, thereby switching to highly accurate positioning control. In other words, by controlling the mobile machine only when it is necessary to position the mobile machine with high accuracy, it is possible to reduce the burden on the processing capacity related to the control.

また、本実施形態に係る移動機械の位置決め制御装置の他態様として、位置センサは、移動機械の位置が特定の位置にあるときに離接方向の位置に関係なく特定の値の位置情報信号を出力するとともに、該特定の値を固定点として離接方向における移動機械のずれ量に応じた一定の傾きを有する位置情報信号を出力する構成を採用することができる。   As another aspect of the positioning control device for a mobile machine according to this embodiment, the position sensor outputs a position information signal having a specific value regardless of the position in the separation / contact direction when the position of the mobile machine is at a specific position. In addition to outputting, it is possible to adopt a configuration in which the specific value is used as a fixed point and a position information signal having a certain inclination according to the amount of displacement of the moving machine in the separation / contact direction is output.

かかる構成によれば、信号補正部は、位置センサから得た位置情報信号を基にその位置情報信号の変化の傾きを利用して、離接方向における移動機械の位置を算出する。   According to such a configuration, the signal correction unit calculates the position of the mobile machine in the separation / contact direction using the inclination of the change in the position information signal based on the position information signal obtained from the position sensor.

また、本実施形態に係る移動機械の位置決め制御装置の他態様として、信号補正部は、移動機械を定速で移動させているときに第2の位置センサから出力される位置情報信号に基づく移動機械のずれ量を算出することが好ましい。   As another aspect of the positioning control device for a mobile machine according to the present embodiment, the signal correction unit moves based on the position information signal output from the second position sensor when the mobile machine is moved at a constant speed. It is preferable to calculate the amount of deviation of the machine.

かかる構成によれば、第2の位置センサから出力される位置情報信号の、目的の位置との相対的な距離に応じた変化の度合い(傾向)が一定となり、移動機械の位置決め制御が容易になる。   According to such a configuration, the degree of change (trend) of the position information signal output from the second position sensor according to the relative distance from the target position is constant, and positioning control of the mobile machine is easy. Become.

本発明に係る移動機械の位置決め方法は、前記移動機械の位置決め制御装置を用いて移動機械を制御する方法であって、位置検出部の結果に基づいて移動機械を走行方向上の目的の位置に停止させることを特徴とする。   A positioning method of a mobile machine according to the present invention is a method of controlling a mobile machine using the mobile machine positioning control device, wherein the mobile machine is brought to a target position in the traveling direction based on a result of a position detection unit. It is characterized by being stopped.

かかる構成によれば、信号補正部は、位置情報信号に基づき離接方向における移動機械のずれ量を算出する。そして、信号補正部は、その移動機械のずれ量に応じて位置情報信号を補正する。停止指令部は、この結果を用いて移動機械に停止指令を出力する。そのため、位置検出部は、離接方向における移動機械のずれに対応しつつ走行方向の位置を検出しているため、移動機械を高精度に位置決めする。   According to this configuration, the signal correction unit calculates the amount of displacement of the moving machine in the separation / contact direction based on the position information signal. Then, the signal correction unit corrects the position information signal according to the shift amount of the mobile machine. The stop command unit outputs a stop command to the mobile machine using this result. Therefore, the position detection unit detects the position in the traveling direction while corresponding to the displacement of the moving machine in the separation / contact direction, and thus positions the moving machine with high accuracy.

以上の如く、本発明によれば、移動機械を高精度に位置決めすることができる。   As described above, according to the present invention, the mobile machine can be positioned with high accuracy.

本実施形態に係る移動機械の位置決め制御装置のブロック図を示す。The block diagram of the positioning control apparatus of the moving machine which concerns on this embodiment is shown. 移動機械の位置と速度との関係を表した図を示す。The figure showing the relationship between the position and speed of a mobile machine is shown. 移動機械と近接スイッチとの位置関係を表した図を示す。The figure showing the positional relationship of a mobile machine and a proximity switch is shown. 近接スイッチの出力波形図を示す。The output waveform figure of a proximity switch is shown. 図4のA部拡大波形図を示す。The A section enlarged waveform figure of FIG. 4 is shown. 位置情報信号の補正方法の説明図を示す。An explanatory view of a correction method of a position information signal is shown. 同位置制御装置のフローチャートを示す。The flowchart of the same position control apparatus is shown. 同位置制御装置のフローチャートを示す。The flowchart of the same position control apparatus is shown. 他の実施形態に係る移動機械の位置決め制御装置のブロック図を示す。The block diagram of the positioning control apparatus of the moving machine which concerns on other embodiment is shown.

以下、本発明に係る移動機械の位置決め制御装置の一実施形態について、図面を参照しつつ説明する。   Hereinafter, an embodiment of a positioning control apparatus for a mobile machine according to the present invention will be described with reference to the drawings.

まず、本実施形態に係る移動機械の位置決め制御装置の構成について、図1〜図6を参照して説明する。本発明に係る移動機械の位置決め制御装置1は、複数の窯に沿って設けられるレール上を走行する移動機械の位置を制御する。   First, the configuration of the positioning control device for a mobile machine according to the present embodiment will be described with reference to FIGS. The positioning control device 1 for a mobile machine according to the present invention controls the position of a mobile machine that travels on rails provided along a plurality of kilns.

位置決め制御装置1は、移動機械を走行させて、窯のそれぞれに対して決められたレール上の所定の目標停止位置で停止させる。本実施形態における目標停止位置は、窯芯位置P0として説明する。具体的には、図2に示すように、移動機械は、隣り合う窯間を高速V1で移動する。窯芯位置P0近くの位置P1に近づくと、移動機械は、制動可能な速度V2[m/sec]まで減速する(以下、この位置P1を「減速開始位置」と呼ぶ)。このときの速度V2は、約3[m/sec]で一定とする。そして、移動機械は、その窯芯位置P0から制動距離Daの手前の位置P3まで定速で移動し、該位置P3で停止指令を受け、制動を開始する(以下、この位置P3を「停止指令位置」と呼ぶ)。移動機械の駆動部3では、その停止指令位置P3で移動機械の車輪を駆動する電動機4にブレーキをかける。このため、位置決め制御装置1は、この停止指令位置P3を検出して、駆動部3にその旨の情報を送信するよう構成されている。   The positioning control device 1 travels the moving machine and stops it at a predetermined target stop position on the rail determined for each of the kilns. The target stop position in the present embodiment will be described as the kiln core position P0. Specifically, as shown in FIG. 2, the moving machine moves between adjacent kilns at a high speed V1. When approaching a position P1 near the kiln core position P0, the mobile machine decelerates to a brakeable speed V2 [m / sec] (hereinafter, this position P1 is referred to as a “deceleration start position”). The speed V2 at this time is constant at about 3 [m / sec]. The moving machine moves at a constant speed from the kiln core position P0 to a position P3 before the braking distance Da, receives a stop command at the position P3, and starts braking (hereinafter, this position P3 is referred to as a “stop command”). Called "position"). The drive unit 3 of the mobile machine brakes the electric motor 4 that drives the wheels of the mobile machine at the stop command position P3. For this reason, the positioning control device 1 is configured to detect the stop command position P3 and transmit information to that effect to the drive unit 3.

位置決め制御装置1で用いる位置センサ2は、図1に示すように、移動機械の位置を絶対位置で検出するエンコーダ21(本発明の「第1の位置センサ」に相当)と、特定の位置との相対位置で検出する近接センサ22(本発明の「第2の位置センサ」に相当)とを備える。   As shown in FIG. 1, the position sensor 2 used in the positioning control device 1 includes an encoder 21 (corresponding to the “first position sensor” of the present invention) that detects the position of the moving machine as an absolute position, a specific position, And a proximity sensor 22 (corresponding to the “second position sensor” of the present invention).

エンコーダ21は、移動機械の車輪の回転量をカウントすることにより移動機械の位置を絶対位置で検出することができるアブソリュート方式のロータリエンコーダである。エンコーダ21は、走行方向における移動機械のおおよその走行位置を検出する。   The encoder 21 is an absolute rotary encoder that can detect the position of the moving machine as an absolute position by counting the amount of rotation of the wheel of the moving machine. The encoder 21 detects the approximate traveling position of the mobile machine in the traveling direction.

近接センサ22は、図3に示すように、非接触センサの一種であり、磁界を発生させる複数の発信器23,…と、該発信器23,…が発生させる磁界を検出する磁気抵抗素子を2つ内蔵した受信器24とを備える。近接センサ22は、移動機械の走行方向と直交し複数の窯と離接する離接方向における距離が一定のときの、走行方向上の特定の位置P0から走行方向に離れた位置に関する位置情報信号を出力する。この位置情報信号は、走行方向上における特定の位置P0との相対的な位置関係を示している。本実施形態では、この特定の位置を窯芯位置P0となるように発信器23を設置しており、受信器24は、この発信器23との位置関係により窯芯位置P0を検出する。   As shown in FIG. 3, the proximity sensor 22 is a kind of non-contact sensor, and includes a plurality of transmitters 23 that generate a magnetic field, and a magnetoresistive element that detects a magnetic field generated by the transmitters 23. And two built-in receivers 24. The proximity sensor 22 outputs a position information signal regarding a position away from a specific position P0 in the traveling direction when the distance in the separating direction that is perpendicular to the traveling direction of the mobile machine and is separated from or contacting the plurality of kilns is constant. Output. This position information signal indicates a relative positional relationship with the specific position P0 in the traveling direction. In this embodiment, the transmitter 23 is installed so that this specific position becomes the kiln core position P0, and the receiver 24 detects the kiln core position P0 based on the positional relationship with the transmitter 23.

発信器23と受信器24は、レール上を走行する移動機械の車輪を境に移動機械側と窯側(地上側)とに跨って設置される。本実施形態では、発信器23が窯のそれぞれの窯芯上の位置P4に設置され、受信器24が移動機械側の移動機械上P5に設置される。   The transmitter 23 and the receiver 24 are installed across the mobile machine side and the kiln side (ground side) with the wheels of the mobile machine traveling on the rail as a boundary. In the present embodiment, the transmitter 23 is installed at a position P4 on each kiln core of the kiln, and the receiver 24 is installed on the mobile machine P5 on the mobile machine side.

近接センサ22は、窯芯位置P0から離接方向における移動機械の位置が一定ではなく、つまり、離接方向に移動機械がずれることによって走行方向の位置に対応して出力される位置情報信号が変わるように構成されている。この近接センサ22は、走行方向における窯芯位置(特定の位置)P0との離隔距離に応じた値の信号を出力する。また、近接センサ22は、その時間の推移とともに変化し、その変化は、一定の傾向を有している。特に、本実施形態に係る近接センサ22は、移動機械の位置が窯芯位置P0にあるときに離接方向の位置に関係なく特定の値の位置情報信号を出力するとともに、該特定の値を固定点として離接方向における移動機械の位置に応じた一定の傾きを有する位置情報信号を出力する。例えば、この近接センサ22は、EUROLASE製のVEROLINE(登録商標)などである。   The proximity sensor 22 has a position information signal output corresponding to the position in the traveling direction when the position of the moving machine in the separation / contact direction is not constant from the kiln core position P0, that is, the movement machine is displaced in the separation / contact direction. It is configured to change. The proximity sensor 22 outputs a signal having a value corresponding to the separation distance from the kiln core position (specific position) P0 in the traveling direction. The proximity sensor 22 changes with the passage of time, and the change has a certain tendency. In particular, the proximity sensor 22 according to the present embodiment outputs a position information signal having a specific value regardless of the position in the separation / contact direction when the position of the mobile machine is at the kiln core position P0, and the specific value is As a fixed point, a position information signal having a certain inclination according to the position of the moving machine in the separation / contact direction is output. For example, the proximity sensor 22 is VEROLINE (registered trademark) manufactured by EUROASE.

この近接センサ22の出力波形について、図3〜図5を参照しつつ詳細に説明する。この出力波形は、近接センサ22から出力される位置情報信号を時間推移的に分析した結果であり、移動機械を定速で走行させた際に得られる結果である。この出力波形は、近接センサ22から出力される位置情報信号の、窯芯位置P0との相対的な距離に応じた変化の度合い(傾向)を示すものである。   The output waveform of the proximity sensor 22 will be described in detail with reference to FIGS. This output waveform is a result obtained by analyzing the position information signal output from the proximity sensor 22 over time, and is a result obtained when the mobile machine is driven at a constant speed. This output waveform indicates the degree of change (trend) of the position information signal output from the proximity sensor 22 according to the relative distance from the kiln core position P0.

受信器24が窯芯L0上の窯芯位置P0に到達すると、特定の値(12mA)の位置情報信号を出力する(図4及び図5の相対距離0mm地点参照)。受信器24は、窯芯L0上であれば、常に同じ特定の値を出力するよう構成されている。   When the receiver 24 reaches the kiln core position P0 on the kiln core L0, a position information signal having a specific value (12 mA) is output (see the relative distance 0 mm point in FIGS. 4 and 5). The receiver 24 is configured to always output the same specific value as long as it is on the kiln core L0.

受信器24は、図4に示すように、窯芯L0を中心として走行方向(窯芯L0と直交する方向)の距離に比例して略正弦曲線状に変化する位置情報信号を出力する。つまり、この位置情報信号は、移動機械の走行方向における窯芯L0との相対距離を示している。発信器23に対して受信器24の位置が窯芯方向(離接方向と同じ)にずれて、発信器23と受信器24との窯芯方向の相対距離が変わると、この受信器24の出力波形は、その相対距離に対応して正弦波の振幅が変わる。なお、本実施形態では、発信器23と受信器24との窯芯方向における離間距離が90mmのときを基準とする(以下、この離間距離を「基準離間距離」と呼ぶ)。   As shown in FIG. 4, the receiver 24 outputs a position information signal that changes in a substantially sinusoidal shape in proportion to the distance in the traveling direction (direction orthogonal to the kiln core L0) with the kiln core L0 as the center. That is, this position information signal indicates a relative distance from the kiln core L0 in the traveling direction of the mobile machine. If the position of the receiver 24 with respect to the transmitter 23 is shifted in the kiln core direction (same as the separating / connecting direction) and the relative distance between the transmitter 23 and the receiver 24 in the kiln core direction is changed, In the output waveform, the amplitude of the sine wave changes corresponding to the relative distance. In the present embodiment, the distance between the transmitter 23 and the receiver 24 in the kiln core direction is 90 mm as a reference (hereinafter, this distance is referred to as “reference distance”).

特に、この受信器24の出力波形は、図5に示すように、原点近傍の出力区間(本実施形態では、−45mm〜+45mmの間)で略直線状に変化する一定の傾きを有する特徴を備える。なお、原点に相当する位置情報信号は、窯芯方向における位置(移動機械のずれ量)に関係なく、常に12mAである。   In particular, as shown in FIG. 5, the output waveform of the receiver 24 has a characteristic that it has a constant slope that changes substantially linearly in the output section near the origin (between -45 mm and +45 mm in this embodiment). Prepare. The position information signal corresponding to the origin is always 12 mA regardless of the position in the kiln core direction (shift amount of the moving machine).

位置決め制御装置1は、図1に示すように、位置センサ2からの位置情報信号を受信する受信部11と、該受信部11からの位置情報信号を基に位置センサ2の位置情報信号を切り替える信号切替部12と、位置センサ2によって移動機械の位置を検出する位置検出部13と、該位置検出部13を用いて移動機械を走行方向上の目的の位置に停止させるための停止指令を出力する停止指令部16と、位置検出部13で検出された移動機械の位置に関する情報を駆動部3に送信する送信部17とを備える。   As shown in FIG. 1, the positioning control device 1 switches the position information signal of the position sensor 2 based on the position information signal from the receiving section 11 that receives the position information signal from the position sensor 2 and the receiving section 11. A signal switching unit 12, a position detecting unit 13 for detecting the position of the moving machine by the position sensor 2, and a stop command for stopping the moving machine at a target position in the traveling direction using the position detecting unit 13 are output. And a transmission unit 17 that transmits information related to the position of the mobile machine detected by the position detection unit 13 to the drive unit 3.

受信部11は、エンコーダ21及び近接センサ22に接続し、これらから送信される位置情報信号を受信する入力インターフェースである。   The receiving unit 11 is an input interface that is connected to the encoder 21 and the proximity sensor 22 and receives position information signals transmitted therefrom.

信号切替部12は、エンコーダ21の位置情報信号で検出された移動機械の位置から、より高精度に移動機械の位置を検出すべき位置の場合、近接センサ22からの位置情報信号による移動機械の位置の検出に切り替えるために、位置検出部13に近接センサ22の位置情報信号を入力する。   In the case where the position of the mobile machine is to be detected with higher accuracy from the position of the mobile machine detected by the position information signal of the encoder 21, the signal switching unit 12 detects the position of the mobile machine based on the position information signal from the proximity sensor 22. In order to switch to position detection, a position information signal of the proximity sensor 22 is input to the position detection unit 13.

具体的には、信号切替部12は、図2に示すように、減速開始位置P1と停止指令位置P3との間の位置P2(以下、この位置P2を「信号切替位置」と呼ぶ)で移動機械の位置を演算する基となる位置情報信号をエンコーダ21の位置情報信号から近接センサ22の位置情報信号に切り替える。この信号切替位置P2は、位置情報信号が正弦波状に変化を開始する窯芯L0から約150mm位置であることが好ましく、また、正弦波状の最大点(若しくは最小点)である約110mm位置であることがさらに好ましく、図5に示すように、略直線状の傾きとなる約45mm位置であることが最も好ましい。なお、以下、本明細書では、エンコーダ21の位置情報信号を絶対位置信号と称し、近接センサ22の位置情報信号を相対位置信号と称する。   Specifically, as shown in FIG. 2, the signal switching unit 12 moves at a position P2 between the deceleration start position P1 and the stop command position P3 (hereinafter, this position P2 is referred to as a “signal switching position”). The position information signal that is a basis for calculating the position of the machine is switched from the position information signal of the encoder 21 to the position information signal of the proximity sensor 22. This signal switching position P2 is preferably a position about 150 mm from the furnace core L0 where the position information signal starts changing in a sine wave shape, and is a position of about 110 mm which is the maximum point (or the minimum point) of the sine wave shape. More preferably, as shown in FIG. 5, it is most preferable that the position is approximately 45 mm where the slope is substantially linear. Hereinafter, in this specification, the position information signal of the encoder 21 is referred to as an absolute position signal, and the position information signal of the proximity sensor 22 is referred to as a relative position signal.

位置検出部13は、図1に示すように、移動機械が離接方向におけるずれ量に応じて相対位置信号を補正する信号補正部14と、補正された相対位置信号に基づき移動機械の位置を演算する位置演算部15とを備える。位置検出部13は、演算処理を実施するCPUと、演算処理に必要なプログラム及び情報を記憶するメモリとを備える。   As shown in FIG. 1, the position detection unit 13 includes a signal correction unit 14 that corrects the relative position signal according to the amount of displacement in the separation / contact direction, and the position of the mobile machine based on the corrected relative position signal. And a position calculation unit 15 for calculation. The position detection unit 13 includes a CPU that performs arithmetic processing and a memory that stores programs and information necessary for the arithmetic processing.

信号補正部14は、図6に示すように、信号切替部12を介して近接センサ22から時間差Δtで入力された2点の相対位置信号の差分ΔOrと、2点の相対位置信号が入力された時間差Δt(図示しない)と、基準離間距離(=90mm)における時間差Δtで変化する相対位置信号の差分ΔOsとを演算する。差分ΔOrは、信号切替部12から相対位置信号を受信するたびにメモリに記憶しており、この2点の相対位置信号をメモリから読み出して、CPUで演算される。時間差Δtは、CPUに内蔵されたタイマによりに計測されている。差分ΔOsは、基準離間距離(=90mm)における出力波形(出力傾向)がメモリに記憶されており、このメモリから出力波形を読み出して、CPUで演算される。つまり、移動機械が定速で移動しており、移動量が窯芯方向のずれに関係なく一致するため(ΔDr=ΔDs)、時間差Δtで移動する移動量ΔDsを基準離間距離における基準の出力波形から演算し、移動量ΔDsから差分ΔOsを演算する。なお、基準離間距離(=90mm)における出力波形は、移動機械を定速で走行させたときに目標位置からの離間距離における出力電流の値を実測したものである。更に、他の離間距離(例えば、120mm、110mm、100mm、80mm、70mm、60mm、50mmなど)における出力波形もメモリに記憶しておき、これらの離隔距離に対応できるようにしてもよい。   As shown in FIG. 6, the signal correction unit 14 receives the difference ΔOr between the two relative position signals input from the proximity sensor 22 with the time difference Δt and the two relative position signals via the signal switching unit 12. And a relative position signal difference ΔOs that changes with the time difference Δt at the reference separation distance (= 90 mm). The difference ΔOr is stored in the memory every time a relative position signal is received from the signal switching unit 12, and the two relative position signals are read from the memory and calculated by the CPU. The time difference Δt is measured by a timer built in the CPU. As for the difference ΔOs, an output waveform (output tendency) at a reference separation distance (= 90 mm) is stored in the memory, and the output waveform is read from the memory and is calculated by the CPU. That is, since the moving machine is moving at a constant speed and the moving amount matches regardless of the deviation in the kiln core direction (ΔDr = ΔDs), the moving amount ΔDs moving with the time difference Δt is used as the reference output waveform at the reference separation distance. And the difference ΔOs is calculated from the movement amount ΔDs. The output waveform at the reference separation distance (= 90 mm) is obtained by actually measuring the value of the output current at the separation distance from the target position when the mobile machine is driven at a constant speed. Furthermore, output waveforms at other separation distances (for example, 120 mm, 110 mm, 100 mm, 80 mm, 70 mm, 60 mm, 50 mm, etc.) may also be stored in the memory so that these separation distances can be handled.

信号演算部15では、基準相対位置信号Isを基準に移動機械の位置を演算している。そのため、信号補正部14は、入力された相対位置信号Irを下記の数式で補正して、基準離間距離のときに対応する基準相対位置信号Isに演算する。なお、図6の出力波形Lrは、移動機械が窯芯方向にずれているときに出力された出力波形の一例である。

Figure 0005827974
The signal calculation unit 15 calculates the position of the moving machine based on the reference relative position signal Is. Therefore, the signal correction unit 14 corrects the input relative position signal Ir with the following mathematical formula, and calculates the reference relative position signal Is corresponding to the reference separation distance. The output waveform Lr in FIG. 6 is an example of an output waveform that is output when the mobile machine is displaced in the kiln core direction.
Figure 0005827974

位置演算部15は、メモリに記憶された基準の出力波形に基づき基準相対位置信号Isに対応する移動機械の位置を演算する。   The position calculation unit 15 calculates the position of the mobile machine corresponding to the reference relative position signal Is based on the reference output waveform stored in the memory.

停止指令部16は、移動機械を窯芯位置P0に停止させるためにその移動機械の制動距離手前の停止指令位置P3で制動を開始させる停止指令を駆動部3に送信する。停止指令部16は、位置演算部15に接続されており、該位置演算部15から入力される相対位置信号に基づき移動機械の位置を判断する。   The stop command unit 16 transmits to the drive unit 3 a stop command for starting braking at the stop command position P3 before the braking distance of the mobile machine in order to stop the mobile machine at the kiln core position P0. The stop command unit 16 is connected to the position calculation unit 15, and determines the position of the mobile machine based on the relative position signal input from the position calculation unit 15.

送信部17は、移動機械の位置に関する情報を駆動部3に送信する出力インターフェースである。   The transmission unit 17 is an output interface that transmits information related to the position of the mobile machine to the drive unit 3.

次に、本実施形態に係る移動機械の位置決め制御装置1による移動機械の位置決め制御方法について、図7及び図8を参照しつつ説明する。   Next, a mobile machine positioning control method by the mobile machine positioning control apparatus 1 according to the present embodiment will be described with reference to FIGS. 7 and 8.

まず、図7に示すように、位置決め制御装置1は、エンコーダ21と近接センサ22とのそれぞれから受信部11を介して信号切替部12に位置情報信号(絶対位置信号及び相対位置信号)を受信する(ステップS1,S2)。信号切替部12は、エンコーダ21の絶対位置信号に基づき移動機械の位置を検出する(ステップS3)。   First, as shown in FIG. 7, the positioning control device 1 receives position information signals (absolute position signal and relative position signal) from the encoder 21 and the proximity sensor 22 to the signal switching unit 12 via the receiving unit 11. (Steps S1, S2). The signal switching unit 12 detects the position of the mobile machine based on the absolute position signal of the encoder 21 (step S3).

その位置が減速開始位置P1に到達していないとき(ステップS4でNO)、信号切替部12は、エンコーダ21の絶対位置信号に基づく移動機械の位置を現在の移動機械の位置と認識して(ステップS5)、送信部17を介して駆動部3に送信する(ステップS6)。   When the position does not reach the deceleration start position P1 (NO in step S4), the signal switching unit 12 recognizes the position of the moving machine based on the absolute position signal of the encoder 21 as the current position of the moving machine ( In step S5), the signal is transmitted to the drive unit 3 via the transmission unit 17 (step S6).

エンコーダ21の絶対位置信号に基づく移動機械の位置が減速開始位置P1を超え信号切替位置P2に到達していないとき(ステップS4でYES,ステップS7でNO)、信号切替部12は、エンコーダ21の絶対位置信号に基づく移動機械の位置を現在の移動機械の位置と認識して(ステップS5)、送信部17を介して駆動部3に送信する(ステップS6)。さらに、信号切替部12は、位置検出部13に近接センサ22の相対位置信号を入力して、近接センサ22に基づく移動機械の位置の検出も開始する(ステップS8)。   When the position of the mobile machine based on the absolute position signal of the encoder 21 exceeds the deceleration start position P1 and has not reached the signal switching position P2 (YES in step S4, NO in step S7), the signal switching unit 12 The position of the mobile machine based on the absolute position signal is recognized as the current position of the mobile machine (step S5), and is transmitted to the drive unit 3 via the transmission unit 17 (step S6). Further, the signal switching unit 12 inputs the relative position signal of the proximity sensor 22 to the position detection unit 13 and starts detecting the position of the mobile machine based on the proximity sensor 22 (step S8).

エンコーダ21の絶対位置信号に基づく移動機械の位置が信号切替位置P2に到達しているとき(ステップS4でYES,ステップS7でYES)、図8に示すように、信号切替部12は、位置検出部13に近接センサ22の相対位置信号を入力して、近接センサ22に基づく移動機械の位置を検出する(ステップS9〜S12)。   When the position of the mobile machine based on the absolute position signal of the encoder 21 has reached the signal switching position P2 (YES in step S4, YES in step S7), as shown in FIG. The relative position signal of the proximity sensor 22 is input to the unit 13, and the position of the mobile machine based on the proximity sensor 22 is detected (steps S9 to S12).

具体的には、信号補正部14は、図6に示すように、信号切替部12を介して近接センサ22から時間差Δtで入力された2点の相対位置信号の差分ΔOrを演算する(ステップS9)。また、信号補正部14は、2点の相対位置信号が入力された時間差ΔtをCPUで計測するとともに、メモリに記憶された基準離間距離のときの受信器24の出力波形Lsに基づき、基準離間距離のときに、時間差Δtで変化する相対位置信号の差分ΔOsを演算する(ステップS10)。そして、信号補正部14は、入力された相対位置信号Irを下記の数式で補正して、基準離間距離のときの基準相対位置信号Isを演算する(ステップS11)。

Figure 0005827974
Specifically, as shown in FIG. 6, the signal correction unit 14 calculates a difference ΔOr between two relative position signals input from the proximity sensor 22 via the signal switching unit 12 with a time difference Δt (step S9). ). Further, the signal correction unit 14 measures the time difference Δt when the two relative position signals are input by the CPU, and based on the output waveform Ls of the receiver 24 at the reference separation distance stored in the memory, the reference separation At the distance, the difference ΔOs of the relative position signal that changes with the time difference Δt is calculated (step S10). Then, the signal correction unit 14 corrects the input relative position signal Ir with the following mathematical formula, and calculates the reference relative position signal Is at the reference separation distance (step S11).
Figure 0005827974

信号補正部14は、位置演算部15に基準相対位置信号Isを入力し、位置演算部15は、メモリに記憶された基準の出力波形Lsに基づき基準相対位置信号Isに対応する移動機械の位置を演算する(ステップS12)。   The signal correction unit 14 inputs the reference relative position signal Is to the position calculation unit 15, and the position calculation unit 15 positions the mobile machine corresponding to the reference relative position signal Is based on the reference output waveform Ls stored in the memory. Is calculated (step S12).

位置演算部15で演算された移動機械の位置は、送信部17によって駆動部3に送信され、電動機4を駆動する(ステップS13)。   The position of the mobile machine calculated by the position calculation unit 15 is transmitted to the drive unit 3 by the transmission unit 17 to drive the electric motor 4 (step S13).

一方、停止指令部16は、位置演算部15から演算された移動機械の位置(に関する情報)に基づき移動機械の位置が停止指令位置に到達したとき(ステップS14でYES)、送信部17を介して駆動部3に停止指令を送信する(ステップS15)。   On the other hand, when the position of the mobile machine has reached the stop command position based on the position (information regarding the mobile machine) calculated from the position calculation unit 15 (YES in step S14), the stop command unit 16 passes through the transmission unit 17. Then, a stop command is transmitted to the drive unit 3 (step S15).

このようにして、信号補正部14は、相対位置信号に基づき離接方向における移動機械のずれ量を考慮して相対位置信号の差分ΔOr及び差分ΔOsが算出される。それらの差分値に応じて相対位置信号を補正する。停止指令部14は、この結果を用いて移動機械に停止指令を出力する。移動機械は、レールの幅方向における車輪の位置がずれることが原因で、離接方向における移動機械のずれが生じることがある。しかし、位置検出部13は、離接方向における移動機械のずれに対応しつつ走行方向の位置を検出している。そのため、移動機械は、高精度に位置決めされる。
In this manner, the signal correction unit 14 calculates the difference ΔOr and the difference ΔOs of the relative position signal in consideration of the shift amount of the moving machine in the separation / contact direction based on the relative position signal. The relative position signal is corrected according to the difference value. The stop command unit 14 outputs a stop command to the mobile machine using this result. Moving machine, the position of the wheel in the width direction of the rail is displaced is caused, deviation of the mobile machine is Rukoto occur in disjunction direction. However, the position detector 13 detects the position in the traveling direction while corresponding to the displacement of the moving machine in the separation / contact direction. Therefore, the moving machine is positioned with high accuracy.

また、エンコーダ21から出力される絶対位置信号に基づいて目的の位置近傍まで移動機械を移動させた後の適切な時点で、信号切替部12が絶対位置信号から近接センサ22から出力される相対位置信号に切り替えて、高精度な位置決め制御に切り替える。つまり、移動機械を高精度に位置決めする必要があるときに限定して制御することにより、制御に係る処理能力に対する負担を低減することができる。また、エンコーダ21は、移動機械の絶対位置を検出することができるが、近接スイッチ22と比較して高精度な位置を検出することができない。一方、近接スイッチ22は、窯芯P0に対応して設定した位置との高精度な相対位置を検出することができるが、絶対位置を検出するものではない。そのため、信号切替部12は、これらの位置センサごとの利点を相互に補完して利用する機能を兼ねている。   Further, the relative position output from the proximity sensor 22 by the signal switching unit 12 at an appropriate time after the moving machine is moved to the vicinity of the target position based on the absolute position signal output from the encoder 21. Switch to signal and switch to high-accuracy positioning control. In other words, by controlling the mobile machine only when it is necessary to position the mobile machine with high accuracy, it is possible to reduce the burden on the processing capacity related to the control. The encoder 21 can detect the absolute position of the mobile machine, but cannot detect a position with higher accuracy than the proximity switch 22. On the other hand, the proximity switch 22 can detect a highly accurate relative position with the position set corresponding to the furnace core P0, but does not detect an absolute position. Therefore, the signal switching unit 12 also has a function of complementing and using the advantages of each position sensor.

また、移動機械を定速で移動させているときは、近接センサ22から出力される相対位置信号の、目的の位置との相対的な距離に応じた変化の度合い(傾向)が一定となり、移動機械の位置決め制御が容易になる。   Further, when the moving machine is moved at a constant speed, the degree of change (trend) of the relative position signal output from the proximity sensor 22 according to the relative distance from the target position becomes constant, and the movement Machine positioning control becomes easy.

なお、本発明に係る移動機械の位置決め制御装置は、上記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲で種々の変更を加えることができる。   The positioning control device for a mobile machine according to the present invention is not limited to the above embodiment, and various modifications can be made without departing from the gist of the present invention.

上記実施形態に係る移動機械の位置決め制御装置1は、信号補正部14が移動機械を目的の位置に停止させる(一連の)位置決め制御を学習する学習機能を備えていてもよい。つまり、信号補正部14は、移動機械が停止したことを検出する停止検出部14aと、離接方向における移動機械の基準位置での位置情報信号(の出力傾向)を記憶する基準位置情報記憶部14bと、移動機械が停止したことを停止検出部14aが検出し、移動機械離接方向におけるずれ量に応じて補正された第1の位置情報信号と、基準位置情報記憶部14bに記憶された第2の位置情報信号とが異なるときに、第1の位置情報信号と第2の位置情報信号との差分値を位置補正情報として演算する補正情報演算部14cと、該位置補正情報を記憶する補正情報記憶部14dと、該補正情報記憶部14に記憶された位置補正情報用いて離接方向における移動機械のずれ量を算出し、算出された移動機械のずれ量に応じて位置情報信号を補正する補正部14eとを備えるようにしてもよい。
The mobile machine positioning control device 1 according to the embodiment may include a learning function in which the signal correction unit 14 learns (a series of) positioning control for stopping the mobile machine at a target position. That is, the signal correction unit 14 is a stop detection unit 14a that detects that the mobile machine has stopped, and a reference position information storage unit that stores a position information signal (output tendency thereof) at the reference position of the mobile machine in the separation / contact direction. and 14b, stop detection unit 14a that the mobile machine has stopped is detected, the first position information signal corrected according to the deviation amount in the disjunction direction of the mobile machine, are stored in the reference position information storage unit 14b When the second position information signal is different from the second position information signal, a correction information calculation unit 14c that calculates a difference value between the first position information signal and the second position information signal as position correction information, and stores the position correction information. a correction information storage unit 14d which, using the position correction information stored in the correction information storage unit 14 d calculates the shift amount of the moving machine in disjunctive direction, the position in accordance with the shift amount of the moving machine that has been calculated Information signal You may make it provide the correction | amendment part 14e to correct | amend.

停止検出部14aは、位置センサ2から出力される位置情報信号に基づき移動機械が停止したことを検出する。位置情報信号は、近接スイッチ22から出力される相対位置情報であることが好ましいが、エンコーダ21や他の位置センサであってもよい。停止検出部14aは、移動機械が停止したときに、停止検出信号を出力する。基準位置とは、例えば、移動機械が離接する方向における位置が基準離間距離(=90mm)にあるときの位置である。また、位置補正情報は、具体的には、近接センサ22から時間差Δtで入力された2点の相対位置信号の差分ΔOrと、基準位置における時間差Δtで変化する相対位置信号の差分ΔOsのことであり、目的の位置を識別可能な情報と対応付けて、当該目的の位置ごとに対応付けて記憶されていてもよいし、このように区別せずに記憶されていてもよい。
Stop detection unit 14a detects that the mobile machine based on the position information signal outputted position sensor 2 whether we stopped. The position information signal is preferably relative position information output from the proximity switch 22, but may be an encoder 21 or another position sensor. The stop detection unit 14a outputs a stop detection signal when the mobile machine stops. The reference position is, for example, a position at which the position in the direction of the mobile machine is disjunctive is located at the reference distance (= 90 mm). Specifically, the position correction information is a difference ΔOr between two relative position signals input from the proximity sensor 22 with a time difference Δt and a difference ΔOs between relative position signals that changes with the time difference Δt at the reference position. Yes, the target position may be associated with the identifiable information and stored in association with each target position, or may be stored without being distinguished in this way.

このようにして、移動機械を繰り返し移動させる際に、基準位置における位置情報信号先に演算された位置補正情報により補正して学習させておくことにより、基準位置における位置情報信号が移動機械の現状の状態に適当な位置情報信号となり、その後の移動機械の位置決め制御より正確とすることができる。 In this manner, when the mobile machine is repeatedly moved, the position information signal at the reference position is corrected by the position correction information previously calculated and learned so that the position information signal at the reference position is becomes appropriate location information signal to the state of the state, it is possible to position control of the subsequent mobile machine and more precisely.

上記実施形態に係る移動機械の位置決め制御装置1は、位置センサ2の発信器23を窯側に設置し、受信器24を移動機械側に設置する例を説明したが、これに限定されるものではない。例えば、発信器23が移動機械側に設置され、受信器24が窯側に設置されてもよい。また、移動機械側に設置される発信器23又は受信器24の位置も移動機械上に限定されず、移動機械と同期して移動するところであればどこでもよい。地上側に設置される発信器23又は受信器24の位置も同様である。   In the mobile machine positioning control device 1 according to the above embodiment, the example in which the transmitter 23 of the position sensor 2 is installed on the kiln side and the receiver 24 is installed on the mobile machine side has been described, but the present invention is limited to this. is not. For example, the transmitter 23 may be installed on the mobile machine side, and the receiver 24 may be installed on the kiln side. Further, the position of the transmitter 23 or the receiver 24 installed on the mobile machine side is not limited to that on the mobile machine, and may be anywhere as long as it moves in synchronization with the mobile machine. The position of the transmitter 23 or the receiver 24 installed on the ground side is the same.

上記実施形態に係る移動機械の位置決め制御装置1は、移動機械を定速で走行しているときの位置を検出する例を説明したが、これに限定されるものではなく、移動機械を減速走行しているときの位置を検出するようにしてもよい。なお、このときは、位置センサから、一定の傾きを有する位置情報信号が出力されるのではなく、移動機械の走行速度が加味された変化率の位置情報信号が出力される。このため、信号補正部は、移動機械を定速走行させていたときのアルゴリズムを応用して減速走行させるときも位置情報信号を補正することにより、本発明の課題を達成することができる。   Although the example of detecting the position when the mobile machine positioning control device 1 according to the above embodiment travels at a constant speed has been described, the present invention is not limited to this, and the mobile machine travels at a reduced speed. You may make it detect the position when doing. At this time, a position information signal having a constant inclination is not output from the position sensor, but a position information signal having a change rate that takes into account the traveling speed of the mobile machine is output. Therefore, the signal correction unit can achieve the object of the present invention by correcting the position information signal even when the mobile machine is traveling at a reduced speed by applying an algorithm when the mobile machine is running at a constant speed.

1…位置決め制御装置、11…受信器、12…信号切替部、13…位置検出部、14…信号補正部、15…位置演算部、16…停止指令部、17…送信部、2…位置センサ、21…エンコーダ、22…近接センサ、23…発信器、24…受信器、3…駆動部、4…電動機、14a…停止検出部、14b…基準位置情報記憶部、14c…補正情報演算部、14d…補正情報記憶部、14e…補正部、L0…窯芯、P0…窯芯位置、P1…減速開始位置、P2…位置切替位置、P3…停止指令位置、Da…制動距離   DESCRIPTION OF SYMBOLS 1 ... Positioning control apparatus, 11 ... Receiver, 12 ... Signal switching part, 13 ... Position detection part, 14 ... Signal correction part, 15 ... Position calculating part, 16 ... Stop command part, 17 ... Transmission part, 2 ... Position sensor 21 ... Encoder, 22 ... Proximity sensor, 23 ... Transmitter, 24 ... Receiver, 3 ... Drive unit, 4 ... Electric motor, 14a ... Stop detection unit, 14b ... Reference position information storage unit, 14c ... Correction information calculation unit, 14d ... Correction information storage unit, 14e ... Correction unit, L0 ... Kiln core, P0 ... Kiln core position, P1 ... Deceleration start position, P2 ... Position switching position, P3 ... Stop command position, Da ... Braking distance

Claims (5)

複数の窯に沿って設けられるレール上を走行する移動機械の位置決め制御装置であって、
移動機械と複数の窯とが離接する離接方向であって、移動機械の走行方向と直交する離接方向における距離が一定のときの、走行方向上の特定の位置から走行方向に離れた位置に関する位置情報信号を出力する位置センサによって移動機械の走行方向上の位置を検出する位置検出部と、
該位置検出部の結果を用いて移動機械を走行方向上の目的の位置に停止させるための停止指令を出力する停止指令部とを備え、
位置検出部は、位置センサから出力される位置情報信号に基づき離接方向における移動機械のずれ量を算出し、算出されたその離接方向における移動機械のずれ量に応じて位置情報信号を補正する信号補正部を備えることを特徴とする移動機械の位置決め制御装置。
A positioning control device for a moving machine that runs on rails provided along a plurality of kilns,
Position where the moving machine and the plurality of kilns are separated from each other and when the distance in the separating direction perpendicular to the traveling direction of the moving machine is constant, the position away from a specific position in the traveling direction A position detection unit that detects a position in the traveling direction of the mobile machine by a position sensor that outputs a position information signal regarding;
A stop command unit that outputs a stop command for stopping the mobile machine at a target position in the traveling direction using the result of the position detection unit;
The position detector calculates the amount of displacement of the moving machine in the separation / contact direction based on the position information signal output from the position sensor, and corrects the position information signal according to the calculated amount of displacement of the moving machine in the separation / contact direction. A positioning control device for a mobile machine, comprising: a signal correction unit that performs the operation.
前記位置センサは、移動機械の位置を絶対位置で検出する第1の位置センサと、移動機械の位置を特定の位置との相対位置で検出する第2の位置センサと、を備え、
移動機械の位置を演算する位置情報信号を、第1の位置センサから出力される位置情報信号から第2の位置センサから出力される位置情報信号に切り替える信号切替部を備える請求項1に記載の移動機械の位置決め制御装置。
The position sensor includes a first position sensor that detects the position of the mobile machine as an absolute position, and a second position sensor that detects the position of the mobile machine as a relative position with respect to a specific position.
The signal switching part which switches the position information signal which calculates the position of a mobile machine from the position information signal output from a 1st position sensor to the position information signal output from a 2nd position sensor of Claim 1 is provided. Positioning control device for mobile machines.
前記第2の位置センサは、移動機械の位置が特定の位置にあるときに離接方向の位置に関係なく特定の値の位置情報信号を出力するとともに、該特定の値を固定点として離接方向における移動機械のずれ量に応じた一定の傾きを有する位置情報信号を出力する請求項2に記載の移動機械の位置決め制御装置。   The second position sensor outputs a position information signal having a specific value regardless of the position in the separation / contact direction when the position of the mobile machine is at a specific position, and uses the specific value as a fixed point for separation / contact. The positioning control device for a mobile machine according to claim 2, which outputs a position information signal having a constant inclination in accordance with a shift amount of the mobile machine in the direction. 前記信号補正部は、移動機械を定速で移動させているときに第2の位置センサから出力される位置情報信号に基づく移動機械のずれ量を算出する請求項2又は請求項3のいずれか1項に記載の移動機械の位置決め制御装置。   The said signal correction | amendment part calculates the deviation | shift amount of a moving machine based on the positional information signal output from a 2nd position sensor, while moving a moving machine at constant speed. 2. A positioning control device for a mobile machine according to item 1. 請求項1〜のいずれか1項に記載の移動機械の位置決め制御装置を用いて移動機械を制御する方法であって、
前記位置検出部の結果に基づいて移動機械を走行方向上の目的の位置に停止させることを特徴とする移動機械を制御する方法。
A method for controlling a mobile machine using the mobile machine positioning control device according to any one of claims 1 to 4 ,
A method of controlling a mobile machine, characterized in that the mobile machine is stopped at a target position in a traveling direction based on a result of the position detection unit.
JP2013100571A 2013-05-10 2013-05-10 Positioning control device for moving machine and positioning method for moving machine Active JP5827974B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013100571A JP5827974B2 (en) 2013-05-10 2013-05-10 Positioning control device for moving machine and positioning method for moving machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013100571A JP5827974B2 (en) 2013-05-10 2013-05-10 Positioning control device for moving machine and positioning method for moving machine

Publications (2)

Publication Number Publication Date
JP2014219935A JP2014219935A (en) 2014-11-20
JP5827974B2 true JP5827974B2 (en) 2015-12-02

Family

ID=51938295

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013100571A Active JP5827974B2 (en) 2013-05-10 2013-05-10 Positioning control device for moving machine and positioning method for moving machine

Country Status (1)

Country Link
JP (1) JP5827974B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2025042166A (en) * 2023-09-14 2025-03-27 住友重機械プロセス機器株式会社 Mobile device mobility control system and mobile device mobility control method

Also Published As

Publication number Publication date
JP2014219935A (en) 2014-11-20

Similar Documents

Publication Publication Date Title
KR101601735B1 (en) Moving body system and method for controlling travel of moving body
US7703396B2 (en) Carriage system
US20190079537A1 (en) Automatic guided vehicle
TWI395077B (en) Walking trolley and walking trolley system
CN102854878A (en) Infrared photoelectric guiding automatic guided vehicle (AGV) device and control method thereof
JP4438882B2 (en) Mobile system
KR20080050287A (en) Truck and its system
US20110153135A1 (en) Travel control device for unmanned conveyance vehicle
US9716459B2 (en) Mobile body, mobile body system, and position detecting method for mobile body
JP5827974B2 (en) Positioning control device for moving machine and positioning method for moving machine
CN103134454A (en) Method, device and system for detecting position of garbage compactor and pusher thereof
CN103365291B (en) Control unit and method for directing self-propelled device to charging stand
KR101218960B1 (en) The Compensation System Of Location Using Proximity Sensor
CN112180949B (en) Positioning rail alignment control method and device and transport vehicle positioning rail alignment system
JP5783410B2 (en) MOBILE SYSTEM AND MOBILE POSITION DETECTING METHOD
TWI697198B (en) Mobile body and mobile body system
US9768721B2 (en) Mobile body and mobile body system
JP2011038052A (en) Device and method for detecting position of coke oven mobile machines
KR101411854B1 (en) Apparatus for protecting crash of reclaimer and control method thereof
KR102470028B1 (en) Linear encoder system and ropeless elevator system using the same
JP5873242B2 (en) Straightness inspection method
JP5423704B2 (en) Spot guided vehicle
JP2005266937A (en) Goods transport equipment
JP2007191258A (en) Calcined ore conveying crane facility and positioning control method for calcined ore conveying crane facility
KR20190034945A (en) Operation synchronizing apparatus of tripper device and method thereof

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20141001

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20150702

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20150710

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20150831

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20151019

R150 Certificate of patent or registration of utility model

Ref document number: 5827974

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

S533 Written request for registration of change of name

Free format text: JAPANESE INTERMEDIATE CODE: R313533

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250