JP2013238821A - Control device of linear motion device and control method thereof - Google Patents
Control device of linear motion device and control method thereof Download PDFInfo
- Publication number
- JP2013238821A JP2013238821A JP2012113444A JP2012113444A JP2013238821A JP 2013238821 A JP2013238821 A JP 2013238821A JP 2012113444 A JP2012113444 A JP 2012113444A JP 2012113444 A JP2012113444 A JP 2012113444A JP 2013238821 A JP2013238821 A JP 2013238821A
- Authority
- JP
- Japan
- Prior art keywords
- signal value
- linear motion
- value
- motion device
- negcal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Abstract
Description
本発明は、線形運動デバイスの制御装置及びその制御方法に関し、より詳細には、磁気センサの搭載位置のずれや磁石の着磁ばらつきが生じるような場合にも、線形運動デバイスの正確な位置制御を可能にした線形運動デバイスの制御装置及びその制御方法に関する。 The present invention relates to a control apparatus for a linear motion device and a control method thereof, and more specifically, accurate position control of a linear motion device even in a case where a mounting position of a magnetic sensor shifts or a magnetization variation of a magnet occurs. The present invention relates to a control apparatus for a linear motion device and a control method thereof.
一般のデジタルカメラ及び携帯電話機、インターネットとの親和性が高く、パソコンの機能をベースとして作られた多機能携帯電話であるスマートフォン(smartphone)などに搭載されているカメラモジュールの多くには、オートフォーカス機能が搭載されている。このようなコンパクトなカメラに搭載されるオートフォーカス機能には、コントラスト検出方式が採用されることが多い。このコントラスト検出方式は、実際にレンズを移動させて、撮像画像内の被写体のコントラストが最大化されるレンズ位置を検出し、その位置にレンズを移動させる方式である。 Many of the camera modules installed in smart phones, which are multifunctional mobile phones that have high compatibility with general digital cameras, mobile phones, and the Internet and are based on the functions of personal computers, The function is installed. A contrast detection method is often adopted for an autofocus function mounted on such a compact camera. In this contrast detection method, the lens is actually moved to detect the lens position where the contrast of the subject in the captured image is maximized, and the lens is moved to that position.
このようなコントラスト検出方式は、被写体に赤外線や超音波を照射して、その反射波から被写体までの距離を測定するアクティブ方式と比較し、低コストで実現することができる。ただし、被写体のコントラストが最大化されるレンズ位置を探索するまでに時間がかかるという問題がある。ユーザがシャッターボタンを半押しした後、被写体にフォーカスを合わせるまでの処理が、1秒以内に完了することが望まれている。 Such a contrast detection method can be realized at a lower cost compared to an active method in which the subject is irradiated with infrared rays or ultrasonic waves and the distance from the reflected wave to the subject is measured. However, there is a problem that it takes time to search for a lens position where the contrast of the subject is maximized. It is desired that the process from when the user presses the shutter button halfway until the subject is focused is completed within one second.
ところで、一般のデジタルカメラ及び携帯電話機などに搭載されているカメラモジュールの画素数は年々増加しており、これらコンパクトなカメラでも、高精細な画像が撮影可能になってきている。高精細な画像では、ピントずれが目立ちやすく、より高精度なオートフォーカス制御が求められている。
また、一般に、入力信号と、この入力信号に応じた変位とが一次関数で表されるデバイスは、線形運動デバイスと言われている。この種の線形運動デバイスには、例えば、カメラのオートフォーカスレンズなどがある。
By the way, the number of pixels of camera modules mounted on general digital cameras and mobile phones is increasing year by year, and high-definition images can be taken even with these compact cameras. In high-definition images, focus shift is conspicuous, and more accurate autofocus control is required.
In general, a device in which an input signal and a displacement corresponding to the input signal are represented by a linear function is called a linear motion device. An example of this type of linear motion device is a camera autofocus lens.
図1は、従来の線形運動デバイスの制御装置を説明するための構成図である。図1に示した線形運動デバイス12の制御装置は、磁場センサ13と差動増幅器14と非反転出力バッファ15と反転出力バッファ16と第1の出力ドライバ17と第2の出力ドライバ18とを備えている。線形運動デバイス12は、制御装置によってフィードバック制御されるもので、レンズ9と磁石10とを備えている。
FIG. 1 is a configuration diagram for explaining a conventional linear motion device control apparatus. 1 includes a
磁場センサ13は、検出した磁場に基づいて信号を生成し、出力信号SAとして出力する。磁場センサ13の出力信号SAとデバイス位置指令信号SBは、差動増幅器14の正転入力端子と反転入力端子とにそれぞれ入力される。磁場センサ13の出力信号SAとデバイス位置指令信号SBとが入力された差動増幅器14からは、出力ドライバ17,18の操作量(偏差と増幅度の積)を表す操作量信号SCが出力される。
The
操作量信号SCの大きさによって線形運動デバイス12のコイル11を流れる電流方向及び電流量が変化する。このコイル11を流れる電流により、磁石10を含む線形運動デバイス12の位置が変化する(移動する)。このとき、磁場センサ13の出力信号SAは、磁石10の移動に伴って変化する。制御装置は、出力信号SAの変化によって線形運動デバイス12の位置を検出し、この位置が外部から入力されるデバイス位置指令信号SBによって指示される位置に一致するようにフィードバック制御を行っている。
The direction and amount of current flowing through the
ここで、図1に示した線形運動デバイス12では、磁石10の着磁のばらつきが生じ得る。また、制御装置では、磁場センサ13の搭載位置のずれにばらつきが生じ得る。このようなばらつきにより、線形運動デバイス12の位置と、磁場センサ13によって検出される磁場が設計時に想定された関係と相違する。
図2は、図1に示した磁場センサによって検出される磁場と線形運動デバイスの位置との関係を示した図である。図2では、図中左側の縦軸には磁場センサ13によって検出された磁場(以下、検出磁場ともいう)が示され、図中右側の縦軸には磁場センサ13の出力信号SAの値が示されている。また、図2の横軸は、線形運動デバイス12の位置である。
Here, in the
FIG. 2 is a diagram showing the relationship between the magnetic field detected by the magnetic field sensor shown in FIG. 1 and the position of the linear motion device. In FIG. 2, the left vertical axis in the figure indicates the magnetic field detected by the magnetic field sensor 13 (hereinafter also referred to as a detected magnetic field), and the right vertical axis in the figure indicates the value of the output signal SA of the
図2中の実線aは、検出磁場と線形運動デバイス12の位置とのずれがない(設計値のとおり)場合の特性を比較のため示している。一点鎖線bは、検出磁場と線形運動デバイス12の位置とのずれがある場合の特性を示している。
図2に示したように、磁石10に着磁のばらつき又は磁場センサ13の位置にずれがある場合、検出磁場が線形運動デバイス12の正しい位置を示さない。このため、制御装置が、線形運動デバイス12を適正に位置制御することができなくなる場合がある。
A solid line “a” in FIG. 2 shows the characteristics when there is no deviation between the detected magnetic field and the position of the linear motion device 12 (as designed), for comparison. An alternate long and short dash line b indicates characteristics when there is a shift between the detected magnetic field and the position of the
As shown in FIG. 2, when the
つまり、実線aで表された設計値通りの場合だと線形運動デバイス12が端点XBOTから他方の端点XTOPまで移動する場合、磁場センサ13の出力信号SAは、VMLaからVMHaまで変化する(図2中にこの範囲をSA(a)として示す)。このとき、磁場センサ13の出力信号SAと同じ電圧範囲であるVMLaからVMHaまでのデバイス位置指令信号SBが制御装置に入力される。そして、中間の電位VMM(=(VMHa−VMLa)/2+VMLa)のデバイス位置指令信号SBが入力されると、線形運動デバイス12は、中間の位置XMIDを得る。
That is, when the
一方、磁石10に着磁のばらつき又は磁場センサ13の位置にずれがある場合、磁場センサ13の出力信号SAは、実線aとは異なる傾きで、例えば、VMLbからVMHbまで変化する(図2中に実線aとは異なる傾きを持った一点鎖線bを示し、この変化の範囲をSA(b)として示す)。このとき、電位VMM(=(VMHa−VMLa)/2+VMLa)のデバイス位置指令信号SBが制御装置に入力されると、線形運動デバイス12は、位置XPOSに位置することになり、制御装置は、線形運動デバイス12を正しく位置制御できなくなるという問題がある。
On the other hand, when the
このような問題を解消するために、磁場センサ13の出力信号SA又はデバイス位置指令信号SBを補正することにより、磁場センサ13の出力信号SAとデバイス位置指令信号SBとを同期化をするものがある(例えば、特許文献1参照)。
また、特許文献2に記載のものは、実際にレンズを移動させて焦点位置を決定するフォーカス制御回路に関するもので、レンズと、このレンズの位置を調整するための駆動素子と、レンズの位置を検出するための位置検出素子とを備える撮像装置に搭載されるフォーカス制御回路において、位置検出素子の出力信号により特定されるレンズの位置と、外部から設定されるレンズの目標位置との差分をもとに、レンズの位置を目標位置に合わせるための駆動信号を生成して駆動素子に出力するイコライザと、位置検出素子のゲイン及びオフセットの少なくとも一方を調整するための調整回路とを備えたものである。
In order to solve such a problem, the output signal SA of the
The device described in Patent Document 2 relates to a focus control circuit that actually moves the lens to determine the focal position. The lens, a drive element for adjusting the position of the lens, and the position of the lens are as follows. In a focus control circuit mounted on an imaging device including a position detection element for detection, a difference between a lens position specified by an output signal of the position detection element and a target position of the lens set from the outside is also obtained. And an equalizer that generates a drive signal for adjusting the lens position to the target position and outputs the drive signal to the drive element, and an adjustment circuit for adjusting at least one of the gain and offset of the position detection element. is there.
しかしながら、上述した磁場センサの出力信号SA又はデバイス位置指令信号SBを同期化する方法には、以下のような問題がある。
すなわち、特許文献1に記載されるような補正テーブルを用いる方式は、補正テーブルを格納する記憶装置を必要とし、その数は分解能ビット数をNとした場合2N×N個となる。したがって、補正テーブルを含んだ集積回路を製造した場合、小型の線形運動デバイには搭載できない場合も生じ、製造コストも増加する。さらに、補正テーブルの作成には、分解能毎に移動させながら、補正テーブルに補正値を書き込む作業が発生するため、さらなる製造コスト増加になる場合もある。
However, the method for synchronizing the output signal SA or device position command signal SB of the magnetic field sensor described above has the following problems.
That is, the method using the correction table described in
また、特許文献2に記載されるような位置検出素子のゲイン及びオフセットを調整する方式の場合、調整するための情報を格納する記憶装置は、少なくできるものの、ゲインの調整量をD/A変換するD/A変換器および補正回路がそれぞれ必要となる。高精度な位置制御を行う場合にはゲイン及びオフセットの両方の調整が必要となる可能性がたかいため、一方のみの調整としてD/A変換器および補正回路の個数を削減できない場合が多い。さらに、自動的に補正量を取得しようとした場合、記憶装置はディジタル値での格納となるのでA/D変換器も必要となる場合がある。したがって、特許文献1と同様に製造コストの増加につながる。
Further, in the case of the method for adjusting the gain and offset of the position detection element as described in Patent Document 2, although the storage device for storing the information for adjustment can be reduced, the gain adjustment amount is D / A converted. A D / A converter and a correction circuit are required. When performing highly accurate position control, there is a high possibility that both the gain and the offset need to be adjusted. Therefore, in many cases, the number of D / A converters and correction circuits cannot be reduced as only one adjustment. Further, when the correction amount is automatically acquired, the storage device stores digital values, so that an A / D converter may be necessary. Therefore, like the
本発明は、上記した点に鑑みてなされたものであり、磁気センサの搭載位置のずれや磁石の着磁ばらつきが生じた場合にも、線形運動デバイスの正確な位置制御を可能にした線形運動デバイスの制御装置及びその制御方法を提供することを目的とする。 The present invention has been made in view of the above points, and linear motion that enables accurate position control of a linear motion device even when a deviation in the mounting position of a magnetic sensor or variation in magnetization of a magnet occurs. An object of the present invention is to provide a device control apparatus and a control method thereof.
本発明は、このような目的を達成するためになされたもので、請求項1に記載の発明は、移動体(33)に取り付けられた磁石(32)を有する線形運動デバイス(31)と、該線形運動デバイス(31)の前記磁石(32)の近傍に配置された駆動コイル(29)とを備え、該駆動コイル(29)にコイル電流が流れることによって発生する力により前記磁石(32)を移動させる線形運動デバイス(31)の制御装置(20)において、前記磁石(32)が発生する磁場を検出し、検出された磁場の値に対応する検出位置信号値(Vip)を出力する磁場センサ(21)と、該磁場センサ(21)からの前記検出位置信号値(Vip)に基づいて、前記線形運動デバイス(31)のホーム位置に対応する第1の位置信号値(NEGCAL)と、前記線形運動デバイス(31)のフル位置に対応する第2の位置信号値(POSCAL)とから検出位置演算信号値(VPROC)を得るキャリブレーション演算回路(24)と、前記線形運動デバイス(31)を移動すべき目標位置を指示する目標位置信号値(VTARG)を出力するデバイス位置指令信号発生回路(26)と、前記検出位置演算信号値(VPROC)と前記目標位置信号値(VTARG)に基づいて、前記駆動コイル(29)に駆動電流を供給する出力ドライバ(28a,28b)とを備え、前記検出位置信号値(Vip)にバラツキがあっても前記目標位置信号値(VTARG)で前記線形運動デバイスの位置制御を可能とすることを特徴とする。
The present invention has been made to achieve such an object, and the invention according to
また、請求項2に記載の発明は、請求項1に記載の発明において、前記磁場センサ(21)からの前記検出位置信号値で、前記キャリブレーション演算回路(24)の入力信号値をVip、前記ホーム位置に対応する前記第1の位置信号値をNEGCAL、前記フル位置に対応する前記第2の位置信号値をPOSCAL、前記キャリブレーション演算回路(24)の出力信号値である検出位置演算信号値をVPROCとした場合に、前記キャリブレーション演算回路(24)の前記検出位置演算信号値VPROCが、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする。 According to a second aspect of the present invention, in the first aspect of the present invention, the input signal value of the calibration operation circuit (24) is Vip, based on the detected position signal value from the magnetic field sensor (21). The first position signal value corresponding to the home position is NEGCAL, the second position signal value corresponding to the full position is POSCAL, and the detected position calculation signal is an output signal value of the calibration calculation circuit (24). When the value is VPROC, the detected position calculation signal value VPROC of the calibration calculation circuit (24) has a proportional relationship with (Vip-NEGCAL) / (POSCAL-NEGCAL).
また、請求項3に記載の発明は、請求項1又は2に記載の発明において、前記キャリブレーション演算回路(24)が、外部からキャリブレーション指示信号が入力されると作動する計数回路(241)と、D/A変換の出力信号が前記D/A変換の出力を最小値に固定を指示して前記駆動コイルに通電した時に、第1の時間まで前記計数回路(241)でカウントして取り込み指示信号が発行され、前記検出位置信号値(Vip)を記憶値(NEGCAL)として保存する第1の記憶装置(242a)と、第2の時間までカウントした時に、前記D/A変換の出力信号が、前記D/A変換の出力を最大値に固定を指示して前記駆動コイルに通電した時に、第3の時間まで前記計数回路(241)でカウントして取り込み指示信号が発行され、前記検出位置信号値(Vip)を記憶値(POSCAL)として保存する第2の記憶装置(242b)とを備え、第4の時間までカウントした時に前記D/A変換の出力指示は、PID制御回路の出力に基づいて出力する指示を発生し、前記計数回路のカウントを停止することを特徴とする。 According to a third aspect of the present invention, in the invention according to the first or second aspect, the calibration operation circuit (24) operates when a calibration instruction signal is input from the outside. When the output signal of the D / A conversion instructs to fix the output of the D / A conversion to the minimum value and energizes the drive coil, the count circuit (241) counts and captures until the first time. A first storage device (242a) that stores the detected position signal value (Vip) as a stored value (NEGCAL) when an instruction signal is issued, and an output signal of the D / A conversion when counting up to a second time However, when the D / A conversion output is instructed to be fixed to the maximum value and the drive coil is energized, the counting circuit (241) counts up to a third time and an acquisition instruction signal is issued. A second storage device (242b) that stores the detected position signal value (Vip) as a stored value (POSCAL), and when the output is counted up to a fourth time, the output instruction of the D / A conversion is a PID control circuit An output instruction is generated on the basis of the output of, and the counting circuit stops counting.
また、請求項4に記載の発明は、請求項3に記載の発明において、前記キャリブレーション演算回路(24)が、前記磁場センサ(21)からの前記検出位置信号値(Vip)と、前記第1の記憶装置(242a)の記憶値(NEGCAL)とを減算する第1の減算器(243a)と、第2の記憶装置(242b)の記憶値(POSCAL)と前記第1の記憶装置(242a)の記憶値(NEGCAL)とを減算する第2の減算器(243b)と、第1の減算器(243a)の出力値(Vip−NEGCAL)と、前記第2の減算器(243b)の出力値(POSCAL−NEGCAL)とを除算する除算器(244)とを備え、前記キャリブレーション演算回路(24)の前記検出位置演算信号値(VPROC)が、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする。 According to a fourth aspect of the present invention, in the third aspect of the present invention, the calibration calculation circuit (24) includes the detection position signal value (Vip) from the magnetic field sensor (21), and the first A first subtracter (243a) that subtracts a storage value (NEGCAL) of one storage device (242a), a storage value (POSCAL) of a second storage device (242b), and the first storage device (242a) ) Stored value (NEGCAL) of the second subtracter (243b), the output value (Vip-NEGCAL) of the first subtractor (243a), and the output of the second subtractor (243b). And a divider (244) that divides the value (POSCAL-NEGCAL), and the detected position calculation signal value (VPROC) of the calibration calculation circuit (24) is (Vip-NEGCA). ) / (Characterized by having a POSCAL-NEGCAL) a proportional relationship.
また、請求項5に記載の発明は、請求項1乃至4のいずれかに記載の発明において、前記磁場センサ(21)が、ホール素子であることを特徴とする。
また、請求項6に記載の発明は、請求項1乃至5のいずれかに記載の発明において、前記線形運動デバイスと前記駆動コイルが、カメラモジュールに組み込まれていることを特徴とする。
The invention according to claim 5 is the invention according to any one of
The invention according to claim 6 is the invention according to any one of
また、請求項7に記載の発明は、移動体(33)に取り付けられた磁石(32)を有する線形運動デバイス(31)と、該線形運動デバイス(31)の前記磁石(32)の近傍に配置された駆動コイル(29)とを備え、該駆動コイル(29)にコイル電流が流れることによって発生する力により前記磁石(32)を移動させる線形運動デバイス(31)の制御装置(20)における制御方法において、まず、磁場センサ(21)により、前記磁石(32)が発生する磁場を検出し、検出された磁場の値に対応する検出位置信号値(Vip)を出力するステップと、次に、キャリブレーション演算回路(24)により、前記磁場センサ(21)からの前記検出位置信号値(Vip)に基づいて、前記線形運動デバイス(31)のホーム位置に対応する第1の位置信号値(NEGCAL)と、前記線形運動デバイス(31)のフル位置に対応する第2の位置信号値(POSCAL)とから検出位置演算信号値(VPROC)を得るステップと、次に、デバイス位置指令信号発生回路(26)により、前記線形運動デバイス(31)を移動すべき目標位置を指示する目標位置信号値(VTARG)を出力するステップと、次に、出力ドライバ(28a,28b)により、前記検出位置演算信号値(VPROC)と前記目標位置信号値(VTARG)に基づいて、前記駆動コイル(29)に駆動電流を供給するステップとを有し、前記検出位置信号値(Vip)にバラツキがあっても前記目標位置信号値(VTARG)で前記線形運動デバイスの位置制御を可能とすることを特徴とする。 Further, the invention according to claim 7 is a linear motion device (31) having a magnet (32) attached to a moving body (33), and in the vicinity of the magnet (32) of the linear motion device (31). In the control device (20) of the linear motion device (31) that includes the drive coil (29) arranged and moves the magnet (32) by a force generated by a coil current flowing through the drive coil (29). In the control method, first, the magnetic field sensor (21) detects the magnetic field generated by the magnet (32), and outputs a detected position signal value (Vip) corresponding to the detected magnetic field value; Based on the detected position signal value (Vip) from the magnetic field sensor (21), the calibration operation circuit (24) sets the home position of the linear motion device (31). Obtaining a detected position calculation signal value (VPROC) from a corresponding first position signal value (NEGCAL) and a second position signal value (POSCAL) corresponding to the full position of the linear motion device (31); Next, a device position command signal generation circuit (26) outputs a target position signal value (VTARG) indicating a target position to which the linear motion device (31) should be moved, and then an output driver (28a) 28b), supplying a drive current to the drive coil (29) based on the detected position calculation signal value (VPROC) and the target position signal value (VTARG), and the detected position signal value Even if there is a variation in (Vip), the position of the linear motion device can be controlled by the target position signal value (VTARG).
また、請求項8に記載の発明は、請求項7に記載の発明において、前記磁場センサ(21)からの前記検出位置信号値で、前記キャリブレーション演算回路(24)の入力信号値をVip、前記ホーム位置に対応する前記第1の位置信号値をNEGCAL、前記フル位置に対応する前記第2の位置信号値をPOSCAL、前記キャリブレーション演算回路(24)の出力信号値である検出位置演算信号値をVPROCとした場合に、前記キャリブレーション演算回路(24)の前記検出位置演算信号値VPROCが、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする。 The invention according to claim 8 is the invention according to claim 7, wherein the input signal value of the calibration operation circuit (24) is Vip, based on the detected position signal value from the magnetic field sensor (21). The first position signal value corresponding to the home position is NEGCAL, the second position signal value corresponding to the full position is POSCAL, and the detected position calculation signal is an output signal value of the calibration calculation circuit (24). When the value is VPROC, the detected position calculation signal value VPROC of the calibration calculation circuit (24) has a proportional relationship with (Vip-NEGCAL) / (POSCAL-NEGCAL).
また、請求項9に記載の発明は、請求項7又は8に記載の発明において、前記キャリブレーション演算回路(24)による演算ステップが、まず、計数回路(241)により、外部からキャリブレーション指示信号が入力されると作動するステップと、次に、D/A変換の出力信号が前記D/A変換の出力を最小値に固定を指示して線形運動デバイスに通電した時に、第1の時間まで前記計数回路(241)でカウントして取り込み指示信号が発行され、第1の記憶装置(242a)により前記検出位置信号値(Vip)を記憶値(NEGCAL)として保存するステップと、次に、第2の時間までカウントした時に、前記D/A変換の出力信号が前記D/A変換の出力を最大値に固定を指示して前記駆動コイルに通電した時に、第3の時間まで前記計数回路(241)でカウントして取り込み指示信号が発行され、第2の記憶装置(242b)により前記検出位置信号値(Vip)を記憶値(POSCAL)として保存するステップと、次に、第1の減算器(243a)により、前記磁場センサ(21)からの前記検出位置信号値(Vip)と、前記第1の記憶装置(242a)の記憶値(NEGCAL)とを減算するステップと、次に、第2の減算器(243b)により、第2の記憶装置(242b)の記憶値(POSCAL)と前記第1の記憶装置(242a)の記憶値(NEGCAL)とを減算するステップと、次に、除算器(244)により、第1の減算器(243a)の出力値(Vip−NEGCAL)と、前記第2の減算器(243b)の出力値(POSCAL−NEGCAL)とを除算するステップと、次に、第4の時間までカウントした時に前記D/A変換の出力指示は、PID制御回路の出力に基づいて出力する指示を発生し、前記計数回路のカウントを停止するステップとを有し、前記キャリブレーション演算回路(24)の前記検出位置演算信号値(VPROC)が、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする。 According to a ninth aspect of the present invention, in the invention according to the seventh or eighth aspect, the calculation step by the calibration calculation circuit (24) is first performed by a counting circuit (241) from the outside by a calibration instruction signal. Until the first time when the D / A conversion output signal indicates that the output of the D / A conversion is fixed to the minimum value and the linear motion device is energized. The counting circuit (241) counts and issues a capture instruction signal, and the first storage device (242a) stores the detected position signal value (Vip) as a stored value (NEGCAL); When the output signal of the D / A conversion indicates that the output of the D / A conversion is fixed to the maximum value and the drive coil is energized when counting up to the time of 2, the third time The counting circuit (241) counts and the capture instruction signal is issued, and the second storage device (242b) stores the detected position signal value (Vip) as a stored value (POSCAL); Subtracting the detected position signal value (Vip) from the magnetic field sensor (21) and the stored value (NEGCAL) of the first storage device (242a) by a first subtractor (243a); Next, the second subtracter (243b) subtracts the stored value (POSCAL) of the second storage device (242b) and the stored value (NEGCAL) of the first storage device (242a); Next, an output value (Vip-NEGCAL) of the first subtractor (243a) and an output value (POSCAL-N) of the second subtracter (243b) are divided by the divider (244). GCAL), and then, when counting up to the fourth time, the D / A conversion output instruction generates an instruction to output based on the output of the PID control circuit, and the counting circuit counts And the detected position calculation signal value (VPROC) of the calibration calculation circuit (24) has a proportional relationship with (Vip-NEGCAL) / (POSCAL-NEGCAL). To do.
本発明によれば、磁場センサの搭載位置のずれや磁石の着磁ばらつきが生じた場合においても、線形運動デバイスの正確な位置制御を可能な線形運動デバイスの制御装置及びその制御方法を実現することができる。 According to the present invention, it is possible to realize a linear motion device control apparatus and a control method thereof capable of accurate position control of a linear motion device even when a magnetic field sensor mounting position shift or magnet magnetization variation occurs. be able to.
以下、図面を参照して本発明の実施例について説明する。
図3は、本発明に係る線形運動デバイスの制御装置を説明するための構成図である。図3においては、カメラモジュール30のレンズの位置調整を行う制御装置20に適用した場合について説明する。この制御装置(位置制御回路)20は、例えば、IC回路として構成されている。なお、カメラモジュール30は、線形運動デバイス31と、レンズ33を移動させる駆動コイル29とで構成されている。したがって、駆動コイル29に電流を流すことにより、磁石32が移動され、その磁石32に固定されているレンズ33の位置調整が可能となる。
Embodiments of the present invention will be described below with reference to the drawings.
FIG. 3 is a block diagram for explaining a control apparatus for a linear motion device according to the present invention. In FIG. 3, the case where it applies to the
つまり、本発明の線形運動デバイス31の制御装置20は、レンズ(移動体)33に取り付けられた磁石32を有する線形運動デバイス31と、この線形運動デバイス31の磁石32の近傍に配置された駆動コイル29とを備え、この駆動コイル29にコイル電流が流れることによって発生する力により磁石32を移動させるように構成されている。
磁場センサ21は、磁石32が発生する磁場を検出し、検出された磁場の値に対応する検出位置信号値Vipを出力するものである。つまり、磁場センサ21は、カメラモジュール30の磁石32が発する磁場を電気信号に変換し、検出位置信号を増幅器22に出力する。増幅器22は、磁場センサ21から入力される検出位置信号を増幅する。なお、この磁場センサ21はホール素子であることが望ましい。
That is, the
The
また、A/D変換回路23は、磁場センサ21からの検出位置信号を増幅器22により増幅してA/D変換するもので、A/D変換された検出位置信号値Vipを得るものである。
また、キャリブレーション(Calibration)演算回路24は、A/D変換回路23によりA/D変換された検出位置信号値Vipに基づいて、線形運動デバイス31のホーム位置に対応する第1の位置信号値NEGCALと、線形運動デバイス31のフル位置に対応する第2の位置信号値POSCALとから検出位置演算信号値VPROCを得るものである。
The A /
The
また、キャリブレーション演算回路24は、磁場センサ21からの検出位置信号値で、キャリブレーション演算回路24の入力信号値をVip、ホーム位置に対応する第1の位置信号値をNEGCAL、フル位置に対応する第2の位置信号値をPOSCAL、キャリブレーション演算回路24の出力信号値である検出位置演算信号値をVPROCとした場合に、検出位置演算信号値VPROCは、
VPROC=(Vip−NEGCAL)/(POSCAL−NEGCAL)×511
の関係を有するように演算する。なお、511は29−1を示す数値である。
The
VPROC = (Vip-NEGCAL) / (POSCAL-NEGCAL) × 511
So as to have a relationship of Note that 511 is a numerical value indicating 2 9 -1.
また、デバイス(レンズ)位置指令信号発生回路26は、線形運動デバイス31を移動すべき目標位置を指示する目標位置信号値VTARG及びキャリブレーション実行信号CALEXEを出力するもので、PID制御回路25及びキャリブレーション演算回路24に接続されている。つまり、レンズ位置指令信号生成回路26は、レンズ33の目標位置を指示するための目標位置信号値VTARGを生成及び外部からのキャリブレーション実行指示をキャリブレーション演算回路24に指示するためのキャリブレーション実行信号CALEXEを生成する。
The device (lens) position command
また、PID制御回路25は、キャリブレーション演算回路24とデバイス位置指令信号発生回路26とに接続され、キャリブレーション演算回路24からの出力信号である検出位置演算信号値VPROCを入力として、PID制御を行うものである。つまり、PID制御回路25は、キョリブレーション演算回路24からの検出位置演算信号値VPROCとレンズ位置指示信号生成回路26で生成されたレンズ位置の目標位置信号値VTARGとを入力し、レンズ33の現在位置と、目標位置信号値VTARGにより指示されるレンズ33の目標位置とから、レンズ33を目標位置に移動させるための制御信号を出力する。
The
ここでPID制御とは、フィードバック制御の一種で、入力値の制御を出力値と目標値との偏差とその積分及び微分の3つの要素によって行う方法のことである。基本的なフィードバック制御として比例制御(P制御)がある。これは入力値を出力値と目標値の偏差の一次関数として制御するものである。PID制御では、この偏差に比例して入力値を変化させる動作を比例動作あるいはP動作(PはPROPORTIONALの略)という。つまり、偏差のある状態が長い時間続けばそれだけ入力値の変化を大きくして目標値に近づけようとする役目を果たす。この偏差の積分に比例して入力値を変化させる動作を積分動作あるいはI動作(IはINTEGRALの略)という。このように比例動作と積分動作を組み合わせた制御方法をPI制御という。この偏差の微分に比例して入力値を変化させる動作を微分動作あるいはD動作(DはDERIVATIVE又はDIFFERENTIALの略)という。比例動作と積分動作と微分動作を組み合わせた制御方法をPID制御という。 Here, the PID control is a kind of feedback control, and is a method of performing control of an input value by three elements of a deviation between an output value and a target value, its integration and differentiation. There is proportional control (P control) as basic feedback control. This controls the input value as a linear function of the deviation between the output value and the target value. In PID control, an operation for changing an input value in proportion to this deviation is referred to as a proportional operation or a P operation (P is an abbreviation for PROPORIONAL). In other words, if a state with a deviation continues for a long time, the change of the input value is increased and the role of trying to approach the target value is achieved. The operation of changing the input value in proportion to the integration of the deviation is referred to as an integration operation or an I operation (I is an abbreviation for INTERGRAL). A control method combining the proportional action and the integral action in this way is called PI control. The operation of changing the input value in proportion to the differential of the deviation is referred to as differential operation or D operation (D is an abbreviation for DERIVATIVE or DIFFERENTIAL). A control method combining a proportional action, an integral action, and a derivative action is called PID control.
PID制御回路25からの出力信号は、D/A変換回路27によりD/A変換され、第1の出力ドライバ28aと第2の出力ドライバ28bにより、検出位置演算信号値VPROCと目標位置信号値VTARGに基づいて、駆動コイル29に駆動電流が供給される。つまり、第1及び第2の出力ドライバ28a,28bは、PID制御回路25からの制御信号に基づき、出力信号Vout1,Vout2を生成する。この出力信号Vout1,Vout2は、カメラモジュール30の駆動コイル29の両端に供給される。
The output signal from the
なお、以上の説明では、線形運動デバイスが、レンズ(移動体)33と、このレンズ(移動体)33に取り付けられた磁石32とからなるものとしているが、駆動コイルを含めて線形運動デバイスとすることもできる。
このようにして、検出位置信号値Vipにバラツキがあったとしても、目標位置信号値VTARGで線形運動デバイス31の位置制御を可能とすることができる。
In the above description, the linear motion device is composed of the lens (moving body) 33 and the
In this way, even if the detected position signal value Vip varies, the position of the
図4は、図3に示したキャリブレーション演算回路の具体的な構成図である。このキャリブレーション演算回路24は、外部からキャリブレーション指示信号が入力されると作動する計数回路(カウンタ/タイマ)241と、D/A変換した出力信号が最小値に固定を指示して駆動コイル29に通電した時T0に、第1の時間T1まで計数回路241でカウントして取り込み指示信号が発行され、検出位置信号値Vipを記憶値NEGCALとして保存する第1の記憶装置(レジスタ/メモリ)242aと、第2の時間T2までカウントした時に、D/A変換した出力信号が、最大値に固定を指示して駆動コイル29に通電した時に、第3の時間T3まで計数回路241でカウントして取り込み指示信号が発行され、検出位置信号値Vipを記憶値POSCALとして保存する第2の記憶装置(レジスタ/メモリ)242bとを備え、第4の時間T4までカウントした時にD/A変換の出力がPID制御回路に基づく出力の指示が発生し、計数回路241のカウントを停止する。
FIG. 4 is a specific configuration diagram of the calibration arithmetic circuit shown in FIG. The
また、キャリブレーション演算回路24は、磁場センサ21からの検出位置信号値Vipと、第1の記憶装置242aの記憶値NEGCALとを減算する第1の減算器243aと、第2の記憶装置242bの記憶値POSCALと第1の記憶装置242aの記憶値NEGCALとを減算する第2の減算器243bと、第1の減算器243aの出力値(Vip−NEGCAL)と、第2の減算器243bの出力値(POSCAL−NEGCAL)とを除算する除算器244とを備えている。この除算器244の出力信号は、積算器245を介して
VPROC=(Vip−NEGCAL)/(POSCAL−NEGCAL)×511
を得る。なお、第3の記憶装置(レジスタ/メモリ)246は、積算器245に接続され、「511」を記憶しているものである。この「511」は目標位置信号値VTARGの設定可能範囲によって任意に変更されるものである。
The
Get. The third storage device (register / memory) 246 is connected to the
図5(a),(b)は、時間経過に伴う駆動コイル電流とレンズ位置との関係を示す図で、図5(a)は、レンズ位置のホーム位置(Home Potion)とフル位置(Full Potion)に対応する検出磁場並びにNEGCALとPOSCALの関係を示した図で、図5(b)は、時間経過に伴う駆動コイル電流を示す図である。図5(a)における実線は目標レンズ位置を示し、破線は実際に検出される磁場強度を示している。図5(a)の実線と破線に示すように、端点間(BhomeとBfull)の差磁場が発生している。 FIGS. 5A and 5B are diagrams showing the relationship between the drive coil current and the lens position over time. FIG. 5A shows the home position (Home Position) and the full position (Full) of the lens position. FIG. 5B is a diagram showing a drive coil current with time. FIG. 5B is a diagram showing a relationship between a detected magnetic field corresponding to “Potion” and NEGCAL and POSCAL. The solid line in FIG. 5A indicates the target lens position, and the broken line indicates the magnetic field intensity that is actually detected. As indicated by a solid line and a broken line in FIG. 5A, a differential magnetic field between end points (Bhome and Bfull) is generated.
外部からCalibration指示信号が入力されると、計数回路241が作動する(T0)。D/A変換の出力指示は、最小値固定を指示し、−Icoilを通電する。規定の時間T1までカウントしたときに取り込み指示信号を発行し、Vipの値を記憶装置に保存(NEGCAL)する。規定の時間T2までカウントしたときに、D/A変換の出力指示は、最大値固定を指示し、+Icoilを通電する。規定の時間T3までカウントしたときに取り込み指示信号を発行し、Vipの値を記憶装置に保存(POSCAL)する。規定の時間T4までカウントしたときにD/A変換の出力指示は、PID制御回路の出力に基づいて出力する指示を発生し、カウントを停止する。
When a calibration instruction signal is input from the outside, the
保存されたPOSCAL値、NEGCAL値及び入力信号Vipから第1及び第2の減算器243a,243bと除算器244と積算器245とを用いて検出位置演算信号値VPROCを演算する。なお、図示したような専用のハードウェアでも良いし、マイコン等の汎用的なもの、ソフトウェアでも良い。
検出位置演算信号値(位置信号)VPROCは、目標位置信号値VTARGと同じ範囲の出力となる。つまり、Vipの個体ばらつきがあっても、位置信号と目標値信号の同期がとれた状態となる。位置制御動作は、演算された位置信号VPROCと目標値VTARGを用いることで、Vipの入力範囲にばらつきが生じても、VTRAGで一意にきまる位置制御が可能である。
The detected position calculation signal value VPROC is calculated from the stored POSCAL value, NEGCAL value, and input signal Vip using the first and second subtracters 243a and 243b, the
The detected position calculation signal value (position signal) VPROC is output in the same range as the target position signal value VTARG. That is, even if there is an individual variation of Vip, the position signal and the target value signal are synchronized. In the position control operation, by using the calculated position signal VPROC and the target value VTARG, it is possible to perform position control uniquely determined by VTRAG even if the input range of Vip varies.
図6は、キャリブレーション演算回路の出力が端点間の差磁場にかかわりなく0乃至511となることを示す図である。図6から明らかなように、磁場のBhomeとBfullに対応してA/D変換回路の出力信号値VipがPOSCAL値とNEGCAL値に対応し、検出位置演算信号値VPROCが0乃至511に対応し、レンズのホーム位置(Home Potion)からフル位置(Full Potion)まで直線的な動きが得られる。 FIG. 6 is a diagram showing that the output of the calibration calculation circuit becomes 0 to 511 regardless of the difference magnetic field between the end points. As is apparent from FIG. 6, the output signal value Vip of the A / D conversion circuit corresponds to the POSCAL value and the NEGCAL value corresponding to Bhome and Bfull of the magnetic field, and the detected position calculation signal value VPROC corresponds to 0 to 511. A linear movement from the home position (Home Position) to the full position (Full Position) of the lens can be obtained.
このようにして、磁場センサの搭載位置のずれや磁石の着磁ばらつきが生じた場合にも線形運動デバイスの正確な位置制御を可能な線形運動デバイスの制御装置を実現することができる。
図7は、本発明に係る線形運動デバイスの制御方法を説明するためのフローチャートを示す図である。
In this way, it is possible to realize a linear motion device control apparatus that can accurately control the position of the linear motion device even when the mounting position of the magnetic field sensor is deviated or the magnetization of the magnets varies.
FIG. 7 is a diagram illustrating a flowchart for explaining the control method of the linear motion device according to the present invention.
本発明の線形運動デバイス31の制御装置20における制御方法は、移動体33に取り付けられた磁石32を有する線形運動デバイス31と、この線形運動デバイス31の磁石32の近傍に配置された駆動コイル29とを備え、この駆動コイル29にコイル電流が流れることによって発生する力により磁石32を移動させる制御方法である。
まず、磁場センサ21により、磁石32が発生する磁場を検出し、検出された磁場の値に対応する検出位置信号値Vipを出力するステップ(S1)と、次に、キャリブレーション演算回路24により、磁場センサ21からの検出位置信号値Vipに基づいて、線形運動デバイス31のホーム位置に対応する第1の位置信号値NEGCALと、線形運動デバイス31のフル位置に対応する第2の位置信号値POSCALを取得するステップ(S2)と、前記ホーム位置に対応する第1の位置信号値NEGCALと、線形運動デバイス31のフル位置に対応する第2の位置信号値POSCALとから検出位置演算信号値VPROCを得るステップ(S3)と、次に、デバイス位置指令信号発生回路26により、線形運動デバイス31を移動すべき目標位置を指示する目標位置信号値VTARGを出力するステップ(S4)と、次に、出力ドライバ28a,28bにより、検出位置演算信号値VPROCと目標位置信号値VTARGに基づいて、駆動コイル29に駆動電流を供給するステップ(S5)とを有し、検出位置信号値Vipにバラツキがあっても目標位置信号値VTARGで線形運動デバイスの位置制御を可能とする。なお、連続して、位置制御を繰り返す場合は、ステップS3乃至S5を繰り返す。
The control method in the
First, the
磁場センサ21からの検出位置信号値で、キャリブレーション演算回路24の入力信号値をVip、ホーム位置に対応する第1の位置信号値をNEGCAL、フル位置に対応する第2の位置信号値をPOSCAL、キャリブレーション演算回路24の出力信号値である検出位置演算信号値をVPROCとした場合に、キャリブレーション演算回路24の検出位置演算信号値VPROCが、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有する。
With the detected position signal value from the
図8は、キャリブレーション演算回路による演算方法を説明するためのフローチャートを示す図である。
キャリブレーション演算回路24による演算ステップが、まず、計数回路241により、外部からキャリブレーション指示信号が入力されると作動するステップ(S11)と、次に、D/A変換の出力信号が最小値に固定を指示して駆動コイル29に通電した時に、第1の時間T1まで計数回路241でカウントして取り込み指示信号が発行され、第1の記憶装置242aにより検出位置信号値Vipを記憶値NEGCALとして保存するステップ(S12)と、次に、第2の時間T2までカウントした時に、D/A変換の出力信号が最大値に固定を指示して駆動コイル29に通電した時に、第3の時間T3まで計数回路241でカウントして取り込み指示信号が発行され、第2の記憶装置242bにより検出位置信号値Vipを記憶値POSCALとして保存するステップ(S13)と、次に、第4の時間T4までカウントした時にD/A変換の出力指示は、PID制御回路の出力に基づいて出力する指示を発生し、計数回路241のカウントを停止するステップ(S14)とを有し、キャリブレーション演算回路24の検出位置演算信号値VPROCが、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有する。
FIG. 8 is a flowchart for explaining the calculation method by the calibration calculation circuit.
The calculation step by the
このようにして、磁場センサの搭載位置のずれや磁石の着磁ばらつきが生じた場合にも線形運動デバイスの正確な位置制御を可能な線形運動デバイスの制御方法を実現することができる。 In this way, it is possible to realize a linear motion device control method capable of accurate position control of the linear motion device even when the mounting position of the magnetic field sensor is deviated or the magnetization of the magnets varies.
9 レンズ
10 磁石
11 コイル
12 線形運動デバイス
13 磁場センサ
14 差動増幅器
15 非反転出力バッファ
16 反転出力バッファ
17 第1の出力ドライバ
18 第2の出力ドライバ
20 制御装置
21 磁場センサ
22 増幅器
23 A/D変換回路
24 キャリブレーション(Calibration)演算回路
25 PID制御回路
26 デバイス(レンズ)位置指令信号発生回路
27 D/A変換回路
28a 第1の出力ドライバ
28b 第2の出力ドライバ
29 駆動コイル
30 カメラモジュール
31 線形運動デバイス
32 磁石
33 レンズ(移動体)
241 計数回路(カウンタ/タイマ)
242a 第1の記憶装置(レジスタ/メモリ)
242b 第2の記憶装置(レジスタ/メモリ)
243a 第1の減算器
243b 第2の減算器
244 除算器
245 積算器
246 第3の記憶装置(レジスタ/メモリ)
9
241 Counting circuit (counter / timer)
242a First storage device (register / memory)
242b Second storage device (register / memory)
243a First subtractor 243b
Claims (9)
前記磁石が発生する磁場を検出し、検出された磁場の値に対応する検出位置信号値を出力する磁場センサと、
該磁場センサからの前記検出位置信号値に基づいて、前記線形運動デバイスのホーム位置に対応する第1の位置信号値と、前記線形運動デバイスのフル位置に対応する第2の位置信号値とから検出位置演算信号値を得るキャリブレーション演算回路と、
前記線形運動デバイスを移動すべき目標位置を指示する目標位置信号値を出力するデバイス位置指令信号発生回路と、
前記検出位置演算信号値と前記目標位置信号値に基づいて、前記駆動コイルに駆動電流を供給する出力ドライバとを備え、
前記検出位置信号値にバラツキがあっても前記目標位置信号値で前記線形運動デバイスの位置制御を可能とすることを特徴とする線形運動デバイスの制御装置。 A linear motion device having a magnet attached to a moving body, and a drive coil disposed in the vicinity of the magnet of the linear motion device, the magnet being moved by a force generated by a coil current flowing through the drive coil In the control device of the linear motion device to be moved,
A magnetic field sensor that detects a magnetic field generated by the magnet and outputs a detected position signal value corresponding to the detected magnetic field value;
Based on the detected position signal value from the magnetic field sensor, from a first position signal value corresponding to the home position of the linear motion device and a second position signal value corresponding to the full position of the linear motion device A calibration calculation circuit for obtaining a detection position calculation signal value;
A device position command signal generating circuit for outputting a target position signal value indicating a target position to move the linear motion device;
An output driver for supplying a drive current to the drive coil based on the detected position calculation signal value and the target position signal value;
An apparatus for controlling a linear motion device, which enables position control of the linear motion device with the target position signal value even if the detected position signal value varies.
前記キャリブレーション演算回路の前記検出位置演算信号値VPROCが、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする請求項1に記載の線形運動デバイスの制御装置。 With the detected position signal value from the magnetic field sensor, the input signal value of the calibration arithmetic circuit is Vip, the first position signal value corresponding to the home position is NEGCAL, and the second position corresponding to the full position. When the position signal value is POSCAL and the detected position calculation signal value which is the output signal value of the calibration calculation circuit is VPROC,
2. The linear motion device control device according to claim 1, wherein the detected position calculation signal value VPROC of the calibration calculation circuit is proportional to (Vip−NEGCAL) / (POSCAL−NEGCAL). 3.
外部からキャリブレーション指示信号が入力されると作動する計数回路と、
D/A変換の出力信号が前記D/A変換の出力を最小値に固定を指示して前記駆動コイルに通電した時に、第1の時間まで前記計数回路でカウントして取り込み指示信号が発行され、前記検出位置信号値を記憶値として保存する第1の記憶装置と、
第2の時間までカウントした時に、前記D/A変換の出力信号が、前記D/A変換の出力を最大値に固定を指示して前記駆動コイルに通電した時に、第3の時間まで前記計数回路でカウントして取り込み指示信号が発行され、前記検出位置信号値を記憶値として保存する第2の記憶装置とを備え、
第4の時間までカウントした時に前記D/A変換の出力指示は、PID制御回路の出力に基づいて出力する指示を発生し、前記計数回路のカウントを停止することを特徴とする請求項1又は2に記載の線形運動デバイスの制御装置。 The calibration calculation circuit is
A counting circuit that operates when a calibration instruction signal is input from the outside;
When the D / A conversion output signal instructs the D / A conversion output to be fixed to the minimum value and the drive coil is energized, a count instruction circuit counts up to the first time and a capture instruction signal is issued. A first storage device that stores the detected position signal value as a stored value;
When the output signal of the D / A conversion indicates that the output of the D / A conversion is fixed to the maximum value and the drive coil is energized when counting up to the second time, the counting is performed until the third time. A second storage device that counts by a circuit and issues a capture instruction signal and stores the detected position signal value as a stored value;
The output instruction of the D / A conversion is generated based on the output of the PID control circuit when counting up to the fourth time, and the counting of the counting circuit is stopped. The control apparatus of the linear motion device of 2.
前記磁場センサからの前記検出位置信号値(Vip)と、前記第1の記憶装置の記憶値(NEGCAL)とを減算する第1の減算器と、
第2の記憶装置の記憶値(POSCAL)と前記第1の記憶装置(NEGCAL)の記憶値とを減算する第2の減算器と、
第1の減算器の出力値(Vip−NEGCAL)と、前記第2の減算器)の出力値(POSCAL−NEGCAL)とを除算する除算器とを備え、
前記キャリブレーション演算回路の前記検出位置演算信号値(VPROC)が、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする請求項3に記載の線形運動デバイスの制御装置。 The calibration calculation circuit is
A first subtractor for subtracting the detected position signal value (Vip) from the magnetic field sensor and a stored value (NEGCAL) of the first storage device;
A second subtractor for subtracting a stored value (POSCAL) of a second storage device and a stored value of the first storage device (NEGCAL);
A divider for dividing the output value of the first subtractor (Vip-NEGCAL) and the output value of the second subtractor (POSCAL-NEGCAL);
4. The linear motion device control according to claim 3, wherein the detected position calculation signal value (VPROC) of the calibration calculation circuit is proportional to (Vip-NEGCAL) / (POSCAL-NEGCAL). apparatus.
まず、磁場センサにより、前記磁石が発生する磁場を検出し、検出された磁場の値に対応する検出位置信号値を出力するステップと、
次に、キャリブレーション演算回路により、前記磁場センサからの前記検出位置信号値に基づいて、前記線形運動デバイスのホーム位置に対応する第1の位置信号値と、前記線形運動デバイスのフル位置に対応する第2の位置信号値とから検出位置演算信号値を得るステップと、
次に、デバイス位置指令信号発生回路により、前記線形運動デバイスを移動すべき目標位置を指示する目標位置信号値を出力するステップと、
次に、出力ドライバにより、前記検出位置演算信号値と前記目標位置信号値に基づいて、前記駆動コイルに駆動電流を供給するステップとを有し、
前記検出位置信号値にバラツキがあっても前記目標位置信号値で前記線形運動デバイスの位置制御を可能とすることを特徴とする線形運動デバイスの制御方法。 A linear motion device having a magnet attached to a moving body, and a drive coil disposed in the vicinity of the magnet of the linear motion device, the magnet being moved by a force generated by a coil current flowing through the drive coil In the control method in the controller of the linear motion device to be moved,
First, a magnetic field sensor detects a magnetic field generated by the magnet, and outputs a detected position signal value corresponding to the detected magnetic field value;
Next, based on the detected position signal value from the magnetic field sensor, a first position signal value corresponding to the home position of the linear motion device and a full position of the linear motion device are detected by a calibration arithmetic circuit. Obtaining a detected position calculation signal value from the second position signal value to be performed;
Next, outputting a target position signal value indicating a target position where the linear motion device is to be moved by a device position command signal generation circuit;
Next, an output driver has a step of supplying a drive current to the drive coil based on the detected position calculation signal value and the target position signal value,
A method for controlling a linear motion device, wherein the position of the linear motion device can be controlled with the target position signal value even if the detected position signal value varies.
前記キャリブレーション演算回路の前記検出位置演算信号値VPROCが、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする請求項7に記載の線形運動デバイスの制御方法。 With the detected position signal value from the magnetic field sensor, the input signal value of the calibration arithmetic circuit is Vip, the first position signal value corresponding to the home position is NEGCAL, and the second position corresponding to the full position. When the position signal value is POSCAL and the detected position calculation signal value which is the output signal value of the calibration calculation circuit is VPROC,
8. The method of controlling a linear motion device according to claim 7, wherein the detected position calculation signal value VPROC of the calibration calculation circuit is proportional to (Vip-NEGCAL) / (POSCAL-NEGCAL).
まず、計数回路により、外部からキャリブレーション指示信号が入力されると作動するステップと、
次に、D/A変換の出力信号が前記D/A変換の出力を最小値に固定を指示して前記駆動コイルに通電した時に、第1の時間まで前記計数回路でカウントして取り込み指示信号が発行され、第1の記憶装置により前記検出位置信号値(Vip)を記憶値(NEGCAL)として保存するステップと、
次に、第2の時間までカウントした時に、前記D/A変換の出力信号が前記D/A変換の出力を最大値に固定を指示して前記駆動コイルに通電した時に、第3の時間まで前記計数回路でカウントして取り込み指示信号が発行され、第2の記憶装置により前記検出位置信号値(Vip)を記憶値(POSCAL)として保存するステップと、
次に、第1の減算器により、前記磁場センサからの前記検出位置信号値(Vip)と、前記第1の記憶装置の記憶値(NEGCAL)とを減算するステップと、
次に、第2の減算器により、第2の記憶装置の記憶値(POSCAL)と前記第1の記憶装置の記憶値(NEGCAL)とを減算するステップと、
次に、除算器により、第1の減算器の出力値(Vip−NEGCAL)と、前記第2の減算器の出力値(POSCAL−NEGCAL)とを除算するステップと、
次に、第4の時間までカウントした時に前記D/A変換の出力指示は、PID制御回路の出力に基づいて出力する指示を発生し、前記計数回路のカウントを停止するステップとを有し、
前記キャリブレーション演算回路の前記検出位置演算信号値(VPROC)が、(Vip−NEGCAL)/(POSCAL−NEGCAL)と比例の関係を有することを特徴とする請求項7又は8に記載の線形運動デバイスの制御方法。 The calculation step by the calibration calculation circuit includes:
First, a step that operates when a calibration instruction signal is input from the outside by a counting circuit;
Next, when the output signal of the D / A conversion instructs to fix the output of the D / A conversion to the minimum value and the drive coil is energized, it is counted by the counting circuit until the first time and the capture instruction signal Is issued, and the first storage device stores the detected position signal value (Vip) as a stored value (NEGCAL);
Next, when counting up to the second time, when the D / A conversion output signal instructs the D / A conversion output to be fixed to the maximum value and the drive coil is energized, until the third time A capture instruction signal is issued after counting by the counting circuit, and the second storage device stores the detected position signal value (Vip) as a stored value (POSCAL);
Next, the first subtracter subtracts the detected position signal value (Vip) from the magnetic field sensor and the stored value (NEGCAL) of the first storage device;
Next, subtracting the stored value (POSCAL) of the second storage device and the stored value (NEGCAL) of the first storage device by a second subtractor;
Next, the step of dividing the output value of the first subtracter (Vip-NEGCAL) by the divider and the output value of the second subtractor (POSCAL-NEGCAL);
Next, the output instruction of the D / A conversion when counting up to the fourth time has a step of generating an instruction to output based on the output of the PID control circuit and stopping the counting of the counting circuit,
The linear motion device according to claim 7 or 8, wherein the detected position calculation signal value (VPROC) of the calibration calculation circuit is proportional to (Vip-NEGCAL) / (POSCAL-NEGCAL). Control method.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012113444A JP2013238821A (en) | 2012-05-17 | 2012-05-17 | Control device of linear motion device and control method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2012113444A JP2013238821A (en) | 2012-05-17 | 2012-05-17 | Control device of linear motion device and control method thereof |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016078806A Division JP2016136837A (en) | 2016-04-11 | 2016-04-11 | Control device of linear motion device and control method thereof |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2013238821A true JP2013238821A (en) | 2013-11-28 |
Family
ID=49763859
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2012113444A Pending JP2013238821A (en) | 2012-05-17 | 2012-05-17 | Control device of linear motion device and control method thereof |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2013238821A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107270945A (en) * | 2017-05-10 | 2017-10-20 | 上海钧嵌传感技术有限公司 | A kind of automatic code sensor to pole |
JP2018146791A (en) * | 2017-03-06 | 2018-09-20 | ローム株式会社 | Actuator driver, image capturing device, and electronic device |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06105206A (en) * | 1992-09-18 | 1994-04-15 | Sony Corp | Position detection method |
JPH09133853A (en) * | 1995-11-08 | 1997-05-20 | Nikon Corp | Lens position detecting device |
JP2004085684A (en) * | 2002-08-23 | 2004-03-18 | Canon Inc | Lens control unit and camera equipped with same |
JP2010107440A (en) * | 2008-10-31 | 2010-05-13 | Asahi Kasei Electronics Co Ltd | Position detection device and electronic apparatus using the same |
JP2010249858A (en) * | 2009-04-10 | 2010-11-04 | Canon Inc | Lens barrel and imaging device having the same |
JP2012083313A (en) * | 2010-10-14 | 2012-04-26 | Asahi Kasei Electronics Co Ltd | Position detection device and electronic apparatus with the same |
-
2012
- 2012-05-17 JP JP2012113444A patent/JP2013238821A/en active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06105206A (en) * | 1992-09-18 | 1994-04-15 | Sony Corp | Position detection method |
JPH09133853A (en) * | 1995-11-08 | 1997-05-20 | Nikon Corp | Lens position detecting device |
JP2004085684A (en) * | 2002-08-23 | 2004-03-18 | Canon Inc | Lens control unit and camera equipped with same |
JP2010107440A (en) * | 2008-10-31 | 2010-05-13 | Asahi Kasei Electronics Co Ltd | Position detection device and electronic apparatus using the same |
JP2010249858A (en) * | 2009-04-10 | 2010-11-04 | Canon Inc | Lens barrel and imaging device having the same |
JP2012083313A (en) * | 2010-10-14 | 2012-04-26 | Asahi Kasei Electronics Co Ltd | Position detection device and electronic apparatus with the same |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2018146791A (en) * | 2017-03-06 | 2018-09-20 | ローム株式会社 | Actuator driver, image capturing device, and electronic device |
CN107270945A (en) * | 2017-05-10 | 2017-10-20 | 上海钧嵌传感技术有限公司 | A kind of automatic code sensor to pole |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5961258B2 (en) | Linear motion device control apparatus and control method thereof | |
KR101920130B1 (en) | Camera module adjustment method, lens position control device, control device and control method for linear motion device | |
JP2018124582A (en) | Image stabilizer correction device and image stabilizer correction circuit, as well as image stabilizer correction method | |
JP2013238822A (en) | Control device of linear motion device and control method thereof | |
JP2013238821A (en) | Control device of linear motion device and control method thereof | |
JP2013025268A (en) | Optical device | |
JP2016136837A (en) | Control device of linear motion device and control method thereof | |
JP2013257486A (en) | Optical device, image capturing device, and method of controlling optical device | |
JP5793130B2 (en) | Linear motion device control apparatus and control method thereof | |
WO2017056575A1 (en) | Movable lens position detection device, lens device, imaging device, movable lens position detection method, and movable lens position detection program | |
JP6368605B2 (en) | Position detecting device and driving device provided with the same | |
JP5731951B2 (en) | Control device for linear motion device, control method for linear motion device | |
JP2016033480A (en) | Position sensor of linear motion device, and position controller of linear motion device using the position sensor | |
JP6472166B2 (en) | Position control apparatus and method | |
JP6188349B2 (en) | Control device, control method, program | |
WO2013054848A1 (en) | Actuator control device, lens barrel, and imaging device | |
JP2017116818A (en) | Image blurring correction device, method for controlling the same, control program, and imaging device | |
JP2016065896A (en) | Imaging apparatus, imaging control method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20131205 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20140929 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20141007 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20141203 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20150602 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150730 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20160112 |