JP6188349B2 - Control device, control method, program - Google Patents
Control device, control method, program Download PDFInfo
- Publication number
- JP6188349B2 JP6188349B2 JP2013031134A JP2013031134A JP6188349B2 JP 6188349 B2 JP6188349 B2 JP 6188349B2 JP 2013031134 A JP2013031134 A JP 2013031134A JP 2013031134 A JP2013031134 A JP 2013031134A JP 6188349 B2 JP6188349 B2 JP 6188349B2
- Authority
- JP
- Japan
- Prior art keywords
- driving
- phase
- lens
- stepping motor
- control unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Lens Barrels (AREA)
Description
本発明は、制御装置、制御方法、プログラムに関する。詳しくは、撮像装置や交換レンズユニットに搭載されるレンズや絞り等の光学素子等を制御する制御装置、制御方法、および制御のためのプログラムに関する。 The present invention relates to a control device, a control method, and a program. Specifically, the present invention relates to a control device, a control method, and a control program for controlling an optical element such as a lens and an aperture mounted in an imaging device or an interchangeable lens unit.
上記のような制御装置において、製造誤差に起因したステッピングモータが持つ複数の相間の電気角誤差量が大きい場合には、回転むら（振動）が発生し、光学素子を移動させる際のモータ駆動音が増加する。
そこで、ステッピングモータが持つ複数の相間の電気角誤差量に応じて予め補正値として測定しておき、その補正値を用いて相の切り換えタイミングを変更して各相に流れる励磁電流の位相を補正することで、振動を低減する方法が知られている。
例えば、特許文献１には、移動速度と移動時間に応じて光学素子の基準移動量を記憶して、光学素子を移動させた際の実際の位置と基準移動量との差が小さくなるように補正値を求め、モータの駆動波形を制御して、モータ振動を軽減させる方法が記されている。
In the control device as described above, when the electrical angle error amount between a plurality of phases of the stepping motor due to the manufacturing error is large, rotation unevenness (vibration) occurs, and the motor drive sound when moving the optical element Will increase.
Therefore, it is measured in advance as a correction value according to the electrical angle error amount between multiple phases of the stepping motor, and the phase of excitation current flowing in each phase is corrected by changing the phase switching timing using the correction value. Thus, a method for reducing vibration is known.
For example, in
しかしながら、前記のような構成では、ステッピングモータごとに複数の相間での電気角誤差量を予め求めておく必要がある。電気角誤差量を求めるためには、ステータ極歯の配置寸法を精密スケールで計測したり、実際にモータを駆動して振動量を測定し、誤差量を推定したりする方法がある。しかしながら、いずれの方法を用いても、モータごとに測定や計算が必要となる課題があった。
さらに、特許文献１に記載の構成では、光学素子の所定時間内の実際の位置と基準移動量との差分を複数回求めて、その差分が最も小さくなるように補正量を決めている。そのため、瞬間的に大きくなる変動の影響を受けやすいという課題がある。
本発明は、電気角誤差量を求める煩雑な前工程を必要とすることなく、精度良く電気角誤差を検出することにより、光学素子を移動させる際のモータ駆動音を低減できるようにした制御装置、制御方法、プログラムを提供する。
However, in the configuration as described above, it is necessary to obtain in advance an electrical angle error amount between a plurality of phases for each stepping motor. In order to obtain the electrical angle error amount, there are methods of measuring the arrangement size of the stator pole teeth with a precision scale, or actually driving the motor to measure the vibration amount to estimate the error amount. However, whichever method is used, there is a problem that requires measurement and calculation for each motor.
Furthermore, in the configuration described in
The present invention provides a control device capable of reducing motor driving noise when moving an optical element by accurately detecting an electrical angle error without requiring a complicated pre-process for obtaining an electrical angle error amount. , Providing a control method and a program.
本発明の制御装置は、駆動対象を駆動するステッピングモータと、前記ステッピングモータを少なくとも２相の電流で駆動させる駆動手段と、前記駆動対象の実際の位置を検出する位置検出手段と、前記駆動手段の少なくとも２相の電流の位相を変更する位相変更手段と、前記位相変更手段を用いて前記駆動手段を制御する制御手段と、前記位置検出手段により検出された位置から前記駆動対象の駆動中における基準位置を算出する基準位置算出手段と、を含み、前記基準位置算出手段は、前記位置検出手段により検出される駆動中の前記駆動対象の少なくとも３つの実際の位置を１次近似することで基準位置を算出し、前記位相変更手段は、前記位置検出手段が検出した前記駆動対象の実際の位置と前記基準位置算出手段が算出した基準位置との差分の絶対値の総和または前記差分の累乗の総和が最も小さくなる電流の位相差を決定し、前記制御手段は、前記位相差の電流を用いて前記ステッピングモータを制御することを特徴とする。 The control device according to the present invention includes a stepping motor that drives a drive target, a drive unit that drives the stepping motor with at least two-phase current, a position detection unit that detects an actual position of the drive target, and the drive unit A phase changing means for changing the phase of at least two phases of current, a control means for controlling the driving means using the phase changing means, and during driving of the drive target from the position detected by the position detecting means includes a reference position calculating means for calculating a reference position, wherein the reference position calculation means, at least three reference the actual position by first-order approximation of the driven object being driven detected by said position detecting means position is calculated, and the phase changing means, the reference position of the reference position calculation means and the actual position of the driven object the position detecting means has detected is calculated Sum or the sum of the power of the difference between the absolute value of the difference between determines the phase difference between the smallest current, said control means includes a control means controls said stepping motor by using a current of the phase difference To do.
本発明によれば、モータに製造誤差がある場合でも、煩雑な前工程を必要とすることなく、個々のステッピングモータの特性に合わせた適切な制御を行うことができる。この結果、駆動対象を駆動する際に、ステッピングモータの駆動音を低減することができる。 According to the present invention, even when there is a manufacturing error in the motor, it is possible to perform appropriate control in accordance with the characteristics of each stepping motor without requiring a complicated pre-process. As a result, the driving sound of the stepping motor can be reduced when driving the drive target.
＜第１の実施形態＞
以下、添付図面を参照して、本発明の実施形態を詳細に説明する。なお、以下に説明する実施形態は、本発明の実現手段としての一例に過ぎない。本発明は、適用される装置の構成や各種条件によって適宜修正や変更されるべきものであり、以下の実施形態に限定されるものではない。
図１は、本発明の第１の実施形態である制御装置が適用される撮像装置１の構成を示す。この撮像装置１は、ズームレンズ群を含むレンズシステムを搭載したビデオカメラであるものとする。なお、本発明は、ビデオカメラの制御装置に限らず、デジタルスチルカメラ等、各種の撮像装置、その他ステッピングモータを用いて制御対象を制御する制御装置にも適用できる。
<First Embodiment>
Hereinafter, embodiments of the present invention will be described in detail with reference to the accompanying drawings. Note that the embodiments described below are merely examples as means for realizing the present invention. The present invention should be modified or changed as appropriate according to the configuration of the apparatus to be applied and various conditions, and is not limited to the following embodiments.
FIG. 1 shows a configuration of an
１０１は、前玉レンズユニットであり、たとえばレンズ鏡筒部などに固定されている。１０２は、駆動対象のズームレンズである。駆動対象のズームレンズ１０２は、光軸方向に移動して変倍を行う。１０３は光量を調整する絞りである。１０４は、固定レンズユニットであり、レンズ鏡筒部などに固定されている。１０５は、駆動対象のフォーカスレンズである。駆動対象のフォーカスレンズ１０５は、焦点調節機能と、変倍による像面移動を補正するコンペセータ機能とを兼ね備える。フォーカスレンズ１０５は、ズームレンズ１０２の光軸後方に、光軸方向に移動可能に設けられる。これらのレンズユニットにより撮影光学系が構成される。この撮影光学系は、被写体側（図の左側）から順に、正、負、正、正の光学パワーを有する４つのレンズユニットで構成されたリアフォーカス光学系である。なお、図中には、各レンズユニットが１枚のレンズにより構成されているように記載されているが、実際には、１枚のレンズにより構成されていてもよいし、複数枚のレンズにより構成されていてもよい。
１０６は、撮像素子であり、たとえば、ＣＣＤやＣＭＯＳセンサにより構成される。撮影光学系を通ってきた被写体からの光束は、この撮像素子１０６上に結像する。そして、撮像素子１０６は、結像した被写体の光学像を、光電変換して撮像信号を出力する。１０７は、増幅器（ＡＧＣ）であり、撮像素子１０６が出力した撮像信号を最適なレベルに増幅する。１０８は、カメラ信号処理回路である。カメラ信号処理回路１０８は、増幅器１０７から入力された撮像信号を標準テレビ信号に変換し、撮影映像として出力する。１０９は、記録手段であり、カメラ信号処理回路１０８が出力した撮影映像を記録する。なお、記録手段１０９には、ＦＬＡＳＨメモリ、ハードディスク、ＤＶＤ、テープメディアなどが用いられる。
１１８はシステムマイコンである。システムマイコン１１８は、ズームレンズ１０２およびフォーカスレンズ１０５を駆動制御するレンズ制御部１１６と、メモリ１１７とを含む。システムマイコン１１８は、たとえば、ＣＰＵとＲＯＭとＲＡＭとを含む。ＲＯＭには、撮像装置の各部を制御するためのコンピュータプログラムが格納されている。そして、ＣＰＵがＲＯＭからコンピュータプログラムを読み出し、ＲＡＭに展開して実行する。これにより、システムマイコン１１８のレンズ制御部１１６とメモリ１１７の機能が実現し、フォーカス駆動回路１１３とズーム駆動回路１１０を介して、ズームレンズ１０２とフォーカスレンズ１０５を駆動制御する。フォーカス駆動回路１１３は、システムマイコン１１８の制御にしたがってフォーカスレンズ１０５を駆動する。ズーム駆動回路１１０は、システムマイコン１１８の制御にしたがってズームレンズ１０２を駆動する。
レンズ制御部１１６は、例えばズームスイッチ（図略）などの操作部材の操作されている方向に対応して、ズームレンズ１０２をテレまたはワイド方向に駆動するための信号を出力する。この信号は、ズーム駆動回路１１０を介してズーム駆動源１１１に駆動信号として与えられる。また、レンズ制御部１１６から与える駆動信号は、励磁位相間の位相を自在に変えることができる。なお、ズームレンズ１０２は、レンズ鏡筒部などに対して移動可能なレンズ保持枠（図略）に固定されている。レンズ保持枠にはラックが取り付けられている。
ズーム駆動源１１１は、ステッピングモータ１３０とリードスクリュー１３１を含んで構成されている。そして、このリードスクリュー１３１とズームレンズ１０２に取り付けられたラックとの噛み合い作用により、ズームレンズ１０２がレンズ保持枠とともに光軸方向に移動する。
また、レンズ制御部１１６は、メモリ１１７に格納されるカム軌跡データを用いて、フォーカスレンズ１０５をズームレンズ１０２と連動して動作させる。そして、レンズ制御部１１６は、フォーカス駆動回路１１３を介してフォーカス駆動源１１４に駆動信号を与える。なお、フォーカスレンズ１０５は、レンズ鏡筒部など対して移動可能なレンズ保持枠に固定されている。レンズ保持枠にはラックが取り付けられている。フォーカス駆動源１１４は、ステッピングモータ１３２とリードスクリュー１３３とを含んで構成されている。そして、リードスクリュー１３３とフォーカスレンズ１０５に取り付けられたラックとの噛み合い作用により、フォーカスレンズ１０５がレンズ保持枠とともに光軸方向に移動する。
なお、本実施形態において、ステッピングモータ１３０，１３２の駆動方式は特に限定されない。たとえば、マイクロステップ駆動方式、１−２相駆動方式および２−２相駆動方式等、いずれの駆動方式を用いてもよい。
The
The
Further, the
In the present embodiment, the driving method of the stepping
ズームレンズ１０２のレンズ保持枠には、ズームレンズ１０２の位置を検出するためのズームレンズ用位置スケール１１９が固定されている。同様に、フォーカスレンズ１０５のレンズ保持枠には、フォーカスレンズ１０５の位置を検出するためのフォーカスレンズ用位置スケール１２０が固定されている。また、レンズ鏡筒部（図略）において、ズームレンズ用位置スケール１１９と対向する箇所には、ズームレンズ位置センサ１１２が固定されている。同様に、フォーカスレンズ用位置スケール１２０と対向する箇所には、フォーカスレンズ位置センサ１１５が固定されている。
そして、ズームレンズ位置センサ１１２とズームレンズ用位置スケール１１９とにより、ズーム位置検出手段が構成される。また、フォーカスレンズ位置センサ１１５とフォーカスレンズ用位置スケール１２０とにより、フォーカス位置検出手段が構成される。
ズームレンズ用位置スケール１１９とフォーカスレンズ用位置スケール１２０には、光軸方向に変化する磁気パターンや光反射パターン等のスケールパターンが形成されている。ズームレンズ用位置スケール１１９は、ズームレンズ１０２とともにズームレンズ位置センサ１１２に対して光軸方向に移動する。そうすると、ズームレンズ位置センサ１１２は、スケールパターンに対応して強度が変化する磁気や反射光等を電気信号に変換して位置検出信号として出力する。同様に、フォーカスレンズ用位置スケール１２０が、フォーカスレンズ１０５とともにフォーカスレンズ位置センサ１１５に対して光軸方向に移動すると、フォーカスレンズ位置センサ１１５は位置検出信号を出力する。
ズームレンズ位置センサ１１２とフォーカスレンズ位置センサ１１５からの位置検出信号は、システムマイコン１１８に出力される。システムマイコン１１８は、これらの位置検出信号を、ズーム駆動源１１１とフォーカス駆動源１１４のステッピングモータ１３０，１３２の駆動の制御を通じて、ズームレンズ１０２とフォーカスレンズ１０５の位置制御に用いる。
A zoom
The zoom
The zoom
Position detection signals from the zoom
次に、ステッピングモータ１３０，１３２の電気角誤差（位相角）と振動について説明する。図２（ａ）は、２相励磁駆動方式の場合のＡ相とＢ相の誘導子の位置関係を模式的に示す図である。図２（ｂ）は、Ａ相とＢ相の誘導子に印加する電流波形の例を模式的に示す図である。
図２（ａ）に示すように、Ａ−、Ｂ−、Ａ＋、Ｂ−の誘導子の機械的配置の位相差は９０［ｄｅｇ］となっている。このような関係を保っている場合は、ステッピングモータ１３０，１３２の各相に、図２（ｂ）のような励磁位相間の位相が９０［ｄｅｇ］の２相の電流波形を印加する。そうすると、ステッピングモータ１３０，１３２の駆動時における振動が少なくなり、ステッピングモータ１３０，１３２の回転軸は滑らかに回転する。
図３（ａ）は、ステッピングモータ１３０，１３２の組み立て誤差により、Ａ相とＢ相の誘導子の位置関係が９０＋α［ｄｅｇ］となっている場合の機械的配置を模式的に示す図である。図３（ｂ）は、Ａ相とＢ相の誘導子に印加する２相の電流波形の例を模式的に示す図である。
図３（ａ）に示すように、Ａ−、Ｂ−の誘導子の機械的配置の位相差が９０＋α［ｄｅｇ］の場合について説明する。この場合、ステッピングモータ１３０，１３２の各相に対して図２（ｂ）のような励磁位相間の差が９０［ｄｅｇ］の電流波形を印加すると、トルク変動が大きくなり振動が大きくなる。そこでこの場合には、図３（ａ）のステッピングモータ１３０，１３２に、誘導子配置の位相ずれに合わせて、図３（ｂ）に示すような励磁位相間の位相が９０＋α［ｄｅｇ］の波形の電流を印加すればよい。そうすると、ステッピングモータ１３０，１３２の回転が滑らかになり振動が抑制される。
Next, the electrical angle error (phase angle) and vibration of the stepping
As shown in FIG. 2A, the phase difference of the mechanical arrangement of the A-, B-, A +, and B- inductors is 90 [deg]. When such a relationship is maintained, a two-phase current waveform having an excitation phase of 90 [deg] as shown in FIG. 2B is applied to each phase of the stepping
FIG. 3A is a diagram schematically showing a mechanical arrangement when the positional relationship between the A-phase and B-phase inductors is 90 + α [deg] due to assembly errors of the stepping
As shown in FIG. 3A, a case where the phase difference of the mechanical arrangement of the A- and B- inductors is 90 + α [deg] will be described. In this case, when a current waveform having a difference of 90 [deg] between the excitation phases as shown in FIG. 2B is applied to each phase of the stepping
ズーム駆動回路１１０に与えられる駆動制御信号は、ズーム駆動源１１１のステッピングモータ１３０の複数の相（Ａ相とＢ相）にそれぞれ与えられる励磁信号間の位相を決定する。このため、駆動制御信号を補正することは、励磁信号間の位相を補正することに相当する。本実施形態では、ズームレンズ位置センサ１１２から得られる位置検出信号を用いて、ステッピングモータ１３０の電気角誤差（位相差）検出する方法を示す。そして、本実施形態の方法で検出された位相差を用いて、ズーム駆動源１１１に与えられる駆動制御信号を補正する。これにより、ズーム駆動源１１１のステッピングモータ１３０において発生する振動を低減し、モータ駆動音の静音化を実現する。
The drive control signal given to the
続いて、本実施形態の撮像装置１内のシステムマイコン１１８が実行する電気角誤差の検出方法について説明する。本実施形態では、この検出方法を、ズーム駆動源１１１に適用するものとする。図４は、ズームレンズ位置センサ１１２から出力に基づき、ステッピングモータ１３０の振動の大きさを比較するための評価値を算出する処理を示すフローチャートである。
この処理を実行するためのコンピュータプログラムは、あらかじめシステムマイコン１１８のＲＯＭに格納されている。そして、システムマイコン１１８のＣＰＵは、このコンピュータプログラムをＲＯＭから読出し、ＲＡＭに展開して実行する。これにより、この処理が実現する。
Next, an electrical angle error detection method executed by the
A computer program for executing this processing is stored in advance in the ROM of the
ステップＳ４０１にて、システムマイコン１１８のレンズ制御部１１６は、まず位相角βと駆動速度Ｖを取得する。ここでの位相角βと駆動速度Ｖの取得方法は図４のフローチャートに示すサブルーチンの引数として得られる。
ステップＳ４０２において、レンズ制御部１１６は、ステップＳ４０１で得た駆動速度Ｖを設定する。そしてステップＳ４０３に進む。
ステップＳ４０３では、レンズ制御部１１６は、ステップＳ４０１で得た位相角βを設定する。
ステップＳ４０４において、レンズ制御部１１６は、ステップＳ４０２とＳ４０３で設定した駆動速度Ｖと位相角βに基づいて駆動制御信号を生成し、ズーム駆動回路１１０に与える。これにより、レンズ制御部１１６は、ズーム駆動回路１１０を介してズームレンズ１０２の駆動を開始する。
ステップＳ４０５では、レンズ制御部１１６は、加速処理が終わってステッピングモータ１３０の駆動速度が一定速度になるまでウェイト状態となる。そして、駆動速度が安定したら（一定速度になったら）ステップＳ４０６に進む。
ステップＳ４０６〜Ｓ４０８では、レンズ制御部１１６は、ズームレンズ１０２が一定速度で駆動中に、ズームレンズ位置センサ１１２から出力されるズームレンズ１０２の位置を、一定の時間間隔で複数保存する。具体的には、次のとおりである。
ステップＳ４０６で、レンズ制御部１１６は、ズームレンズ１０２が一定速度で駆動中にズームレンズ位置センサ１１２から得られるズームレンズ１０２の実際の位置を、Ｐ［Ｃ］（０＜Ｃ＜Ｎ−１。Ｎは３以上の自然数）に格納する。
ステップＳ４０７にて、レンズ制御部１１６は、次の位置を取得するためのカウンタＣをインクリメントする。
ステップＳ４０８にて、レンズ制御部１１６は、取得したズームレンズ１０２の実際の位置を示す位置データの数ＣがＮ個に達したか否かを判定する。実際の位置を示す位置データの数ＣがＮ個に達した場合には、Ｓ４０９に進む。
ステップＳ４０６〜４０８で取得する位置データの数Ｃは、３以上であるものとする。また、レンズ制御部１１６は、ズームレンズ１０２の駆動中における実際の位置の取得を、一定の時間間隔で行う。
ステップＳ４０９では、レンズ制御部１１６は、ステップＳ４０６〜Ｓ４０８で取得した位置Ｐ［０］〜Ｐ［Ｎ−１］のズームレンズ１０２の実際の位置のデータを１次近似する（基準位置算出）。すなわち、１次近似として最小二乗法を用いて、次の（式１）に示す近似直線の係数ａとｂの算出を行う。
Ｙ ＝ ａＸ ＋ ｂ （式１）
図５は、ズームレンズ１０２の位置のデータ５０２と近似直線５０１の一例を示すグラフである。なお、最小二乗法の詳細な説明は省略する。この近似直線５０１がズームレンズ１０２の駆動中の各時間における基準位置となる。
ステップＳ４１０にて、レンズ制御部１１６は、カウンタＣをクリアする。そして、Ｓ４１１に進む。
In step S401, the
In step S402, the
In step S403, the
In step S404, the
In step S405, the
In steps S406 to S408, the
In step S406, the
In step S407, the
In step S408, the
It is assumed that the number C of position data acquired in steps S406 to S408 is 3 or more. In addition, the
In step S409, the
Y = aX + b (Formula 1)
FIG. 5 is a graph showing an example of the
In step S410, the
ステップＳ４１１では、レンズ制御部１１６は、ステップＳ４０９で求めた近似直線５０１上の点Ｄ［Ｃ］を、次の（式２）を用いて算出する。（式２）中の係数ａとｂは、ステップＳ４０９において算出されたものである。
Ｄ［Ｃ］ ＝ ａＰ［Ｃ］ ＋ ｂ （式２）
ステップＳ４１２にて、レンズ制御部１１６は、次の（式３）を用いて、近似直線上の点Ｄ［Ｃ］（基準位置）とステップＳ４０６〜Ｓ４０８で取得した位置Ｐ［Ｃ］（実際の位置）の差分の２乗（累乗）を算出する。
Ｖａｆ［Ｃ］ ＝ （Ｄ［Ｃ］ − Ｐ［Ｃ］ ）2 （式３）
そして、算出した差分の２乗（累乗）を、ＲａｍであるＶａｆ［Ｃ］に格納する。なお、ステップＳ４１２においては、レンズ制御部１１６は、次の（式３’）を用いて、近似直線上の点Ｄ［Ｃ］（基準位置）とステップＳ４０６〜Ｓ４０８で取得した位置Ｐ［Ｃ］（実際の位置）の差分の絶対値を算出してもよい。この場合には、算出した差分の絶対値をＶａｆ［Ｃ］に格納することになる。
Ｖａｆ［Ｃ］ ＝ ｜Ｄ［Ｃ］ − Ｐ［Ｃ］｜ （式３’）
In step S411, the
D [C] = aP [C] + b (Formula 2)
In step S412, the
Vaf [C] = (D [C] −P [C]) 2 (Formula 3)
Then, the square (power) of the calculated difference is stored in Ram, Vaf [C]. In step S412, the
Vaf [C] = | D [C] −P [C] | (
ステップＳ４１３にて、レンズ制御部１１６は、次の処理のためのカウンタＣをインクリメントする。そしてステップＳ４１４に進む。
ステップＳ４１４にて、レンズ制御部１１６は、ステップＳ４１１〜Ｓ４１３の処理をＮ回繰り返したかを判定する。Ｎ回繰り返したと判定した場合にはステップＳ４１５に進み、そうでない場合にはステップＳ４１１に進む。
ステップＳ４１５にて、レンズ制御部１１６は、ステップＳ４１１〜Ｓ４１４で得られたＮ個のＶａｆ［０］〜Ｖａｆ［Ｎ−１］の総和を算出し、算出した総和を評価値Ｖａｌとする。そして、評価値Ｖａｌを、図４のフローチャートに示すサブルーチンの呼びもとに返す。
以上のように図４のフローチャートに従い、振動を評価するための評価値Ｖａｌを求める。
In step S413, the
In step S414, the
In step S415, the
As described above, the evaluation value Val for evaluating vibration is obtained according to the flowchart of FIG.
次に、図６のフローチャートと図７のグラフを用いて、本実施形態におけるステッピングモータ１３０の電気角誤差（位相差）αを算出する処理について説明する。図６は、ステッピングモータ１３０の電気角誤差（位相差）を算出する処理を示すフローチャートである。図７は、図５に示すフローチャートの処理により算出した評価値Ｖａｌと電気角誤差（位相差）の関係を模式的に示すグラフである。ここで、本実施形態で使用するステッピングモータ１３０においては、Ａ相とＢ相の位相差が９０±ΔＭａｘ［ｄｅｇ］の範囲に収まるものとする。
Next, a process of calculating the electrical angle error (phase difference) α of the stepping
ステップＳ６０１にて、レンズ制御部１１６は、ステッピングモータ１３０の上限位相差９０＋ΔＭａｘ［ｄｅｇ］とした場合の評価値（Ｖａｌ［９０＋ΔＭａｘ］）を算出する。この処理は、図４のフローチャートで示される処理を用いて行う。
ステップＳ６０２にて、レンズ制御部１１６は、ステッピングモータ１３０の下限位相差９０−ΔＭａｘ［ｄｅｇ］のときの評価値（Ｖａｌ［９０−ΔＭａｘ］）を算出する。この処理は、図４のフローチャートで示される処理を用いて行う。
ステップＳ６０３にて、レンズ制御部１１６は、評価値であるＶａｌ［９０＋ΔＭａｘ］とＶａｌ［９０−ΔＭａｘ］の大小比較を行う。そして、Ｖａｌ［９０＋ΔＭａｘ］＜Ｖａｌ［９０−ΔＭａｘ］である場合にはステップＳ６０４へ進み、そうでない場合はステップＳ６１１に進む。
In step S601, the
In step S <b> 602, the
In step S603, the
ステップＳ６０４に進んだ場合には、ステッピングモータ１３０のＡ相とＢ相の誘導子の位相差が９０［ｄｅｇ］より大きいことを示している（図７参照）。そこで、レンズ制御部１１６は、補正方向＋フラグをセットし、カウンタ変数ｄをクリアする。
ステップＳ６０５〜Ｓ６０９にて、レンズ制御部１１６は、評価値Ｖａｌが最小となる位相角９０＋ｄ［ｄｅｇ］を追い込んでいき、図７に示すような位相差αを特定する。具体的には、次のとおりである。
ステップＳ６０５にて、レンズ制御部１１６は、カウンタ変数ｄ（＝０〜ΔＭａｘ）のときの評価値Ｖａｌ［９０＋ｄ］を算出する。
ステップＳ６０６にて、レンズ制御部１１６は、算出した評価値Ｖａｌ［９０＋ｄ］をＲａｍ変数ｄａｔ［ｄ］に格納する。
ステップＳ６０７において、レンズ制御部１１６は、カウンタ変数ｄをインクリメントする。そしてステップＳ６０８に進む。
ステップＳ６０８では、前回算出した評価値と、今回算出した評価値の大きさを比較する。そして、ｄａｔ［ｄ−１］（前回の評価値）＞ｄａｔ［ｄ］（今回の評価値）である場合にはＳ６１０へ進み、そうでない場合はＳ６０９へ進む。
ステップＳ６０９にて、レンズ制御部１１６は、ΔＭａｘとカウンタ変数ｄの大きさを比較する。カウンタ変数ｄがΔＭａｘより大きいと判定された場合にはステップＳ６１８へ進む。
ステップＳ６１８では、レンズ制御部１１６は、位相角検出エラーが生じたと判定する。そしてこの処理を終了する。
When the process proceeds to step S604, it indicates that the phase difference between the A-phase and B-phase inductors of the stepping
In steps S605 to S609, the
In step S605, the
In step S606, the
In step S607, the
In step S608, the evaluation value calculated last time is compared with the magnitude of the evaluation value calculated this time. If dat [d−1] (previous evaluation value)> dat [d] (current evaluation value), the process proceeds to S610; otherwise, the process proceeds to S609.
In step S609, the
In step S618, the
一方、ステップＳ６０８の処理でｄａｔ［ｄ−１］（前回の評価値）＞ｄａｔ［ｄ］（今回の評価値）であると判定された場合には、その時の位相角９０＋ｄが最小値となり、最も振動成分が小さくなることを示している。そこで、この場合には、ステップＳ６１０に進む。
ステップＳ６１０に進んだ場合には、レンズ制御部１１６は、カウンタ変数ｄの大きさを電気角誤差αとしてメモリに格納する。そしてこの処理を終了する。
On the other hand, if it is determined in step S608 that dat [d−1] (previous evaluation value)> dat [d] (current evaluation value), the
When the process proceeds to step S610, the
ステップＳ６０３にて、Ｖａｌ［９０＋ΔＭａｘ］＜Ｖａｌ［９０−ΔＭａｘ］でない場合には、ステッピングモータ１３０の位相差が９０［ｄｅｇ］より小さいことを示す。そこでこの場合には、ステップＳ６１１に進む。
ステップＳ６１１では、レンズ制御部１１６は、補正方向−フラグをセットし、カウンタ変数ｄをクリアする。その後、ステップＳ６１２〜Ｓ６１６の処理で評価値が最小となる位相角９０−ｄ［ｄｅｇ］を追い込んでいき、電気角誤差αを特定する。
ステップＳ６１２では、レンズ制御部１１６は、カウンタ変数ｄ（＝０〜ΔＭａｘ）のときの評価値Ｖａｌ［９０−ｄ］を算出する。
ステップＳ６１３にて、レンズ制御部１１６は、算出した評価値Ｖａｌ［９０−ｄ］を、Ｒａｍ変数ｄａｔ［ｄ］に格納する。
ステップＳ６１４において、レンズ制御部１１６は、カウンタ変数ｄをインクリメントする。そしてＳ６１５に進む。
ステップＳ６１５では、レンズ制御部１１６は、今回のステップＳ６１３において算出した評価値Ｖａｌ［９０−ｄ］と、前回のステップＳ６１３において算出した評価値Ｖａｌ［９０−（ｄ−１）］と大きさを比較する。そして、Ｖａｌ［９０−（ｄ−１）］＞Ｖａｌ［９０−ｄ］である場合にはステップＳ６１６へ進み、そうでない場合はステップＳ６１７へ進む。
ステップＳ６１５にてＶａｌ［９０−（ｄ−１）］＞ｄａｔ［ｄ］でないと判定された場合にはステップＳ６１６に進む。ステップＳ６１６にてΔＭａｘよりカウンタ変数ｄが大きいと判定された場合にはステップＳ６１８へ進み、位相角検出エラーとして処理を終了する。
一方、ステップＳ６１５にてＶａｌ［９０−（ｄ−１）］＞ｄａｔ［ｄ］であると判定された場合には、その時の位相角９０−ｄ［ｄｅｇ］が最小値となり、最も振動成分が小さくなることを示している。そこでこの場合には、ステップＳ６１７へ進む。
ステップＳ６１７にて、レンズ制御部１１６は、カウンタ変数ｄの値を電気角誤差αとして格納する。そしてこの処理を終了する。
If Val [90 + ΔMax] <Val [90−ΔMax] is not satisfied in step S603, it indicates that the phase difference of the stepping
In step S611, the
In step S612, the
In step S613, the
In step S614, the
In step S615, the
If it is determined in step S615 that Val [90- (d-1)]> dat [d] is not satisfied, the process proceeds to step S616. If it is determined in step S616 that the counter variable d is larger than ΔMax, the process proceeds to step S618, and the process ends as a phase angle detection error.
On the other hand, if it is determined in step S615 that Val [90- (d-1)]> dat [d], the phase angle 90-d [deg] at that time is the minimum value, and the vibration component is the most. It shows that it becomes smaller. Therefore, in this case, the process proceeds to step S617.
In step S617, the
図８（ａ）は、位相差９０［ｄｅｇ］の場合のズームレンズ１０２の位置データの一例を示すグラフである。図８（ｂ）は、位相差９０＋α［ｄｅｇ］の場合のズームレンズ１０２の位置データの一例を示すグラフである。図８（ａ）の実線８０１は、位相差が９０［ｄｅｇ］の電流で駆動した時のズーム位置を示す。破線８０２は、理想的なズーム位置を示す。図８（ｂ）の実線８０３は、位相差を９０＋α［ｄｅｇ］に変更した電流（位相変更した電流）で駆動した時のズーム位置を示す。破線８０２は、理想的なズーム位置を示す。
図８に示すように、レンズ制御部１１６は、２相の電流波形の位相差を、９０［ｄｅｇ］から９０°＋α［ｄｅｇ］に決定する（位相変更）。そして、レンズ制御部１１６は、２相の電流波形を決定した位相差（９０＋α［ｄｅｇ］）となるように位相変更し、位相変更した２相の電流をステッピングモータ１３０に印加する。このように、２相の電流の位相変更を行う構成によれば、ズーム位置データの振動が少なくなるため、ステッピングモータ１３０の振動が軽減できる。したがって、回転が滑らかになり振動が抑制される。
FIG. 8A is a graph showing an example of position data of the
As shown in FIG. 8, the
＜第２の実施形態＞
以下、添付図面を参照して本発明の第２の実施形態について説明する。なお、第２の実施形態と第１の実施形態とは、システムマイコン１１８の処理が相違し、その他は共通の構成が適用できる。したがって、相違する構成を説明し、共通の構成については説明を省略する。
はじめに、図９のフローチャートと図１０のグラフを用いて、ズームレンズ位置センサ１１２から出力に基づき、ステッピングモータ１３０の振動の大きさを比較するための平均速度Ｕａｖｅを算出する処理について説明する。図９は、平均速度Ｕａｖｅを算出する処理を示すフローチャートである。図１０は平均速度を算出する処理を説明するためのグラフである。具体的には、図１０（ａ）は時間とズーム位置との関係を示すグラフであり、図１０（ｂ）は、速度の絶対値の変動を模式的に示すグラフである。
<Second Embodiment>
Hereinafter, a second embodiment of the present invention will be described with reference to the accompanying drawings. Note that the processing of the
First, a process of calculating an average speed Uave for comparing the magnitude of vibration of the stepping
ステップＳ９０１にて、レンズ制御部１１６は、位相角γと駆動速度Ｖを取得する。ここでの位相角γと駆動速度Ｖの取得方法は図４のフローチャートに示すサブルーチンの引数として得られる。
ステップＳ９０２において、レンズ制御部１１６は、ステップＳ９０１で得た駆動速度Ｖを設定する。そして、Ｓ９０３に進む。
ステップＳ９０３では、レンズ制御部１１６は、ステップＳ９０１で得た位相角γを設定する。
ステップＳ９０４において、レンズ制御部１１６は、ステップＳ９０２とＳ９０３で設定した駆動速度Ｖと位相角γに基づき、駆動制御信号をズーム駆動回路１１０に与えて、ズームレンズ１０２を駆動する。
ステップＳ９０５では、レンズ制御部１１６は、加速処理が終わりステッピングモータ１３０が一定速度になるまでウェイト状態となる。そして、駆動速度が安定したら（一定速度となったら）ステップＳ９０６に進む。
In step S901, the
In step S902, the
In step S903, the
In step S904, the
In step S905, the
ステップＳ９０６〜Ｓ９１０では、レンズ制御部１１６は、ズームレンズ位置センサ１１２からのズームレンズ１０２の位置Ｐと前回にサンプリングした位置Ｐｂｋの差分から、ステッピングモータ１３０の駆動速度を求める（駆動速度算出）。そして、ステップＳ９０６〜Ｓ９１０の処理を複数回にわたって繰り返すことにより、複数の駆動速度を求める。具体的には、次のとおりである。
ステップＳ９０６にて、レンズ制御部１１６は、現在の位置Ｐを取得する。その後Ｓ９０７に進む。
ステップＳ９０７にて、レンズ制御部１１６は、あらかじめ保存してある前回の処理ときの位置Ｐｂｋと、現在位置Ｐから、次の（式４）を用いて速度（単位時間当たりの移動量）の絶対値を算出する。そして、算出した速度の絶対値をＵ［Ｃ］（０＜Ｃ＜Ｎ−１）に格納する（図１０（ａ）参照）。
Ｕ［Ｃ］＝｜Ｐｂｋ−Ｐ｜ （式４）
ステップＳ９０９にて、レンズ制御部１１６は、次の速度データＵ［Ｃ］を取得するためのカウンタ変数Ｃをインクリメントする。
ステップＳ９１０にて、レンズ制御部１１６は、取得したズームレンズ１０２の速度データＶの数ＣがＮ個に達したか否かを判定する。速度データ数ＣがＮ個に達していない場合にはステップＳ９０６に戻り、達した場合にはステップＳ９１１に進む。
ステップＳ９１１にて、レンズ制御部１１６は、ズームレンズ１０２の駆動を停止させる。そして、処理をＳ９１２に進ませる。
ステップＳ９１２では、レンズ制御部１１６は、ステップＳ９０６〜Ｓ９１６の処理で得られたＮ個の駆動速度Ｕ［０］〜Ｕ［Ｎ−１］の平均値を算出し、算出した平均値を実速度平均Ｕａｖｅとする（図１０（ｂ）参照）。そして、実速度平均Ｕａｖｅを、図４のフローチャートに示すサブルーチンの呼びもとに返す。
In steps S906 to S910, the
In step S906, the
In step S907, the
U [C] = | Pbk−P | (Formula 4)
In step S909, the
In step S910, the
In step S911, the
In step S912, the
次に図１１のフローチャートを用いて、本実施形態におけるステッピングモータ１３０の位相差αを算出する処理に関して説明する。なお、本実施形態で使用するステッピングモータ１３０は、９０±ΔＭａｘ［ｄｅｇ］の範囲に位相差が収まるものとする。
Next, processing for calculating the phase difference α of the stepping
ステップＳ１１０１にて、レンズ制御部１１６は、ステッピングモータ１３０の上限位相差９０＋ΔＭａｘ［ｄｅｇ］のときの平均速度Ｕａｖｅ［９０＋ΔＭａｘ］を、図１０のフローチャートで示される処理を用いて算出する。
ステップＳ１１０２にて、レンズ制御部１１６は、ステッピングモータ１３０の上限位相差９０―ΔＭａｘ［ｄｅｇ］のときの平均速度Ｕａｖｅ［９０−ΔＭａｘ］を、図１０のフローチャートで示される処理を用いて算出する。
ステップＳ１１０３にて、レンズ制御部１１６は、Ｕａｖｅ［９０＋ΔＭａｘ］とＵａｖｅ［９０−ΔＭａｘ］の大小比較を行う。そして、Ｕａｖｅ［９０＋ΔＭａｘ］＜Ｕａｖｅ［９０−ΔＭａｘ］である場合にはステップＳ１１０４へ進み、そうでない場合はステップＳ１１１１に進む。
In step S1101, the
In step S1102, the
In step S1103, the
Ｕａｖｅ［９０＋ΔＭａｘ］＜Ｕａｖｅ［９０−ΔＭａｘ］である場合には、ステッピングモータ１３０の位相差が９０［ｄｅｇ］より大きいことを示す。
そこで、ステップＳ１１０４では、レンズ制御部１１６は、補正方向＋フラグをセットし、カウンタ変数ｄをクリアする。
When Uave [90 + ΔMax] <Uave [90−ΔMax], it indicates that the phase difference of the stepping
Therefore, in step S1104, the
ステップＳ１１０５〜Ｓ１１０９において、レンズ制御部１１６は、平均速度Ｕａｖｅと駆動速度Ｖの差分が最小となる位相角９０＋ｄ［ｄｅｇ］を追い込んでいき、電気角誤差αを特定する。具体的には、次のとおりである。
ステップＳ１１０５において、レンズ制御部１１６は、カウンタ変数ｄ（＝０〜ΔＭａｘ）のときの評価値Ｕａｖｅ［９０＋ｄ］を求める。
ステップＳ１１０６にて、レンズ制御部１１６は、次の（式５）を用いて、Ｕａｖｅ［９０＋ａ］と、駆動速度の差分の絶対値を算出する。
Ｕａｖｅ ＝ ｜Ｕａｖｅ［９０＋ｄ］−Ｖ｜ （式５）
そして、算出した絶対値を、Ｒａｍ変数ｄａｔ［ｄ］に格納する。
なお、（式５）の代わりに、次の（式５’）を用いてＵａｖｅ［９０＋ｄ］と、駆動速度の差分の２乗（累乗）を算出してもよい。この場合には、算出した差分の２乗（累乗）をＲａｍ変数ｄａｔ［ｄ］に格納することになる。
Ｕａｖｅ ＝ （Ｕａｖｅ［９０＋ｄ］−Ｖ）2 （式５’）
ステップＳ１１０７において、レンズ制御部１１６は、カウンタ変数ｄをインクリメントする。そしてステップＳ１１０８に進む。
ステップＳ１１０８では、レンズ制御部１１６は、前回のステップＳ１１０６において格納したｄａｔ［ｄ−１］と、今回のステップＳ１１０６において格納したｄａｔ［ｄ］の大きさを比較する。ｄａｔ［ｄ−１］＞ｄａｔ［ｄ］である場合にはＳ１１１０へ進む。そうでない場合はＳ１１０９へ進む。
ステップＳ１１０９にて、レンズ制御部１１６は、カウンタ変数ｄがΔＭａｘより大きいか否かを判定する。大きいと判定された場合にはステップＳ１１１８へ進む。
ステップＳ１１１８では、レンズ制御部１１６は、位相角検出エラーであると判定する。そして処理を終了する。
ステップＳ１１０８の処理でｄａｔ［ｄ］の方が小さいと判定された場合には、その時の位相角９０＋ｄが最小値となり、最も振動成分が小さくなることを示す。そこでこの場合には、ステップＳ１１１０へ進む。
ステップＳ１１１０にて、レンズ制御部１１６は、カウンタ変数ｄの値を、電気角誤差αとして、メモリに格納する。そして処理を終了する。
In steps S <b> 1105 to S <b> 1109, the
In step S1105, the
In step S1106, the
Uave = | Uave [90 + d] −V | (Formula 5)
Then, the calculated absolute value is stored in the Ram variable dat [d].
Instead of (Expression 5), the following (Expression 5 ′) may be used to calculate Uave [90 + d] and the square (power) of the difference between the drive speeds. In this case, the square (power) of the calculated difference is stored in the Ram variable dat [d].
Uave = (Uave [90 + d] −V) 2 (Formula 5 ′)
In step S1107, the
In step S1108, the
In step S1109, the
In step S1118, the
If it is determined in step S1108 that dat [d] is smaller, the
In step S1110, the
ステップＳ１１０３にて、Ｕａｖｅ［９０＋ΔＭａｘ］＜Ｕａｖｅ［９０−ΔＭａｘ］ではないと判定された場合には、ステッピングモータ１３０の位相差が９０［ｄｅｇ］より小さいことを示す。そこでこの場合には、ステップＳ１１１１に進む。
ステップＳ１１１１では、レンズ制御部１１６は、補正方向−フラグをセットし、カウンタ変数ｄをクリアする。
ステップＳ１１１２〜Ｓ１１１６では、レンズ制御部１１６は、平均速度Ｕａｖｅと駆動速度Ｖの差分が最小となる位相角９０−ｄ［ｄｅｇ］を追い込んでいき、電気角誤差αを特定する。具体的には、次のとおりである。
ステップＳ１１１２にて、レンズ制御部１１６は、カウンタ変数ｄ（＝０〜ΔＭａｘ）のときの評価値Ｕａｖｅ［９０−ｄ］を求める。そしてステップＳ１１１３に進む。
ステップＳ１１１３にて、レンズ制御部１１６は、次の（式６）を用いて、Ｕａｖｅ［９０−ｄ］と駆動速度Ｖの差分の絶対値を算出する。
Ｕａｖｅ ＝ ｜Ｕａｖｅ［９０−ｄ］−Ｖ｜ （式６）
そして、算出結果をＲａｍ変数ｄａｔ［ｄ］に格納する。
ステップＳ１１１４において、レンズ制御部１１６は、カウンタ変数ｄをインクリメントする。そしてステップＳ１１１５に進む。
ステップＳ１１１５では、前回のステップＳ１１０６の結果であるｄａｔ［ｄ−１］と、今回のＳ１１０６の結果であるｄａｔ［ｄ］の大きさを比較する。ｄａｔ［ｄ−１］＞ｄａｔ［ｄ］である場合にはステップＳ１１１７へ進み、そうでない場合はステップＳ１１１６へ進む。
If it is determined in step S1103 that Uave [90 + ΔMax] <Uave [90−ΔMax], it indicates that the phase difference of the stepping
In step S <b> 1111, the
In steps S1112 to S1116, the
In step S1112, the
In step S <b> 1113, the
Uave = | Uave [90-d] -V | (Formula 6)
Then, the calculation result is stored in the Ram variable dat [d].
In step S1114, the
In step S1115, the magnitude of dat [d−1], which is the result of the previous step S1106, is compared with the magnitude of dat [d], which is the result of the current S1106. If dat [d−1]> dat [d], the process proceeds to step S1117; otherwise, the process proceeds to step S1116.
ステップＳ１１１６にて、レンズ制御部１１６は、カウンタ変数ｄがΔＭａｘより大きいか否かを判定する。大きいと判定された場合にはステップＳ１１１８へ進む。
ステップＳ１１１８にて、レンズ制御部１１６は、位相角検出エラーが生じたと判定する。そしてこの処理を終了する。
一方、ステップＳ１１１５の処理でｄａｔ［ｄ］の方が小さいと判定された場合には、その時の位相角９０−ｄが最小値となり、振動成分が最も小さくなることを示す。そこでこの場合には、ステップＳ１１１７へ進む。
ステップＳ１１１７にて、レンズ制御部１１６は、カウンタ変数ｄの値を、電気角誤差αとして、メモリに格納する。そして処理を終了する。
In step S1116, the
In step S1118,
On the other hand, if it is determined in step S1115 that dat [d] is smaller, the phase angle 90-d at that time is the minimum value, indicating that the vibration component is the smallest. Therefore, in this case, the process proceeds to step S1117.
In step S1117, the
図８（ａ）（ｂ）に示すように、レンズ制御部１１６は、２相の電流の位相差を、９０＋α［ｄｅｇ］に決定する。そして、レンズ制御部１１６は、ズーム駆動回路１１０を介してステッピングモータ１３０に印加する２相の電流の位相差を、決定した位相差（励磁位相間の差が９０＋α［ｄｅｇ］）に位相変更する。そうすると、ズーム位置データの振動が少なくなり、ステッピングモータ１３０の振動が軽減できる。したがって、回転が滑らかになり振動が抑制される。
As shown in FIGS. 8A and 8B, the
前記実施形態では、ズーム駆動源１１１のステッピングモータ１３０を制御する構成を説明したが、フォーカス駆動源１１４のステッピングモータ１３２の制御も同様である。
In the above embodiment, the configuration for controlling the stepping
本発明は、以下の処理を実行することによっても実現される。即ち、上述した実施形態の機能を実現するコンピュータ読取り可能なプログラム（ソフトウェア）を、ネットワーク又は各種記録媒体を介してシステム或いは装置に供給し、そのシステム或いは装置のコンピュータ（又はＣＰＵやＭＰＵ等）がプログラムを読み出して実行する処理である。この場合、そのプログラム及びプログラムを記憶した記録媒体は本発明を構成することになる。 The present invention is also realized by executing the following processing. That is, a computer-readable program (software) that realizes the functions of the above-described embodiments is supplied to a system or apparatus via a network or various recording media, and a computer (or CPU, MPU, or the like) of the system or apparatus. This is a process of reading and executing a program. In this case, the program and the recording medium storing the program constitute the present invention.
以上、本発明をその好適な実施形態に基づいて詳述してきたが、本発明はこれら特定の実施形態に限られるものではなく、この発明の要旨を逸脱しない範囲の様々な形態も本発明に含まれる。上述の実施形態の一部を適宜組み合わせてもよい。
たとえば、上述した実施形態においては、本発明を撮像装置の制御装置に適用した場合を例にして説明したが、本発明はこの例に限定されない。本発明は、少なくとも２相の電流で駆動するステッピングモータの制御装置であれば適用可能である。すなわち、本発明は、撮像装置のみならず、各種アクチュエータなどにも適用できる。
Although the present invention has been described in detail based on preferred embodiments thereof, the present invention is not limited to these specific embodiments, and various forms within the scope of the present invention are also included in the present invention. included. A part of the above-described embodiments may be appropriately combined.
For example, in the above-described embodiment, the case where the present invention is applied to the control device of the imaging apparatus has been described as an example, but the present invention is not limited to this example. The present invention is applicable to any stepping motor control device that is driven by at least two-phase currents. That is, the present invention can be applied not only to an imaging apparatus but also to various actuators.
本発明は、撮像装置や交換レンズユニットに搭載されるレンズや絞り等の光学素子等を制御する制御装置に適用できる。このほか、本発明は、ステッピングモータを有する各種アクチュエータなどに適用できる。 The present invention can be applied to a control device that controls an optical element such as a lens and an aperture mounted in an imaging device or an interchangeable lens unit. In addition, the present invention can be applied to various actuators having a stepping motor.
５０１：近似直線、５０２：ズームレンズ位置、８０１：位相差が９０°の電流で駆動した時のズーム位置、８０２：理想的なズーム位置、８０３：適切な位相差の電流で駆動した時のズーム位置 501: Approximate straight line, 502: Zoom lens position, 801: Zoom position when driven with a current having a phase difference of 90 °, 802: Ideal zoom position, 803: Zoom when driven with a current having an appropriate phase difference position
Claims (4)
前記ステッピングモータを少なくとも２相の電流で駆動させる駆動手段と、
前記駆動対象の実際の位置を検出する位置検出手段と、
前記駆動手段の少なくとも２相の電流の位相を変更する位相変更手段と、
前記位相変更手段を用いて前記駆動手段を制御する制御手段と、
前記位置検出手段により検出された位置から前記駆動対象の駆動中における基準位置を算出する基準位置算出手段と、
を含み、
前記基準位置算出手段は、前記位置検出手段により検出される駆動中の前記駆動対象の少なくとも３つの実際の位置を１次近似することで基準位置を算出し、
前記位相変更手段は、前記位置検出手段が検出した前記駆動対象の実際の位置と前記基準位置算出手段が算出した基準位置との差分の絶対値の総和または前記差分の累乗の総和が最も小さくなる電流の位相差を決定し、
前記制御手段は、前記位相差の電流を用いて前記ステッピングモータを制御することを特徴とする制御装置。 A stepping motor for driving the driven object;
Driving means for driving the stepping motor with at least two-phase current;
Position detecting means for detecting an actual position of the driving object;
Phase changing means for changing the phase of at least two phases of current of the driving means;
Control means for controlling the driving means using the phase changing means;
Reference position calculation means for calculating a reference position during driving of the drive target from the position detected by the position detection means ;
Including
The reference position calculating means calculates a reference position by first approximating at least three actual positions of the driving target being driven detected by the position detecting means;
The phase changing means has the smallest sum of absolute values of differences between the actual position of the drive target detected by the position detecting means and the reference position calculated by the reference position calculating means or the sum of the powers of the differences. Determine the phase difference of the current,
The control device controls the stepping motor using the current of the phase difference.
前記駆動対象の実際の位置を検出するステップと、
検出された前記駆動対象の実際の位置から前記駆動対象の駆動中における基準位置を、検出された駆動中の前記駆動対象の少なくとも３つの実際の位置を１次近似することで算出するステップと、
検出された前記駆動対象の実際の位置と算出した基準位置との差分の絶対値の総和または前記差分の累乗の総和が最も小さくなる電流の位相差を決定するステップと、
決定した位相差となるように２相の電流の位相を変更するステップと、
位相を変更した２相の電流を用いて前記ステッピングモータを駆動するステップと、
を有することを特徴とする制御方法。 A stepping motor control method for driving a drive object,
Detecting the actual position of the drive object;
Calculating a reference position during driving of the driving target from the detected actual position of the driving target by first approximating at least three actual positions of the detected driving target during driving ;
Determining a phase difference of a current that minimizes a sum of absolute values of differences between the detected actual position of the driving target and a calculated reference position or a sum of powers of the differences;
Changing the phase of the current of the two phases so that the determined phase difference is obtained;
Driving the stepping motor using a two-phase current having a changed phase;
A control method characterized by comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2013031134A JP6188349B2 (en) | 2013-02-20 | 2013-02-20 | Control device, control method, program |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2013031134A JP6188349B2 (en) | 2013-02-20 | 2013-02-20 | Control device, control method, program |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2014160193A JP2014160193A (en) | 2014-09-04 |
| JP6188349B2 true JP6188349B2 (en) | 2017-08-30 |
Family
ID=51611914
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2013031134A Active JP6188349B2 (en) | 2013-02-20 | 2013-02-20 | Control device, control method, program |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6188349B2 (en) |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2745606B2 (en) * | 1988-12-26 | 1998-04-28 | ソニー株式会社 | Stepping motor drive circuit |
| JP5615017B2 (en) * | 2010-04-05 | 2014-10-29 | キヤノン株式会社 | Optical equipment |
| JP5797044B2 (en) * | 2011-07-25 | 2015-10-21 | キヤノン株式会社 | Drive device and optical apparatus |
-
2013
- 2013-02-20 JP JP2013031134A patent/JP6188349B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2014160193A (en) | 2014-09-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP5839850B2 (en) | Imaging apparatus and control method thereof | |
| JP5901423B2 (en) | LENS DEVICE, IMAGING SYSTEM, AND LENS DEVICE CONTROL METHOD | |
| JP5875265B2 (en) | Stepping motor drive control device, drive control method, drive control system, and optical apparatus | |
| US8817169B2 (en) | Motor driven optical apparatus | |
| JP6071669B2 (en) | Lens device and camera system | |
| US8824063B2 (en) | Optical device | |
| JP5868109B2 (en) | Optical apparatus, lens barrel, and automatic focusing method | |
| JPH09311265A (en) | Autofocusing device for image pickup device and method for correcting zoom tracking curve | |
| US20130027791A1 (en) | Motor drive apparatus and optical apparatus | |
| JP5797044B2 (en) | Drive device and optical apparatus | |
| JP2013238822A (en) | Control device of linear motion device and control method thereof | |
| JP6188349B2 (en) | Control device, control method, program | |
| JP6368605B2 (en) | Position detecting device and driving device provided with the same | |
| EP3745179A1 (en) | Lens apparatus, camera, camera system, and program | |
| JP2013238821A (en) | Control device of linear motion device and control method thereof | |
| JP2021067802A (en) | Control device, lens apparatus, imaging apparatus, control method, and program | |
| WO2023234057A1 (en) | Lens device, processing method of lens device, program, and imaging device | |
| JP7175677B2 (en) | optical equipment | |
| JP2017191343A (en) | Lens driving device, lens driving method, and imaging device | |
| JP2014164244A (en) | Lens driving device, lens driving method and imaging device | |
| JP6472166B2 (en) | Position control apparatus and method | |
| JP5793130B2 (en) | Linear motion device control apparatus and control method thereof | |
| US11829000B2 (en) | Optical apparatus, its control method, and storage medium | |
| JP2024039121A (en) | Lens device, imaging device, lens device control method, and program | |
| JP2017003403A (en) | Encoder signal processing device and device using encoder |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160217 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20161129 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20161206 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20170206 |
|
| 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: 20170704 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170801 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6188349 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |