JP2006258728A - Measuring device of rotation angle - Google Patents

Measuring device of rotation angle Download PDF

Info

Publication number
JP2006258728A
JP2006258728A JP2005079660A JP2005079660A JP2006258728A JP 2006258728 A JP2006258728 A JP 2006258728A JP 2005079660 A JP2005079660 A JP 2005079660A JP 2005079660 A JP2005079660 A JP 2005079660A JP 2006258728 A JP2006258728 A JP 2006258728A
Authority
JP
Japan
Prior art keywords
rotation
value
detection signal
rotation angle
voltage value
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2005079660A
Other languages
Japanese (ja)
Other versions
JP4671405B2 (en
Inventor
Masahito Kageyama
雅人 影山
Hideji Hori
秀司 堀
Naoki Ishizaki
直樹 石崎
Nobuyuki Nagahashi
伸之 永橋
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.)
Komatsu Zenoah Co
Komatsu Ltd
Original Assignee
Komatsu Zenoah Co
Komatsu 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 Komatsu Zenoah Co, Komatsu Ltd filed Critical Komatsu Zenoah Co
Priority to JP2005079660A priority Critical patent/JP4671405B2/en
Publication of JP2006258728A publication Critical patent/JP2006258728A/en
Application granted granted Critical
Publication of JP4671405B2 publication Critical patent/JP4671405B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To accurately measure a rotation angle without an error by a certain and easy method even when waveform of individual rotation sensors is different. <P>SOLUTION: When a first detection signal 400A (voltage value VA) is inputted to a measurement controller 30 from the rotation sensor 100, correspondence relationship on the first detection signal 400A of the rotation sensor 100 is selected from a storage table 36, and rotation angles θA1 and θA2 corresponding to the present detection voltage value VA are read. Similarly, when a second detection signal 400B (voltage value VB) is inputted to the measurement controller 30 from the rotation sensor 100, correspondence relationship on the second detection signal 400B of the rotation sensor 100 is selected from the storage table 36, and rotation angles θB1 and θB2 corresponding to the present detection voltage value VB are read. Based on the first and second rotation angles, a stroke position of a hydraulic cylinder 200 is measured. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は、回転角度の計測装置に関するものである。   The present invention relates to a rotation angle measuring device.

後掲する特許文献1、2には、回転センサを磁力センサで構成し、回転に応じて変化する磁力を検出することで、回転角度を検出するという発明が記載されている。   Patent Documents 1 and 2 described later describe an invention in which a rotation angle is detected by configuring a rotation sensor as a magnetic sensor and detecting a magnetic force that changes according to the rotation.

特許文献1、2では、磁力センサから位相が異なる第1の検出信号と第2の検出信号とを出力させ、第1および第2の検出信号の波形を正弦波形とみなして、正弦波形の関数式を用いて、回転センサの出力電圧を回転角度を工学単位変換するようにしている。
特許第2977821号公報 特開2001−241942号公報
In Patent Documents 1 and 2, the first detection signal and the second detection signal having different phases are output from the magnetic sensor, the waveforms of the first and second detection signals are regarded as sine waveforms, and a function of the sine waveform is obtained. Using the equation, the rotation angle of the output voltage of the rotation sensor is converted into engineering units.
Japanese Patent No. 2977821 JP 2001-241942 A

回転センサを磁力センサで構成した場合には、回転角度の計測値に誤差が生じやすくなるという問題がある。また、建設機械のように、回転センサが取り付けられる計測対象(たとえば油圧シリンダ)が多数あるシステムに適用した場合には、個々の回転センサ毎に出力信号の波形が異なる、つまり同じ回転角度にあっても検出電圧値が各回転センサで異なる、という問題がある。   When the rotation sensor is constituted by a magnetic sensor, there is a problem that an error is likely to occur in the measured value of the rotation angle. In addition, when applied to a system having a large number of measurement objects (for example, hydraulic cylinders) to which rotation sensors are attached, such as construction machinery, the output signal waveform differs for each rotation sensor, that is, at the same rotation angle. However, there is a problem that the detected voltage value is different for each rotation sensor.

すなわち、磁力が検出媒体の場合、検出対象の磁石の精度や磁石の取付誤差等に起因して、回転センサの検出信号の波形にゆがみが生じやすい。また、これらゆがみは、個々の回転センサ毎に異なる。   That is, when the magnetic force is a detection medium, the waveform of the detection signal of the rotation sensor is likely to be distorted due to the accuracy of the magnet to be detected, the magnet mounting error, or the like. Moreover, these distortions differ for each rotation sensor.

ここで、仮に特許文献1、2にみられるように、個々の回転センサから出力される波形を一義的に正弦波とみなし、正弦波形の関数式を一律に用いて、回転センサの出力電圧を回転角度に工学単位変換したとしても、それによって計測される回転角度は、検出信号に波形のゆがみによって誤差を含むことになる。また、個々の回転センサ毎に検出信号の波形のゆがみが異なることから、回転角度の計測値がばらつくことになる。   Here, as seen in Patent Documents 1 and 2, the waveform output from each rotation sensor is regarded as a sine wave uniquely, and the output voltage of the rotation sensor is determined by uniformly using a functional expression of the sine waveform. Even if the engineering unit is converted into the rotation angle, the rotation angle measured thereby includes an error in the detection signal due to the distortion of the waveform. Further, since the distortion of the waveform of the detection signal is different for each rotation sensor, the measured value of the rotation angle varies.

本発明はこうした実状に鑑みてなされたものであり、磁力を検出媒体とする回転センサの検出信号に基づいて回転角度を計測する処理を行うに際して、確実かつ簡易な方法で、誤差なく高精度に回転角度を計測できるようにすることを解決課題とするものである。   The present invention has been made in view of such a situation, and when performing a process of measuring a rotation angle based on a detection signal of a rotation sensor using magnetic force as a detection medium, it is a reliable and simple method with high accuracy and no error. An object of the present invention is to make it possible to measure the rotation angle.

第1発明は、
磁力を検出媒体とする回転センサであって、回転角度に応じて検出物理量が周期的に変化し、位相が異なる第1および第2の検出信号を出力する回転センサと、
予め回転センサで検出される物理量と回転角度との対応関係が記憶され、
前記対応関係を参照して、第1および第2の検出信号に対応する第1および第2の回転角度を求め、第1の回転角度と第2の回転角度との差に基づいて、回転角度を計測する計測手段と
を備えたことを特徴とする。
The first invention is
A rotation sensor that uses magnetic force as a detection medium, the detection physical quantity periodically changing according to the rotation angle, and a rotation sensor that outputs first and second detection signals having different phases;
The correspondence between the physical quantity detected by the rotation sensor in advance and the rotation angle is stored,
Referring to the correspondence relationship, the first and second rotation angles corresponding to the first and second detection signals are obtained, and the rotation angle is determined based on the difference between the first rotation angle and the second rotation angle. And a measuring means for measuring.

第2発明は、第1発明において、
両回転角度の差が所定値以下になっている第1の回転角度と第2の回転角度を選択し、この選択された第1および第2の回転角度に基づいて回転角度を計測すること
を特徴とする。
The second invention is the first invention,
Selecting a first rotation angle and a second rotation angle at which the difference between the two rotation angles is equal to or less than a predetermined value, and measuring the rotation angle based on the selected first and second rotation angles. Features.

第3発明は、
第1の回転角度と第2の回転角度との差が所定値以下にならない場合には、回転センサが異常であると判断すること
を特徴とする。
The third invention is
When the difference between the first rotation angle and the second rotation angle does not become a predetermined value or less, the rotation sensor is determined to be abnormal.

第1発明を、図9(b)、図10(b)を参照して具体的に説明する。   The first invention will be specifically described with reference to FIGS. 9B and 10B.

第1発明によれば、計測用コントローラ30に、図10(b)に示すように、ブーム用油圧シリンダ200に設けられた回転センサ100から第1の検出信号400A(電圧値VA)が入力されると、記憶テーブル36から、図9(b)に示すように、ブームシリンダ200の回転センサ100の第1の検出信号400Aについての対応関係が選択され、現在の検出電圧値VAに対応する回転角度(以下、第1の回転角度)θA1、θA2が読み出される。同様に、計測用コントローラ30に、図10(b)に示すように、ブーム用油圧シリンダ200に設けられた回転センサ100から第2の検出信号400B(電圧値VB)が入力されると、記憶テーブル36から、図9(b)に示すように、ブームシリンダ200の回転センサ100の第2の検出信号400Bについての対応関係が選択され、現在の検出電圧値VBに対応する回転角度(以下、第2の回転角度)θB1、θB2が読み出される。そして、これら第1および第2の回転角度に基づいて、油圧シリンダ200のストローク位置が計測される。   According to the first invention, as shown in FIG. 10B, the first detection signal 400A (voltage value VA) is input to the measurement controller 30 from the rotation sensor 100 provided in the boom hydraulic cylinder 200. Then, as shown in FIG. 9B, the correspondence relationship with respect to the first detection signal 400A of the rotation sensor 100 of the boom cylinder 200 is selected from the storage table 36, and the rotation corresponding to the current detection voltage value VA. Angles (hereinafter referred to as first rotation angles) θA1 and θA2 are read out. Similarly, when the second detection signal 400B (voltage value VB) is input to the measurement controller 30 from the rotation sensor 100 provided in the boom hydraulic cylinder 200, as shown in FIG. As shown in FIG. 9B, the correspondence relationship for the second detection signal 400B of the rotation sensor 100 of the boom cylinder 200 is selected from the table 36, and the rotation angle corresponding to the current detection voltage value VB (hereinafter referred to as “the detection angle value”) Second rotation angle) θB1 and θB2 are read out. The stroke position of the hydraulic cylinder 200 is measured based on the first and second rotation angles.

このように個々の回転センサ100毎に、検出電圧値と回転角度との対応関係に基づいて回転角度を計測するようにしたので、個々の回転センサ100の波形が異なっていたとしても、確実かつ簡易な方法で、誤差なく高精度に回転角度を計測できる。   As described above, the rotation angle is measured for each rotation sensor 100 based on the correspondence relationship between the detected voltage value and the rotation angle. Therefore, even if the waveform of each rotation sensor 100 is different, The rotation angle can be measured with high accuracy and no error by a simple method.

以下、第2発明、第3発明を具体的に説明する。   The second invention and the third invention will be specifically described below.

第1発明で説明したように、図10(b)に示すように、第1の回転角度、第2の回転角度については、それぞれ2つの値θA1、θA2、θB1、θB2が求められる。   As described in the first invention, as shown in FIG. 10B, two values θA1, θA2, θB1, and θB2 are obtained for the first rotation angle and the second rotation angle, respectively.

そこで、第1の回転角度θA1、θA2と、第2の回転角度θB1、θB2との差、つまりθA1−θB1、θA2−θB2、θA1−θB2、θA2−θB1がそれぞれ算出される。そして、これらの第1および第2の回転角度の組合せの中で、両回転角度の差が最も小さい組合せ(θA2−θB1)が選択される。つぎに、その選択された第1および第2の回転角度の組合せの差(θA2−θB1)が所定値以下になっているか否か、つまり両回転角度差に異常はないかが判断される。   Therefore, differences between the first rotation angles θA1 and θA2 and the second rotation angles θB1 and θB2, that is, θA1−θB1, θA2−θB2, θA1−θB2, and θA2−θB1 are calculated. Then, among these combinations of the first and second rotation angles, the combination (θA2−θB1) having the smallest difference between the two rotation angles is selected. Next, it is determined whether or not the difference (θA2−θB1) between the selected combinations of the first and second rotation angles is equal to or less than a predetermined value, that is, whether or not there is an abnormality in both rotation angle differences.

両回転角度の差が所定値以下になっている場合には、その所定値以下となっている第1の回転角度(θA2)と第2の回転角度(θB1)に基づいて、ブーム用油圧シリンダ200のストローク位置が計測される。たとえば第1の回転角度(θA2)と第2の回転角度(θB1)の平均値を回転ローラ110の現在の回転角度として、ブーム用油圧シリンダ200のストローク位置が計測される(第2発明)。   When the difference between the two rotation angles is less than or equal to a predetermined value, the boom hydraulic cylinder is based on the first rotation angle (θA2) and the second rotation angle (θB1) that are less than or equal to the predetermined value. 200 stroke positions are measured. For example, the stroke position of the boom hydraulic cylinder 200 is measured using the average value of the first rotation angle (θA2) and the second rotation angle (θB1) as the current rotation angle of the rotation roller 110 (second invention).

一方、第1の回転角度と第2の回転角度との差が所定値以下にならない場合、つまり最も差の小さい両回転角度の組合せ(θA2−θB1)についても、その差が所定値以下にならない場合には、ブーム用油圧シリンダ200の回転センサ100で現在、異常が発生していると判断し、計測処理を中止する(第3発明)。   On the other hand, when the difference between the first rotation angle and the second rotation angle is not less than the predetermined value, that is, for the combination of both rotation angles with the smallest difference (θA2−θB1), the difference is not less than the predetermined value. In this case, the rotation sensor 100 of the boom hydraulic cylinder 200 determines that an abnormality is currently occurring, and stops the measurement process (third invention).

このため第2発明によれば、回転センサ100から出力される第1および第2の検出信号400A、400Bに基づいて、異常が発生していないときのみに確実に回転角度を計測することができ、計測結果の信頼性を向上させることができる。   Therefore, according to the second aspect of the invention, the rotation angle can be reliably measured only when no abnormality has occurred based on the first and second detection signals 400A and 400B output from the rotation sensor 100. The reliability of measurement results can be improved.

また、第3発明によれば、回転センサ100から出力される第1および第2の検出信号400A、400Bに基づいて、回転センサ100の異常を判断することができ、計測結果の信頼性を向上させることができる。   In addition, according to the third invention, the abnormality of the rotation sensor 100 can be determined based on the first and second detection signals 400A and 400B output from the rotation sensor 100, and the reliability of the measurement result is improved. Can be made.

本発明は、回転センサ100が油圧ショベルなどの建設機械に搭載され油圧シリンダのストローク量を検出する場合に限定されるわけではなく、回転センサ100が搭載される機械、検出対象は、任意である。   The present invention is not limited to the case where the rotation sensor 100 is mounted on a construction machine such as a hydraulic excavator and detects the stroke amount of the hydraulic cylinder. The machine on which the rotation sensor 100 is mounted and the detection target are arbitrary. .

以下、図面を参照して本発明に係る回転角度の計測装置の実施の形態について説明する。なお、以下の実施形態では、油圧作業機械における油圧シリンダのストローク位置を計測するために、回転角度を計測する場合を想定して説明する。   Embodiments of a rotation angle measuring device according to the present invention will be described below with reference to the drawings. In the following embodiments, a description will be given assuming that the rotation angle is measured in order to measure the stroke position of the hydraulic cylinder in the hydraulic working machine.

図1、図2は、実施形態の油圧作業機械の油圧回路を示している。なお、油圧作業機械は、たとえば油圧ショベルなどの建設機械を想定している。   1 and 2 show a hydraulic circuit of the hydraulic working machine according to the embodiment. The hydraulic working machine is assumed to be a construction machine such as a hydraulic excavator.

図1は、油圧式の操作レバー装置1から油圧信号Ppが、油圧シリンダ200用の制御弁2に供給されることによって、油圧シリンダ200が駆動される構成を示している。   FIG. 1 shows a configuration in which the hydraulic cylinder 200 is driven by supplying a hydraulic signal Pp from the hydraulic operation lever device 1 to the control valve 2 for the hydraulic cylinder 200.

図2は、電気式の操作レバー装置3から電気信号Stが、制御用コントローラ(メインコントローラ)20に入力され、制御用コントローラ20から制御電気信号iが、油圧シリンダ200用の制御弁4に供給されることによって、油圧シリンダ200が駆動される構成を示している。   In FIG. 2, an electric signal St is input from the electric operation lever device 3 to the control controller (main controller) 20, and a control electric signal i is supplied from the control controller 20 to the control valve 4 for the hydraulic cylinder 200. Thus, the configuration in which the hydraulic cylinder 200 is driven is shown.

まず、図1の構成について説明する。   First, the configuration of FIG. 1 will be described.

油圧ショベルには、ブーム、アーム、バケット等の複数の作業機が設けられており、これら複数の作業機は、対応する作業機用油圧シリンダ200が駆動されることにより、それぞれ作動される。なお、実際の油圧ショベルでは、各作業機毎に油圧シリンダ200が設けられるが、図1では説明の便宜上、1つの油圧シリンダ200を図示して他を省略している。   The hydraulic excavator is provided with a plurality of work machines such as a boom, an arm, and a bucket, and each of the plurality of work machines is operated by driving a corresponding work machine hydraulic cylinder 200. In an actual hydraulic excavator, a hydraulic cylinder 200 is provided for each work machine. However, in FIG. 1, for convenience of explanation, one hydraulic cylinder 200 is illustrated and others are omitted.

油圧シリンダ200は、たとえば可変容量型の油圧ポンプ5を駆動源として駆動される。油圧ポンプ5は、エンジン6によって駆動される。   The hydraulic cylinder 200 is driven using, for example, a variable displacement hydraulic pump 5 as a drive source. The hydraulic pump 5 is driven by the engine 6.

油圧ポンプ5の斜板5aは、サーボ機構7によって駆動される。サーボ機構7は、制御用コントローラ20から出力される制御信号(電気信号)に応じて作動して、油圧ポンプ5の斜板5aが制御信号に応じた位置に変化される。また、エンジン6のエンジン駆動機構8(ガバナ、噴射ポンプ、インジェクタ等)は、制御用コントローラ20から出力される制御信号(電気信号)に応じて作動して、エンジン6のシリンダ内に制御信号に応じた量の燃料が、制御信号に応じたタイミングで噴射されるとともに、制御信号に応じた回転数でエンジン6が回転する。   The swash plate 5 a of the hydraulic pump 5 is driven by the servo mechanism 7. The servo mechanism 7 operates in accordance with a control signal (electric signal) output from the control controller 20, and the swash plate 5a of the hydraulic pump 5 is changed to a position corresponding to the control signal. Further, the engine drive mechanism 8 (governor, injection pump, injector, etc.) of the engine 6 operates in accordance with a control signal (electric signal) output from the controller 20 for control, and generates a control signal in the cylinder of the engine 6. A corresponding amount of fuel is injected at a timing corresponding to the control signal, and the engine 6 rotates at a rotation speed corresponding to the control signal.

油圧ポンプ5の吐出口は、吐出油路9を介して、制御弁2の入口ポートに連通している。制御弁2の出口ポートは油路11、12を介して油圧シリンダ200の油室204B、204Hに連通している。   The discharge port of the hydraulic pump 5 communicates with the inlet port of the control valve 2 through the discharge oil passage 9. The outlet port of the control valve 2 communicates with the oil chambers 204B and 204H of the hydraulic cylinder 200 via the oil passages 11 and 12.

油圧ポンプ5から吐出された圧油は、吐出油路9を介して制御弁2に供給され、制御弁2を通過した圧油は、油路11または12を介して油圧シリンダ200の油室204Bまたは油室204Hに供給される。   The pressure oil discharged from the hydraulic pump 5 is supplied to the control valve 2 through the discharge oil passage 9, and the pressure oil that has passed through the control valve 2 passes through the oil passage 11 or 12 to the oil chamber 204B of the hydraulic cylinder 200. Or it is supplied to the oil chamber 204H.

操作レバー装置1は、たとえば運転室に設けられた操作レバー1aと、操作レバー1aの操作に応じて弁開度が変化される操作レバー用制御弁1bとからなる。操作レバー用制御弁1bの入口ポートは、油路13を介して、例えば定容量型の油圧ポンプ14の吐出口に連通している。油圧ポンプ14はエンジン6によって駆動される。油路13には、油路13内の圧油の圧力を蓄圧するアキュムレータ19が設けられている。油路13には、油路13内の圧力の圧力を検出する圧力センサ15が設けられている。圧力センサ15の検出信号は、計測用コントローラ30に入力される。   The operating lever device 1 includes, for example, an operating lever 1a provided in the cab and an operating lever control valve 1b whose valve opening is changed in accordance with the operation of the operating lever 1a. The inlet port of the control lever control valve 1b communicates with, for example, a discharge port of a constant displacement hydraulic pump 14 via an oil passage 13. The hydraulic pump 14 is driven by the engine 6. The oil passage 13 is provided with an accumulator 19 that accumulates the pressure of the pressure oil in the oil passage 13. The oil passage 13 is provided with a pressure sensor 15 that detects the pressure of the pressure in the oil passage 13. A detection signal of the pressure sensor 15 is input to the measurement controller 30.

操作レバー用制御弁1bの出口ポートは、パイロット油路16a、16bを介して制御弁2のパイロットポート2a、2bに連通している。   The outlet port of the control valve 1b for the operation lever communicates with the pilot ports 2a and 2b of the control valve 2 via the pilot oil passages 16a and 16b.

操作レバー1aが操作されると、操作レバー1aの操作量に応じて操作レバー用制御弁1bの弁開度が変化され、操作量に応じた圧力の油圧信号Ppが制御弁2のパイロットポート2aまたは2bに供給され、操作量に応じて制御弁2の開口面積が変化される。また、パイロット油路16a、16bのうち、操作レバー1aの操作方向に応じたパイロット油路にパイロット圧油が出力され、それに応じてパイロット圧油が制御弁2のパイロットポート2aまたは2bに供給され、操作レバー1aの操作方向に対応する方向に制御弁2の弁位置が変化される。   When the operation lever 1a is operated, the valve opening degree of the operation lever control valve 1b is changed according to the operation amount of the operation lever 1a, and the hydraulic signal Pp of the pressure corresponding to the operation amount is changed to the pilot port 2a of the control valve 2. Or it supplies to 2b and the opening area of the control valve 2 is changed according to the operation amount. In addition, pilot pressure oil is output to the pilot oil passage corresponding to the operation direction of the operation lever 1a among the pilot oil passages 16a and 16b, and the pilot pressure oil is supplied to the pilot port 2a or 2b of the control valve 2 accordingly. The valve position of the control valve 2 is changed in a direction corresponding to the operation direction of the operation lever 1a.

このため、操作レバー1aの操作量に応じた流量の圧油が、油路11、12のうち、操作レバー1aの操作方向に対応する油路に対して出力され、油路11または12を介して油圧シリンダ200の油室204Bまたは油室204Hに供給される。このため油圧シリンダ200は、操作レバー1aの操作に応じた方向、速度で駆動され、それに応じた方向、速度で、ブーム、アーム、バケット等が作動される。   For this reason, the pressure oil having a flow rate corresponding to the operation amount of the operation lever 1 a is output to the oil passage corresponding to the operation direction of the operation lever 1 a among the oil passages 11 and 12, and is passed through the oil passage 11 or 12. To the oil chamber 204B or the oil chamber 204H of the hydraulic cylinder 200. For this reason, the hydraulic cylinder 200 is driven at a direction and speed according to the operation of the operation lever 1a, and a boom, an arm, a bucket, and the like are operated at a direction and speed according to the operation.

バッテリ8(たとえば定格電圧24V)は、計測用コントローラ30、制御用コントローラ20を起動する電源である。   The battery 8 (for example, rated voltage 24V) is a power source that activates the measurement controller 30 and the control controller 20.

計測用コントローラ30のパワー端子31は、バッテリ8に電気的に接続されている。制御用コントローラ20のパワー端子21は、エンジンキースイッチ9を介してバッテリ8に電気的に接続されている。   A power terminal 31 of the measurement controller 30 is electrically connected to the battery 8. The power terminal 21 of the control controller 20 is electrically connected to the battery 8 via the engine key switch 9.

エンジンキースイッチ9が、オン操作されると、バッテリ8がエンジン6の始動用モータ(図示せず)に電気的に接続されてエンジン6が始動されるとともに、制御用コントローラ20のパワー端子21にバッテリ8が電気的に接続されて制御用コントローラ20が起動される。エンジンキースイッチ9が、オフ操作されると、制御用コントローラ20のパワー端子21とバッテリ8との電気的な接続が遮断されて、エンジン6が停止されるとともに、制御用コントローラ20が起動停止する。   When the engine key switch 9 is turned on, the battery 8 is electrically connected to a starter motor (not shown) of the engine 6 to start the engine 6 and to the power terminal 21 of the controller 20 for control. The battery 8 is electrically connected and the control controller 20 is activated. When the engine key switch 9 is turned off, the electrical connection between the power terminal 21 of the control controller 20 and the battery 8 is cut off, the engine 6 is stopped, and the control controller 20 is started and stopped. .

計測用コントローラ30の制御端子32には、エンジンキースイッチ9のスイッチ状態(オン、オフ)を示すスイッチ状態信号Kが入力される。   A switch state signal K indicating the switch state (on / off) of the engine key switch 9 is input to the control terminal 32 of the measurement controller 30.

計測用コントローラ30内には、主要電源回路33が設けられており、この主要電源回路33にパワー端子31からバッテリ8の電力が供給される。計測用コントローラ30内には、後述するように、ソフトウエアタイマ(内部プログラム)が格納されるか、内部電源回路(ハードタイマ)が組み込まれている。   A main power supply circuit 33 is provided in the measurement controller 30, and the power of the battery 8 is supplied from the power terminal 31 to the main power supply circuit 33. The measurement controller 30 stores a software timer (internal program) or an internal power supply circuit (hardware timer) as will be described later.

計測用コントローラ30の制御端子32に入力されるスイッチ状態信号Kがオンである場合には、主要電源回路33の駆動がオンされ、計測用コントローラ30が起動状態となる。スイッチ状態信号Kがオフになった場合には、上記タイマが作動し、タイマの設定時間経過後に、主要電源回路33の駆動がオフされ、計測用コントローラ30は起動停止状態となる。   When the switch state signal K input to the control terminal 32 of the measurement controller 30 is on, the drive of the main power supply circuit 33 is turned on and the measurement controller 30 is activated. When the switch state signal K is turned off, the timer is activated, and after the set time of the timer has elapsed, the drive of the main power supply circuit 33 is turned off, and the measurement controller 30 enters a start / stop state.

つぎに、図2の構成ついて説明する。図1と共通する構成については説明を省略する。   Next, the configuration of FIG. 2 will be described. The description of the configuration common to FIG. 1 is omitted.

操作レバー装置3は、たとえば運転室に設けられた操作レバー3aと、操作レバー3aの操作方向および操作量を示す操作信号Stを検出する検出部3bとからなる。検出部3bで検出された操作信号Stは、制御用コントローラ20に入力される。   The operation lever device 3 includes, for example, an operation lever 3a provided in a cab and a detection unit 3b that detects an operation signal St indicating an operation direction and an operation amount of the operation lever 3a. The operation signal St detected by the detection unit 3b is input to the controller 20 for control.

制御弁4の電磁ソレノイド4a、4bは電気信号線17を介して制御用コントローラ20に接続されている。   The electromagnetic solenoids 4 a and 4 b of the control valve 4 are connected to the control controller 20 via the electric signal line 17.

操作レバー3aが操作されると、操作レバー3aの操作信号Stが制御用コントローラ20に入力され、制御用コントローラ20で、操作レバー3aの操作方向、操作量に応じた方向、弁開度で制御弁4を作動させるための制御信号iが生成される。制御信号iは、制御用コントローラ20から電気信号線17を介して制御弁4の電磁ソレノイド4aまたは4bに供給され、操作レバー3aの操作方向に対応する方向に、操作レバー3aの操作量に対応する弁開度となるように、制御弁4の弁位置が変化される。   When the operation lever 3a is operated, the operation signal St of the operation lever 3a is input to the control controller 20, and the control controller 20 controls the operation direction of the operation lever 3a, the direction according to the operation amount, and the valve opening degree. A control signal i for operating the valve 4 is generated. The control signal i is supplied from the control controller 20 to the electromagnetic solenoid 4a or 4b of the control valve 4 via the electric signal line 17, and corresponds to the operation amount of the operation lever 3a in the direction corresponding to the operation direction of the operation lever 3a. The valve position of the control valve 4 is changed so that the opening degree of the valve is adjusted.

計測用コントローラ30のパワー端子31、制御用コントローラ20のパワー端子21は、バッテリ8に電気的に接続されている。   The power terminal 31 of the measurement controller 30 and the power terminal 21 of the control controller 20 are electrically connected to the battery 8.

制御用コントローラ20の制御端子22には、エンジンキースイッチ9のスイッチ状態(オン、オフ)を示すスイッチ状態信号Kが入力される。   A switch state signal K indicating the switch state (ON / OFF) of the engine key switch 9 is input to the control terminal 22 of the controller 20 for control.

制御用コントローラ20内には、主要電源回路23が設けられており、この主要電源回路23にパワー端子21からバッテリ8の電力が供給される。   A main power supply circuit 23 is provided in the control controller 20, and the power of the battery 8 is supplied from the power terminal 21 to the main power supply circuit 23.

計測用コントローラ30の制御端子32には、電気信号線18を介して、制御用コントローラ20から、後述する油圧シリンダ200の作動が可能な状態であるか否かの情報(レベル1、0)を示す信号Jが入力される。   The control terminal 32 of the measurement controller 30 receives information (levels 1 and 0) from the control controller 20 via the electric signal line 18 as to whether or not the hydraulic cylinder 200 described later is in an operable state. The signal J shown is input.

計測用コントローラ30内には、主要電源回路33が設けられており、この主要電源回路33にパワー端子31からバッテリ8の電力が供給される。   A main power supply circuit 33 is provided in the measurement controller 30, and the power of the battery 8 is supplied from the power terminal 31 to the main power supply circuit 33.

計測用コントローラ30の制御端子32に入力される情報信号Jのレベルは、後述するように、ソフトウエアによって監視されており、情報信号Jが「1レベル」である場合には、主要電源回路33の駆動がオンされ、計測用コントローラ30が起動状態となる。情報信号Jが「0レベル」になった場合には、主要電源回路33の駆動がオフされ、計測用コントローラ30は起動停止状態となる。   As will be described later, the level of the information signal J input to the control terminal 32 of the measurement controller 30 is monitored by software. When the information signal J is “1 level”, the main power supply circuit 33. Is turned on, and the measurement controller 30 is activated. When the information signal J becomes “0 level”, the driving of the main power supply circuit 33 is turned off, and the measurement controller 30 enters a start / stop state.

つぎに、図3を併せ参照して、油圧シリンダ200と計測用コントローラ30と制御用コントローラ20について説明する。   Next, the hydraulic cylinder 200, the measurement controller 30, and the control controller 20 will be described with reference to FIG.

同図3に示すように、ブーム、アーム、バケット毎に、油圧シリンダ200が設けられている。各油圧シリンダ200にはそれぞれ、油圧シリンダ200のストローク量を回転量として検出する回転センサ100と、油圧シリンダ200のストローク位置の原点位置を検出するリセットセンサ300が設けられている。   As shown in FIG. 3, a hydraulic cylinder 200 is provided for each boom, arm, and bucket. Each hydraulic cylinder 200 is provided with a rotation sensor 100 that detects the stroke amount of the hydraulic cylinder 200 as a rotation amount, and a reset sensor 300 that detects the origin position of the stroke position of the hydraulic cylinder 200.

回転センサ100、リセットセンサ300は、電気信号線(ハーネス)150、ジャンクションボックス42を介して、計測用コントローラ30の入力端子34に電気的に接続されている。   The rotation sensor 100 and the reset sensor 300 are electrically connected to the input terminal 34 of the measurement controller 30 via the electric signal line (harness) 150 and the junction box 42.

計測用コントローラ30は、A/D変換部35と、後述する記憶テーブル36と、CPU37を備えている。   The measurement controller 30 includes an A / D converter 35, a storage table 36, which will be described later, and a CPU 37.

回転センサ100、リセットセンサ300の検出信号は、電気信号線150、ジャンクションボックス42を介して、計測用コントローラ30の入力端子34に入力され、A/D変換部35でディジタル信号に変換されて、CPU37に入力される。CPU37では、後述するように記憶テーブル36を参照しつつ、回転センサ100、リセットセンサ300の検出信号に基づいて、油圧シリンダ200のストローク位置が計測される。   The detection signals of the rotation sensor 100 and the reset sensor 300 are input to the input terminal 34 of the measurement controller 30 via the electric signal line 150 and the junction box 42, converted into a digital signal by the A / D converter 35, Input to the CPU 37. The CPU 37 measures the stroke position of the hydraulic cylinder 200 based on detection signals from the rotation sensor 100 and the reset sensor 300 while referring to the storage table 36 as will be described later.

計測用コントローラ30の出力端子38と、制御用コントローラ20とは、シリアル通信が可能となるように信号線43によって接続されており、車体内ネットワークを構成している。信号線43には、所定のプロトコルのフレーム信号が伝送される。   The output terminal 38 of the measurement controller 30 and the control controller 20 are connected by a signal line 43 so as to enable serial communication, and constitute an in-vehicle network. A frame signal of a predetermined protocol is transmitted to the signal line 43.

計測用コントローラ30で計測された油圧シリンダ200のストローク位置のデータは、フレーム信号に記述され、出力端子38から信号線43を介して、制御用コントローラ20に伝送される。   The stroke position data of the hydraulic cylinder 200 measured by the measurement controller 30 is described in the frame signal and transmitted from the output terminal 38 to the control controller 20 via the signal line 43.

制御用コントローラ20には、油圧シリンダ20の計測ストローク位置のデータが取り込まれ、制御用コントローラ20は、取り込まれた油圧シリンダ20の計測ストローク位置のデータに基づいて制御信号を生成し、制御対象のアクチュエータ(油圧ポンプ5のサーボ機構7、エンジン6の駆動機構8、制御弁4の電磁ソレノイド4a、4b)に対して出力し、油圧ポンプ5、エンジン6、制御弁4を制御する。   The control controller 20 receives the data of the measured stroke position of the hydraulic cylinder 20, and the control controller 20 generates a control signal based on the acquired data of the measured stroke position of the hydraulic cylinder 20, and controls the control target. Output to the actuator (servo mechanism 7 of the hydraulic pump 5, drive mechanism 8 of the engine 6, electromagnetic solenoids 4a and 4b of the control valve 4), and controls the hydraulic pump 5, engine 6 and control valve 4.

なお、本実施例では、制御用コントローラ20を、1つのコントローラで図示しているが、油圧ポンプ5用、エンジン6用、制御弁4用の各コントローラに分割して設けてもよい。   In the present embodiment, the controller 20 for control is shown as a single controller, but it may be divided into controllers for the hydraulic pump 5, the engine 6, and the control valve 4.

つぎに、油圧シリンダ200に設けられた回転センサ100、リセットセンサ300について説明する。   Next, the rotation sensor 100 and the reset sensor 300 provided in the hydraulic cylinder 200 will be described.

図4(a)は、油圧シリンダ200と、回転センサ100と、リセットセンサとしての磁力センサ300の位置関係を、シリンダ200の縦断面図で示している。   FIG. 4A shows the positional relationship among the hydraulic cylinder 200, the rotation sensor 100, and the magnetic force sensor 300 as a reset sensor in a longitudinal sectional view of the cylinder 200. FIG.

図4(a)に示すように、油圧シリンダ200の壁であるシリンダチューブ250には、ピストン201が摺動自在に設けられている。ピストン201には、ロッド202が取り付けられている。ロッド202は、シリンダヘッド203に摺動自在に設けられている。シリンダヘッド203とピストン201とシリンダ内壁とによって画成された室が、シリンダヘッド側油室204Hを構成する。ピストン201を介してシリンダヘッド側油室204Hとは反対側の油室がシリンダボトム側油室204Bを構成している。   As shown in FIG. 4A, a piston 201 is slidably provided on a cylinder tube 250 that is a wall of the hydraulic cylinder 200. A rod 202 is attached to the piston 201. The rod 202 is slidably provided on the cylinder head 203. A chamber defined by the cylinder head 203, the piston 201, and the cylinder inner wall constitutes a cylinder head side oil chamber 204H. An oil chamber opposite to the cylinder head side oil chamber 204H via the piston 201 constitutes a cylinder bottom side oil chamber 204B.

シリンダヘッド203には、ロッド202との隙間を密封し、塵埃等のコンタミがシリンダヘッド側油室204Hに入り込まないようにするロッドシール205a、ダストシール205bが設けられている。   The cylinder head 203 is provided with a rod seal 205a and a dust seal 205b that seal a gap with the rod 202 and prevent contamination such as dust from entering the cylinder head side oil chamber 204H.

シリンダチューブ250には、油圧ポート206H、206Bが形成されている。油圧ポート206Hを介して、シリンダヘッド側油室204Hに圧油が供給され、若しくは同油室204Hから油圧ポート206Hを介して圧油が排出される。油圧ポート206Bを介して、シリンダボトム側油室204Bに圧油が供給され、若しくは同油室204Bから油圧ポート206Bを介して圧油が排出される。   The cylinder tube 250 is formed with hydraulic ports 206H and 206B. Pressure oil is supplied to the cylinder head side oil chamber 204H via the hydraulic port 206H, or pressure oil is discharged from the oil chamber 204H via the hydraulic port 206H. Pressure oil is supplied to the cylinder bottom side oil chamber 204B via the hydraulic port 206B, or pressure oil is discharged from the oil chamber 204B via the hydraulic port 206B.

シリンダヘッド側油室204Hに圧油が供給され、シリンダボトム側油室204Bから圧油が排出されることによって、ロッド202が縮退し、あるいは、シリンダヘッド側油室204Hから圧油が排出され、シリンダボトム側油室204Bに圧油が供給されることによって、ロッド202が伸張する。すなわち、ロッド202は図中左右方向に直動する。   When pressure oil is supplied to the cylinder head side oil chamber 204H and pressure oil is discharged from the cylinder bottom side oil chamber 204B, the rod 202 is degenerated, or pressure oil is discharged from the cylinder head side oil chamber 204H, By supplying pressure oil to the cylinder bottom side oil chamber 204B, the rod 202 extends. That is, the rod 202 moves linearly in the left-right direction in the figure.

シリンダヘッド側油室204Hの外部にあって、シリンダヘッド203に密接した場所には、回転センサ100を覆い、内部に収容するケース207が形成されている。ケース207は、シリンダヘッド203にボルト等によって締結等されて、シリンダヘッド203に固定されている。すなわち、ケース207(回転センサ100)は、シリンダチューブ250に簡易に取り付けたり、取り外すことができる。   A case 207 that covers the rotation sensor 100 and accommodates it inside is formed outside the cylinder head side oil chamber 204H and in close contact with the cylinder head 203. The case 207 is fixed to the cylinder head 203 by being fastened to the cylinder head 203 with a bolt or the like. That is, the case 207 (the rotation sensor 100) can be easily attached to or removed from the cylinder tube 250.

回転センサ100を構成する後述する回転ローラ110は、その表面がロッド202の表面に接触し、ロッド202の直動に応じて回転自在に設けられている。すなわち、回転ローラ110によって、ロッド202の直線運動が回転運動に変換される。   A rotation roller 110 (to be described later) constituting the rotation sensor 100 has a surface in contact with the surface of the rod 202 and is rotatably provided in accordance with the linear movement of the rod 202. That is, the rotating roller 110 converts the linear motion of the rod 202 into rotational motion.

回転ローラ110は、その回転中心軸110cが、ロッド202の直動方向に対して、直交(紙面の背後方向、看者方向)するように配置されている。ケース207には、ロッド202との隙間を密封し、塵埃等のコンタミが回転ローラ110とロッド202との間に入り込まないようにするダストシール208が設けられている。これにより回転ローラ110とロッド202との間に塵埃等が入り込んで、回転ローラ110が動作不良となるような事態を回避することができる。つまり、回転センサ100は、ケース207に設けられたダストシール208と、シリンダヘッド203に設けられたダストシール205bとによって防塵構造となっている。   The rotation roller 110 is arranged such that the rotation center shaft 110c is orthogonal to the linear movement direction of the rod 202 (the rear direction of the paper, the viewer direction). The case 207 is provided with a dust seal 208 that seals a gap with the rod 202 and prevents contamination such as dust from entering between the rotating roller 110 and the rod 202. As a result, it is possible to avoid a situation in which dust or the like enters between the rotating roller 110 and the rod 202 and the rotating roller 110 malfunctions. That is, the rotation sensor 100 has a dustproof structure by the dust seal 208 provided on the case 207 and the dust seal 205 b provided on the cylinder head 203.

回転センサ100は、上述した回転ローラ110と、回転ローラ110の回転量を検出する、後述する回転センサ部130(図5)とを少なくとも備えている。回転センサ部130で検出された回転ローラ110の回転量を示す信号は、電気信号線150を介して、計測用コントローラ30に送られ、この計測用コントローラ30で油圧シリンダ200のロッド202の位置(ストローク)に変換される。   The rotation sensor 100 includes at least the above-described rotation roller 110 and a rotation sensor unit 130 (FIG. 5), which will be described later, that detects the amount of rotation of the rotation roller 110. A signal indicating the amount of rotation of the rotating roller 110 detected by the rotation sensor unit 130 is sent to the measurement controller 30 via the electric signal line 150, and the position of the rod 202 of the hydraulic cylinder 200 (by the measurement controller 30 ( Stroke).

回転センサ100の回転ローラ110とロッド202と間では、微小な滑り(スリップ)が発生することは避けられず、この滑りによって回転センサ100の検出結果から得られるロッド202の計測位置と、ロッド202の実際の位置との間には、誤差(滑りによる累積誤差)が生じる。そこで、この回転センサ100の検出結果から得られる計測位置を、原点位置(基準位置)にリセットするために、シリンダチューブ250の外部には、リセットセンサとしての磁力センサ300が設けられている。   It is inevitable that a minute slip (slip) occurs between the rotation roller 110 of the rotation sensor 100 and the rod 202, and the measurement position of the rod 202 obtained from the detection result of the rotation sensor 100 due to this slip and the rod 202. An error (cumulative error due to slipping) occurs between the actual position and the actual position. Therefore, in order to reset the measurement position obtained from the detection result of the rotation sensor 100 to the origin position (reference position), a magnetic force sensor 300 as a reset sensor is provided outside the cylinder tube 250.

すなわち、ピストン201には、磁力線を生成する磁石350が設けられている。磁石350は、ピストン201、ロッド202の直動方向に対して垂直な図中鉛直方向に、N極、S極が配置されるように、ピストン201に設けられている。なお、磁石350を、ピストン201、ロッド202の直動方向と平行な方向に沿って、N極、S極が配置されるように、ピストン201に設けてもよい。   That is, the piston 201 is provided with a magnet 350 that generates lines of magnetic force. The magnet 350 is provided on the piston 201 so that the N pole and the S pole are arranged in the vertical direction in the drawing perpendicular to the linear movement direction of the piston 201 and the rod 202. The magnet 350 may be provided on the piston 201 so that the N pole and the S pole are arranged along a direction parallel to the linear movement direction of the piston 201 and the rod 202.

磁力センサ300は、ピストン201の直動方向に沿って所定距離離間されて配置された2個の磁力センサ301、302からなる。磁力センサ301、302は、既知の原点位置に設けられている。磁力センサ301、302は、磁石350で生成された磁力線を透過して、磁力(磁束密度)を検出し、磁力(磁束密度)に応じた電気信号(電圧)を出力する。磁力センサ301、302で検出された信号は、電気信号線150を介して、計測用コントローラ30に送られ、この計測用コントローラ30では、磁力センサ301、302の検出結果に基づいて、回転センサ100の検出結果から得られる計測位置を、原点位置(基準位置)にリセットする処理が実行される。   The magnetic force sensor 300 includes two magnetic force sensors 301 and 302 that are spaced apart from each other by a predetermined distance along the linear movement direction of the piston 201. The magnetic sensors 301 and 302 are provided at known origin positions. The magnetic sensors 301 and 302 transmit the magnetic lines generated by the magnet 350, detect the magnetic force (magnetic flux density), and output an electric signal (voltage) corresponding to the magnetic force (magnetic flux density). The signals detected by the magnetic sensors 301 and 302 are sent to the measurement controller 30 via the electric signal line 150. The measurement controller 30 uses the rotation sensor 100 based on the detection results of the magnetic sensors 301 and 302. A process of resetting the measurement position obtained from the detection result to the origin position (reference position) is executed.

また、2個の磁力センサ301、302の検出位置に基づいて、ピストン201、ロッド202の絶対移動距離を計測することができる。たとえば、回転センサ100の回転ローラ110が経年変化によって消耗すると、回転センサ100の検出回転量から得られるロッド202の移動距離は、実際のロッド202の移動距離よりも小さくなるが、ピストン201が2個の磁力センサ301、302間を移動したときに回転センサ100の検出回転量から得られる移動距離L′と、実際の2個の磁力センサ301、302間の距離Lとの比率L/L′に基づいて、回転センサ100の検出回転量から得られる移動距離を補正することができる。   Further, the absolute movement distance of the piston 201 and the rod 202 can be measured based on the detection positions of the two magnetic sensors 301 and 302. For example, when the rotation roller 110 of the rotation sensor 100 is consumed due to aging, the movement distance of the rod 202 obtained from the detected rotation amount of the rotation sensor 100 is smaller than the actual movement distance of the rod 202, but the piston 201 is 2 The ratio L / L ′ of the moving distance L ′ obtained from the rotation amount detected by the rotation sensor 100 when moving between the magnetic sensors 301 and 302 and the actual distance L between the two magnetic sensors 301 and 302 Based on the above, the movement distance obtained from the rotation amount detected by the rotation sensor 100 can be corrected.

磁力センサ301、302としては、たとえばホールICが使用される。   As the magnetic sensors 301 and 302, for example, Hall ICs are used.

磁力センサ301、302は、ひさし310に装着されている。ひさし310は、バンド320に装着されている。バンド320は、シリンダチューブ250の外周に固定されている。バンド320は、磁性材料によって構成されている。バンド320の材料としては、一般構造用鉄鋼材等、通常容易に入手できる磁性材料を使用することができる。   The magnetic sensors 301 and 302 are attached to the eaves 310. The eaves 310 are attached to the band 320. The band 320 is fixed to the outer periphery of the cylinder tube 250. The band 320 is made of a magnetic material. As a material of the band 320, a magnetic material that is usually easily available, such as a general structural steel material, can be used.

図4(b)は、図4(a)のA−A断面図、つまりシリンダチューブ250の横断面図を示している。   FIG. 4B shows a cross-sectional view taken along line AA of FIG. 4A, that is, a cross-sectional view of the cylinder tube 250.

バンド320は、シリンダチューブ250の外周に圧接されて固定される。バンド320は、シリンダチューブ250の外径に応じた断面半円弧状のバンド部材320Aと、同じく断面半円弧状のバンド部材320Bとからなり、バンド部材320Aと、バンド部材320Bとは、ボルト321によって締結され、締結されることによりシリンダチューブ250の外周に圧接される。一方のバンド部材320Aには、ひさし310が装着されている。このためシリンダチューブ250にネジ穴を形成したり、シリンダチューブ250の外周を溶接するなどの加工、処理を施すことなくして、シリンダチューブ250の外周に磁力センサ301、302を固定することができる。また、シリンダチューブ250に加工、処理を施す必要がないため、シリンダチューブ250の厚さを、最低限の厚さに維持することができる。すなわち、シリンダチューブ250に加工、処理を施すことにすると、強度を保つために、チューブ自体を厚くしなければならないが、その必要はない。   The band 320 is fixed in pressure contact with the outer periphery of the cylinder tube 250. The band 320 includes a band member 320A having a semicircular cross section corresponding to the outer diameter of the cylinder tube 250, and a band member 320B having a semicircular cross section, and the band member 320A and the band member 320B are The cylinder tube 250 is pressed against the outer periphery by being fastened. The eaves 310 are attached to one band member 320A. For this reason, the magnetic force sensors 301 and 302 can be fixed to the outer periphery of the cylinder tube 250 without forming a screw hole in the cylinder tube 250 or performing processing such as welding the outer periphery of the cylinder tube 250. Moreover, since it is not necessary to process and process the cylinder tube 250, the thickness of the cylinder tube 250 can be maintained at a minimum thickness. That is, if the cylinder tube 250 is processed and processed, in order to maintain the strength, the tube itself must be thickened, but this is not necessary.

また、バンド320のシリンダチューブ250への固定位置の変更が容易かつ簡単に行え、磁力センサ301、302を、シリンダチューブ250の長手方向(ピストン201、ロッド202の直動方向)の任意の位置に、容易にかつ簡単に装着することができる。   In addition, the fixing position of the band 320 to the cylinder tube 250 can be easily and easily changed, and the magnetic force sensors 301 and 302 can be placed at arbitrary positions in the longitudinal direction of the cylinder tube 250 (the linear movement direction of the piston 201 and the rod 202). Can be easily and easily installed.

つぎに、回転センサ100の構成について説明する。   Next, the configuration of the rotation sensor 100 will be described.

図5(a)に示すように、回転センサ100は、大きくは、前述したように、ロッド202の表面に接触し、ロッド202の変位に応じて回転するように設けられた回転ローラ110と、回転ローラ110をロッド202の表面に押圧する押圧部材120と、回転ローラ110の回転量を検出する回転センサ部130とから構成されている。   As shown in FIG. 5A, the rotation sensor 100 roughly includes a rotation roller 110 provided to contact the surface of the rod 202 and rotate according to the displacement of the rod 202, as described above. The pressing member 120 presses the rotating roller 110 against the surface of the rod 202, and the rotation sensor unit 130 detects the amount of rotation of the rotating roller 110.

押圧部材120は、ホルダ121とバネ122とからなる。ホルダ121は、ケース207に、ロッド202の表面に向かう方向および同表面から離れる方向に摺動自在に、ケース207に嵌装されている。バネ122は、ホルダ121がロッド202の表面に向かう方向にバネ力が付与されるように、両端がそれぞれケース207の内壁とホルダ121との間に配置されている。ホルダ121には、回転ローラ110の回転軸111が、ベアリング123a、123bを介して回転自在に支持されている。なお、図5(b)は、図5(a)のB−B断面を示している。同図5(b)に示すように、ホルダ121には、ピン124が装着されており、ピン124は、ケース207に摺動自在に嵌装されている。   The pressing member 120 includes a holder 121 and a spring 122. The holder 121 is fitted to the case 207 so as to be slidable in a direction toward the surface of the rod 202 and in a direction away from the surface. Both ends of the spring 122 are disposed between the inner wall of the case 207 and the holder 121 so that a spring force is applied in a direction in which the holder 121 faces the surface of the rod 202. The holder 121 supports the rotating shaft 111 of the rotating roller 110 through bearings 123a and 123b so as to be rotatable. FIG. 5B shows a BB cross section of FIG. As shown in FIG. 5 (b), a pin 124 is attached to the holder 121, and the pin 124 is slidably fitted to the case 207.

よって、回転ローラ110は、バネ122のバネ力によって、ロッド202の表面に押圧される。   Therefore, the rotating roller 110 is pressed against the surface of the rod 202 by the spring force of the spring 122.

回転センサ部130は、固定部材131と、メインシャフト(回転軸)132と、回転体133と、カバー134と、センサ部材135とからなる。   The rotation sensor unit 130 includes a fixed member 131, a main shaft (rotating shaft) 132, a rotating body 133, a cover 134, and a sensor member 135.

固定部材131の周囲には、ネジ部136が形成されており、固定部材131はホルダ121に形成されたネジ穴121aにねじ込まれる。更に固定部材131は、Oリング137、ワッシャ138を介してナット140によってホルダ121に締結されている。   A screw part 136 is formed around the fixing member 131, and the fixing member 131 is screwed into a screw hole 121 a formed in the holder 121. Further, the fixing member 131 is fastened to the holder 121 by a nut 140 via an O-ring 137 and a washer 138.

メインシャフト132は、固定部材131の挿通孔131a内に、挿通されている。メインシャフト132は、固定部材131にベアリング(ローラベアリング)141、142を介して回転自在に挿通されている。   The main shaft 132 is inserted into the insertion hole 131 a of the fixing member 131. The main shaft 132 is rotatably inserted into the fixed member 131 via bearings (roller bearings) 141 and 142.

メインシャフト132は、その中心軸132cが、回転ローラ110の回転中心軸と110cと軸芯を同じくするように、回転ローラ110に連結されている。メインシャフト132は、回転ローラ110と一体に回転するように、継手部143を介して回転ローラ110に連結されている。   The main shaft 132 is connected to the rotating roller 110 so that the central axis 132c has the same axis as the rotating central axis of the rotating roller 110 and 110c. The main shaft 132 is coupled to the rotating roller 110 via a joint portion 143 so as to rotate integrally with the rotating roller 110.

図5(c)は、継手部143を図5(a)の断面図で示している。同図5(c)に示すように、継手部143は、回転ローラ110の回転軸111の穴111aに嵌合されたスリーブ144と、メインシャフト132の断面長方形状の先端部132aとからなる。回転ローラ110のスリーブ144に、メインシャフト132の先端部132aがはめ込まれることにより、メインシャフト132は、回転ローラ110に対する相対回転方向の動きが規制されて、メインシャフト132は、回転ローラ110と一体になって回転する。   FIG.5 (c) has shown the coupling part 143 with sectional drawing of Fig.5 (a). As shown in FIG. 5C, the joint portion 143 includes a sleeve 144 fitted into the hole 111 a of the rotating shaft 111 of the rotating roller 110 and a tip portion 132 a having a rectangular cross section of the main shaft 132. When the distal end portion 132 a of the main shaft 132 is fitted into the sleeve 144 of the rotating roller 110, the movement of the main shaft 132 relative to the rotating roller 110 is restricted, and the main shaft 132 is integrated with the rotating roller 110. Rotate.

回転体133は、メインシャフト132の他端に、嵌合されることによって固定されている。回転体133には、検出媒体である磁石145が設けられている。磁石145は、回転体133の回転、つまり回転ローラ110の回転に応じて、回転する。   The rotating body 133 is fixed by being fitted to the other end of the main shaft 132. The rotating body 133 is provided with a magnet 145 that is a detection medium. The magnet 145 rotates in accordance with the rotation of the rotating body 133, that is, the rotation of the rotating roller 110.

カバー134は、回転体133を内部に収容するように固定部材131に、かしめによって、Oリング146を介して、固定されている。   The cover 134 is fixed to the fixing member 131 via the O-ring 146 by caulking so as to accommodate the rotating body 133 therein.

センサ部材135は、磁石145によって生成される磁力(磁束密度)を電気信号として検出する磁力センサであり、カバー134に装着されている。センサ部材135は、メインシャフト132の軸方向に沿って、磁石145から所定距離離間された位置に設けられている。   The sensor member 135 is a magnetic sensor that detects a magnetic force (magnetic flux density) generated by the magnet 145 as an electric signal, and is attached to the cover 134. The sensor member 135 is provided at a position separated from the magnet 145 by a predetermined distance along the axial direction of the main shaft 132.

検出媒体である磁石145は、回転体133の一回転、つまり回転ローラ110の一回転を一周期として、センサ部材135で検出される磁力(磁束密度)が周期的に変動するような態様で、回転体133に装着されている。磁石145の着磁面の構成例、センサ部材135の配置例については、後述する。   The magnet 145 which is a detection medium is a mode in which the magnetic force (magnetic flux density) detected by the sensor member 135 periodically varies with one rotation of the rotating body 133, that is, one rotation of the rotating roller 110 as one cycle. The rotating body 133 is attached. A configuration example of the magnetized surface of the magnet 145 and an arrangement example of the sensor member 135 will be described later.

センサ部材135には、ハーネス150が電気的に接続されている。センサ部材135で検出された電気信号は、ハーネス150を介して、計測用コントローラ30に送られ、この計測用コントローラ30で、センサ部材135の電気信号が、回転ローラ110の回転量、つまりシリンダ200のロッド202の変位量(ストローク位置)に変換される。なお、センサ部材135は、たとえばホールICが使用される。   A harness 150 is electrically connected to the sensor member 135. The electrical signal detected by the sensor member 135 is sent to the measurement controller 30 via the harness 150, and the electrical signal of the sensor member 135 is transmitted to the rotation amount of the rotating roller 110, that is, the cylinder 200. It is converted into the displacement amount (stroke position) of the rod 202. As the sensor member 135, for example, a Hall IC is used.

本実施形態では、検出媒体である磁石145とは、別に一対の磁石147、148が設けられている。   In the present embodiment, a pair of magnets 147 and 148 are provided separately from the magnet 145 that is the detection medium.

一対の磁石147、148のうち、一方の磁石147は、固定部材131に設けられ、他方の磁石148は、回転体133の磁石147に対面する側に設けられている。なお、検出媒体である磁石145は、回転体133の磁石147が設けられた側とは反対側に設けられている。   Of the pair of magnets 147 and 148, one magnet 147 is provided on the fixing member 131, and the other magnet 148 is provided on the side of the rotating body 133 facing the magnet 147. In addition, the magnet 145 which is a detection medium is provided on the opposite side to the side where the magnet 147 of the rotating body 133 is provided.

一対の磁石147、148は、共に環状に形成されており、磁石の着磁面が、メインシャフト132の中心軸132cに対して直交する平面となるように、配置されている。検出媒体である磁石145は、円板状に形成されており、磁石の着磁面が、メインシャフト132の中心軸132cに対して直交する平面となるように、配置されている。   The pair of magnets 147 and 148 are both formed in an annular shape, and are arranged such that the magnetized surfaces of the magnets are planes orthogonal to the central axis 132 c of the main shaft 132. The magnet 145 that is a detection medium is formed in a disk shape, and is arranged so that the magnetized surface of the magnet is a plane orthogonal to the central axis 132 c of the main shaft 132.

一対の磁石147、148は、反発力を生じさせる同極同士(N極同士、S極同士)で構成されている。このため回転体133には、同極の磁石147、148同士の反発力が、メインシャフト132の軸方向に作用する。回転体133には、図5(a)中、右方向に、上記反発力が作用する。   The pair of magnets 147 and 148 are composed of the same poles (N poles and S poles) that generate a repulsive force. Therefore, the repulsive force between the magnets 147 and 148 having the same polarity acts on the rotating body 133 in the axial direction of the main shaft 132. The repulsive force acts on the rotating body 133 in the right direction in FIG.

回転体133は、磁石147、148同士の反発力に抗して、支持部材としてのベアリング142によって支持されている。   The rotating body 133 is supported by a bearing 142 as a support member against the repulsive force between the magnets 147 and 148.

メインシャフト132は、回転ローラ110側の大径部132dと、回転体133側の小径部132eとからなり、小径部132eには、ベアリング(ローラベアリング)142が環装されている。回転体133には、図5(a)中、右方向に、一対の磁石147、148同士の反発力が作用するが、メインシャフト132の大径部132dと小径部132eとの段差がベアリング142に当接されていることによって、回転体133の図中右方向の動きが規制され、回転体133は、定位置に位置決めされる。このため回転体133に設けられた検出媒体の磁石145と、センサ部材135との距離が、一定に保持される。つまり、メインシャフト132と固定部材131との間のガタを無くすことにより、検出媒体としての磁石145とセンサ部材135との距離が一定に保持される。   The main shaft 132 includes a large-diameter portion 132d on the rotating roller 110 side and a small-diameter portion 132e on the rotating body 133 side, and a bearing (roller bearing) 142 is provided around the small-diameter portion 132e. A repulsive force between the pair of magnets 147 and 148 acts on the rotating body 133 in the right direction in FIG. 5A, but the step between the large diameter portion 132 d and the small diameter portion 132 e of the main shaft 132 is a bearing 142. The movement of the rotating body 133 in the right direction in the figure is restricted, and the rotating body 133 is positioned at a fixed position. For this reason, the distance between the magnet 145 of the detection medium provided on the rotating body 133 and the sensor member 135 is kept constant. That is, by eliminating the backlash between the main shaft 132 and the fixing member 131, the distance between the magnet 145 as the detection medium and the sensor member 135 is kept constant.

このように本実施形態によれば、検出媒体としての磁石145とセンサ部材135との距離が一定に保持されるため、センサ部材135の検出精度、つまり回転ローラ110の回転量、ロッド202の変位量の計測精度が向上する。   As described above, according to the present embodiment, the distance between the magnet 145 serving as the detection medium and the sensor member 135 is kept constant, so that the detection accuracy of the sensor member 135, that is, the rotation amount of the rotating roller 110, the displacement of the rod 202, and so on. Measurement accuracy of quantity is improved.

ところで、本実施形態の回転センサ100は、ロッド202の変位を回転ローラ110の回転量に変換し、その回転量を回転センサ部130で検出することを前提としている。したがって、回転ローラ110は、半径方向に容易に変形したり消耗したりせずに、回転半径が一定値に保持されることが、回転センサ部130の検出精度、ロッド202の変位量(ストローク)の計測精度を高める上で必要である。また、ロッド202の変位が回転ローラ110の回転運動に忠実に変換されスリップしないことが、回転センサ部130の検出精度、ロッド202の変位量(ストローク)の計測精度を高める上で必要である。   By the way, the rotation sensor 100 of this embodiment is based on the assumption that the displacement of the rod 202 is converted into the rotation amount of the rotation roller 110 and the rotation sensor unit 130 detects the rotation amount. Therefore, the rotation roller 110 is not easily deformed or consumed in the radial direction, and the rotation radius is held at a constant value, so that the detection accuracy of the rotation sensor unit 130 and the displacement amount (stroke) of the rod 202 are maintained. It is necessary to improve the measurement accuracy. Further, it is necessary to increase the detection accuracy of the rotation sensor unit 130 and the measurement accuracy of the displacement amount (stroke) of the rod 202 so that the displacement of the rod 202 is faithfully converted to the rotational motion of the rotating roller 110 and does not slip.

そこで、本実施形態では、図5(a)に示すように、回転ローラ110のうち、少なくともロッド2に接触する部分の一部110d(凸部)を、回転ローラ110の回転中心軸110cとロッド202の表面との距離を一定値dに保持することができる程度に硬い材料(たとえばS45C)で構成し、回転ローラ110のうち、少なくともロッド2に接触する部分の他の一部114を、回転ローラ110とロッド202との間で滑りが生じない程度に摩擦係数が高い材料(たとえばNBR等の弾性部材)で構成するようにしている。   Therefore, in the present embodiment, as shown in FIG. 5A, at least a part 110 d (convex portion) of the rotating roller 110 that contacts the rod 2 is formed with the rotation center shaft 110 c of the rotating roller 110 and the rod. It is made of a material (e.g., S45C) that is hard enough to maintain the distance to the surface of 202 at a constant value d, and at least the other part 114 of the rotating roller 110 that contacts the rod 2 is rotated. The roller 110 and the rod 202 are made of a material (for example, an elastic member such as NBR) having a friction coefficient that is high enough to prevent slippage.

いいかえれば、回転ローラ110のうち、少なくともロッド2に接触する部分の一部114は、回転ローラ110の他の接触部分110d(S45C)よりも、摩擦係数が高い材料(NBR等の弾性部材)で構成するようにしている。   In other words, at least a portion 114 of the rotating roller 110 that contacts the rod 2 is made of a material (elastic member such as NBR) having a higher friction coefficient than the other contact portion 110d (S45C) of the rotating roller 110. I am trying to configure it.

すなわち、回転ローラ110の周方向には、円環状の溝112、113が形成されている。溝112と溝113の間は、回転中心軸110cから回転ローラ表面までの距離が、回転ローラ110の回転半径dに設定された凸部110dを構成している。ここで回転半径dとは、ロッド202の表面から回転ローラ110の回転中心軸110cまでの距離とみなされ、回転ローラ110の回転量をロッド202の変位量(ストローク)に変換する指標となるパラメータである。たとえば回転ローラ110が1回転したときのロッド202の直動量は、回転半径dを用いて、2πdとして計算される。   That is, annular grooves 112 and 113 are formed in the circumferential direction of the rotating roller 110. Between the groove 112 and the groove 113, a convex portion 110d in which the distance from the rotation center shaft 110c to the surface of the rotation roller is set to the rotation radius d of the rotation roller 110 is configured. Here, the rotation radius d is regarded as a distance from the surface of the rod 202 to the rotation center axis 110c of the rotation roller 110, and is a parameter serving as an index for converting the rotation amount of the rotation roller 110 into a displacement amount (stroke) of the rod 202. It is. For example, the amount of linear motion of the rod 202 when the rotating roller 110 makes one rotation is calculated as 2πd using the rotation radius d.

溝112、113には、NBR等を材料とするチューブ状の弾性部材114、114が、全周にわたり嵌装される。回転ローラ110が押圧部材120によってロッド202の表面に押圧されていないフリーの状態では、回転中心軸110cから弾性部材114の最外周面までの距離d1は、回転ローラ110の回転半径dよりも僅かに大きな距離(d1>d)に設定されている。   Tube-shaped elastic members 114 and 114 made of NBR or the like are fitted into the grooves 112 and 113 over the entire circumference. In a free state where the rotating roller 110 is not pressed against the surface of the rod 202 by the pressing member 120, the distance d1 from the rotation center shaft 110c to the outermost peripheral surface of the elastic member 114 is slightly smaller than the rotation radius d of the rotating roller 110. A large distance (d1> d) is set.

回転ローラ110は、押圧部材120のバネ122のバネ力によって、ロッド202の表面に押圧される。このため回転ローラ110のうち、ロッド202との接触面では、弾性部材114が変形し撓み、凸部110dがロッド202の表面に接触し回転中心軸110cからロッド202表面までの距離が、回転ローラ110の回転半径dとほぼ同じ距離になる。   The rotating roller 110 is pressed against the surface of the rod 202 by the spring force of the spring 122 of the pressing member 120. For this reason, in the rotating roller 110, the elastic member 114 is deformed and bent on the contact surface with the rod 202, the convex portion 110d contacts the surface of the rod 202, and the distance from the rotation center axis 110c to the surface of the rod 202 is the rotating roller. The distance is substantially the same as the rotation radius d of 110.

回転ローラ110は、バネ力によってロッド202の表面に押圧されているため、弾性部材114がロッド202の表面と接触する面で、バネ力と弾性部材114の摩擦係数に応じた摩擦力が発生する。ここで、弾性部材114は、回転ローラ110(回転ローラ本体)の材質(S45C)よりも摩擦係数が大きいため、スリップを生じることなく、ロッド202の直動運動を、回転ローラ110の回転運動に忠実に変換する。   Since the rotating roller 110 is pressed against the surface of the rod 202 by a spring force, a friction force corresponding to the spring force and the friction coefficient of the elastic member 114 is generated on the surface where the elastic member 114 contacts the surface of the rod 202. . Here, since the elastic member 114 has a larger coefficient of friction than the material (S45C) of the rotating roller 110 (rotating roller body), the linear motion of the rod 202 is changed to the rotating motion of the rotating roller 110 without causing a slip. Convert faithfully.

一方、凸部110dについてもバネ力によってロッド202の表面に接触するが、凸部110dは、回転ローラ110(回転ローラ本体)の材質(S45C)で構成されているため、硬く、直動するロッド表面に押圧されても、半径方向に容易に変形したり、消耗したりすることがない。このため回転中心軸110cから回転ローラ表面までの距離は、一定値d、つまり当初の設計値である回転ローラ110の回転半径dに保持される。   On the other hand, the convex portion 110d also comes into contact with the surface of the rod 202 by a spring force, but the convex portion 110d is made of the material (S45C) of the rotating roller 110 (rotating roller main body), and thus is a hard and linearly moving rod. Even if pressed against the surface, it is not easily deformed or consumed in the radial direction. For this reason, the distance from the rotation center shaft 110c to the surface of the rotating roller is held at a constant value d, that is, the rotation radius d of the rotating roller 110 that is the original design value.

このため回転ローラ110のスリップによる誤差を招くことがなく、また、回転ローラ110が変形したり摩耗したりして実際の回転半径が設計上の回転半径dからずれてしまうことによる演算誤差も生じることない。これによりロッド202の直動量(ストローク)は、極めて精度よく計測される。   For this reason, an error due to slip of the rotating roller 110 is not caused, and an arithmetic error is caused due to the actual rotating radius deviating from the designed rotating radius d due to deformation or wear of the rotating roller 110. Nothing. Thereby, the amount of linear motion (stroke) of the rod 202 is measured with extremely high accuracy.

つぎに、検出媒体用磁石145の着磁面の構成例、センサ部材135の配置例について説明する。   Next, a configuration example of the magnetized surface of the detection medium magnet 145 and an arrangement example of the sensor member 135 will be described.

図6は、検出媒体用の磁石145の着磁面の構成例を示している。図6は、図5(a)で回転体133をZ視方向(図5(a)の右側から見た方向)からみた図である。   FIG. 6 shows a configuration example of the magnetized surface of the magnet 145 for the detection medium. FIG. 6 is a view of the rotating body 133 seen from the Z viewing direction (direction seen from the right side of FIG. 5A) in FIG.

同図6(a)、(b)、(c)に示すように、磁石145は、回転体133の回転角度に応じて、N極、S極が交互に入れ替わるように構成されている。図6(a)は、S極、N極が1回、交互に入れ替わる構成例であり、図6(b)は、S極、N極が2回、交互に入れ替わる構成例であり、図6(c)は、S極、N極が3回、交互に入れ替わる構成例である。   As shown in FIGS. 6A, 6 </ b> B, and 6 </ b> C, the magnet 145 is configured so that the N pole and the S pole are alternately switched according to the rotation angle of the rotating body 133. 6A is a configuration example in which the S pole and the N pole are alternately switched once, and FIG. 6B is a configuration example in which the S pole and the N pole are alternately switched twice. (C) is a configuration example in which the S pole and the N pole are alternately switched three times.

図7(a)は、センサ部材135の配置例を示している。図7は、図5(a)でセンサ部材135をZ視方向(図5(a)の右側から見た方向)からみた図である。図7(b)は、図6(a)に示す磁石145を設けた場合のセンサ部材135A、135Bの配置例であり、センサ部材135A、135Bを90゜の位相差だけ位相がずれるように設置している。図6(b)に示す磁石145の場合には、センサ部材135A、135Bを45゜の位相差だけ位相がずれるように設置すればよく、また、図6(c)に示す磁石145の場合には、センサ部材135A、135Bを30゜の位相差だけ位相がずれるように設置すればよい。   FIG. 7A shows an arrangement example of the sensor member 135. FIG. 7 is a view of the sensor member 135 seen from the Z viewing direction (direction seen from the right side of FIG. 5A) in FIG. FIG. 7B shows an arrangement example of the sensor members 135A and 135B when the magnet 145 shown in FIG. 6A is provided. The sensor members 135A and 135B are installed so that the phases are shifted by a phase difference of 90 °. is doing. In the case of the magnet 145 shown in FIG. 6B, the sensor members 135A and 135B may be installed so as to be out of phase by a phase difference of 45 °. In the case of the magnet 145 shown in FIG. The sensor members 135A and 135B may be installed so that the phase is shifted by a phase difference of 30 °.

図7(a)に示すように、センサ部材135は、回転体133の回転面上において、回転中心軸132cから所定距離離間された位置に、設けられている。   As shown in FIG. 7A, the sensor member 135 is provided at a position spaced apart from the rotation center shaft 132c by a predetermined distance on the rotation surface of the rotating body 133.

図8(a)は、図7(a)に対応する回転ローラ110の回転角度と、センサ部材135で検出される電気信号(電圧)との関係を例示している。   FIG. 8A illustrates the relationship between the rotation angle of the rotating roller 110 corresponding to FIG. 7A and the electrical signal (voltage) detected by the sensor member 135.

回転ローラ110が回転し、それに応じて検出媒体用磁石145が装着された回転体133が回転すると、回転角度に応じて、センサ部材135を透過する磁力(磁束密度)が周期的に変化し、電気信号(電圧)が周期的に変化する。   When the rotating roller 110 rotates and the rotating body 133 mounted with the detection medium magnet 145 rotates accordingly, the magnetic force (magnetic flux density) transmitted through the sensor member 135 periodically changes according to the rotation angle. The electrical signal (voltage) changes periodically.

センサ部材135から出力される電圧の大きさから回転ローラ110の回転角度を計測することができる。   The rotation angle of the rotating roller 110 can be measured from the magnitude of the voltage output from the sensor member 135.

図7(b)は、センサ部材135A、135Bを、回転体133の回転面上において、回転中心軸132cから所定距離離間された位置に、所定角度(たとえば90゜)だけ位相をずらして配置した場合を示している。   In FIG. 7B, the sensor members 135A and 135B are arranged on the rotation surface of the rotating body 133 at a position separated by a predetermined distance from the rotation center axis 132c with a phase shifted by a predetermined angle (for example, 90 °). Shows the case.

図8(b)は、図6(a)に示す磁石145を設け、図7(b)に示すセンサ部材135A、135Bを設けた場合に対応する図であり、回転ローラ110の回転角度と、センサ部材135A、135Bで検出される電気信号(電圧)との関係を例示している。   FIG. 8B is a diagram corresponding to the case where the magnet 145 shown in FIG. 6A is provided and the sensor members 135A and 135B shown in FIG. 7B are provided. The relationship with the electrical signal (voltage) detected by the sensor members 135A and 135B is illustrated.

回転ローラ110が回転し、それに応じて検出媒体用磁石145が装着された回転体133が回転すると、回転角度に応じて、センサ部材135A、135Bを透過する磁力(磁束密度)が周期的に変化し、電気信号(電圧)が周期的に変化する。センサ部材135A、Bを2個配置した場合には、各センサ部材135A、135Bの検出信号の位相がずれているため、回転ローラ110の変位量のみならず、回転ローラ110の絶対角度を計測することができる。また、回転ローラ110の回転方向についても計測することができる。   When the rotating roller 110 rotates and the rotating body 133 mounted with the detection medium magnet 145 correspondingly rotates, the magnetic force (magnetic flux density) transmitted through the sensor members 135A and 135B changes periodically according to the rotation angle. However, the electric signal (voltage) changes periodically. When two sensor members 135A and 135B are arranged, the detection signals of the sensor members 135A and 135B are out of phase, so that not only the displacement amount of the rotation roller 110 but also the absolute angle of the rotation roller 110 is measured. be able to. Further, the rotational direction of the rotating roller 110 can also be measured.

また、図8(c)に示すように、センサ部材135あるいはセンサ部材135A、135Bから出力される電気信号(電圧)の1周期が繰り返される数をカウントすることで、回転ローラ110の回転数を計測することができる。   Further, as shown in FIG. 8C, by counting the number of times one cycle of the electrical signal (voltage) output from the sensor member 135 or the sensor members 135A and 135B is counted, the rotation number of the rotating roller 110 is set. It can be measured.

そして、図8(a)あるいは図8(b)に示す検出信号から得られる回転ローラ110の回転角度と、図8(c)のようにしてカウントされる回転ローラ110の回転数とに基づいて、シリンダ200のロッド202の変位量(ストローク)が計測される。   Then, based on the rotation angle of the rotating roller 110 obtained from the detection signal shown in FIG. 8A or 8B, and the rotation number of the rotating roller 110 counted as shown in FIG. 8C. The displacement amount (stroke) of the rod 202 of the cylinder 200 is measured.

以下、計測用コントローラ30で行われる処理について説明する。   Hereinafter, processing performed by the measurement controller 30 will be described.

(第1実施例)
本実施例では、図10(a)に示すように、図8(a)と同様に、回転センサ100から1つの検出信号400Aが出力される場合を想定する。
(First embodiment)
In the present embodiment, as shown in FIG. 10A, it is assumed that one detection signal 400A is output from the rotation sensor 100, as in FIG. 8A.

さて、前述したように、本実施形態では、油圧シリンダ200のストローク量センサを、回転センサ100で構成し、回転センサ100を磁力センサで構成している。この場合、計測ストローク位置に誤差が生じやすくなるという問題がある。特に、油圧ショベルなどの建設機械のように、計測対象の油圧シリンダ200が多数あるシステムに適用した場合には、個々の回転センサ100毎に出力信号の波形が異なる、つまり同じストローク位置にあっても検出電圧値が各回転センサ100で異なる、という問題がある。   As described above, in this embodiment, the stroke amount sensor of the hydraulic cylinder 200 is configured by the rotation sensor 100, and the rotation sensor 100 is configured by a magnetic force sensor. In this case, there is a problem that an error is likely to occur in the measurement stroke position. In particular, when applied to a system having a large number of hydraulic cylinders 200 to be measured, such as construction machines such as hydraulic excavators, the waveform of the output signal differs for each rotation sensor 100, that is, at the same stroke position. However, there is a problem that the detected voltage value is different for each rotation sensor 100.

すなわち、磁力が検出媒体の場合、検出対象の磁石145の精度や磁石145の取付誤差等に起因して、回転センサ100の検出信号の波形にゆがみが生じやすく、これらゆがみは、個々の回転センサ100毎に異なる。ここで、仮に個々の回転センサ100の検出波形を一義的に正弦波形とみなし、正弦波形の関数式を用いて、回転センサ100の出力電圧を回転角度に工学単位変換したとしても、それによって計測される回転角度は、検出信号の波形のゆがみによって誤差を含むことになる。また、個々の回転センサ100毎に検出信号の波形のゆがみが異なることから、回転角度の計測値がばらつくことになる。   That is, when the magnetic force is the detection medium, the detection signal waveform of the rotation sensor 100 is likely to be distorted due to the accuracy of the magnet 145 to be detected, the mounting error of the magnet 145, and the like. Every 100 is different. Here, even if the detected waveform of each rotation sensor 100 is uniquely regarded as a sine waveform and the output voltage of the rotation sensor 100 is converted into an engineering unit to a rotation angle using a functional expression of the sine waveform, measurement is performed by that. The rotation angle to be included includes an error due to the distortion of the waveform of the detection signal. Further, since the distortion of the waveform of the detection signal is different for each rotation sensor 100, the measured value of the rotation angle varies.

また、磁力センサで検出される検出レベルは、磁石の磁化特性によるものであり、実際には正弦波形ではない。   Further, the detection level detected by the magnetic force sensor is due to the magnetization characteristics of the magnet, and is not actually a sine waveform.

そこで、本第1実施例では、計測用コントローラ30の記憶テーブル36に、図9(a)に示すように、予め、回転センサ100の出力電圧値VAと回転角度θAとの対応関係をデータテーブル形式で記憶させておき、計測用コントローラ30に、回転センサ100の検出信号(電圧値VA)が入力されると、図9(a)に示す対応関係を参照して、検出された電圧値VAに対応する回転角度θAを求め、求められた回転角度θAに基づいて、油圧シリンダ200のストローク位置を計測するようにしている。   Therefore, in the first embodiment, the correspondence table between the output voltage value VA of the rotation sensor 100 and the rotation angle θA is previously stored in the storage table 36 of the measurement controller 30 as shown in FIG. When the detection signal (voltage value VA) of the rotation sensor 100 is input to the measurement controller 30, the detected voltage value VA is referenced with reference to the correspondence shown in FIG. Is obtained, and the stroke position of the hydraulic cylinder 200 is measured based on the obtained rotation angle θA.

すなわち、図9(a)に示すように、回転センサ100から出力される出力電圧値VAと、回転ローラ110の回転角度θAとの対応関係を予め求めておき、記憶テーブル36に記憶しておく。   That is, as shown in FIG. 9A, a correspondence relationship between the output voltage value VA output from the rotation sensor 100 and the rotation angle θA of the rotation roller 110 is obtained in advance and stored in the storage table 36. .

この場合、ブーム、アーム、バケットの各油圧シリンダ200に設けられた各回転センサ100毎に、出力電圧値VAと回転角度θAの対応関係を予め求めておき、ブーム、アーム、バケットの各回転センサ100毎に対応関係を記憶させておくようにする。これは、個々の回転センサ100毎に、検出対象の磁石145の精度や磁石145の取付誤差等が異なり、それ故に検出信号400Aの波形が異なるという理由によるものである。   In this case, a correspondence relationship between the output voltage value VA and the rotation angle θA is obtained in advance for each rotation sensor 100 provided in each hydraulic cylinder 200 for the boom, arm, and bucket, and each rotation sensor for the boom, arm, and bucket is obtained. The correspondence is stored for every 100. This is because the accuracy of the magnet 145 to be detected, the mounting error of the magnet 145, and the like are different for each rotation sensor 100, and therefore the waveform of the detection signal 400A is different.

計測用コントローラ30に、図10(a)に示すように、ブーム用油圧シリンダ200に設けられた回転センサ100から検出信号400A(電圧値VA)が入力されると、記憶テーブル36から、図9(a)に示すように、ブームシリンダ200の回転センサ100についての対応関係が選択され、現在の検出電圧値VAに対応する回転角度θAが読み出され、読み出された回転角度θAに基づいて、ブーム用油圧シリンダ200のストローク位置が計測される。   When the detection signal 400A (voltage value VA) is input to the measurement controller 30 from the rotation sensor 100 provided in the boom hydraulic cylinder 200, as shown in FIG. As shown in (a), the correspondence relation of the rotation sensor 100 of the boom cylinder 200 is selected, the rotation angle θA corresponding to the current detected voltage value VA is read, and based on the read rotation angle θA. The stroke position of the boom hydraulic cylinder 200 is measured.

なお、図10(a)に示すように、回転センサ100の検出信号400Aの波形は、正弦波状であるため、回転センサ100の出力電圧値VAに対応する回転角度は、異なる値θA1、θA2の2つが読み出される。この場合には、前回に得られた回転角度θA0と今回の回転角度の候補θA1、θA2を比較して、前回の回転角度θA0に近い方の回転角度(θA1)を選択すればよい。   As shown in FIG. 10A, since the waveform of the detection signal 400A of the rotation sensor 100 is sinusoidal, the rotation angle corresponding to the output voltage value VA of the rotation sensor 100 has different values θA1 and θA2. Two are read out. In this case, the rotation angle θA0 obtained last time is compared with the current rotation angle candidates θA1 and θA2, and the rotation angle (θA1) closer to the previous rotation angle θA0 may be selected.

アーム用油圧シリンダ200、バケット用油圧シリンダ200に設けられた回転センサ100についても同様な処理が実行される。   Similar processing is executed for the rotation sensor 100 provided in the arm hydraulic cylinder 200 and the bucket hydraulic cylinder 200.

(第2実施例)
本第2実施例は、図10(b)に示すように、図8(b)と同様に、回転センサ100から、位相が異なる2つの検出信号、つまり第1の検出信号400A、第2の検出信号400Bが出力される場合を想定する。
(Second embodiment)
In the second embodiment, as shown in FIG. 10B, the two detection signals having different phases, that is, the first detection signal 400A and the second detection signal are output from the rotation sensor 100, as in FIG. 8B. Assume that the detection signal 400B is output.

図9(b)は、記憶テーブル36の記憶内容を示す図である。回転センサ100から出力される第1の検出信号400Aの出力電圧値VAと、回転ローラ110の回転角度θAとの対応関係を予め求めておき、記憶テーブル36に記憶しておく。同様に、回転センサ100から出力される第2の検出信号400Bの出力電圧値VBと、回転ローラ110の回転角度θBとの対応関係を予め求めておき、記憶テーブル36に記憶しておく。   FIG. 9B is a diagram showing the storage contents of the storage table 36. A correspondence relationship between the output voltage value VA of the first detection signal 400A output from the rotation sensor 100 and the rotation angle θA of the rotation roller 110 is obtained in advance and stored in the storage table 36. Similarly, a correspondence relationship between the output voltage value VB of the second detection signal 400B output from the rotation sensor 100 and the rotation angle θB of the rotation roller 110 is obtained in advance and stored in the storage table 36.

この場合、ブーム、アーム、バケットの各油圧シリンダ200に設けられた各回転センサ100毎に、出力電圧値VAと回転角度θAの対応関係、出力電圧値VBと回転角度θBの対応関係を予め求めておき、ブーム、アーム、バケットの各回転センサ100毎に対応関係を記憶させておくようにする。   In this case, the correspondence relationship between the output voltage value VA and the rotation angle θA and the correspondence relationship between the output voltage value VB and the rotation angle θB are obtained in advance for each rotation sensor 100 provided in each hydraulic cylinder 200 of the boom, arm, and bucket. The correspondence relationship is stored for each rotation sensor 100 for the boom, arm, and bucket.

計測用コントローラ30に、図10(b)に示すように、ブーム用油圧シリンダ200に設けられた回転センサ100から第1の検出信号400A(電圧値VA)が入力されると、記憶テーブル36から、図9(b)に示すように、ブームシリンダ200の回転センサ100の第1の検出信号400Aについての対応関係が選択され、現在の検出電圧値VAに対応する回転角度(以下、第1の回転角度)θA1、θA2が読み出される。同様に、計測用コントローラ30に、図10(b)に示すように、ブーム用油圧シリンダ200に設けられた回転センサ100から第2の検出信号400B(電圧値VB)が入力されると、記憶テーブル36から、図9(b)に示すように、ブームシリンダ200の回転センサ100の第2の検出信号400Bについての対応関係が選択され、現在の検出電圧値VBに対応する回転角度(以下、第2の回転角度)θB1、θB2が読み出される。   When the first detection signal 400A (voltage value VA) is input to the measurement controller 30 from the rotation sensor 100 provided in the boom hydraulic cylinder 200, as shown in FIG. As shown in FIG. 9B, the correspondence relationship with respect to the first detection signal 400A of the rotation sensor 100 of the boom cylinder 200 is selected, and the rotation angle corresponding to the current detection voltage value VA (hereinafter referred to as the first detection signal 400A). (Rotation angle) θA1 and θA2 are read out. Similarly, when the second detection signal 400B (voltage value VB) is input to the measurement controller 30 from the rotation sensor 100 provided in the boom hydraulic cylinder 200, as shown in FIG. As shown in FIG. 9B, the correspondence relationship for the second detection signal 400B of the rotation sensor 100 of the boom cylinder 200 is selected from the table 36, and the rotation angle corresponding to the current detection voltage value VB (hereinafter referred to as “the detection angle value”) Second rotation angle) θB1 and θB2 are read out.

つぎに、第1の回転角度θA1、θA2と、第2の回転角度θB1、θB2との差、つまりθA1−θB1、θA2−θB2、θA1−θB2、θA2−θB1がそれぞれ算出される。   Next, differences between the first rotation angles θA1 and θA2 and the second rotation angles θB1 and θB2, that is, θA1−θB1, θA2−θB2, θA1−θB2, and θA2−θB1 are calculated.

そして、これらの第1および第2の回転角度の組合せの中で、両回転角度の差が最も小さい組合せ(θA2−θB1)が選択される。   Then, among these combinations of the first and second rotation angles, the combination (θA2−θB1) having the smallest difference between the two rotation angles is selected.

つぎに、その選択された第1および第2の回転角度の組合せの差(θA2−θB1)が所定値以下になっているか否か、つまり両回転角度差に異常はないかが判断される。   Next, it is determined whether or not the difference (θA2−θB1) between the selected combinations of the first and second rotation angles is equal to or less than a predetermined value, that is, whether or not there is an abnormality in both rotation angle differences.

両回転角度の差が所定値以下になっている場合には、その所定値以下となっている第1の回転角度(θA2)と第2の回転角度(θB1)に基づいて、ブーム用油圧シリンダ200のストローク位置が計測される。たとえば第1の回転角度(θA2)と第2の回転角度(θB1)の平均値を回転ローラ110の現在の回転角度として、ブーム用油圧シリンダ200のストローク位置が計測される。   When the difference between the two rotation angles is less than or equal to a predetermined value, the boom hydraulic cylinder is based on the first rotation angle (θA2) and the second rotation angle (θB1) that are less than or equal to the predetermined value. 200 stroke positions are measured. For example, the stroke position of the boom hydraulic cylinder 200 is measured using the average value of the first rotation angle (θA2) and the second rotation angle (θB1) as the current rotation angle of the rotation roller 110.

一方、第1の回転角度と第2の回転角度との差が所定値以下にならない場合、つまり最も差の小さい両回転角度の組合せ(θA2−θB1)についても、その差が所定値以下にならない場合には、ブーム用油圧シリンダ200の回転センサ100で現在、異常が発生していると判断し、計測処理を中止する。   On the other hand, when the difference between the first rotation angle and the second rotation angle is not less than the predetermined value, that is, for the combination of both rotation angles with the smallest difference (θA2−θB1), the difference is not less than the predetermined value. In this case, the rotation sensor 100 of the boom hydraulic cylinder 200 determines that an abnormality is currently occurring, and stops the measurement process.

アーム用油圧シリンダ200、バケット用油圧シリンダ200に設けられた回転センサ100についても同様な処理が実行される。   Similar processing is executed for the rotation sensor 100 provided in the arm hydraulic cylinder 200 and the bucket hydraulic cylinder 200.

以上のように第1実施例、第2実施例によれば、磁力を検出媒体とする回転センサ100の検出信号をコントローラに入力させて、計測処理を行うに際して、コントローラに入力される個々の回転センサ100の波形が異なっていたとしても、確実かつ簡易な方法で、誤差なく高精度に回転角度を計測できる。   As described above, according to the first and second embodiments, the individual rotations input to the controller when performing the measurement process by inputting the detection signal of the rotation sensor 100 using the magnetic force as the detection medium to the controller. Even if the waveform of the sensor 100 is different, the rotation angle can be measured with high accuracy and no error by a reliable and simple method.

また、第2実施例によれば、回転センサ100から出力される第1および第2の検出信号400A、400Bに基づいて、回転センサ100の異常を判断することができ、計測結果の信頼性を向上させることができる。   Further, according to the second embodiment, the abnormality of the rotation sensor 100 can be determined based on the first and second detection signals 400A and 400B output from the rotation sensor 100, and the reliability of the measurement result can be improved. Can be improved.

なお、第1実施例、第2実施例では、回転センサ100が油圧ショベルなどの建設機械に搭載され油圧シリンダのストローク量を検出する場合を想定して説明したが、本発明としては、回転センサ100が搭載される機械、検出対象は、任意である。   In the first embodiment and the second embodiment, the case where the rotation sensor 100 is mounted on a construction machine such as a hydraulic excavator and detects the stroke amount of the hydraulic cylinder has been described. The machine on which 100 is mounted and the detection target are arbitrary.

(第3実施例)
ところで、油圧ショベルなどの油圧作業機械は、作業終了後にキースイッチ9をオフにして電源を切った後でも、長時間が経過(たとえば1か月)すれば、バケット等の作業機が自重によって下方に移動し、油圧シリンダ200内に残っていた圧油が徐々に排出され、油圧シリンダ200のストローク位置が変化することがある。
(Third embodiment)
By the way, in a hydraulic working machine such as a hydraulic excavator, when a long time elapses (for example, one month) even after the key switch 9 is turned off and the power is turned off after the work is finished, the working machine such as a bucket is lowered by its own weight The pressure oil remaining in the hydraulic cylinder 200 is gradually discharged, and the stroke position of the hydraulic cylinder 200 may change.

また、油圧作業機械では、作業終了後にキースイッチ9をオフにして電源8を切った後に、オペレータによって油圧シリンダ200の「圧抜き」の操作が行われることがある。   In the hydraulic working machine, after the operation is finished, the key switch 9 is turned off and the power supply 8 is turned off.

「圧抜き」操作が行われると、電源オフ期間中でも油圧シリンダ200内に残っていた圧油が排出され、油圧シリンダ200のストローク位置が変化することになる。   When the “pressure release” operation is performed, the pressure oil remaining in the hydraulic cylinder 200 is discharged even during the power-off period, and the stroke position of the hydraulic cylinder 200 changes.

このように油圧作業機械では、電源オフ(エンジン停止)期間中でも油圧シリンダ200のストローク位置が変化することがある。   Thus, in the hydraulic working machine, the stroke position of the hydraulic cylinder 200 may change even during the power-off (engine stop) period.

一方、回転センサ100の検出信号を計測用コントローラ30に入力させて計測用コントローラ30で油圧シリンダ200のストローク位置を計測しようとする場合には、その位置計測処理は、計測用コントローラ30が起動中、つまり計測用コントローラ30に電源8が投入されているときのみ行われる。   On the other hand, when the detection signal of the rotation sensor 100 is input to the measurement controller 30 and the stroke position of the hydraulic cylinder 200 is to be measured by the measurement controller 30, the position measurement process is performed when the measurement controller 30 is activated. That is, it is performed only when the power supply 8 is turned on to the measurement controller 30.

しかし、仮に、計測用コントローラ30の起動中以外の電源オフ期間に、油圧シリンダ200のストローク位置が変化してしまうと、その間は計測用コントローラ30で回転センサ100の検出信号に基づく計測処理が行われないため、電源8が再度オン(エンジン6が稼動)され、再度、計測用コントローラ30で計測処理を開始しようとしても、電源オフ期間中のストローク位置変化量がわからないため、位置計測処理そのものを行えなくなるおそれがある。   However, if the stroke position of the hydraulic cylinder 200 changes during a power-off period other than when the measurement controller 30 is activated, the measurement controller 30 performs measurement processing based on the detection signal of the rotation sensor 100 during that time. Therefore, even if the power supply 8 is turned on again (the engine 6 is running) and the measurement controller 30 tries to start the measurement process again, the stroke position change amount during the power-off period is not known. There is a risk that it will not be possible.

そこで、本第3実施例では、電源オフ(エンジン停止)期間中に油圧シリンダ200のストローク位置が変化するような場合であったとしても、計測用コントローラ30で回転センサ100の検出信号に基づき正確なストローク位置を確実に計測できるようにするものである。   Therefore, in the third embodiment, even if the stroke position of the hydraulic cylinder 200 changes during the power-off (engine stop) period, the measurement controller 30 accurately detects the stroke based on the detection signal of the rotation sensor 100. This makes it possible to reliably measure the correct stroke position.

図11、図12は、第3実施例の処理手順を示すフローチャートである。また、図13は、電源オフ、オンの前後のストローク位置を説明する図である。図13(a)は図8(c)に対応する図で、時間と、回転角度θ、回転数nとの関係を示す図で、図13(b)は、図13(a)に対応させて、時間とストローク位置Sとの関係を示す図である。   11 and 12 are flowcharts showing the processing procedure of the third embodiment. FIG. 13 is a diagram for explaining stroke positions before and after power-off and on. FIG. 13 (a) is a diagram corresponding to FIG. 8 (c), showing the relationship between time, rotation angle θ, and rotation speed n, and FIG. 13 (b) is made to correspond to FIG. 13 (a). It is a figure which shows the relationship between time and stroke position S.

なお、本第3実施例では、第1実施例の図10(a)で説明したように、回転センサ100から1つの検出信号400Aが出力されて、同じ電圧値VAから2つの回転角度θA1、θA2が求められる場合を想定して説明する。   In the third embodiment, as described with reference to FIG. 10A of the first embodiment, one detection signal 400A is output from the rotation sensor 100, and two rotation angles θA1, Description will be made assuming that θA2 is required.

図11(a)のステップ1001に示すように、計測用コントローラ30では、入力されるスイッチ状態信号Kのレベル(オン、オフ)が監視されており、エンジンキースイッチ9がオフ操作されたか否かが判断される(ステップ1001)。   As shown in step 1001 of FIG. 11A, the measurement controller 30 monitors the level (ON / OFF) of the input switch state signal K, and whether or not the engine key switch 9 has been turned OFF. Is determined (step 1001).

入力されるスイッチ状態信号Kのレベルがオフであり、エンジンキースイッチ9がオフ操作されたと判断されると(ステップ1001の判断YES)、つぎに、油圧シリンダ200の作動が可能な状態であるか否かの情報に基づいて、油圧シリンダ200の作動が可能な状態であるか否かが判断される。「油圧シリンダ200の作動が可能な状態であるか否かの情報」については、ここでは一例を挙げるが、他の各種例については後述する。   If it is determined that the level of the input switch state signal K is off and the engine key switch 9 is turned off (determination YES in step 1001), then whether the hydraulic cylinder 200 can be operated is checked. Based on the information on whether or not, it is determined whether or not the hydraulic cylinder 200 can be operated. An example of “information about whether the hydraulic cylinder 200 is operable” is given here, but other examples will be described later.

たとえば、図1の構成を想定すると、オフのスイッチ状態信号Kが入力されると(ステップ1001の判断YES)、内部のタイマ(ソフトウエアタイマあるいはハードタイマ)が作動し、設定時間まで計時を行う。ここで、タイマの設定時間は、たとえば「圧抜き」操作が可能な時間に設定される。すなわち、電源がオフされ、油圧式の操作レバー装置1に元圧を供給する定容量型ポンプ14が稼動を停止したとしても、電源オフ後の所定時間(たとえば30秒程度)は、アキュムレータ19には、操作レバー装置1を作動させて、油圧信号Ppを制御弁2に供給して制御弁2を駆動させて油圧シリンダ200を作動させるだけの圧力が残っており、その間は「圧抜き」操作は可能だからである(ステップ1002)。   For example, assuming the configuration of FIG. 1, when an OFF switch state signal K is input (determination YES in step 1001), an internal timer (software timer or hardware timer) is activated and measures time until a set time. . Here, the set time of the timer is set to a time during which the “pressure release” operation is possible, for example. That is, even if the power is turned off and the constant displacement pump 14 that supplies the original pressure to the hydraulic operation lever device 1 stops operating, the accumulator 19 is not activated for a predetermined time (for example, about 30 seconds) after the power is turned off. The operation lever device 1 is operated to supply the hydraulic pressure signal Pp to the control valve 2 to drive the control valve 2 and the pressure to operate the hydraulic cylinder 200 remains. Is possible (step 1002).

上記タイマによって設定時間の計時が終了すると、油圧シリンダ200の作動が不可能になったと判断される。つまり「圧抜き」操作はもはや不可能であり、「圧抜き」操作によっては油圧シリンダ200のストローク位置は変化しないと判断される(ステップ1002の判断YES)。そして、つぎに、回転センサ100の現在の検出信号400A(現在の電圧値VA)が入力され、第1実施例と同様に、現在の回転角度の候補値θA1′、θA2′が記憶テーブル36から読み出され、これらに基づき現在の回転角度θA0が求められる。この回転角度θA0が旧回転角度、つまり電源オフ時の回転角度θA0としてバックアップメモリに記憶される。また、回転ローラ110の回転数nがカウントされていれば、現在の回転数のカウント値nが、旧回転数、つまり電源オフ時の回転数nとしてバックアップメモリに記憶される(ステップ1003)。   When the timer finishes measuring the set time, it is determined that the hydraulic cylinder 200 cannot be operated. That is, it is determined that the “pressure releasing” operation is no longer possible, and that the stroke position of the hydraulic cylinder 200 is not changed by the “pressure releasing” operation (YES in step 1002). Next, the current detection signal 400A (current voltage value VA) of the rotation sensor 100 is input, and the current rotation angle candidate values θA1 ′ and θA2 ′ are stored from the storage table 36 as in the first embodiment. The current rotation angle θA0 is obtained based on these values. This rotation angle θA0 is stored in the backup memory as the old rotation angle, that is, the rotation angle θA0 when the power is turned off. If the rotational speed n of the rotating roller 110 is counted, the current rotational speed count value n is stored in the backup memory as the old rotational speed, that is, the rotational speed n when the power is turned off (step 1003).

つぎに、計測用コントローラ30の主要電源回路33の駆動がオフされ、計測用コントローラ30は起動停止状態、つまり電源オフ状態となる(ステップ1004)。   Next, the drive of the main power supply circuit 33 of the measurement controller 30 is turned off, and the measurement controller 30 enters a start-stop state, that is, a power-off state (step 1004).

スイッチ状態信号Kのレベル(オン、オフ)により、計測用コントローラ30の主要電源回路33が起動される。すなわち、主要電源回路33は、ロジック回路を備えており、エンジンキースイッチ9がオンのとき、またはソフトウェアからの指令信号が「電源オン」を指示しているときには、電源オンとなり、エンジンキースイッチ9がオフで、かつソフトウェアからの指令信号が「電源オン」でないときには、電源オフとなる。   The main power supply circuit 33 of the measurement controller 30 is activated by the level (ON / OFF) of the switch state signal K. That is, the main power supply circuit 33 includes a logic circuit. When the engine key switch 9 is turned on or when a command signal from the software indicates “power on”, the main power circuit 33 is turned on. Is off and the command signal from the software is not “power on”, the power is turned off.

主要電源回路33が起動されると(電源オンされると)(ステップ1101の判断YES)、バックアップメモリから旧回転角度(電源オフ時の回転角度)θA0、旧回転数(電源オフ時の回転数)nが読み出される。   When the main power supply circuit 33 is activated (when the power is turned on) (YES at step 1101), the old rotation angle (rotation angle when the power is turned off) θA0, the old rotation speed (the rotation number when the power is turned off) from the backup memory. ) N is read.

また、回転センサ100の現在の検出信号400A(現在の電圧値VA)が入力され、第2実施例と同様に、現在の回転角度(図13におけるθA1)が求められる(ステップ1102)。   Further, the current detection signal 400A (current voltage value VA) of the rotation sensor 100 is input, and the current rotation angle (θA1 in FIG. 13) is obtained as in the second embodiment (step 1102).

すなわち、図13(a)、(b)に例示するように、電源オフ時のストローク位置SA0から今回の電源オン時のストローク位置の候補値SA1、SA2までのストローク距離が小さくなる方の候補値SA1を、現在のストローク位置SA1として選択し、油圧シリンダ200のストローク位置Sが計測される(ステップ1103)。   That is, as illustrated in FIGS. 13A and 13B, the candidate value of the shorter stroke distance from the stroke position SA0 when the power is turned off to the candidate values SA1 and SA2 of the stroke position when the power is turned on this time. SA1 is selected as the current stroke position SA1, and the stroke position S of the hydraulic cylinder 200 is measured (step 1103).

ステップ1103のストローク位置計測処理は、図12にサブルーチンで示される。   The stroke position measurement process in step 1103 is shown by a subroutine in FIG.

この位置計測処理は、回転センサ100の回転ローラ110が、旧回転角度θA0から新回転角度θA1になるまでには、半回転〜1回転(180゜+α)以上には回転していないという前提で行われるものである。上述したステップ1002では、回転ローラ110を1回転以上回転させることがある「圧抜き」操作がもはや不可能になったときの回転角度を、旧回転角度θA0としており、つぎに電源がオンされるまでには、回転ローラ110は1回転以上には大きく回転されることはないからである。電源オフからオンまでの間に回転ローラ110が1回転以上回転されてしまうと、その間では計測用コントローラ30で回転数nをカウントする処理が行われないため回転数は不定となり、位置計測処理を行うことはできない。このような状況になることをステップ1002の処理で取り除いたものである。   This position measurement process is based on the premise that the rotation roller 110 of the rotation sensor 100 does not rotate from half rotation to one rotation (180 ° + α) or more before the rotation angle θA0 reaches the new rotation angle θA1. Is to be done. In step 1002 described above, the rotation angle when the “pressure release” operation that may rotate the rotating roller 110 one or more times is no longer possible is the old rotation angle θA0, and then the power is turned on. This is because the rotating roller 110 does not rotate more than one rotation until then. If the rotation roller 110 is rotated one or more times between the time when the power is turned off and the time when the power is turned off, the measurement controller 30 does not perform the process of counting the rotation speed n during that time, so the rotation speed becomes indefinite and the position measurement process is performed. Can't do it. This situation is eliminated by the processing in step 1002.

以下においては、図13における図中右方向の回転方向を正転方向、図中左方向の回転方向を逆転方向とする。   In the following, the rightward rotation direction in FIG. 13 is the forward rotation direction, and the left rotation direction in the drawing is the reverse rotation direction.

同図12に示すように、まず、新回転角度θA1から旧回転角度θA0を減算した値が0゜以上であるか否か、つまり、
新回転角度(θA1)−旧回転角度(θA0)≧0゜
であるかが判断される(ステップ1201)。
As shown in FIG. 12, first, whether or not the value obtained by subtracting the old rotation angle θA0 from the new rotation angle θA1 is 0 ° or more, that is,
It is determined whether or not new rotation angle (θA1) −old rotation angle (θA0) ≧ 0 ° (step 1201).

このステップ1201の判断がYESであるとすると、つぎに、新回転角度θA1から旧回転角度θA0を減算した値が180゜+αよりも小さいか否か、つまり、
新回転角度(θA1)−旧回転角度(θA0)<180゜+α
であるかが判断される。ここで、αは、ブーム、アーム、バケットなどの作業機が重力によって落下されるなど、回転ローラ110が正転方向に回転することが予想される場合には、αは、0゜<α<180゜の範囲で設定されておかれ、逆回転が予想される場合には、αは、180゜<α<0゜の範囲で設定されておかれる(ステップ1202)。
If the determination in step 1201 is YES, then whether or not the value obtained by subtracting the old rotation angle θA0 from the new rotation angle θA1 is smaller than 180 ° + α, that is,
New rotation angle (θA1)-Old rotation angle (θA0) <180 ° + α
Is determined. Here, α is 0 ° <α <when the rotating roller 110 is expected to rotate in the forward rotation direction, for example, when a work machine such as a boom, an arm, or a bucket is dropped by gravity. If it is set in the range of 180 ° and reverse rotation is expected, α is set in the range of 180 ° <α <0 ° (step 1202).

このステップ1202の判断がYESであると、回転ローラ110は正転方向に回転したものと判断される(ステップ1203)。   If the determination in step 1202 is YES, it is determined that the rotating roller 110 has rotated in the forward direction (step 1203).

一方、ステップ1202の判断がNOであると、回転ローラ110は逆転方向に回転したものと判断される(ステップ1204)。   On the other hand, if the determination in step 1202 is NO, it is determined that the rotating roller 110 has rotated in the reverse direction (step 1204).

ステップ1201の判断がNOであったとすると、つぎに、新回転角度θA1から旧回転角度θA0を減算した値が−(180゜−α)よりも大きいか否か、つまり、
新回転角度(θA1)−旧回転角度(θA0)>−(180゜−α)
であるかが判断される(ステップ1205)。
If the determination in step 1201 is NO, then whether or not the value obtained by subtracting the old rotation angle θA0 from the new rotation angle θA1 is larger than − (180 ° −α), that is,
New rotation angle (θA1)-Old rotation angle (θA0)>-(180 °-α)
Is determined (step 1205).

このステップ1205の判断がYESであると、回転ローラ110は逆転方向に回転したものと判断される(ステップ1206)。   If the determination in step 1205 is YES, it is determined that the rotating roller 110 has rotated in the reverse direction (step 1206).

一方、ステップ1205の判断がNOであると、回転ローラ110は正転方向に回転したものと判断される(ステップ1207)。   On the other hand, if the determination in step 1205 is NO, it is determined that the rotating roller 110 has rotated in the forward rotation direction (step 1207).

つぎに、上記の判断の結果、回転ローラ110が正転方向に回転され、かつ新回転角度θA1が180゜よりも小さく(新回転角度(θA1)<180゜)、かつ旧回転角度θA0が180゜よりも大きい(旧回転角度(θA0)>180゜)か否かが判断される(ステップ1208)。   Next, as a result of the above determination, the rotating roller 110 is rotated in the forward direction, the new rotation angle θA1 is smaller than 180 ° (new rotation angle (θA1) <180 °), and the old rotation angle θA0 is 180. It is determined whether or not the angle is larger than the angle (old rotation angle (θA0)> 180 °) (step 1208).

ステップ1208の判断がYESである場合には、旧回転角度θA0から新回転角度θA1に移行するまでの間に、360゜から0゜への切り替わりが発生したものと判断し(図13(a)参照)、旧回転数nを+1だけインクリメントして(正転方向に1回転回転したものとして)、新たな回転数n(n+1→n)とする(ステップ1209)。   If the determination in step 1208 is YES, it is determined that switching from 360 ° to 0 ° has occurred during the transition from the old rotation angle θA0 to the new rotation angle θA1 (FIG. 13A). The old rotation number n is incremented by +1 (assuming one rotation in the forward rotation direction) to obtain a new rotation number n (n + 1 → n) (step 1209).

一方、ステップ1208の判断がNOである場合には、つぎに、回転ローラ110が逆転方向に回転され、かつ新回転角度θA1が180゜よりも大きく(新回転角度(θA1)>180゜)、かつ旧回転角度θA0が180゜よりも小さい(旧回転角度(θA0)<180゜)か否かが判断される(ステップ1210)。   On the other hand, if the determination in step 1208 is NO, then the rotating roller 110 is rotated in the reverse direction, and the new rotation angle θA1 is greater than 180 ° (new rotation angle (θA1)> 180 °). Further, it is determined whether or not the old rotation angle θA0 is smaller than 180 ° (old rotation angle (θA0) <180 °) (step 1210).

ステップ1210の判断がYESである場合には、旧回転角度θA0から新回転角度θA1に移行するまでの間に、0゜から360゜への切り替わりが発生したものと判断し、旧回転数nを−1だけインクリメントして(逆転方向に1回転回転したものとして)、新たな回転数n(n−1→n)とする(ステップ1211)。   If the determination in step 1210 is YES, it is determined that a change from 0 ° to 360 ° occurred before the transition from the old rotation angle θA0 to the new rotation angle θA1, and the old rotation speed n is set to Incremented by −1 (assuming one rotation in the reverse direction) and set to a new number of rotations n (n−1 → n) (step 1211).

ステップ1210の判断がNOである場合には、回転数nを更新することなく、つぎのステップ1212に移行する。また、ステップ1209、ステップ1211で回転数nを更新した後に、ステップ1212に移行する。   If the determination in step 1210 is NO, the process proceeds to the next step 1212 without updating the rotation speed n. In addition, after updating the rotation speed n in steps 1209 and 1211, the process proceeds to step 1212.

ステップ1212では、現在の回転ローラ110の回転数n、新回転角度θA1に基づいて、下記演算式によって、油圧シリンダ200のストローク位置Sが演算される。   In step 1212, the stroke position S of the hydraulic cylinder 200 is calculated by the following calculation formula based on the current rotation speed n of the rotating roller 110 and the new rotation angle θA1.

S=(回転数n+新回転角度(θA1)/360゜)×回転半径d×2π
ここで、回転半径dは、前述したように、ロッド202の表面から回転ローラ110の回転中心軸110cまでの距離のことである(ステップ1212)。
S = (rotation speed n + new rotation angle (θA1) / 360 °) × rotation radius d × 2π
Here, as described above, the rotation radius d is the distance from the surface of the rod 202 to the rotation center axis 110c of the rotation roller 110 (step 1212).

以上のように本第3実施例によれば、電源オフ(エンジン停止)期間中に油圧シリンダ200のストローク位置が変化するような場合であったとしても、油圧シリンダ200の作動が不可能になったときの回転数、回転角度を旧回転角度、旧回転数として、この旧回転数、旧回転数に基づいて、電源が再度オンされたときのストローク位置を計測するようにしたので、回転数が不定になることなくストローク位置の計測を確実に行うことができる。   As described above, according to the third embodiment, even if the stroke position of the hydraulic cylinder 200 changes during the power-off (engine stop) period, the hydraulic cylinder 200 cannot be operated. Since the rotation speed and rotation angle are the old rotation angle and old rotation speed, the stroke position when the power is turned on again is measured based on the old rotation speed and old rotation speed. It is possible to reliably measure the stroke position without becoming unstable.

(第4実施例)
上述した第3実施例では、油圧シリンダ200の作動が不可能になったか否かの情報として、エンジンキースイッチ9がオフ操作されてから設定時間が経過したか否かの情報を用いているが(ステップ1002)、これは一例であり、つぎに掲げるように各種の他の実施が可能である。以下においては、図11、図12のフローチャートについて、ステップ1001、1002、1101に係る部分のみ説明し、他の処理については第3実施例と同様の処理が行われるものとして、詳細な説明は省略する。
(Fourth embodiment)
In the third embodiment described above, information on whether or not the set time has elapsed since the engine key switch 9 was turned off is used as information on whether or not the operation of the hydraulic cylinder 200 has become impossible. (Step 1002), this is an example, and various other implementations are possible as listed below. In the following, with respect to the flowcharts of FIGS. 11 and 12, only portions relating to steps 1001, 1002, and 1101 will be described, and the other processing is the same as in the third embodiment, and detailed description thereof is omitted. To do.

(第4実施例の他の実施例1)
図1の構成において、油圧シリンダ200の作動が不可能になったか否かの情報として、圧力センサ15で検出された圧力が所定のしきい値以下になったか否かの情報を用いてもよい。
(Another embodiment 1 of the fourth embodiment)
In the configuration of FIG. 1, information on whether or not the pressure detected by the pressure sensor 15 has become a predetermined threshold value or less may be used as information on whether or not the operation of the hydraulic cylinder 200 has become impossible. .

すなわち、オフのスイッチ状態信号Kが入力されると(ステップ1001の判断YES)、圧力センサ15の検出信号を入力し、検出圧力が所定のしきい値以下になったか否か、つまりアキュムレータ19内の圧力が、「圧抜き」操作が不可能になる圧力にまで低下したか否かが判断される(ステップ1002)。   That is, when the OFF switch state signal K is input (determination YES in step 1001), the detection signal of the pressure sensor 15 is input, whether or not the detected pressure has become a predetermined threshold value or less, that is, in the accumulator 19 It is determined whether or not the pressure has decreased to a pressure at which the “pressure release” operation becomes impossible (step 1002).

圧力センサ15で検出された圧力が所定のしきい値以下になったと判断されると、もはや油圧シリンダ200の作動は不可能になったと判断して(ステップ1002の判断YES)、そのときの回転ローラ110の回転角度、回転数を求め、これを旧回転角度、旧回転数として記憶して(ステップ1003)、計測用コントローラ30の電源をオフにする(ステップ1004)。   If it is determined that the pressure detected by the pressure sensor 15 has become equal to or lower than a predetermined threshold value, it is determined that the hydraulic cylinder 200 can no longer operate (YES in step 1002), and the rotation at that time is determined. The rotation angle and the rotation number of the roller 110 are obtained, stored as the old rotation angle and the old rotation number (step 1003), and the measurement controller 30 is turned off (step 1004).

(第4実施例の他の実施例2)
図2の構成において、制御用コントローラ20から、油圧シリンダ200の作動が不可能になったか否かの情報の信号Jを、計測用コントローラ30に入力させ、計測用コントローラ30において、この入力信号Jに基づいて油圧シリンダ200の作動が不可能になったか否かを判断してもよい。
(Other embodiment 2 of the fourth embodiment)
In the configuration of FIG. 2, a signal J indicating whether or not the hydraulic cylinder 200 cannot be operated is input from the control controller 20 to the measurement controller 30, and the input signal J Based on the above, it may be determined whether the operation of the hydraulic cylinder 200 has become impossible.

すなわち、制御用コントローラ20には、スイッチ状態信号Kが入力されており、このスイッチ状態信号Kのレベル(オン、オフ)が常時監視されていて、エンジンキースイッチ9がオン、オフ操作されたか否かが常時判断されている。   That is, the switch state signal K is input to the control controller 20, the level (on / off) of the switch state signal K is constantly monitored, and whether or not the engine key switch 9 is turned on / off. Is always judged.

制御用コントローラ20で、スイッチ状態信号Kがオフ状態になったと判断されると、このオフ状態から設定時間(操作レバー3aによって「圧抜き」操作が行われる可能性のある時間)が経過したか否かが判断される。また、電気式の操作レバー装置3から入力される操作電気信号Stを監視して、オフ状態になってから操作レバー3aの操作が継続して行われているか否かを判断してもよい。   If it is determined by the control controller 20 that the switch state signal K has been turned off, whether a set time (a time during which a “pressure release” operation may be performed by the operation lever 3a) has elapsed from the off state. It is determined whether or not. Alternatively, the operation electric signal St input from the electric operation lever device 3 may be monitored to determine whether or not the operation lever 3a is continuously operated after being turned off.

このように制御用コントローラ20では、エンジンキースイッチ9がオフ操作されてから、油圧シリンダ200の作動が不可能になったか否かの判断がなされ、その判断内容(1レベル、0レベル)の信号Jが生成される。   As described above, the control controller 20 determines whether or not the hydraulic cylinder 200 can be operated after the engine key switch 9 is turned off, and a signal indicating the determination contents (1 level, 0 level). J is generated.

制御用コントローラ20では、信号Jが1レベルに変化すると、もはや「圧抜き」操作はされないと判断して、制御用コントローラ20の主要電源回路23の駆動がオフにされ、制御用コントローラ20は起動停止状態、つまり電源オフ状態となる。なお、エンジンキースイッチ9がオン状態になっていれば、信号Jは0レベルとなっている。   When the signal J changes to 1 level, the control controller 20 determines that the “pressure release” operation is no longer performed, and the drive of the main power supply circuit 23 of the control controller 20 is turned off, and the control controller 20 is activated. It becomes a stop state, that is, a power-off state. If the engine key switch 9 is on, the signal J is at 0 level.

このように信号Jは、エンジンキースイッチ9のオンオフにかかわらず、油圧シリンダ200の作動が可能な状態、つまり制御電気信号iが制御弁4に供給可能な状態であれば、0レベルであり、エンジンキースイッチ9がオフであって、油圧シリンダ200の作動が不可能な状態、つまり制御電気信号iが制御弁4に供給不可能な状態になると、1レベルとなる。   Thus, the signal J is 0 level if the hydraulic cylinder 200 can be operated regardless of whether the engine key switch 9 is on or off, that is, if the control electric signal i can be supplied to the control valve 4. When the engine key switch 9 is OFF and the hydraulic cylinder 200 cannot be operated, that is, when the control electric signal i cannot be supplied to the control valve 4, the level becomes 1 level.

計測用コントローラ30では、図11(a)のステップ1001、1002の代わりに以下の処理が実行される。
制御用コントローラ20から、油圧シリンダ200の作動が不可能になったか否かを示す信号Jが入力され、入力された信号Jのレベルが1であるか0であるかが判断される(ステップ1001′、1002′)。
In the measurement controller 30, the following processing is executed instead of steps 1001 and 1002 in FIG.
A signal J indicating whether or not the operation of the hydraulic cylinder 200 has become impossible is input from the control controller 20, and it is determined whether the level of the input signal J is 1 or 0 (step 1001). ', 1002').

信号Jのレベルが1レベルになったと判断されると、油圧シリンダ200の作動は不可能になったと判断して(ステップ1001′、1002′の判断YES)、そのときの回転ローラ110の回転角度、回転数を求め、これを旧回転角度、旧回転数として記憶して(ステップ1003)、計測用コントローラ30の電源をオフにする(ステップ1004)。   If it is determined that the level of the signal J has reached 1 level, it is determined that the operation of the hydraulic cylinder 200 has become impossible (YES in Steps 1001 ′ and 1002 ′), and the rotation angle of the rotating roller 110 at that time The rotation speed is obtained, stored as the old rotation angle and the old rotation speed (step 1003), and the measurement controller 30 is turned off (step 1004).

計測用コントローラ30では、図11(b)のステップ1101の代わりに以下の処理が実行される。
制御用コントローラ20から、油圧シリンダ200の作動が不可能になったか否かを示す信号Jが入力され、入力された信号Jのレベルが0であるか1であるかが判断される(ステップ1101′)。
In the measurement controller 30, the following processing is executed instead of step 1101 in FIG.
A signal J indicating whether or not the operation of the hydraulic cylinder 200 has become impossible is input from the control controller 20, and it is determined whether the level of the input signal J is 0 or 1 (step 1101). ′).

入力される信号Jのレベルが0であり、エンジンキースイッチ9がオン操作されたと判断されると(ステップ1101′の判断YES)、つぎのステップ1101に移行して、旧回転角度、旧回転数を読み出すとともに、新回転角度を求める処理が実行される(ステップ1101)。   If it is determined that the level of the input signal J is 0 and the engine key switch 9 has been turned on (YES at step 1101 ′), the routine proceeds to the next step 1101, where the old rotation angle and the old rotation speed are determined. And a process for obtaining a new rotation angle is executed (step 1101).

ところで、油圧ショベル等の油圧作業機械には、通常、作業機が多数(ブーム、アーム、バケット)あり、各作業機をストローク位置センサからの検出信号に基づいて制御しようとすると、多数のストローク位置センサが必要になる。しかも上述した各実施例のように、ストローク位置を、回転センサ100とリセットセンサ300の検出信号に基づいて、計測しようとすると、センサの数は、更に膨大な数となり、演算処理は煩雑かつ多大な時間を要することになる。そして、更に、仮に、これら膨大な数のセンサに基づく煩雑な計測処理を、制御信号を生成する処理も行わなければならない制御用コントローラ20で行わせようとすると、制御用コントローラ20における演算負荷は、膨大なものとなる。このため演算処理能力の高い大容量の制御用コントローラ20を新規に開発しなければならなくなる。そして、演算処理能力の高い大容量の制御用コントローラ20を新規に開発するとなると、車内の制御システムのコストが嵩むという問題が招来する。   By the way, a hydraulic working machine such as a hydraulic excavator usually has a large number of work machines (boom, arm, bucket), and when each work machine is controlled based on a detection signal from a stroke position sensor, a large number of stroke positions are detected. A sensor is required. Moreover, as in each of the embodiments described above, when the stroke position is to be measured based on the detection signals of the rotation sensor 100 and the reset sensor 300, the number of sensors becomes even larger, and the calculation process is complicated and enormous. It will take a long time. Further, if it is attempted to perform complicated measurement processing based on these enormous number of sensors in the control controller 20 that must also perform processing for generating a control signal, the calculation load on the control controller 20 is as follows. , Become enormous. For this reason, it is necessary to newly develop a large-capacity control controller 20 having a high processing capacity. When a large-capacity control controller 20 having a high arithmetic processing capacity is newly developed, there arises a problem that the cost of the control system in the vehicle increases.

この点、本実施例によれば、図3に示すように、制御信号を生成、出力する制御用コントローラ20とは、独立して計測用コントローラ30を設け、この計測用コントローラ30に回転センサ100、リセットセンサ300の検出信号を入力させて、ストローク位置の計測処理を行わせ、計測結果を制御用コントローラ20に送るようにしており、制御用コントローラ20では、ストローク位置計測処理を行う必要がない。   In this regard, according to the present embodiment, as shown in FIG. 3, a measurement controller 30 is provided independently of the control controller 20 that generates and outputs a control signal, and the rotation sensor 100 is provided in the measurement controller 30. The detection signal of the reset sensor 300 is input, the stroke position measurement process is performed, and the measurement result is sent to the control controller 20. The control controller 20 does not need to perform the stroke position measurement process. .

このため、新規に演算処理能力の高い大容量の制御用コントローラ20を開発する必要がなくなり、既存の制御用コントローラ20をそのまま利用することができ、油圧作業機械の車内の制御システムのコストを飛躍的に低減させることができる。   This eliminates the need to newly develop a large-capacity control controller 20 having a high processing capacity, allowing the existing control controller 20 to be used as it is, and increasing the cost of the control system inside the hydraulic work machine. Can be reduced.

なお、第3実施例、第4実施例では、回転センサ100が油圧ショベルなどの建設機械に搭載され油圧シリンダのストローク量を検出する場合を想定して説明したが、本発明としては、回転センサ100が搭載される機械、検出対象は、任意である。   In the third and fourth embodiments, the case where the rotation sensor 100 is mounted on a construction machine such as a hydraulic excavator and detects the stroke amount of the hydraulic cylinder has been described. The machine on which 100 is mounted and the detection target are arbitrary.

(第5実施例)
ところで、本実施形態のように回転センサ100を磁力センサで構成したとすると、回転センサ100で検出される信号レベル(電圧値)は、温度や他の磁界発生源(ノイズ)や検出対象の磁石145の取付け誤差、回転ローラ110のガタなどの影響を受け、変動する場合がある。たとえば、図14に示すように、低温から高温に変化するに伴い磁力が弱まり、回転センサ100で検出される信号レベルが低下する。このため回転センサ100の出力電圧Vを、記憶テーブル36のデータにしたがいそのまま回転角度θに変換すると、実際には真の回転角度は同じでありながら、低温時と高温時とで計算上の回転角度が異なってしまい、回転角度の計測値に誤差が生じることになる。
(5th Example)
By the way, when the rotation sensor 100 is configured by a magnetic sensor as in the present embodiment, the signal level (voltage value) detected by the rotation sensor 100 is the temperature, other magnetic field generation source (noise), or the magnet to be detected. It may be affected by the mounting error of 145, the backlash of the rotating roller 110, and the like. For example, as shown in FIG. 14, as the temperature changes from low to high, the magnetic force is weakened, and the signal level detected by the rotation sensor 100 decreases. Therefore, if the output voltage V of the rotation sensor 100 is converted into the rotation angle θ as it is according to the data in the storage table 36, the calculated rotation is low and high, although the true rotation angle is actually the same. The angle is different, and an error occurs in the measured value of the rotation angle.

そこで、本第5実施例は、磁力を検出媒体とする回転センサ100の検出信号レベルが温度等によって変動したとしても、確実かつ簡易な方法で、誤差なく高精度に回転角度を計測できるようにするものである。   Therefore, in the fifth embodiment, even if the detection signal level of the rotation sensor 100 using the magnetic force as a detection medium fluctuates due to the temperature or the like, the rotation angle can be measured with high accuracy and no error by a reliable and simple method. To do.

図21、図22、図23は本第5実施例の処理手順を示すフローチャートであり、図16は図21、図22、図23の説明図で、図10(b)と同様に回転センサ100から出力される互いに位相が異なる第1および第2の検出信号400A、400Bを示している。ただし、図16では、説明の便宜上、図10(b)に示す第1および第2の検出信号400A、400Bを入れ換えて図示している。   21, 22, and 23 are flowcharts showing the processing procedure of the fifth embodiment, and FIG. 16 is an explanatory diagram of FIGS. 21, 22, and 23, and the rotation sensor 100 as in FIG. The 1st and 2nd detection signal 400A, 400B from which a phase mutually differs is output. However, in FIG. 16, for convenience of explanation, the first and second detection signals 400A and 400B shown in FIG.

本第5実施例では、予め第1および第2の検出信号400A、400Bの最大ピーク電圧値、最小ピーク電圧値の基準値を記憶しておき、回転センサ100から出力される第1および第2の検出信号400A、400Bが1周期変化したときの各電圧値の中から最大ピーク電圧値、最小ピーク電圧値を求め、求められた最大ピーク電圧値、最小ピーク電圧値と、記憶されている最大ピーク基準電圧値、最小ピーク基準電圧値とを比較し、求められた最大ピーク電圧値が記憶されている最大ピーク基準電圧値に一致しかつ求められた最小ピーク電圧値が記憶されている最小ピーク基準電圧値に一致するように、回転センサ400から出力される第1および第2の検出信号400A、400Bを補正する処理が計測用コントローラ30で行われる。   In the fifth embodiment, the reference values of the maximum peak voltage value and the minimum peak voltage value of the first and second detection signals 400A and 400B are stored in advance, and the first and second output from the rotation sensor 100 are stored. The maximum peak voltage value and the minimum peak voltage value are obtained from the respective voltage values when the detection signals 400A and 400B of the signal change for one cycle, and the obtained maximum peak voltage value, minimum peak voltage value, and stored maximum Compare the peak reference voltage value and the minimum peak reference voltage value, and the calculated maximum peak voltage value matches the stored maximum peak reference voltage value and the minimum peak voltage stored is stored The measurement controller 30 performs a process of correcting the first and second detection signals 400A and 400B output from the rotation sensor 400 so as to match the reference voltage value.

図21、図22、図23、図16を説明するにあたり、演算処理に用いられる符号の意味について以下のように定義する。   In describing FIGS. 21, 22, 23, and 16, the meanings of symbols used in arithmetic processing are defined as follows.

A1;第1の検出信号400Aの検出信号レベル(検出電圧値)の最大値が格 納されるアドレス(以下、第1信号最大値変数A1)
A2;第1の検出信号400Aの検出信号レベル(検出電圧値)の最小値が格 納されるアドレス(以下、第1信号最小値変数A2)
B1;第2の検出信号400Bの検出信号レベル(検出電圧値)の最大値が格 納されるアドレス(以下、第2信号最大値変数B1)
B2;第2の検出信号400Bの検出信号レベル(検出電圧値)の最小値が格 納されるアドレス(以下、第2信号最小値変数B2)
posi〔0〕;今回、通過したと判断されたピークのタイプが格納されるアドレ ス(以下、今回ピークタイプposi〔0〕)
posi〔1〕;前回、通過したと判断されたピークのタイプが格納されるアドレ ス(以下、前回ピークタイプposi〔1〕)
posi〔2〕;前々回、通過したと判断されたピークのタイプが格納されるアド レス(以下、前々回ピークタイプposi〔2〕)
AMAX;第1信号最大値変数A1に格納された値が真の最大ピーク値であ ると確定された場合に、その最大ピーク値が格納されるメモリ (以下、第1信号最大ピーク値メモリAMAX)
AMIN;第1信号最小値変数A2に格納された値が真の最小ピーク値であ ると確定された場合に、その最小ピーク値が格納されるメモリ( 以下、第1信号最小ピーク値メモリAMIN)
BMAX;第2信号最大値変数B1に格納された値が真の最大ピーク値であ ると確定された場合に、その最大ピーク値が格納されるメモリ( 以下、第2信号最大ピーク値メモリBMAX)
BMIN;第2信号最小値変数B2に格納された値が真の最小ピーク値であ ると確定された場合に、その最小ピーク値が格納されるメモリ( 以下、第2信号最小ピーク値メモリBMIN)

ここで、ピークタイプとは、ピーク値が最大ピーク値であるか最小ピーク値であるかの別、ピーク値をとった信号が第1の検出信号400Aであるか第2の検出信号400Bであるかの別の識別する符号のことであり、図16に示すように、第2の検出信号400Bが最大ピーク値をとるピークタイプ(2)、第1の検出信号400Aが最大ピーク値をとるピークタイプ(3)、第2の検出信号400Bが最小値をとるピークタイプ(4)、第1の検出信号400Aが最小値をとるピークタイプ(1)がある。
A1: Address where the maximum value of the detection signal level (detection voltage value) of the first detection signal 400A is stored (hereinafter referred to as first signal maximum value variable A1)
A2: Address where the minimum value of the detection signal level (detection voltage value) of the first detection signal 400A is stored (hereinafter referred to as the first signal minimum value variable A2).
B1: Address where the maximum value of the detection signal level (detection voltage value) of the second detection signal 400B is stored (hereinafter referred to as second signal maximum value variable B1)
B2: Address where the minimum value of the detection signal level (detection voltage value) of the second detection signal 400B is stored (hereinafter referred to as second signal minimum value variable B2).
posi [0]: The address where the type of the peak that was judged to have passed this time is stored (hereinafter peak type posi [0]).
posi [1]: The address where the type of peak that was previously passed is stored (hereinafter referred to as the previous peak type posi [1])
posi [2]: Address that stores the type of peak that was determined to have passed the previous time (hereinafter referred to as the previous peak type posi [2])
AMAX; a memory for storing the maximum peak value when the value stored in the first signal maximum value variable A1 is determined to be a true maximum peak value (hereinafter referred to as a first signal maximum peak value memory AMAX). )
AMIN: Memory in which the minimum peak value is stored when it is determined that the value stored in the first signal minimum value variable A2 is the true minimum peak value (hereinafter, the first signal minimum peak value memory AMIN). )
BMAX; a memory for storing the maximum peak value when the value stored in the second signal maximum value variable B1 is determined to be the true maximum peak value (hereinafter, the second signal maximum peak value memory BMAX). )
BMIN: Memory in which the minimum peak value is stored when it is determined that the value stored in the second signal minimum value variable B2 is the true minimum peak value (hereinafter, the second signal minimum peak value memory BMIN). )

Here, the peak type is whether the peak value is the maximum peak value or the minimum peak value, and the signal having the peak value is the first detection signal 400A or the second detection signal 400B. As shown in FIG. 16, the second detection signal 400B has a maximum peak value (2), and the first detection signal 400A has a maximum peak value, as shown in FIG. There are a type (3), a peak type (4) in which the second detection signal 400B has a minimum value, and a peak type (1) in which the first detection signal 400A has a minimum value.

また、各メモリAMAX、AMIN、BMAX、BMINには、回転ローラ110の10回転分のデータが記憶される。   Each memory AMAX, AMIN, BMAX, BMIN stores data for 10 rotations of the rotating roller 110.

また、第1信号最大値変数A1、第2信号最大値変数B1に格納される値の初期値は、0Vに設定されており、第1信号最小値変数A2、第2信号最小値変数B2に格納される値の初期値は、5Vに設定されている。   The initial values stored in the first signal maximum value variable A1 and the second signal maximum value variable B1 are set to 0V, and the first signal minimum value variable A2 and the second signal minimum value variable B2 The initial value of the stored value is set to 5V.

また、第1信号最大値変数A1に格納された値が真の最大ピーク値であると確定されると、第1信号最大値変数A1に格納される値は、初期値(0V)にクリアされ、第1信号最小値変数A2に格納された値が真の最小ピーク値であると確定されると、第1信号最小変数A2に格納される値は、初期値(5V)にクリアされる。第2信号最大値変数B1、第2信号最小値変数B2についても同様にしてクリアされる。   When it is determined that the value stored in the first signal maximum value variable A1 is the true maximum peak value, the value stored in the first signal maximum value variable A1 is cleared to the initial value (0 V). When it is determined that the value stored in the first signal minimum value variable A2 is the true minimum peak value, the value stored in the first signal minimum variable A2 is cleared to the initial value (5V). The second signal maximum value variable B1 and the second signal minimum value variable B2 are similarly cleared.

図21に示すように、処理が開始されると、第1の検出信号400Aの現在の検出電圧値が、第1信号最大値変数A1の格納値よりも大きいか否かが判断される(ステップ1301)、このステップ1301の判断がYESの場合には、第1信号最大値変数A1の格納値を、第1の検出信号400Aの現在の検出電圧値によって更新して(ステップ1302)、つぎのステップ1303に移行する。ステップ1301の判断がNOの場合にも、ステップ1303に移行する。   As shown in FIG. 21, when the process is started, it is determined whether or not the current detection voltage value of the first detection signal 400A is larger than the stored value of the first signal maximum value variable A1 (step). 1301) If the determination in step 1301 is YES, the stored value of the first signal maximum value variable A1 is updated with the current detection voltage value of the first detection signal 400A (step 1302). Control goes to step 1303. Even when the determination in step 1301 is NO, the process proceeds to step 1303.

ステップ1303では、第2の検出信号400Bの現在の検出電圧値が、第2信号最大値変数B1の格納値よりも大きいか否かが判断される(ステップ1303)、このステップ1303の判断がYESの場合には、第2信号最大値変数B1の格納値を、第2の検出信号400Bの現在の検出電圧値によって更新して(ステップ1304)、つぎのステップ1305に移行する。ステップ1303の判断がNOの場合にも、ステップ1305に移行する。   In step 1303, it is determined whether or not the current detection voltage value of the second detection signal 400B is larger than the stored value of the second signal maximum value variable B1 (step 1303). The determination in step 1303 is YES. In this case, the stored value of the second signal maximum value variable B1 is updated with the current detection voltage value of the second detection signal 400B (step 1304), and the process proceeds to the next step 1305. Even when the determination in step 1303 is NO, the process proceeds to step 1305.

第1の検出信号400Aの現在の検出電圧値が、第1信号最小値変数A2の格納値よりも小さいか否かが判断される(ステップ1305)、このステップ1305の判断がYESの場合には、第1信号最小値変数A2の格納値を、第1の検出信号400Aの現在の検出電圧値によって更新して(ステップ1306)、つぎのステップ1307に移行する。ステップ1305の判断がNOの場合にも、ステップ1307に移行する。   It is determined whether or not the current detection voltage value of the first detection signal 400A is smaller than the stored value of the first signal minimum value variable A2 (step 1305). If the determination in step 1305 is YES, The stored value of the first signal minimum value variable A2 is updated with the current detection voltage value of the first detection signal 400A (step 1306), and the process proceeds to the next step 1307. Even when the determination in step 1305 is NO, the process proceeds to step 1307.

ステップ1307では、第2の検出信号400Bの現在の検出電圧値が、第2信号最小値変数B2の格納値よりも小さいか否かが判断される(ステップ1307)、このステップ1307の判断がYESの場合には、第2信号最小値変数B2の格納値を、第2の検出信号400Bの現在の検出電圧値によって更新して(ステップ1308)、図22に示すつぎのステップ1309に移行する。ステップ1307の判断がNOの場合にも、ステップ1309に移行する。   In step 1307, it is determined whether or not the current detection voltage value of the second detection signal 400B is smaller than the stored value of the second signal minimum value variable B2 (step 1307). The determination in step 1307 is YES. In this case, the stored value of the second signal minimum value variable B2 is updated with the current detection voltage value of the second detection signal 400B (step 1308), and the process proceeds to the next step 1309 shown in FIG. Even when the determination in step 1307 is NO, the process proceeds to step 1309.

ステップ1309では、第1の検出信号400Aの現在の検出電圧値が最小ピーク値であるか否かが判定される。たとえば図16に示すように、第1の検出信号400Aの現在の検出電圧値が、第2の検出信号400Bの現在の検出電圧値よりも小さく、かつ第1の検出信号400Aの現在の検出電圧値がしきい値C1よりも小さいか否かを判断することによって、上記判定がなされる(ステップ1309)。   In step 1309, it is determined whether or not the current detection voltage value of the first detection signal 400A is the minimum peak value. For example, as shown in FIG. 16, the current detection voltage value of the first detection signal 400A is smaller than the current detection voltage value of the second detection signal 400B, and the current detection voltage of the first detection signal 400A. The above determination is made by determining whether or not the value is smaller than the threshold value C1 (step 1309).

つぎに、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(2)、(3)、(4)または(4)、(3)、(2)であるか否かが判断される(ステップ1310)。   Next, the peak types stored in the previous peak type posi [2], the previous peak type posi [1], and the current peak type posi [0] are read out, and the previous peak type posi [2] and the previous peak type posi [ 1] and whether the contents of the current peak type posi [0] are (2), (3), (4) or (4), (3), (2), respectively (step 1310). ).

ステップ1310の判断がYESの場合には、図16に示すように、最大ピーク値(ピークタイプ(3))の前後で、正転((2)→(3)→(4))または逆転((4)→(3)→(2))することで、第1の検出信号400Aが1周期変化したものと判断して、第1信号最大値変数A1に現在格納されている値が、真の最大ピーク値であると確定して、第1信号最大値変数A1の現在の格納値を第1信号最大ピーク値メモリAMAXに記憶させる。また、第1信号最大値変数A1の格納値を真の最大ピーク値であると確定したことに伴い、第1信号最大値変数A1の格納値は、初期値(0V)にクリアされる(ステップ1311)。   If the determination in step 1310 is YES, as shown in FIG. 16, forward rotation ((2) → (3) → (4)) or reverse rotation (before and after the maximum peak value (peak type (3))) (4) → (3) → (2)), it is determined that the first detection signal 400A has changed by one cycle, and the value currently stored in the first signal maximum value variable A1 is true. And the current stored value of the first signal maximum value variable A1 is stored in the first signal maximum peak value memory AMAX. Further, as the stored value of the first signal maximum value variable A1 is determined to be the true maximum peak value, the stored value of the first signal maximum value variable A1 is cleared to the initial value (0V) (step S1). 1311).

つぎに、計測用コントローラ30に電源が投入された直後であるか否かが判断される。あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(3)、(4)または(3)、(2)であるか否かが判断される(ステップ1312)。   Next, it is determined whether or not the measurement controller 30 has just been turned on. Alternatively, the peak types stored in the previous peak type posi [1] and the current peak type posi [0] are read, and the contents of the previous peak type posi [1] and current peak type posi [0] are (3 ), (4) or (3), (2) is determined (step 1312).

計測用コントローラ30に電源が投入された直後であると判断された場合、あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(3)、(4)または(3)、(2)であると判断された場合には、図16に示すように、第1の検出信号400Aの最大ピーク値(ピークタイプ(3))、第2の検出信号400Bの最小ピーク値(ピークタイプ(4))を経由して、第1の検出信号400Aが最小ピーク値(ピークタイプ(1))となったか(正転の場合)、第1の検出信号400Aの最大ピーク値(ピークタイプ(3))、第2の検出信号400Bの最大ピーク値(ピークタイプ(2))を経由して、第1の検出信号400Aが最小ピーク値(ピークタイプ(1))となった(逆転の場合)ものと判断して、今回ピークタイプposi〔0〕の内容を、ピークタイプ(3)に更新する。なお、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕の内容については、それぞれ前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に現在格納されているピークタイプによって更新される(ステップ1313)。   If it is determined that the measurement controller 30 has just been turned on, or the contents of the previous peak type posi [1] and current peak type posi [0] are (3), (4) or ( 3), if it is determined that (2), as shown in FIG. 16, the maximum peak value (peak type (3)) of the first detection signal 400A and the minimum peak of the second detection signal 400B Whether the first detection signal 400A has reached the minimum peak value (peak type (1)) via the value (peak type (4)) (in the case of normal rotation), the maximum peak value of the first detection signal 400A The first detection signal 400A becomes the minimum peak value (peak type (1)) via the (peak type (3)) and the maximum peak value (peak type (2)) of the second detection signal 400B. Judge that it is (in case of reverse) , The contents of this peak type posi [0], is updated to the peak type (3). The contents of the previous peak type posi [2] and the previous peak type posi [1] are updated by the peak types currently stored in the previous peak type posi [1] and the current peak type posi [0], respectively. (Step 1313).

ステップ1313の処理が終了するか、ステップ1309の判断がNOである場合には、ステップ1314に移行する。   If the process in step 1313 is completed or if the determination in step 1309 is NO, the process proceeds to step 1314.

ステップ1314では、第2の検出信号400Bの現在の検出電圧値が最小ピーク値であるか否かが判定される。たとえば、第2の検出信号400Bの現在の検出電圧値が、第1の検出信号400Aの現在の検出電圧値よりも小さく、かつ第2の検出信号400Bの現在の検出電圧値がしきい値C1よりも小さいか否かを判断することによって、上記判定がなされる(ステップ1314)。   In step 1314, it is determined whether or not the current detection voltage value of the second detection signal 400B is the minimum peak value. For example, the current detection voltage value of the second detection signal 400B is smaller than the current detection voltage value of the first detection signal 400A, and the current detection voltage value of the second detection signal 400B is the threshold value C1. The above determination is made by determining whether it is smaller than (step 1314).

つぎに、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(1)、(2)、(3)または(3)、(2)、(1)であるか否かが判断される(ステップ1315)。   Next, the peak types stored in the previous peak type posi [2], the previous peak type posi [1], and the current peak type posi [0] are read out, and the previous peak type posi [2] and the previous peak type posi [ 1], it is determined whether the contents of the current peak type posi [0] are (1), (2), (3) or (3), (2), (1), respectively (step 1315). ).

ステップ1315の判断がYESの場合には、最大ピーク値(ピークタイプ(2))の前後で、正転((1)→(2)→(3))または逆転((3)→(2)→(1))することで、第2の検出信号400Bが1周期変化したものと判断して、第2信号最大値変数B1に現在格納されている値が、真の最大ピーク値であると確定して、第2信号最大値変数B1の現在の格納値を第2信号最大ピーク値メモリBMAXに記憶させる。また、第2信号最大値変数B1の格納値を真の最大ピーク値であると確定したことに伴い、第2信号最大値変数B1の格納値は、初期値(0V)にクリアされる(ステップ1316)。   If the determination in step 1315 is YES, forward rotation ((1) → (2) → (3)) or reverse rotation ((3) → (2) before and after the maximum peak value (peak type (2)). (1)), it is determined that the second detection signal 400B has changed by one period, and the value currently stored in the second signal maximum value variable B1 is the true maximum peak value. Then, the current stored value of the second signal maximum value variable B1 is stored in the second signal maximum peak value memory BMAX. Further, as the stored value of the second signal maximum value variable B1 is determined to be the true maximum peak value, the stored value of the second signal maximum value variable B1 is cleared to the initial value (0V) (step S1). 1316).

つぎに、計測用コントローラ30に電源が投入された直後であるか否かが判断される。あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(2)、(3)または(2)、(1)であるか否かが判断される(ステップ1317)。   Next, it is determined whether or not the measurement controller 30 has just been turned on. Alternatively, the peak types stored in the previous peak type posi [1] and the current peak type posi [0] are read, and the contents of the previous peak type posi [1] and current peak type posi [0] are (2 ), (3) or (2), (1) is determined (step 1317).

計測用コントローラ30に電源が投入された直後であると判断された場合、あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(2)、(3)または(2)、(1)であると判断された場合には、第2の検出信号400Bの最大ピーク値(ピークタイプ(2))、第1の検出信号400Aの最大ピーク値(ピークタイプ(3))を経由して、第2の検出信号400Bが最小ピーク値(ピークタイプ(4))となったか(正転の場合)、第2の検出信号400Bの最大ピーク値(ピークタイプ(2))、第1の検出信号400Aの最小ピーク値(ピークタイプ(1))を経由して、第2の検出信号400Bが最小ピーク値(ピークタイプ(4))となった(逆転の場合)ものと判断して、今回ピークタイプposi〔0〕の内容を、ピークタイプ(4)に更新する。なお、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕の内容については、それぞれ前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されている現在のピークタイプによって更新される(ステップ1318)。   If it is determined that the measurement controller 30 has just been turned on, or the contents of the previous peak type posi [1] and current peak type posi [0] are (2), (3) or ( 2) When it is determined that (1), the maximum peak value of the second detection signal 400B (peak type (2)), the maximum peak value of the first detection signal 400A (peak type (3)) ), Whether the second detection signal 400B has reached the minimum peak value (peak type (4)) (in the case of normal rotation), or the maximum peak value of the second detection signal 400B (peak type (2)) The second detection signal 400B becomes the minimum peak value (peak type (4)) via the minimum peak value (peak type (1)) of the first detection signal 400A (in the case of reverse rotation). Judgment, this time peak type po The content of si [0] is updated to the peak type (4). The contents of the previous peak type posi [2] and the previous peak type posi [1] are updated by the current peak type stored in the previous peak type posi [1] and the current peak type posi [0], respectively. (Step 1318).

ステップ1318の処理が終了するか、ステップ1314の判断がNOである場合には、ステップ1319に移行する。   If the process in step 1318 is completed or if the determination in step 1314 is NO, the process proceeds to step 1319.

ステップ1319では、第1の検出信号400Aの現在の検出電圧値が最大ピーク値であるか否かが判定される。たとえば、第1の検出信号400Aの現在の検出電圧値が、第2の検出信号400Aの現在の検出電圧値よりも大きく、かつ第1の検出信号400Aの現在の検出電圧値がしきい値C2よりも大きいか否かを判断することによって、上記判定がなされる(ステップ1319;図16参照)。   In step 1319, it is determined whether or not the current detection voltage value of the first detection signal 400A is the maximum peak value. For example, the current detection voltage value of the first detection signal 400A is larger than the current detection voltage value of the second detection signal 400A, and the current detection voltage value of the first detection signal 400A is the threshold value C2. The above determination is made by determining whether it is greater than (step 1319; see FIG. 16).

つぎに、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(4)、(1)、(2)または(2)、(1)、(4)であるか否かが判断される(ステップ1320)。   Next, the peak types stored in the previous peak type posi [2], the previous peak type posi [1], and the current peak type posi [0] are read out, and the previous peak type posi [2] and the previous peak type posi [ 1] and whether the contents of the current peak type posi [0] are (4), (1), (2) or (2), (1), (4), respectively (step 1320). ).

ステップ1320の判断がYESの場合には、最小ピーク値(ピークタイプ(1))の前後で、正転((4)→(1)→(2))または逆転((2)→(1)→(4))することで、第1の検出信号400Aが1周期変化したものと判断して、第1信号最小値変数A2に現在格納されている値が、真の最小ピーク値であると確定して、第1信号最小値変数A2の現在の格納値を第1信号最小ピーク値メモリAMINに記憶させる。また、第1信号最小値変数A2の格納値を真の最小ピーク値であると確定したことに伴い、第1信号最小値変数A2の格納値は、初期値(5V)にクリアされる(ステップ1321)。   If the determination in step 1320 is YES, forward rotation ((4) → (1) → (2)) or reverse rotation ((2) → (1) before and after the minimum peak value (peak type (1)). (4)), it is determined that the first detection signal 400A has changed by one cycle, and the value currently stored in the first signal minimum value variable A2 is the true minimum peak value. Then, the current stored value of the first signal minimum value variable A2 is stored in the first signal minimum peak value memory AMIN. Further, as the stored value of the first signal minimum value variable A2 is determined to be the true minimum peak value, the stored value of the first signal minimum value variable A2 is cleared to the initial value (5V) (step S1). 1321).

つぎに、計測用コントローラ30に電源が投入された直後であるか否かが判断される。あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(1)、(2)または(1)、(4)であるか否かが判断される(ステップ1322)。   Next, it is determined whether or not the measurement controller 30 has just been turned on. Alternatively, the peak types stored in the previous peak type posi [1] and the current peak type posi [0] are read, and the contents of the previous peak type posi [1] and current peak type posi [0] are (1), respectively. ), (2) or (1), (4) is determined (step 1322).

計測用コントローラ30に電源が投入された直後であると判断された場合、あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(1)、(2)または(1)、(4)であると判断された場合には、第1の検出信号400Aの最小ピーク値(ピークタイプ(1))、第2の検出信号400Bの最大ピーク値(ピークタイプ(2))を経由して、第1の検出信号400Aが最大ピーク値(ピークタイプ(3))となったか(正転の場合)、第1の検出信号400Aの最小ピーク値(ピークタイプ(1))、第2の検出信号400Bの最小ピーク値(ピークタイプ(4))を経由して、第1の検出信号400Aが最大ピーク値(ピークタイプ(3))となった(逆転の場合)ものと判断して、今回ピークタイプposi〔0〕の内容を、ピークタイプ(3)に更新する。なお、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕の内容については、それぞれ前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されている現在のピークタイプによって更新される(ステップ1323)。   If it is determined that the measurement controller 30 has just been turned on, or the contents of the previous peak type posi [1] and current peak type posi [0] are (1), (2) or ( 1) When it is determined that they are (4), the minimum peak value of the first detection signal 400A (peak type (1)) and the maximum peak value of the second detection signal 400B (peak type (2)) ), Whether the first detection signal 400A has reached the maximum peak value (peak type (3)) (in the case of normal rotation), or the minimum peak value of the first detection signal 400A (peak type (1)) The first detection signal 400A becomes the maximum peak value (peak type (3)) via the minimum peak value (peak type (4)) of the second detection signal 400B (in the case of reverse rotation). Judgment, this time the peak type posi The content of [0] is updated to the peak type (3). The contents of the previous peak type posi [2] and the previous peak type posi [1] are updated by the current peak type stored in the previous peak type posi [1] and the current peak type posi [0], respectively. (Step 1323).

ステップ1323の処理が終了するか、ステップ1319の判断がNOである場合には、ステップ1324に移行する。   If the processing in step 1323 is completed or if the determination in step 1319 is NO, the process proceeds to step 1324.

ステップ1324では、第2の検出信号400Bの現在の検出電圧値が最大ピーク値であるか否かが判定される。たとえば、第2の検出信号400Bの現在の検出電圧値が、第1の検出信号400Aの現在の検出電圧値よりも大きく、かつ第2の検出信号400Bの現在の検出電圧値がしきい値C2よりも大きいか否かを判断することによって、上記判定がなされる(ステップ1324;図16参照)。   In step 1324, it is determined whether or not the current detection voltage value of the second detection signal 400B is the maximum peak value. For example, the current detection voltage value of the second detection signal 400B is larger than the current detection voltage value of the first detection signal 400A, and the current detection voltage value of the second detection signal 400B is the threshold value C2. The above determination is made by determining whether it is greater than (step 1324; see FIG. 16).

つぎに、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(3)、(4)、(1)または(1)、(4)、(3)であるか否かが判断される(ステップ1325)。   Next, the peak types stored in the previous peak type posi [2], the previous peak type posi [1], and the current peak type posi [0] are read out, and the previous peak type posi [2] and the previous peak type posi [ 1], it is determined whether the contents of the current peak type posi [0] are (3), (4), (1) or (1), (4), (3), respectively (step 1325). ).

ステップ1325の判断がYESの場合には、最小ピーク値(ピークタイプ(4))の前後で、正転((3)→(4)→(1))または逆転((1)→(4)→(3))することで、第2の検出信号400Bが1周期変化したものと判断して、第2信号最小値変数B2に現在格納されている値が、真の最小ピーク値であると確定して、第2信号最小値変数B2の現在の格納値を第2信号最小ピーク値メモリBMINに記憶させる。また、第2信号最小値変数B2の格納値を真の最小ピーク値であると確定したことに伴い、第2信号最小値変数B2の格納値は、初期値(5V)にクリアされる(ステップ1326)。   If the determination in step 1325 is YES, forward rotation ((3) → (4) → (1)) or reverse rotation ((1) → (4) before and after the minimum peak value (peak type (4)). (3)), it is determined that the second detection signal 400B has changed by one cycle, and the value currently stored in the second signal minimum value variable B2 is the true minimum peak value. Then, the current stored value of the second signal minimum value variable B2 is stored in the second signal minimum peak value memory BMIN. Further, as the stored value of the second signal minimum value variable B2 is determined to be the true minimum peak value, the stored value of the second signal minimum value variable B2 is cleared to the initial value (5V) (step S1). 1326).

つぎに、計測用コントローラ30に電源が投入された直後であるか否かが判断される。あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されたピークタイプが読み出され、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(4)、(1)または(4)、(3)であるか否かが判断される(ステップ1327)。   Next, it is determined whether or not the measurement controller 30 has just been turned on. Alternatively, the peak types stored in the previous peak type posi [1] and the current peak type posi [0] are read, and the contents of the previous peak type posi [1] and current peak type posi [0] are (4 ), (1) or (4), (3) is determined (step 1327).

計測用コントローラ30に電源が投入された直後であると判断された場合、あるいは、前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕の内容がそれぞれ、(4)、(1)または(4)、(3)であると判断された場合には、第2の検出信号400Bの最小ピーク値(ピークタイプ(4))、第1の検出信号400Aの最小ピーク値(ピークタイプ(1))を経由して、第2の検出信号400Bが最大ピーク値(ピークタイプ(2))となったか(正転の場合)、第2の検出信号400Bの最小ピーク値(ピークタイプ(4))、第1の検出信号400Aの最大ピーク値(ピークタイプ(3))を経由して、第2の検出信号400Bが最大ピーク値(ピークタイプ(2))となった(逆転の場合)ものと判断して、今回ピークタイプposi〔0〕の内容を、ピークタイプ(2)に更新する。なお、前々回ピークタイプposi〔2〕、前回ピークタイプposi〔1〕の内容については、それぞれ前回ピークタイプposi〔1〕、今回ピークタイプposi〔0〕に格納されている現在のピークタイプによって更新される(ステップ1328)。   When it is determined that the measurement controller 30 has just been turned on, or the contents of the previous peak type posi [1] and current peak type posi [0] are (4), (1) or ( 4) When it is determined that (3), the minimum peak value of the second detection signal 400B (peak type (4)) and the minimum peak value of the first detection signal 400A (peak type (1)) ), Whether the second detection signal 400B has reached the maximum peak value (peak type (2)) (in the case of normal rotation), or the minimum peak value of the second detection signal 400B (peak type (4)) The second detection signal 400B becomes the maximum peak value (peak type (2)) via the maximum peak value (peak type (3)) of the first detection signal 400A (in the case of reverse rotation). Judgment, this time peak type po The content of si [0] is updated to the peak type (2). The contents of the previous peak type posi [2] and the previous peak type posi [1] are updated by the current peak type stored in the previous peak type posi [1] and the current peak type posi [0], respectively. (Step 1328).

つぎに、第1信号最大ピーク値メモリAMAX、第1信号最小ピーク値メモリAMIN、第2信号最大ピーク値メモリBMAX、第2信号最小ピーク値メモリBMINからそれぞれ最近の複数個、たとえば最近の10個(回転ローラ110の最近の10回転分)の記憶ピーク値が読み出される。そして、これら読み出された記憶ピーク値に基づいて、第1の検出信号400Aの最大ピーク値および最小ピーク値、第2の検出信号400Bの最大ピーク値および最小ピーク値が算出される。たとえば、第1信号最大ピーク値メモリAMAXに記憶された最近10個の記憶最大ピーク値を平均する演算処理を行うことで、第1の検出信号400Aの最大ピーク値が求められる。第1の検出信号400Aの最小ピーク値、第2の検出信号400Bの最大ピーク値および最小ピーク値についても同様にして求められる(ステップ1329)。   Next, from the first signal maximum peak value memory AMAX, the first signal minimum peak value memory AMIN, the second signal maximum peak value memory BMAX, and the second signal minimum peak value memory BMIN, respectively, for example, the latest 10 The stored peak value of (the latest 10 rotations of the rotating roller 110) is read out. Based on the read storage peak values, the maximum peak value and the minimum peak value of the first detection signal 400A and the maximum peak value and the minimum peak value of the second detection signal 400B are calculated. For example, the maximum peak value of the first detection signal 400 </ b> A is obtained by performing an arithmetic process that averages the last 10 stored maximum peak values stored in the first signal maximum peak value memory AMAX. The minimum peak value of the first detection signal 400A and the maximum peak value and the minimum peak value of the second detection signal 400B are obtained in the same manner (step 1329).

つぎに、記憶テーブル36に記憶された出力電圧値の最大ピーク値(以下、最大ピーク基準電圧値)、最小ピーク値(以下、最小ピーク基準電圧値)それぞれに、上記ステップ1329で求められた最大ピーク値(以下、入力最大ピーク値)、最小ピーク値(以下、入力最小ピーク値)が一致するように、第1および第2の検出信号400A、400Bの波形が補正される。具体的には、下記の演算式(1)によって、第1および第2の検出信号400A、400Bの出力電圧値Vが、補正演算されて、出力電圧値V′に変換される。   Next, the maximum peak value (hereinafter referred to as the maximum peak reference voltage value) and the minimum peak value (hereinafter referred to as the minimum peak reference voltage value) of the output voltage values stored in the storage table 36 are determined in the above step 1329. The waveforms of the first and second detection signals 400A and 400B are corrected so that the peak value (hereinafter referred to as the input maximum peak value) and the minimum peak value (hereinafter referred to as the input minimum peak value) match. Specifically, the output voltage value V of the first and second detection signals 400A and 400B is corrected and converted into the output voltage value V ′ by the following arithmetic expression (1).

V′=(V−入力最小ピーク値)×(最大ピーク基準値−最小ピーク基準値) /(入力最大ピーク値−入力最小ピーク値)+最小ピーク基準値
…(1)
図14を併せ参照して、第1の検出信号400Aを例にとり説明する。図14における第1の検出信号400A(高温時)の出力電圧値VAを、第1の検出信号400A′(低温時)の出力電圧値VA′に補正することを想定する。低温時に、第1の検出信号400A′の出力電圧値VA′と回転ローラ110の回転角度θAとの対応関係が予め求められ、図9(b)と同様に、記憶テーブル36に記憶されておかれる。
V ′ = (V−input minimum peak value) × (maximum peak reference value−minimum peak reference value) / (input maximum peak value−input minimum peak value) + minimum peak reference value
... (1)
The first detection signal 400A will be described as an example with reference to FIG. It is assumed that the output voltage value VA of the first detection signal 400A (at high temperature) in FIG. 14 is corrected to the output voltage value VA 'of the first detection signal 400A ′ (at low temperature). When the temperature is low, the correspondence relationship between the output voltage value VA ′ of the first detection signal 400A ′ and the rotation angle θA of the rotating roller 110 is obtained in advance and stored in the storage table 36 as in FIG. 9B. It is burned.

記憶テーブル36に記憶された出力電圧値VA′の中から最大ピーク基準値VAM′、最小ピーク基準値VAN′が読み出される。そして、最大ピーク基準値VAM′、最小ピーク基準値VAN′それぞれに対して、上記ステップ1329で求められた入力最大ピーク値VAM、入力最小ピーク値VANが一致するように、上記(1)式を用いて、第1の検出信号400Aの波形が、400A′に補正される。つまり図14において、高温時の第1の検出信号400Aの波形が、低温時の第1の検出信号400A′の波形に一致するように、スケール変換される。   The maximum peak reference value VAM ′ and the minimum peak reference value VAN ′ are read out from the output voltage value VA ′ stored in the storage table 36. Then, the above equation (1) is set so that the maximum input peak value VAM and the minimum input peak value VAN obtained in step 1329 coincide with the maximum peak reference value VAM ′ and the minimum peak reference value VAN ′. In use, the waveform of the first detection signal 400A is corrected to 400A ′. That is, in FIG. 14, the scale conversion is performed so that the waveform of the first detection signal 400A at the high temperature matches the waveform of the first detection signal 400A ′ at the low temperature.

図15は、上記(1)式における補正前の出力電圧値VAと補正後の出力電圧値VA′との関係を示す。   FIG. 15 shows the relationship between the output voltage value VA before correction and the output voltage value VA ′ after correction in the equation (1).

図15に実線410で示すように、出力電圧値VAは補正出力電圧値VA′に補正される。なお、破線で示す直線420は、補正前の出力電圧値VAと補正後の出力電圧値VA′とが一致している理想的な関係を示している。   As indicated by a solid line 410 in FIG. 15, the output voltage value VA is corrected to a corrected output voltage value VA ′. A straight line 420 indicated by a broken line shows an ideal relationship in which the output voltage value VA before correction matches the output voltage value VA ′ after correction.

第1の検出信号400Aを補正する場合について説明したが、第2の検出信号400Bについても同様にして補正される(ステップ1330)。   Although the case of correcting the first detection signal 400A has been described, the second detection signal 400B is corrected in the same manner (step 1330).

以上のようにして、補正出力電圧値VA′、VB′が求められると、記憶テーブル36から、図9(b)(第2実施例)で説明したのと同様にして、補正出力電圧値VA′、VB′(図9(b)ではVA、VBと表記)に対応する回転角度θA、θBが読み出され、この読み出された回転角度θA、θBに基づいて、第2実施例で説明したのと同様にして、油圧シリンダ200のストローク位置が計測される。   When the corrected output voltage values VA 'and VB' are obtained as described above, the corrected output voltage value VA is stored from the storage table 36 in the same manner as described in FIG. 9B (second embodiment). ′, VB ′ (represented as VA and VB in FIG. 9B) are read out rotation angles θA and θB, and the second embodiment will be described based on the read rotation angles θA and θB. In the same manner as described above, the stroke position of the hydraulic cylinder 200 is measured.

以上のように本実施例によれば、低温から高温に変化するに伴い磁力が弱まり、回転センサ100で検出される信号レベルが低下したとしても、回転センサ100の出力電圧値Vが、記憶テーブル36に記憶された出力電圧値V′に一致するように補正しているので、低温時と高温時とで回転角度θが等しく得られ、回転角度θを誤差なく、ひいては油圧シリンダ200のストローク位置を誤差なく計測することができる。このように、本第5実施例によれば、磁力を検出媒体とする回転センサ100の検出信号レベルが温度等によって変動したとしても、確実かつ簡易な方法で、誤差なく高精度に回転角度、ストローク位置を計測することができる。   As described above, according to the present embodiment, even if the magnetic force is weakened as the temperature changes from low to high, and the signal level detected by the rotation sensor 100 decreases, the output voltage value V of the rotation sensor 100 is stored in the storage table. Since the correction is made so as to coincide with the output voltage value V ′ stored in 36, the rotation angle θ can be obtained equally at the low temperature and the high temperature, and the rotation angle θ can be obtained without error, and as a result, the stroke position of the hydraulic cylinder 200. Can be measured without error. As described above, according to the fifth embodiment, even if the detection signal level of the rotation sensor 100 using the magnetic force as a detection medium fluctuates due to temperature or the like, the rotation angle, The stroke position can be measured.

本第5実施例では、図21、図22、図23に示すアルゴリズムで、回転センサ100から出力される第1および第2の検出信号400A、400Bが1周期変化したときの各電圧値の中から最大ピーク電圧値、最小ピーク電圧値を求めるようにしているが、図21、図22、図23に示すアルゴリズムは一例であり、これに限定されるものではない。たとえば、第1および第2の検出信号400A、400Bの一方の検出信号がゼロクロス点にあるときの他の検出信号の正負状態に応じて、上述したピークタイプが(1)、(2)、(3)、(4)のいずれのタイプであるかを判定しつつ、最大ピーク電圧値、最小ピーク電圧値を求めるようにしてもよい。   In the fifth embodiment, according to the algorithm shown in FIGS. 21, 22, and 23, the first and second detection signals 400A and 400B output from the rotation sensor 100 are included in the respective voltage values when they change for one cycle. The maximum peak voltage value and the minimum peak voltage value are obtained from the above, but the algorithms shown in FIGS. 21, 22, and 23 are examples, and the present invention is not limited to these. For example, according to the positive / negative state of the other detection signal when one of the first and second detection signals 400A and 400B is at the zero cross point, the above-described peak type is (1), (2), ( The maximum peak voltage value and the minimum peak voltage value may be obtained while determining which type is 3) or (4).

また、本第5実施例では、第1および第2の検出信号400A、400Bが1周期変化したときの各電圧値の中からピーク点における電圧値を求め、求められたピーク点における電圧値が、記憶テーブル36に記憶されたピーク点における基準電圧値に一致するように、第1および第2の検出信号400A、400Bの各出力電圧値VA、VBを補正しているが、本実施例の第1および第2の検出信号400A、400Bの「ピーク点」を「クロス点」に置き換えて同様に実施してもよい。   In the fifth embodiment, the voltage value at the peak point is obtained from each voltage value when the first and second detection signals 400A and 400B change by one cycle, and the obtained voltage value at the peak point is obtained. The output voltage values VA and VB of the first and second detection signals 400A and 400B are corrected so as to coincide with the reference voltage value at the peak point stored in the storage table 36. The same may be implemented by replacing the “peak point” of the first and second detection signals 400A and 400B with a “cross point”.

すなわち、図16に示すように、第1および第2の検出信号400A、400Bの各クロス点のうち電圧値が正側のクロス点の電圧値を、正クロス電圧値とし、電圧値が負側のクロス点の電圧値を、負クロス電圧値とすると、予め記憶テーブル36に、正クロス基準電圧値、負クロス基準電圧値を記憶しておき、回転センサ100の第1および第2の検出信号400A、400Bが1周期変化したときの各電圧値の中から、正クロス電圧値、負クロス電圧値を求め、求められた正クロス電圧値、負クロス電圧値と記憶された正クロス基準電圧値、負クロス基準電圧値とをそれぞれ比較し、正クロス電圧値、負クロス電圧値が正クロス基準電圧値、負クロス基準電圧値とそれぞれ一致するように、回転センサ100の第1および第2の検出信号400A、400Bを補正する実施も可能である。   That is, as shown in FIG. 16, among the cross points of the first and second detection signals 400A and 400B, the voltage value at the cross point with the positive voltage value is defined as the positive cross voltage value, and the voltage value is the negative side. If the voltage value at the cross point is a negative cross voltage value, the positive cross reference voltage value and the negative cross reference voltage value are stored in advance in the storage table 36, and the first and second detection signals of the rotation sensor 100 are stored. The positive cross voltage value and the negative cross voltage value are obtained from each voltage value when 400A and 400B change by one cycle, and the obtained positive cross voltage value and negative cross voltage value and the stored positive cross reference voltage value are obtained. The negative cross reference voltage value is compared with each other, and the first and second of the rotation sensor 100 are set so that the positive cross voltage value and the negative cross voltage value coincide with the positive cross reference voltage value and the negative cross reference voltage value, respectively. Detection signal 00A, implementation is also possible to correct the 400B.

また、本第5実施例では、図10(b)に示すように回転センサ100から位相が異なる第1および第2の検出信号400A、400Bが出力されることを前提としているが、図10(a)に示すように、一種類の検出信号400Aが出力される場合にも本実施例と同様にして補正を行うようにしてもよい。   In the fifth embodiment, it is assumed that the first and second detection signals 400A and 400B having different phases are output from the rotation sensor 100 as shown in FIG. As shown in a), even when one type of detection signal 400A is output, correction may be performed in the same manner as in this embodiment.

すなわち、記憶テーブル36に、図9(a)と同様に、予め検出信号400Aの最大ピーク基準電圧値、最小ピーク基準電圧値を記憶しておき、回転センサ100の検出信号400Aが1周期変化したときの各電圧値の中から、最大ピーク電圧値、最小ピーク電圧値を求め、求められた最大ピーク電圧値、最小ピーク電圧値とをそれぞれ比較し、最大ピーク電圧値、最小ピーク電圧値が最大ピーク基準電圧値、最小ピーク基準電圧値とそれぞれ一致するように、回転センサ100の検出信号400Aを補正する実施も可能である。   That is, as in FIG. 9A, the maximum peak reference voltage value and the minimum peak reference voltage value of the detection signal 400A are stored in advance in the storage table 36, and the detection signal 400A of the rotation sensor 100 changes by one cycle. The maximum peak voltage value and the minimum peak voltage value are obtained from the respective voltage values, and the maximum peak voltage value and the minimum peak voltage value are respectively compared with the obtained maximum peak voltage value and the minimum peak voltage value. It is also possible to correct the detection signal 400A of the rotation sensor 100 so as to match the peak reference voltage value and the minimum peak reference voltage value, respectively.

また、本実施例では、1つのセンサ部材135に対して、1つの記憶テーブルを対応させて、出力電圧値VA、回転角度θAを求めるようにしているが、1つのセンサ部材135に対して、最大ピーク電圧、最小ピーク電圧の大きさに応じた複数の記憶テーブルを対応させてもよく、この場合には、最大ピーク電圧、最小ピーク電圧の大きさに応じて、記憶テーブルが選択されて、出力電圧値VA、回転角度θAが求められる。これにより補正の精度を更に向上させることができる。   In this embodiment, one storage table is associated with one sensor member 135 to obtain the output voltage value VA and the rotation angle θA. However, with respect to one sensor member 135, A plurality of storage tables corresponding to the maximum peak voltage and the minimum peak voltage may be associated. In this case, the storage table is selected according to the maximum peak voltage and the minimum peak voltage. An output voltage value VA and a rotation angle θA are obtained. Thereby, the correction accuracy can be further improved.

また、本第5実施例では、図15に示すように、第1の検出信号400Aの出力電圧値VAと補正出力電圧値VA′との関係が線形であるとして、上記(1)式に示す演算式を用いて、補正しているが、図17(b)に示すように、第1の検出信号400Aの出力電圧値VAと補正出力電圧値VA′との関係が非線形的であるとして、後述する演算式を用いて補正してもよい。   Further, in the fifth embodiment, as shown in FIG. 15, the relationship between the output voltage value VA of the first detection signal 400A and the corrected output voltage value VA ′ is assumed to be linear, and is expressed by the above equation (1). Although correction is performed using an arithmetic expression, as shown in FIG. 17B, it is assumed that the relationship between the output voltage value VA of the first detection signal 400A and the corrected output voltage value VA 'is nonlinear. You may correct | amend using the arithmetic formula mentioned later.

図17(a)、(b)はそれぞれ図14、図15に対応する図である。   FIGS. 17A and 17B correspond to FIGS. 14 and 15, respectively.

図17(a)に示す高温時の第1の検出信号400Aの波形を、低温時の第1の検出信号400A′の波形に補正する場合を想定する。   Assume that the waveform of the first detection signal 400A at a high temperature shown in FIG. 17A is corrected to the waveform of the first detection signal 400A ′ at a low temperature.

図17(a) に示す第1の検出信号400Aの最小ピーク点Pmin、最大ピーク点Pmaxにおける補正係数は、以下の演算式(2)、(3)によって求められる。   The correction coefficients at the minimum peak point Pmin and the maximum peak point Pmax of the first detection signal 400A shown in FIG. 17A are obtained by the following arithmetic expressions (2) and (3).

Pminでの補正係数;αmin=VAN′/VAN …(2)
Pmaxでの補正係数;αmax=VAM′/VAM …(3)
電圧値VAは、上記(2)、(3)式を用いた下記(4)式に示す演算式によって、電圧値VA′に補正される。
Correction coefficient at Pmin: αmin = VAN '/ VAN (2)
Correction coefficient at Pmax; αmax = VAM ′ / VAM (3)
The voltage value VA is corrected to the voltage value VA ′ by an arithmetic expression shown in the following expression (4) using the expressions (2) and (3).

VA′=αmin+(αmax−αmin)×(VA−VAN)/(VAM−VAN)
…(4)
第1の検出信号400Aについて説明したが、第2の検出信号400Bについても同様にして補正することができる。
VA '= αmin + (αmax−αmin) × (VA−VAN) / (VAM−VAN)
(4)
Although the first detection signal 400A has been described, the second detection signal 400B can be similarly corrected.

なお、第5実施例では、回転センサ100が油圧ショベルなどの建設機械に搭載され油圧シリンダのストローク量を検出する場合を想定して説明したが、本発明としては、回転センサ100が搭載される機械、検出対象は、任意である。   In the fifth embodiment, the rotation sensor 100 is mounted on a construction machine such as a hydraulic excavator and the stroke amount of the hydraulic cylinder is detected. However, in the present invention, the rotation sensor 100 is mounted. The machine and the detection target are arbitrary.

(第6実施例)
ところで、図18(a)に示すように、位相の異なる2種類の第1および第2の検出信号400A、400Bが出力される回転センサ100を使用する場合には、同じ時刻に、異なる出力電圧値に基づいて、同じ回転角度を得ることができる。
(Sixth embodiment)
By the way, as shown in FIG. 18A, when using the rotation sensor 100 that outputs two types of first and second detection signals 400A and 400B having different phases, different output voltages at the same time. Based on the value, the same rotation angle can be obtained.

また、第1および第2の検出信号400A、400Bの波形は、正弦状であるため、回転角度θの変化に対して、出力電圧Vの変化が小さく(磁力の変化が小さく)分解能が低い区間と、回転角度θの変化に対して、出力電圧Vの変化が大きく(磁力の変化が大きく)分解能が高い区間とがある。   Since the waveforms of the first and second detection signals 400A and 400B are sinusoidal, the change in the output voltage V is small (the change in magnetic force is small) and the resolution is low with respect to the change in the rotation angle θ. In addition, there is a section in which the change in the output voltage V is large (the change in magnetic force is large) and the resolution is high with respect to the change in the rotation angle θ.

そこで、本実施例では、各時刻において、位相の異なる2種類の第1および第2の検出信号400A、400Bのうちで分解能が高い区間にある検出信号を選択して、選択した分解能が高い区間にある検出信号に基づいて回転角度θを逐次取得することにより、回転角度θの計測を誤差なく精度よく行おうとするものである。   Therefore, in this embodiment, at each time, a detection signal in a section having a high resolution is selected from the two types of first and second detection signals 400A and 400B having different phases, and a section in which the selected resolution is high. By sequentially acquiring the rotation angle θ based on the detection signal in the above, the rotation angle θ is measured accurately without error.

図18(b)は、分解能が高い区間にある検出信号を選択する処理を説明する図である。   FIG. 18B is a diagram illustrating processing for selecting a detection signal in a section with high resolution.

同図18(b)に示すように、第1および第2の検出信号400A、400Bのクロス点であって出力電圧が正の値をとるクロス点の電圧値を、しきい値D1として設定する。   As shown in FIG. 18B, the voltage value of the cross point where the output voltage takes a positive value at the cross point of the first and second detection signals 400A and 400B is set as the threshold value D1. .

そして、下記のように、第1および第2の検出信号400A、400Bの出力電圧値と、しきい値D1とを比較するとともに、第1の検出信号400Aの出力電圧値と、第2の検出信号400Bの出力電圧値とを比較し、その比較結果に応じて、分解能が高い区間にある検出信号を選択する。   Then, as described below, the output voltage values of the first and second detection signals 400A and 400B are compared with the threshold value D1, and the output voltage value of the first detection signal 400A and the second detection signal are compared. The output voltage value of the signal 400B is compared, and a detection signal in a section with high resolution is selected according to the comparison result.

・第2の検出信号400Bの出力電圧値がしきい値D1以上であり、第2の検出信号400Bの出力電圧値が第1の検出信号400Aの出力電圧値以上の区間E1にある場合;第1の検出信号400Aを分解能が高い区間にある検出信号として選択する。 When the output voltage value of the second detection signal 400B is greater than or equal to the threshold value D1, and the output voltage value of the second detection signal 400B is in the section E1 greater than or equal to the output voltage value of the first detection signal 400A; One detection signal 400A is selected as a detection signal in a section with high resolution.

・第1の検出信号400Aの出力電圧値がしきい値D1を超えて、第1の検出信号400Aの出力電圧値が第2の検出信号400Bの出力電圧値を超えた区間E2にある場合;第2の検出信号400Bを分解能が高い区間にある検出信号として選択する。 When the output voltage value of the first detection signal 400A exceeds the threshold value D1 and the output voltage value of the first detection signal 400A exceeds the output voltage value of the second detection signal 400B; The second detection signal 400B is selected as a detection signal in a section with high resolution.

・第1の検出信号400Aの出力電圧値がしきい値D1以下であり、第1の検出信号400Aの出力電圧値が第2の検出信号400Bの出力電圧値以上の区間E3にある場合;第1の検出信号400Aを分解能が高い区間にある検出信号として選択する。 When the output voltage value of the first detection signal 400A is equal to or less than the threshold value D1, and the output voltage value of the first detection signal 400A is in the section E3 that is equal to or greater than the output voltage value of the second detection signal 400B; One detection signal 400A is selected as a detection signal in a section with high resolution.

・第2の検出信号400Bの出力電圧値がしきい値D1を下回り、第2の検出信号400Bの出力電圧値が第1の検出信号400Aの出力電圧値を超えた区間E4にある場合;第2の検出信号400Bを分解能が高い区間にある検出信号として選択する。 When the output voltage value of the second detection signal 400B is below the threshold value D1 and the output voltage value of the second detection signal 400B exceeds the output voltage value of the first detection signal 400A; The second detection signal 400B is selected as a detection signal in a section with high resolution.

以上にようにして選択された検出信号400Aまたは400Bの出力電圧値Vに対応する回転角度θが、図9(b)に示す記憶テーブル36から読み出され、読み出された回転角度θに基づいて油圧シリンダ200のストローク位置が計測される。   The rotation angle θ corresponding to the output voltage value V of the detection signal 400A or 400B selected as described above is read from the storage table 36 shown in FIG. 9B, and is based on the read rotation angle θ. Thus, the stroke position of the hydraulic cylinder 200 is measured.

(第7実施例)
第6実施例では、各区間E1〜E4毎に、択一的に検出信号を選択するようにしている。このため、一方の検出信号(たとえば第1の検出信号400A)から他方の検出信号(第2の検出信号400B)に選択を切り換える境界(区間E1と区間2の境界)で、回転角度θ、ストローク位置の計測値が不連続に変化することがある。
(Seventh embodiment)
In the sixth embodiment, the detection signal is alternatively selected for each of the sections E1 to E4. For this reason, at the boundary (boundary between the section E1 and the section 2) for switching the selection from one detection signal (for example, the first detection signal 400A) to the other detection signal (the second detection signal 400B), the rotation angle θ and the stroke The position measurement value may change discontinuously.

そこで、検出信号の選択が切り換えられる区間の境界で、回転角度θ、ストローク位置の計測値が不連続に変化せず、滑らかに連続的に変化するように、下記のように境界付近で重み付け処理を行うようにしてもよい。   Therefore, weighting is performed near the boundary as shown below so that the measured values of the rotation angle θ and stroke position do not change discontinuously but change smoothly and continuously at the boundary of the section where the detection signal selection is switched. May be performed.

図19(a)は、図18(b)に対応する図であり、第1および第2の検出信号400A、400Bクロス点であって出力電圧が正の値をとるクロス点の電圧値を、しきい値D1として設定するとともに、出力電圧が負の値をとるクロス点の電圧値を、しきい値D2として設定する
そして、第6実施例と同様にして、第1および第2の検出信号400A、400Bの出力電圧値と、しきい値D1とを比較するとともに、第1の検出信号400Aの出力電圧値と、第2の検出信号400Bの出力電圧値とを比較し、その比較結果に応じて、分解能が高い区間にある検出信号を選択する。
FIG. 19 (a) is a diagram corresponding to FIG. 18 (b), and shows the voltage values of the first and second detection signals 400A and 400B at the cross point where the output voltage takes a positive value. The threshold value D1 is set, and the voltage value at the cross point at which the output voltage takes a negative value is set as the threshold value D2. Then, in the same manner as in the sixth embodiment, the first and second detection signals The output voltage values of 400A and 400B are compared with the threshold value D1, and the output voltage value of the first detection signal 400A is compared with the output voltage value of the second detection signal 400B. Accordingly, the detection signal in the section with high resolution is selected.

ただし、各区間E1〜E4の境界付近では、以下のように重み付け処理が行われる。   However, in the vicinity of the boundaries between the sections E1 to E4, the weighting process is performed as follows.

図19(b)は、第1の検出信号400Aに基づいて計測される回転角度θAの変化(これを破線430で示す)と、第2の検出信号400Bに基づいて計測される回転角度θBの変化(これを実線440で示す)とを対比して示している。同図19(b)に両回転角度θA、θBとの間には、ずれがある。   FIG. 19B shows a change in the rotation angle θA measured based on the first detection signal 400A (shown by a broken line 430) and the rotation angle θB measured based on the second detection signal 400B. The change (this is indicated by the solid line 440) is shown in contrast. In FIG. 19B, there is a deviation between the rotation angles θA and θB.

このため、第6実施例のように仮に、たとえば区間E4から区間1に移行するときに、第2の検出信号400Bから第1の検出信号400Bに切り換えたとすると、両回転角度θA、θBとの間のずれによって、回転角度θの計測値が不連続に変化してしまう。   For this reason, if the second detection signal 400B is switched to the first detection signal 400B, for example, when shifting from the section E4 to the section 1 as in the sixth embodiment, the rotation angles θA and θB are The measurement value of the rotation angle θ changes discontinuously due to the deviation.

そこで、本実施例では、図19(a)に示すように、しきい値D1の前後に、所定の電圧幅D1−ΔV〜D1+ΔVの遷移領域を設定し、この遷移領域D1−ΔV〜D1+ΔV内で、下記(5)式にしたがい重み付け処理を行い、回転角度θを求めるようにする。   Therefore, in the present embodiment, as shown in FIG. 19A, a transition region having a predetermined voltage width D1−ΔV to D1 + ΔV is set before and after the threshold value D1, and the transition region D1−ΔV to D1 + ΔV Thus, weighting processing is performed according to the following equation (5) to obtain the rotation angle θ.

θ=WA・θA+WB・θB …(5)
ただし、
θA;第1の検出信号400Aの出力電圧値VAから得られる回転角度
θB;第2の検出信号400Bの出力電圧値VBから得られる回転角度
WA;第1の検出信号400Aの重み(0%〜100%)
WB;第2の検出信号400Bの重み(0%〜100%)
たとえば区間E4から区間E1に移行する場合のように、第2の検出信号400Bから第1の検出信号400Aに切り換えられる場合について説明する。
θ = WA · θA + WB · θB (5)
However,
θA: rotation angle θB obtained from the output voltage value VA of the first detection signal 400A; rotation angle WA obtained from the output voltage value VB of the second detection signal 400B; weight of the first detection signal 400A (0% to 100%)
WB: Weight of second detection signal 400B (0% to 100%)
For example, a case where the second detection signal 400B is switched to the first detection signal 400A as in the case of shifting from the section E4 to the section E1 will be described.

第2の検出信号400Bから第1の検出信号400Aに切り換えられる場合、遷移領域D1−ΔV〜D1+ΔVでは、電圧値がD1−ΔVからD1+ΔVに変化するに伴い、第1の検出信号400Aの重みWAは、0%から100%に連続的に変化させる。出力電圧値がD1−ΔVのときには、第1の検出信号400Aの重みWAは、0%となり、出力電圧値がD1(しきい値)のときには、第1の検出信号400Aの重みWAは、50%となり、出力電圧値がD1+ΔVのときには、第1の検出信号400Aの重みWAは、100%となる。一方、第2の検出信号400Bの重みWBは、100%から0%に連続的に変化させる。出力電圧値がD1−ΔVのときには、第2の検出信号400Bの重みWBは、100%となり、出力電圧値がD1(しきい値)のときには、第2の検出信号400Bの重みWBは、50%となり、出力電圧値がD1+ΔVのときには、第2の検出信号400Bの重みWBは、0%となる。   When switching from the second detection signal 400B to the first detection signal 400A, in the transition region D1-ΔV to D1 + ΔV, as the voltage value changes from D1-ΔV to D1 + ΔV, the weight WA of the first detection signal 400A. Is continuously changed from 0% to 100%. When the output voltage value is D1-ΔV, the weight WA of the first detection signal 400A is 0%, and when the output voltage value is D1 (threshold), the weight WA of the first detection signal 400A is 50%. When the output voltage value is D1 + ΔV, the weight WA of the first detection signal 400A is 100%. On the other hand, the weight WB of the second detection signal 400B is continuously changed from 100% to 0%. When the output voltage value is D1-ΔV, the weight WB of the second detection signal 400B is 100%, and when the output voltage value is D1 (threshold), the weight WB of the second detection signal 400B is 50%. When the output voltage value is D1 + ΔV, the weight WB of the second detection signal 400B is 0%.

この結果、図19(c)に拡大して示すように、第2の検出信号400Bから第1の検出信号400Aに切り換えられる場合、遷移領域D1−ΔV〜D1+ΔVでは、一点鎖線450で示すように、回転角度θが連続的に変化する。このためストローク位置についても遷移領域で連続的に変化する。   As a result, as shown in an enlarged view in FIG. 19 (c), when switching from the second detection signal 400B to the first detection signal 400A, the transition regions D1-ΔV to D1 + ΔV are as shown by the alternate long and short dash line 450. The rotation angle θ changes continuously. For this reason, the stroke position also changes continuously in the transition region.

つぎに、たとえば区間E3から区間E4に移行する場合のように、第1の検出信号400Aから第2の検出信号400Bに切り換えられる場合について説明する。   Next, a case will be described in which the first detection signal 400A is switched to the second detection signal 400B, for example, as in the case of shifting from the section E3 to the section E4.

第1の検出信号400Aから第2の検出信号400Bに切り換えられる場合、遷移領域D1−ΔV〜D1+ΔVでは、電圧値がD1−ΔVからD1+ΔVに変化するに伴い、第1の検出信号400Aの重みWAは、100%から0%に連続的に変化させる。出力電圧値がD1−ΔVのときには、第1の検出信号400Aの重みWAは、100%となり、出力電圧値がD1(しきい値)のときには、第1の検出信号400Aの重みWAは、50%となり、出力電圧値がD1+ΔVのときには、第1の検出信号400Aの重みWAは、0%となる。一方、第2の検出信号400Bの重みWBは、0%から100%に連続的に変化させる。出力電圧値がD1−ΔVのときには、第2の検出信号400Bの重みWBは、0%となり、出力電圧値がD1(しきい値)のときには、第2の検出信号400Bの重みWBは、50%となり、出力電圧値がD1+ΔVのときには、第2の検出信号400Bの重みWBは、100%となる。   When switching from the first detection signal 400A to the second detection signal 400B, in the transition region D1-ΔV to D1 + ΔV, the weight WA of the first detection signal 400A increases as the voltage value changes from D1-ΔV to D1 + ΔV. Is continuously changed from 100% to 0%. When the output voltage value is D1−ΔV, the weight WA of the first detection signal 400A is 100%, and when the output voltage value is D1 (threshold), the weight WA of the first detection signal 400A is 50%. When the output voltage value is D1 + ΔV, the weight WA of the first detection signal 400A is 0%. On the other hand, the weight WB of the second detection signal 400B is continuously changed from 0% to 100%. When the output voltage value is D1-ΔV, the weight WB of the second detection signal 400B is 0%, and when the output voltage value is D1 (threshold value), the weight WB of the second detection signal 400B is 50%. When the output voltage value is D1 + ΔV, the weight WB of the second detection signal 400B is 100%.

この結果、図19(d)に拡大して示すように、第1の検出信号400Bから第2の検出信号400Bに切り換えられる場合、遷移領域D1−ΔV〜D1+ΔVでは、一点鎖線460で示すように、回転角度θが、連続的に変化する。このためストローク位置についても遷移領域で連続的に変化する。   As a result, as shown in an enlarged view in FIG. 19D, when switching from the first detection signal 400B to the second detection signal 400B, the transition regions D1-ΔV to D1 + ΔV are as shown by the alternate long and short dash line 460. The rotation angle θ changes continuously. For this reason, the stroke position also changes continuously in the transition region.

(第8実施例)
上述した第7実施例では、一方の検出信号から他方の検出信号に切り換えられる境界付近でのみ、重み付け処理を行い、回転角度θ、ストローク位置の計測値を連続的に変化させるようにしているが、全ての区間において重み付け処理を行うようにしてもよい。
(Eighth embodiment)
In the seventh embodiment described above, weighting processing is performed only in the vicinity of the boundary where one detection signal is switched to the other detection signal, and the measurement values of the rotation angle θ and the stroke position are continuously changed. The weighting process may be performed in all sections.

図20(a)、(b)、(c)、(d)は、第1および第2の検出信号400A、400Bそれぞれについて重みの関数wait1、wait2を求める演算処理を説明する図である。なお、以下の説明では、説明の便宜のため、第1の検出信号400Aの出力電圧値をv1、第1の検出信号400Aの最大ピーク電圧値をmaxv1、第1の検出信号400Aの最小ピーク電圧値をminv1、第2の検出信号400Bの出力電圧値をv2、第2の検出信号400Bの最大ピーク電圧値をmaxv2、第2の検出信号400Bの最小ピーク電圧値をminv2とする。   FIGS. 20A, 20B, 20C, and 20D are diagrams illustrating arithmetic processing for obtaining weight functions wait1 and wait2 for the first and second detection signals 400A and 400B, respectively. In the following description, for convenience of explanation, the output voltage value of the first detection signal 400A is v1, the maximum peak voltage value of the first detection signal 400A is maxv1, and the minimum peak voltage of the first detection signal 400A. The value is minv1, the output voltage value of the second detection signal 400B is v2, the maximum peak voltage value of the second detection signal 400B is maxv2, and the minimum peak voltage value of the second detection signal 400B is minv2.

すなわち、図20(a)に示すように、計測用コントローラ30に、第1の検出信号400Aの出力電圧値v1、第2の検出信号400Bの出力電圧値v2が入力されると、下記(6)、(7)式に示す演算処理が行われ、第1および第2の検出信号400A、400Bそれぞれについて、分解能が高い区間の中間値、つまり最大ピーク電圧値〜最小ピーク電圧値間の中間値で、最大レベルとなり、分解能が低い区間の中間値、つまりピーク点で最小レベルとなる、第1および第2の中間信号t1、t2が、図20(b)に示すごとく、求められる。   That is, as shown in FIG. 20A, when the output voltage value v1 of the first detection signal 400A and the output voltage value v2 of the second detection signal 400B are input to the measurement controller 30, the following (6 ) And (7) are performed, and for each of the first and second detection signals 400A and 400B, an intermediate value in a section with high resolution, that is, an intermediate value between the maximum peak voltage value and the minimum peak voltage value. Thus, as shown in FIG. 20 (b), the first and second intermediate signals t1 and t2 that are the maximum level and have the lowest resolution, that is, the minimum level at the peak point, are obtained.

t1=(maxv1−minv1)/2−abs(v1−(maxv1+minv1)/2)
…(6)
t2=(maxv2−minv2)/2−abs(v2−(maxv2+minv2)/2)
…(7)
つぎに、上記第1および第2の中間信号t1、t2を用いて、下記(8)、(9)式に示す演算処理が行われ、第1および第2の検出信号400A、400Bそれぞれについて、分解能が高い区間の中間値、つまり最大ピーク電圧値〜最小ピーク電圧値間の中間値で、最大レベル1となり、分解能が低い区間の中間値、つまりピーク点で最小レベル0となる、第1および第2の重み信号wait1、wait2が、図20(c)に示すごとく、求められる。第1および第2の重み信号wait1、wait2は、両者を加算して1となるように調整される。
t1 = (maxv1-minv1) / 2-abs (v1- (maxv1 + minv1) / 2)
(6)
t2 = (maxv2-minv2) / 2-abs (v2- (maxv2 + minv2) / 2)
... (7)
Next, using the first and second intermediate signals t1, t2, the arithmetic processing shown in the following equations (8), (9) is performed, and for each of the first and second detection signals 400A, 400B, An intermediate value in a section with high resolution, that is, an intermediate value between the maximum peak voltage value and the minimum peak voltage value, has a maximum level of 1, and an intermediate value in a section with low resolution, that is, has a minimum level of 0 at a peak point. Second weight signals wait1 and wait2 are obtained as shown in FIG. The first and second weight signals wait1 and wait2 are adjusted to be 1 by adding both.

wait1=t1/(t1+t2) …(8)
wait2=t2/(t1+t2) …(9)
そして、第7実施例で説明したのと同様に、下記(10)式にしたがい重み付け処理が行われ、回転角度θが求められる。
wait1 = t1 / (t1 + t2) (8)
wait2 = t2 / (t1 + t2) (9)
Then, as described in the seventh embodiment, the weighting process is performed according to the following equation (10), and the rotation angle θ is obtained.

θ=wait1・θA+wait2・θB …(10)
ただし、
θA;第1の検出信号400Aの出力電圧値v1から得られる回転角度
θB;第2の検出信号400Bの出力電圧値v2から得られる回転角度
図20(d)に示す実線470は、上記(10)式によって得られた回転角度θの変化を示している。また、同図20(d)に示す破線480は、比較のために、第1の検出信号400Aのみに基づいて得られた回転角度θAの変化を示している。図20(d)の横軸は、基準回転角度、つまり回転角度の真値であり、縦軸は、回転角度θの計測値である。
θ = wait1, θA + wait2, θB (10)
However,
θA: rotation angle obtained from the output voltage value v1 of the first detection signal 400A θB: rotation angle obtained from the output voltage value v2 of the second detection signal 400B The solid line 470 shown in FIG. ) Shows the change in the rotation angle θ obtained by the equation. Further, a broken line 480 shown in FIG. 20D shows a change in the rotation angle θA obtained based only on the first detection signal 400A for comparison. The horizontal axis in FIG. 20D is the reference rotation angle, that is, the true value of the rotation angle, and the vertical axis is the measured value of the rotation angle θ.

両者を図20(d)で対比すると、回転角度θAを、第1の検出信号400Aのみに基づいて求めるようにした場合には(破線480)、分解能が低いピーク点付近で、基準回転角度からずれており、回転角度θAに誤差が生じているのに対して、回転角度θを、上記(10)式から求めるようにした場合には(実線470)、全区間にわたり、回転角度θが高精度に計測されていることがわかる。   When the two are compared in FIG. 20D, when the rotation angle θA is obtained based only on the first detection signal 400A (broken line 480), the reference rotation angle is measured near the peak point with low resolution. When the rotation angle θ is calculated from the above equation (10) (solid line 470), the rotation angle θ is high over the entire section. It can be seen that the measurement is accurate.

なお、上述した各実施例では、回転センサ100から電圧値という物理量が検出される場合を例にとり説明したが、回転センサ100の検出物理量は、電圧以外の任意の物理量を用いてもよい。   In each of the above-described embodiments, the case where a physical quantity called a voltage value is detected from the rotation sensor 100 has been described as an example. However, any physical quantity other than voltage may be used as the detected physical quantity of the rotation sensor 100.

また、上述した各実施例では、回転センサ100を、回転ローラ110を設けた構成とし、回転センサ100を、その回転ローラ110が油圧シリンダ200のロッド202に押し当てられるように装着して、ロッド202の直動変位を回転量に変換して電圧値として出力する場合を想定して説明したが、本発明としては、回転センサ100の構成、装着態様は任意である。たとえば、回転センサ100を、回転ローラ110などのロッド202に押し当てる際に必要となる部品を省略した構成とし、回転センサ100の回転軸132が、油圧ショベルのブーム、アーム、バケットの回動軸とともに回転するように、回転センサ100を装着して、ブーム、アーム、バケットの回動軸の回転量を直接、電圧値として出力する場合にも本発明は適用可能である。   Further, in each of the embodiments described above, the rotation sensor 100 is provided with the rotation roller 110, and the rotation sensor 100 is mounted so that the rotation roller 110 is pressed against the rod 202 of the hydraulic cylinder 200. Although the description has been made assuming that the linear displacement of 202 is converted into a rotation amount and output as a voltage value, the configuration and mounting mode of the rotation sensor 100 are arbitrary in the present invention. For example, the rotation sensor 100 is configured such that parts necessary for pressing the rotation sensor 100 against the rod 202 such as the rotation roller 110 are omitted, and the rotation shaft 132 of the rotation sensor 100 is a rotation shaft of a boom, an arm, or a bucket of a hydraulic excavator. The present invention can also be applied to the case where the rotation sensor 100 is mounted so as to rotate together with the rotation amount of the pivot shafts of the boom, arm, and bucket and is directly output as a voltage value.

なお、第3実施例、第4実施例では、検出媒体は磁石(磁力)であることを前提に説明したが、検出媒体は必ずしも磁石(磁力)である必要はなく、油圧シリンダのストローク位置を回転量として検出する回転センサであれば、検出媒体は任意である。たとえば検出媒体を光とし、光センサで光を検出する場合にも第3実施例、第4実施例に係る本発明を適用することができる。   In the third and fourth embodiments, the description has been made on the assumption that the detection medium is a magnet (magnetic force). However, the detection medium is not necessarily a magnet (magnetic force), and the stroke position of the hydraulic cylinder is determined. The detection medium is arbitrary as long as the rotation sensor detects the rotation amount. For example, the present invention according to the third and fourth embodiments can also be applied to the case where the detection medium is light and the light is detected by an optical sensor.

図1は、実施形態の油圧作業機械の油圧回路を示す図である。FIG. 1 is a diagram illustrating a hydraulic circuit of a hydraulic working machine according to an embodiment. 図2は、実施形態の油圧作業機械の油圧回路を示す図である。FIG. 2 is a diagram illustrating a hydraulic circuit of the hydraulic working machine according to the embodiment. 図3はシリンダとコントローラとの関係を示すブロック図である。FIG. 3 is a block diagram showing the relationship between the cylinder and the controller. 図4(a)、(b)は、シリンダと回転センサとリセットセンサの関係を説明するために用いたシリンダチューブの断面図である。4A and 4B are cross-sectional views of a cylinder tube used for explaining the relationship among the cylinder, the rotation sensor, and the reset sensor. 図5(a)、(b)、(c)は、回転センサの構成を示す図である。5A, 5B, and 5C are diagrams showing the configuration of the rotation sensor. 図6(a)、(b)、(c)は、検出対象の磁石の構成を例示した図である。FIGS. 6A, 6 </ b> B, and 6 </ b> C are diagrams illustrating the configuration of a magnet to be detected. 図7(a)、(b)は、回転センサのセンサ部材の構成を例示した図である。7A and 7B are diagrams illustrating the configuration of the sensor member of the rotation sensor. 図8(a)、(b)は、回転センサから出力される検出信号を例示したグラフで、図8(c)は、図8(a)、(b)に対応させて、時間と回転角度の関係を示したグラフである。FIGS. 8A and 8B are graphs illustrating detection signals output from the rotation sensor. FIG. 8C is a graph corresponding to FIGS. 8A and 8B. It is the graph which showed this relationship. 図9(a)、(b)は、記憶テーブルの記憶内容を例示した図である。FIGS. 9A and 9B are diagrams illustrating the storage contents of the storage table. 図10(a)、(b)は、図8(a)、(b)に対応する図であり、記憶テーブルに基づいて回転角度を求める処理を説明する図である。FIGS. 10A and 10B are diagrams corresponding to FIGS. 8A and 8B, and are diagrams for explaining processing for obtaining a rotation angle based on a storage table. 図11(a)、(b)は、図1または図2に示す計測用コントローラで行われる処理の内容を説明するフローチャートである。FIGS. 11A and 11B are flowcharts for explaining the contents of processing performed by the measurement controller shown in FIG. 1 or FIG. 図12は、図11(b)のサブルーチン処理を示すフローチャートである。FIG. 12 is a flowchart showing the subroutine processing of FIG. 図13(a)、(b)は、図11〜図12に示す処理を説明するために用いた図で、時間と回転角度の関係、時間とストロークとの関係をそれぞれ示したグラフである。FIGS. 13A and 13B are diagrams used for explaining the processing shown in FIGS. 11 to 12, and are graphs showing the relationship between time and rotation angle and the relationship between time and stroke, respectively. 図14は、温度変化によって回転センサで検出される電圧(磁力)レベルが変化する様子を説明するグラフである。FIG. 14 is a graph for explaining how the voltage (magnetic force) level detected by the rotation sensor changes due to a temperature change. 図15は、回転センサの出力電圧値と補正出力電圧値との関係を示したグラフである。FIG. 15 is a graph showing the relationship between the output voltage value of the rotation sensor and the corrected output voltage value. 図16は、図21〜図23の処理内容を説明するために用いた図で、回転センサから出力される位相が異なる第1および第2の検出信号を示したグラフである。FIG. 16 is a graph used for explaining the processing contents of FIGS. 21 to 23, and is a graph showing first and second detection signals having different phases output from the rotation sensor. 図17(a)、(b)は、図14、図15に対応する図であり、出力電圧値と補正出力電圧値が非線形の関係にある場合の処理について説明する図である。FIGS. 17A and 17B are diagrams corresponding to FIGS. 14 and 15 and are diagrams for explaining processing when the output voltage value and the corrected output voltage value are in a non-linear relationship. 図18(a)は、回転センサから出力される第1および第2の検出信号について、分解能が高い区間と分解能が低い区間を指摘する図で、図18(b)は。図18(a)に対応させて、第1および第2の検出信号のうち、分解能が高い区間にある検出信号を選択する実施例を説明する図である。FIG. 18 (a) is a diagram pointing out a section with high resolution and a section with low resolution for the first and second detection signals output from the rotation sensor, and FIG. 18 (b). It is a figure explaining the Example which selects the detection signal in the area with high resolution among the 1st and 2nd detection signals corresponding to Fig.18 (a). 図19(a)、(b)、(c)、(d)は、第1および第2の検出信号のうち一方の検出信号から他方の検出信号に切り換えられる遷移領域で重み付け処理が行われる実施例を説明する図である。19 (a), (b), (c), and (d) are implementations in which weighting processing is performed in a transition region in which one of the first and second detection signals is switched from one detection signal to the other detection signal. It is a figure explaining an example. 図20(a)、(b)、(c)、(d)は、全区間において、重み付け処理が行われる実施例を説明する図である。FIGS. 20A, 20 </ b> B, 20 </ b> C, and 20 </ b> D are diagrams illustrating an example in which weighting processing is performed in all sections. 図21は、回転センサの出力電圧値を補正して補正出力電圧値を求める処理の手順を示したフローチャートである。FIG. 21 is a flowchart showing a processing procedure for correcting the output voltage value of the rotation sensor to obtain the corrected output voltage value. 図22は、回転センサの出力電圧値を補正して補正出力電圧値を求める処理の手順を示したフローチャートである。FIG. 22 is a flowchart showing a procedure of processing for obtaining a corrected output voltage value by correcting the output voltage value of the rotation sensor. 図23は、回転センサの出力電圧値を補正して補正出力電圧値を求める処理の手順を示したフローチャートである。FIG. 23 is a flowchart illustrating a procedure of processing for obtaining a corrected output voltage value by correcting the output voltage value of the rotation sensor.

符号の説明Explanation of symbols

20 制御用コントローラ 30 計測用コントローラ 36 記憶テーブル 100 回転センサ 200 油圧シリンダ 300 301、302 磁力センサ(リセットセンサ)   20 controller 30 measurement controller 36 storage table 100 rotation sensor 200 hydraulic cylinder 300 301, 302 magnetic force sensor (reset sensor)

Claims (3)

磁力を検出媒体とする回転センサであって、回転角度に応じて検出物理量が周期的に変化し、位相が異なる第1および第2の検出信号を出力する回転センサと、
予め回転センサで検出される物理量と回転角度との対応関係が記憶され、
前記対応関係を参照して、第1および第2の検出信号に対応する第1および第2の回転角度を求め、第1の回転角度と第2の回転角度との差に基づいて、回転角度を計測する計測手段と
を備えたことを特徴とする回転角度の計測装置。
A rotation sensor that uses magnetic force as a detection medium, the detection physical quantity periodically changing according to the rotation angle, and a rotation sensor that outputs first and second detection signals having different phases;
The correspondence between the physical quantity detected by the rotation sensor in advance and the rotation angle is stored,
Referring to the correspondence relationship, the first and second rotation angles corresponding to the first and second detection signals are obtained, and the rotation angle is determined based on the difference between the first rotation angle and the second rotation angle. A measuring device for measuring a rotation angle.
両回転角度の差が所定値以下になっている第1の回転角度と第2の回転角度を選択し、この選択された第1および第2の回転角度に基づいて、回転角度を計測すること
を特徴とする請求項1記載の回転角度の計測装置。
Selecting a first rotation angle and a second rotation angle at which the difference between the two rotation angles is equal to or less than a predetermined value, and measuring the rotation angle based on the selected first and second rotation angles The rotation angle measuring device according to claim 1.
第1の回転角度と第2の回転角度との差が所定値以下にならない場合には、回転センサが異常であると判断すること
を特徴とする請求項1記載の回転角度の計測装置。
The rotation angle measuring device according to claim 1, wherein if the difference between the first rotation angle and the second rotation angle does not become a predetermined value or less, the rotation sensor is determined to be abnormal.
JP2005079660A 2005-03-18 2005-03-18 Rotation angle measuring device Active JP4671405B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2005079660A JP4671405B2 (en) 2005-03-18 2005-03-18 Rotation angle measuring device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2005079660A JP4671405B2 (en) 2005-03-18 2005-03-18 Rotation angle measuring device

Publications (2)

Publication Number Publication Date
JP2006258728A true JP2006258728A (en) 2006-09-28
JP4671405B2 JP4671405B2 (en) 2011-04-20

Family

ID=37098144

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2005079660A Active JP4671405B2 (en) 2005-03-18 2005-03-18 Rotation angle measuring device

Country Status (1)

Country Link
JP (1) JP4671405B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018021884A (en) * 2016-08-05 2018-02-08 株式会社リコー Phase detection device, motor system, image forming apparatus, conveying device, and sensor level acquiring method
CN112327213A (en) * 2020-10-19 2021-02-05 南京工程学院 Electric revolving body performance detection system and detection method
CN112327213B (en) * 2020-10-19 2024-04-19 南京工程学院 Electric revolving body performance detection system and detection method

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7245099B2 (en) * 2019-03-29 2023-03-23 株式会社小松製作所 WORK MACHINE CALIBRATION METHOD, WORK MACHINE CONTROLLER, AND WORK MACHINE

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05157584A (en) * 1991-12-02 1993-06-22 Komatsu Ltd Rotation position detection device and complex rotation position sensor
JP2977821B1 (en) * 1998-10-20 1999-11-15 マッスル株式会社 Rotation amount measuring device
JP2001241942A (en) * 2000-02-25 2001-09-07 Alps Electric Co Ltd Device for detecting angle of rotation
JP2004138606A (en) * 2002-09-24 2004-05-13 Yazaki Corp Steering angle sensor
JP2005003549A (en) * 2003-06-12 2005-01-06 Hosiden Corp Rotational position detector

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05157584A (en) * 1991-12-02 1993-06-22 Komatsu Ltd Rotation position detection device and complex rotation position sensor
JP2977821B1 (en) * 1998-10-20 1999-11-15 マッスル株式会社 Rotation amount measuring device
JP2001241942A (en) * 2000-02-25 2001-09-07 Alps Electric Co Ltd Device for detecting angle of rotation
JP2004138606A (en) * 2002-09-24 2004-05-13 Yazaki Corp Steering angle sensor
JP2005003549A (en) * 2003-06-12 2005-01-06 Hosiden Corp Rotational position detector

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018021884A (en) * 2016-08-05 2018-02-08 株式会社リコー Phase detection device, motor system, image forming apparatus, conveying device, and sensor level acquiring method
CN112327213A (en) * 2020-10-19 2021-02-05 南京工程学院 Electric revolving body performance detection system and detection method
CN112327213B (en) * 2020-10-19 2024-04-19 南京工程学院 Electric revolving body performance detection system and detection method

Also Published As

Publication number Publication date
JP4671405B2 (en) 2011-04-20

Similar Documents

Publication Publication Date Title
JP4574406B2 (en) Stroke position measuring device of hydraulic cylinder in hydraulic work machine
JP4797721B2 (en) Rotation angle detector
EP2820384B1 (en) Method for contactlessly measuring a relative position by means of a 3d hall sensor having measurement signal store
US9846090B2 (en) Magnetic load sensor for use in a linear motion actuator, and a linear motion actuator
US7659713B2 (en) Rotational angle detector and method for initializing rotational angle detector
JP4753352B2 (en) Rotation sensor correction device
GB2440040A (en) A Valve Actuator with Feedback Control
JPWO2005124285A1 (en) Magnetic encoder device
WO2013153015A1 (en) Displacement sensor for contactlessly measuring a relative position by means of a magnetic field sensor array on the basis of the hall effect
JP4671405B2 (en) Rotation angle measuring device
JP2011514498A (en) Cylinder
JP4628815B2 (en) Cylinder position measuring device
JP2008148412A (en) Motor control device
CN110446841A (en) Accelerator opening detection device
JP2014070977A (en) Encoder, and abnormality detection method of encoder
EP3748304B1 (en) Position sensor with wake up function
JP2017090073A (en) Non-contact type rotation angle detector
JP4848225B2 (en) Axial gap motor
JP5185164B2 (en) Contact
JP4899410B2 (en) Magnetic encoder device
JP2015075075A (en) Power generating device
CN110651135A (en) Method and device for determining the absolute position of a component of an actuator, in particular a clutch actuator, which rotates about an axis of rotation
CN113840981B (en) Motor control device, motor control method, variable valve timing control device, variable valve timing control method, and variable valve timing control program
JP2019018693A (en) Electric linear actuator and electric brake device
JP7035583B2 (en) Electric oil pump

Legal Events

Date Code Title Description
A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20070704

A711 Notification of change in applicant

Free format text: JAPANESE INTERMEDIATE CODE: A712

Effective date: 20070704

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20071001

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20071001

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20080212

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100823

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100907

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20101101

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

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20110117

R150 Certificate of patent or registration of utility model

Ref document number: 4671405

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140128

Year of fee payment: 3