(57)【特許請求の範囲】
【請求項１】
モータを駆動制御し、該モータに連結された駆動系における駆動対象物の位置を制御するモータ制御装置であって、前記駆動対象物を反転駆動する場合に前記駆動系に配置されたギヤにより生じるバックラッシュを除去するための前記モータの駆動制御を行った後、前記駆動対象物を所定の目標位置に設定するための前記モータの位置制御を行うモータ制御装置において、
前記バックラッシュを除去するための前記モータの駆動制御を行うモータ制御手段は、前記バックラッシュ分だけ前記モータを駆動する時間が終了する時点の所定時間前の時点まで前記モータを最高速度で駆動するように前記駆動対象物の目標位置を設定して位置制御し、前記所定時間前の時点において、前記駆動対象物の目標位置を、前記モータの最高速度での駆動を開始した時点での目標位置に戻して前記モータの速度を減速させることを特徴とするモータ制御装置。
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
本発明はモータ制御装置に係り、特にテレビカメラ及び雲台の駆動制御に用いられるモータ制御装置に関する。
【０００２】
【従来の技術】
各種の分野で、駆動系の機械的位置を制御するモータ制御装置としてのサーボ回路が用いられており、サーボ回路は、例えばテレビカメラを動かす雲台の駆動やレンズの駆動にも適用されている。即ち、テレビカメラを支持する雲台ではパン（左右方向）、チルト（上下方向）の動きがサーボ回路で行われ、テレビカメラ内のズームレンズ、フォーカスレンズがサーボ回路によって駆動される。
【０００３】
しかしながら、従来のサーボ回路では、モータから駆動対象物までの駆動系に配置されているギヤのバックラッシュによって、駆動対象物の動きが不自然となったり、操作した通りの動きとならないという問題があった。例えば、テレビカメラのパン動作において方向を転換させて位置Ｐ１から位置Ｐ２へ移動させる場合に、位置制御信号は位置Ｐ１から位置Ｐ２までの距離に比例した位置信号電圧となり、この位置信号電圧によってモータが駆動される。このときの駆動対象物であるテレビカメラの軌跡は、バックラッシュが存在することにより、制御開始からバックラッシュ分のモータの駆動時間が過ぎた後に急激に動き出すことになる。このため、テレビカメラの動きが不自然となり、しかも、駆動系に負担がかかるという問題があった。
【０００４】
また、テレビカメラをパン及びチルト動作させ、位置Ｐ３から位置Ｐ４に移動させる場合において、パンについてのみ方向転換して例えば右側へ移動させると、パンのバックラッシュ分を駆動させている間に、チルトでは例えば上側へ移動するので、テレビカメラは位置Ｐ３から位置Ｐ４へ真っ直ぐ進まず、屈折した軌跡をたどることになる。従って、カメラが被写体を正確に追うことができないという不都合があった。
【０００５】
そこで、本願出願人は、特開平７−２９５６４５号公報、特開平７−２９５６４６号公報、及び、特開平７−２９５６４８号公報において上記不具合等を解消するためのサーボ回路を提案している。特開平７−２９５６４５号公報に記載のサーボ回路では、バックラッシュ分を駆動させる時間を設定し、このバックラッシュ駆動時間ではモータを速度制御する。そして、その後、モータの制御を位置制御に切り替えて駆動系（駆動対象物）の実質的な駆動を開始するようにしている。これにより、駆動対象物の不自然な動きが低減される。また、ジョイスティック等の手動操作手段を用いる場合は、バックラッシュ分を駆動させる操作領域を設け、このバックラッシュ操作領域の操作時間にバックラッシュを除去するための速度制御を行うようにしている。これにより、実際の駆動と一致した操作感覚が得られる。また、複数の駆動系を同時に制御する場合は、バックラッシュ分の駆動後の各駆動系の実質的な駆動開始時間を一致させるようにしている。これにより、操作通りの正確な軌跡の駆動が可能となる。
【０００６】
特開平７−２９５６４６号公報に記載のサーボ回路では、バックラッシュ分を駆動させる時間を設定し、このバックラッシュ駆動時間では実質的駆動の速度よりも遅い速度となるようにモータを駆動制御するようにしている。これにより、実質的な駆動を安定したモータ回転数で開始でき、駆動対象物の不自然な動きが軽減される。また、ジョイスティック等の手動操作手段を用いる場合は、バックラッシュ分を駆動させる操作領域を設け、このバックラッシュ操作領域の操作時間に遅い速度のモータ駆動を実行するようにしている。これにより実際の駆動と一致した操作感覚が得られる。また、複数の駆動系を同時に制御する場合は、上記公報と同様の処理により操作通りの正確な軌跡の駆動が可能となる。
【０００７】
特開平７−２９５６４８号公報に記載のサーボ回路では、バックラッシュ分を駆動させる時間を設定し、このバックラッシュ駆動時間では位置制御信号でバックラッシュ分を駆動し、このバックラッシュ駆動時間が経過した時点で、位置制御信号を被駆動系の駆動開始位置である元の状態に戻して新たに位置制御を開始するようにしている。これにより、モータの回転数の急激な増加が防止され、駆動対象物の不自然な動きが軽減される。また、ジョイスティック等の手動操作手段を用いる場合は、バックラッシュ分を駆動させる操作領域を設け、このバックラッシュ操作領域の操作時間経過時に位置信号を元の状態に戻して新たに位置制御を開始する。これにより、実際の駆動と一致した操作感覚が得られる。また、複数の駆動系を同時に制御する場合は、上記公報と同様の処理により操作通りの正確な軌跡の駆動が可能となる。
【０００８】
以上の公報に記載のサーボ回路はいずれもバックラッシュを除去するためのモータの駆動制御を、駆動対象物を実質的に駆動する前に別制御で行うことによって、バックラッシュによる悪影響を除去するようにしたものである。
【０００９】
【発明が解決しようとする課題】
しかしながら、上記公報に記載のサーボ回路では、バックラッシュ駆動時間におけるモータの駆動速度は、駆動対象物を実質的に駆動する際の駆動速度に対応した速度に設定されるため、実質的駆動時における駆動速度が遅いときには駆動対象物が動き出すまでの時間が長くなるという欠点があった。
【００１０】
本発明はこのような事情に鑑みてなされたもので、反転駆動時におけるギヤのバックラッシュを除去するためのバックラッシュ駆動時間をできるだけ短くし、駆動対象物が動き出すまでの時間の短縮を図るモータ制御装置を提供することを目的とする。
【００１１】
【課題を解決するための手段】
前記目的を達成するために、請求項１に記載の発明は、モータを駆動制御し、該モータに連結された駆動系における駆動対象物の位置を制御するモータ制御装置であって、前記駆動対象物を反転駆動する場合に前記駆動系に配置されたギヤにより生じるバックラッシュを除去するための前記モータの駆動制御を行った後、前記駆動対象物を所定の目標位置に設定するための前記モータの位置制御を行うモータ制御装置において、前記バックラッシュを除去するための前記モータの駆動制御を行うモータ制御手段は、前記バックラッシュ分だけ前記モータを駆動する時間が終了する時点の所定時間前の時点まで前記モータを最高速度で駆動するように前記駆動対象物の目標位置を設定して位置制御し、前記所定時間前の時点において、前記駆動対象物の目標位置を、前記モータの最高速度での駆動を開始した時点での目標位置に戻して前記モータの速度を減速させることを特徴としている。
【００１３】
本発明によれば、モータを反転駆動する際にバックラッシュ分のモータの駆動が終了する所定時間前までモータの駆動を最高速度で行うようにしたため、駆動対象物が実際に動き出すまでの間の時間を短縮することができる。また、バックラッシュ分の駆動が終了する前にモータを最高速度で駆動する制御を終了するため、駆動対象物が実際に動き出す前にモータの速度が減速され、駆動対象物の動き出しを好適に行うことができる。
【００１７】
【発明の実施の形態】
以下添付図面に従って本発明に係るモータ制御装置の好ましい実施の形態について詳説する。
【００１８】
図１には、本発明に係るモータ制御装置の第１乃至第３の実施の形態におけるサーボ回路の構成が示されており、この実施の形態はテレビカメラ及び雲台に適用した場合の例である。図１において、雲台の操作部には図示の操作スイッチ１０及びその表示灯１１が複数（図では１個のみ表示）配置されており、この操作スイッチ１０としては、予め設定された場所に自動的にカメラを移動させるためのショットスイッチ等が設けられる。また、手動操作により任意の位置へカメラを駆動させるジョイスティック１２が設けられている。上記の操作スイッチ１０の操作信号は、直接、入出力（Ｉ／Ｏ）部１４へ供給され、ジョイスティック１２の操作信号は、Ａ／Ｄ変換器１５を介して入出力（Ｉ／Ｏ）部１４へ供給される。そして、これらの操作信号はＣＰＵ２２に読み取られ、操作信号に基づいてＣＰＵ２２から出力された制御信号が、Ｉ／Ｏ部１４及びＤ／Ａ変換器１６を介してサーボアンプ１７へ供給される。
【００１９】
このサーボアンプ１７には、テレビカメラのパン（左右方向）動作、チルト  （上下方向）動作、カメラ部内レンズのフォーカス動作、ズーム動作をするために、それぞれの駆動系に対応してモータ１８、位置検出器１９及び速度検出器２５が４組接続されており、これらのモータ１８と各駆動対象物との間は複数のギヤによって接続される。従って、それぞれの駆動系によって多少相違するバックラッシュが存在することになる。尚、上記位置検出器１９の出力は、Ａ／Ｄ変換器２０、Ｉ／Ｏ部１４を介して、後述するＣＰＵ２２へ供給される。
【００２０】
また、サーボアンプ１７は、ＣＰＵ２２から与えられる位置／速度制御切替信号によりモータ１８の制御を位置制御と速度制御とに切り替えられるようになっており、位置／速度制御切替信号によりサーボアンプ１７が位置制御に切り替えられた場合には、位置検出器１９（及び速度検出器２５）の出力がサーボアンプ１７にフィードバックされると共に、ＣＰＵ２２からサーボアンプ１７に与えられる制御信号が位置制御信号として認識される。そして、位置制御信号の電圧が示す目標位置と位置検出器１９の出力電圧が示す現在位置（検出位置）との比較により、検出位置が目標位置となるようにモータ１８が駆動される。尚、位置検出器１９は、モータ１８によって駆動される駆動対象物の位置を検出しており、バックラッシュでのモータ１８の駆動時にはその出力電圧は変化しない。
【００２１】
一方、位置／速度制御切替信号によりサーボアンプ１７が速度制御に切り替えられた場合、位置検出器１９の出力はサーボアンプ１７にフォードバックされず、速度検出器２５の出力のみがサーボアンプ１７にフィードバックされると共に、ＣＰＵ２２からサーボアンプ１７に与えられる制御信号が速度制御信号として認識される。そして、速度制御信号の電圧が示す目標速度と速度検出器２５の出力電圧が示す現在速度（検出速度）との比較により、検出速度が目標速度となるようにモータ１８が駆動される。尚、速度検出器２５は、モータ１８の回転速度を検出しており、バックラッシュでのモータ１８の駆動時においてもモータ１８の回転速度に応じた出力電圧がサーボアンプ１７に与えられる。
【００２２】
ここで、本明細書において、サーボアンプ１７及び後述するＣＰＵ２２での処理を含めて何らかの目標位置をもち、その目標位置となるようにモータ１８を駆動する場合のモータ１８の制御を位置制御と定義し、サーボアンプ１７及びＣＰＵ２２での処理を含めて何らかの目標速度をもち、その目標速度となるようにモータ１８を駆動する場合のモータ１８の制御を速度制御と定義すると、本明細書中の実施の形態（第１〜第３の実施の形態）では、位置検出器１９の出力（検出位置）をサーボアンプ１７にフィードバックする場合をモータ１８の位置制御ということができ、位置検出器１９の出力をサーボアンプ１７にフォードバックしない場合をモータ１８の速度制御ということができる。
【００２３】
また、本サーボ回路には各種制御を統轄するＣＰＵ２２が配置され、ショット位置情報や現在の駆動方向を記憶するメモリ（ＲＡＭ）２３、制御プログラムが記憶されているメモリ（ＲＯＭ）２４が配置される。
【００２４】
ＣＰＵ２２は、上述のように雲台の操作部から与えられた操作信号に対応して対象の駆動系の目標位置又は目標速度を設定し、対象の駆動系をその目標位置又は目標速度に設定するための位置制御信号又は速度制御信号をＩ／Ｏ部１４及びＤ／Ａ変換器１６を介してサーボアンプ１７に出力する。尚、実際には、目標位置又は目標速度の設定と、その目標位置又は目標速度に対応する位置制御信号又は速度制御信号の電圧値の設定とがそれぞれ個別の処理で行われるのでなく、位置制御信号又は速度制御信号の電圧値を設定する処理自体が目標位置又は目標速度を設定する処理に該当する。また、ＣＰＵ２２は、Ｉ／Ｏ部１４を介してサーボアンプ１７に位置／速度制御切替信号を与えてサーボアンプ１７を位置制御又は速度制御に切り替えることにより、上述のように目標位置を設定して位置制御信号をサーボアンプ１７に出力する場合には、サーボアンプ１７を位置制御の状態に設定し、目標速度を設定して速度制御信号をサーボアンプ１７に出力する場合には、サーボアンプ１７を速度制御の状態に設定する。
【００２５】
ここで例えば、ジョイスティック１２は、操作者が垂直位置からの傾斜角度及び傾斜方向（操作量）を操作することによってその傾斜角度及び傾斜方向に応じたパン方向及びチルト方向への駆動速度を指示できるようにしたものであり、この操作量に応じた電圧の操作信号がジョイスティック１２からＣＰＵ２２に与えられるようになっている。この操作信号に対してＣＰＵ２２は、目標位置を設定して位置制御信号をサーボアンプ１７に出力する場合と、目標速度を設定して速度制御信号をサーボアンプ１７に出力する場合とがあり、前者の場合、ＣＰＵ２２は、ジョイスティック１２から与えられた操作信号に積分等の処理を施して、その操作信号が指示する速度での駆動と同等となるように目標位置を逐次更新しながら目標位置に対応した電圧の位置制御信号をサーボアンプ１７に出力する。一方、後者の場合、ＣＰＵ２２は、ジョイスティック１２から与えられた操作信号が指示する速度を目標速度とし、その目標速度に対応した電圧の速度制御信号をサーボアンプ１７に出力する。尚、前者の場合には、後述のバックラッシュの制御について第１及び第２の実施の形態が適用され、後者の場合には後述の第３の実施の形態が適用される。
【００２６】
また例えば、操作部の所定の操作スイッチ１０が操作され（ショットスイッチが押され）、その操作信号がＣＰＵ２２に与えられると、ＣＰＵ２２は、上記ＲＡＭ２３に記憶されたショット位置情報を読み出し、そのショット位置情報に基づいて目標位置を設定し、その目標位置に対応した電圧の位置制御信号をサーボアンプ１７に出力する。
【００２７】
尚、雲台の操作部にはパン動作やチルト動作を操作するジョイスティック１２だけでなく、カメラ部内レンズのフォーカス動作やズーム動作を操作するための操作部材と、その操作を操作信号としてＣＰＵ２２に与える検出器も設置されているが、本実施の形態では、ジョイスティック１２とショット位置情報に基づいて駆動系を駆動する場合についてのみ説明する。
【００２８】
一方、ＣＰＵ２２は、ジョイスティック１２からの操作信号、又は、ショット位置情報に基づいて新たな目標位置又は目標速度を設定する際に、新たな駆動方向が現在の駆動方向と反転することになる駆動系が存在するときには、駆動系の実質的な駆動のための制御処理とは別のバックラッシュを除去するための特別の制御処理を実行する。
【００２９】
ジョイスティック１２の操作信号に基づいて各駆動系の実質的な駆動を制御する場合には、その操作信号からジョイスティック１２の操作方向を知ることにより、各駆動系の新たな駆動方向を認識することができる。一方、ショット位置情報に基づいて各駆動系の実質的な駆動を制御する場合には、ショット位置情報に基づいて設定する目標位置の変化や、目標位置と位置検出器１９により取得される現在位置との関係により各駆動系の新たな駆動方向を認識することができる。これに対して、ＣＰＵ２２は、上述のようにして各駆動系の駆動方向を検出すると共に、その駆動方向の情報を逐次更新しながらＲＡＭ２３に記憶させるようにしており、上記現在の駆動方向は、ＲＡＭ２３に記憶されている駆動方向の情報から読み取ることができる。これにより、新たな駆動方向が現在の駆動方向と反転（反転駆動）することになるか否かが判断される。尚、各駆動系の駆動時において位置検出器１９から取得される現在位置（検出位置）の変化から各駆動系の現在の駆動方向を検出することもできる。
【００３０】
また、反転駆動になると判断し、バックラッシュを除去するための制御処理を行う場合、ＣＰＵ２２は、ＲＯＭ２４に記憶されているバックラッシュ駆動時間ｔ１を読み出し、その駆動時間ｔ１においてバックラッシュを除去するための位置制御信号又は速度制御信号をサーボアンプ１７に出力する。これによってバックラッシュ分のモータ１８の駆動が行われる。ここで、詳細を後述するようにバックラッシュ分のモータ１８の駆動においては、モータ１８の回転速度が最大となるように制御され、バックラッシュ分の駆動時間の短縮が図られている。
【００３１】
バックラッシュ分のモータ１８の駆動が終了すると、ＣＰＵ２２は、各駆動系の実質的な駆動のための制御処理を開始する。尚、上記ＲＯＭ２４には、各駆動系のバックラッシュ駆動時間ｔ１が記憶されており、この駆動時間ｔ１は複数の値から選択できるように構成される。また、上記バックラッシュ駆動時間ｔ１は、実際の駆動時において検出されたモータ電流値等の変化に基づき、上記ＣＰＵ２２で演算することにより、自動的に設定することもできる。
【００３２】
更に、ＣＰＵ２２は４つの駆動系のバックラッシュを考慮して、各駆動系の実質的な駆動を同時に行うように制御している。即ち、パン、チルト、フォーカス、ズームの各駆動系ではバックラッシュ量が多少相違し、これらが同時に反転駆動されると、相互間に動きのずれが生じる。また、一方が正転駆動で、他方が反転駆動される場合もあり、この場合も相互間に動きのずれが生じる。そこで、本実施の形態では反転駆動する駆動系、又はこの駆動系の中で最もバックラッシュ駆動時間ｔ１が長い駆動系のバックラッシュ分の駆動が終了した後に、全ての駆動系の実質的な駆動を同時に開始制御するようにしている。これにより、操作通りの軌跡で駆動が実行可能となる。
【００３３】
更に、ＣＰＵ２２は、上記ジョイスティック１２からの操作信号に基づいて各駆動系（パン、チルトの駆動系）の実質的な駆動を制御する場合、ジョイスティック１２から操作信号を次のように処理する。図２には、ジョイスティック１２の操作領域が示されており、図に示されるように、棒状の操作レバー２６は全方位方向で垂直位置から位置Ｑ１又は位置Ｑ２まで倒せるようになっている。そして、Ｄが不感帯領域、Ｅがバックラッシュ操作領域、Ｆが実際の操作領域として設定されている。ＣＰＵ２２は、ジョイスティック１２からの操作信号により操作レバー２６が不感帯領域Ｄにあると判断したときには、駆動系の駆動を行わず、駆動系を静止状態にする。一方、ジョイスティック１２からの操作信号により操作レバー２６がバックラッシュ操作領域Ｅにあると判断したときには、不感帯領域Ｄと同様に駆動系の実質的な駆動を行わないが、上述のようにその操作方向に対応する駆動系の新たな駆動方向が現在の駆動方向と反転となる場合には、バックラッシュを除去するための制御処理を実行する。このように駆動系の実質的な駆動が行われないバックラッシュ操作領域Ｅにおいてバックラッシュを除去するための駆動系の駆動を行うことで、実際の操作領域Ｆにおけるジョイスティック１２の実質的な操作において、実際の駆動と一致した操作感覚が得られるという利点がある。
【００３４】
本実施の形態におけるサーボ回路は以上の構成からなり、以下、ＣＰＵ２２におけるバックラッシュを除去するための制御処理の内容についての第１乃至第３の実施の形態を順に説明する。
【００３５】
まず、第１の実施の形態を図３〜図５に基づいて説明する。第１の実施の形態は、駆動系の実質的な駆動の制御がショット位置情報又はジョイスティック１２からの操作信号に基づいて位置制御により行われる場合に適用され、バックラッシュを除去するための制御も位置制御により行われる場合である。駆動系の実質的な駆動の制御がショット位置情報に基づいて行われる場合、ＣＰＵ２２は、上述のように所定の操作スイッチ１０が操作されたことを検出すると、ＲＡＭ２３に記憶されたショット位置情報を読み出し、そのショット位置情報に基づいて目標位置を設定してその目標位置に対応した電圧の位置制御信号をサーボアンプ１７に出力する。これによってサーボアンプ１７がモータ１８を位置制御し、駆動対象物が前記目標位置へ駆動される。一方、目標位置と現在位置との比較（及び現在の駆動方向との比較）において、反転することになる駆動系が存在する場合は、バックラッシュを除去するための制御処理が実行される。この制御処理においてＣＰＵ２２は、ＲＯＭ２４からバックラッシュ駆動時間ｔ１を読み出し、そのバックラッシュ駆動時間ｔ１の間、バックラッシュ分だけモータ１８の駆動するための位置制御信号をサーボアンプ１７に出力する。尚、後述のように、このバックラッシュ駆動時間ｔ１は実際のバックラッシュ分を完全に駆動させる時間ｔ１´（図３）よりも短い時間に設定されており、これによりモータ回転数が大きくなり過ぎないように制御される。
【００３６】
バックラッシュ駆動時間ｔ１が経過すると、ＣＰＵ２２は位置制御信号をバックラッシュ駆動開始時の値に戻し、ショット位置情報に基づいて駆動系の実質的な駆動の制御を開始する。即ち、ショット位置情報に基づく位置制御信号をサーボアンプ１７に出力する。
【００３７】
図３には、反転駆動する駆動系で位置Ｐ１から位置Ｐ２まで駆動対象物を移動させる場合の制御状態が示されており、図（Ａ）に示されるように、まずバックラッシュ駆動時間ｔ１の間において、位置信号電圧Ｖｐの位置制御信号がサーボアンプ１７へ与えられる。これにより、図（Ｃ）に示されるバックラッシュ分Ｂが駆動される。そして、図示のように、バックラッシュ分Ｂを完全に駆動させるためには、ｔ１´の時間が必要となるが、これよりも少し手前の時間ｔ１で、図（Ａ）に示されるように、時間ｔ２において位置信号電圧Ｖｐが元の値に戻された後、目標位置Ｐ２に向かって位置信号電圧Ｖｐが出力される。従って、この新たな位置信号電圧Ｖｐによって、駆動対象物は位置Ｐ１から位置Ｐ２まで駆動されることになる。
【００３８】
このときのモータ１８の回転数が図（Ｄ）に示されており、最初に回転数が最高速度まで上昇した後、時間ｔ１後に回転数が下がり、バックラッシュ分Ｂが駆動されて実際の駆動に入る時点（時間ｔ１´後）では、駆動対象物の動き出しと等しい安定した回転数となる。従って、パン、チルト、ズーム、フォーカス動作における駆動対象物の急激な動きは防止され、自然な動きの駆動が実現される。
【００３９】
また、上記バックラッシュ駆動時間ｔ１における位置信号電圧Ｖｐは、モータ１８の回転速度が最大（駆動源の最高速度）となるように変化しており、バックラッシュ分Ｂを駆動する時間の短縮化が図られている。ここで、反転駆動する駆動系で位置Ｐ１から位置Ｐ２まで駆動対象物を移動させる場合における従来の位置制御信号（位置信号電圧）の状態と本実施の形態における位置制御信号（位置信号電圧）の状態とをそれぞれ図４（Ａ）、図４（Ｂ）に比較して示す。図（Ａ）に示すように従来では、バックラッシュ駆動時間ｔ３における位置信号電圧が、駆動対象物を実際に駆動する時間ｔ４における位置信号電圧と同一の変化率により変化するようになっているため、駆動対象物を実際に駆動する際の動作スピードが遅いと、バックラッシュ駆動時間ｔ３も長くなる。これに対して、本実施の形態では、バックラッシュ駆動時間ｔ１における位置信号電圧が、駆動対象物を実際に駆動する時間ｔ２における位置信号電圧とは無関係に、上述のようにモータ１８の回転速度が最大となるように変化するため、駆動対象物を実際に駆動する際の動作スピードが遅くても、バックラッシュ駆動時間ｔ１は短く、ｔ１＜ｔ３となる。尚、バックラッシュ駆動時間ｔ１はモータ１８を最高速度で駆動した場合を考慮して設定され上記ＲＯＭ２４に記憶される。また、バックラッシュ駆動時間ｔ１において位置制御信号をバックラッシュ量Ｂ（図３（Ｃ）参照）に相当する電圧だけ上昇させるようにすると好適である。ただし、これに限定されない。また、バックラッシュ駆動時間ｔ１において図３（Ａ）に示したように位置制御信号の電圧を徐々に変化させるのではなく、位置制御信号の電圧を現在位置から大きく離れた目標位置に対応する電圧に瞬時に切り替えることにより、モータ１８の回転速度を最大にするようにしてもよい。
【００４０】
次に、駆動系の実質的な駆動の制御がジョイスティック１２からの操作信号に基づいて行われる場合について図５のフローチャートを用いて説明する。尚、ＣＰＵ２２は、上述のようにジョイスティック１２からの操作信号に基づいて目標位置を設定して位置制御信号をサーボアンプ１７に出力するものとする。また、この場合における制御も図３に示した制御状態と同様に行われるため詳細な説明を省略する。まず、ステップ１０１で操作レバー２６の操作量がＣＰＵ２２へ入力されると、ステップ１０２にてその操作量が不感帯領域Ｄにあるか否かの判定を行う。そして、Ｙ（Ｙｅｓ）のときはステップ１０３でバックラッシュフラグ（ＢＦ）を０にリセットし、Ｎ（Ｎｏ）のときはステップ１０４へ移行して、上記操作レバー２６の操作量がバックラッシュ操作領域Ｅにあるか否かの判定を行う。このステップ１０４で、Ｙのとき、即ちバックラッシュ操作領域Ｅに操作レバー２６が操作されているときは、ステップ１０５に移行して現在の操作方向が前回の駆動方向と一致するか否かの判定を行う。即ち、ここでモータ１８が反転することになるか正転することになるかの判定が行われる。
【００４１】
そして、このステップ１０５で操作方向が前回の駆動方向と一致していると判定すれば（Ｙのとき）、今回の制御動作を終了するが、操作方向が前回の駆動方向と一致せず、反転動作となる場合（Ｎのとき）は、ステップ１０６にて、ＢＦが１であるか否かの判定を行う。即ち、バックラッシュ分が既に駆動されている場合は、このＢＦが１となるので、今回の操作でバックラッシュ分が駆動されているか否かを判定することになる。そして、このステップ１０６でバックラッシュフラグが１でないと判定したとき（Ｎのとき）は、次のステップ１０７で、図３（Ａ）のようにモータ１８の回転速度が最大となるような位置信号電圧Ｖｐの位置制御信号がサーボアンプ１７へ出力され、上記駆動時間ｔ１の間のバックラッシュ分の駆動がモータ１８により実行され、次のステップ１０８へ移行する。
【００４２】
このステップ１０８では、再び操作レバー２６がバックラッシュ操作領域Ｅにあるか否かの判定を行い、Ｎのとき、即ちバックラッシュの駆動がほぼ終了するときは、ステップ１０９にて上記位置信号電圧Ｖｐを元に戻し、新たな位置信号電圧Ｖｐの位置制御信号をサーボアンプ１７へ出力し、その後に上記ＢＦを１にセットする。従ってこの時点で、上記バックラッシュ操作領域Ｅの操作時間によって設定されたバックラッシュ駆動時間のモータ駆動が終了することになる。
【００４３】
また、上記ステップ１０４にて、Ｎのとき、即ち操作レバー２６が実質的な操作領域Ｆにあるときは、ステップ１１０にて、位置信号電圧Ｖｐをサーボアンプ１７へ出力して位置制御を行い、ステップ１１１では、モータ１８の駆動方向をＲＡＭ２３へ記憶して、動作を終了する。従って、ここでは図３の時間ｔ２における安定した駆動が実行され、これによってパン、チルト、ズーム、フォーカスの各駆動系が操作レバー２６の操作量に応じて駆動される。
【００４４】
次に、上述のようにいずれかの駆動系においてバックラッシュを除去するための駆動を行った場合において、各駆動系の実質的な駆動を同時に開始する場合の開始時の動作について図６で説明する。同図において、パンをＡ駆動系、チルトをＢ駆動系とし、例えばＡ駆動系では図６（Ａ）に示されるバックラッシュ駆動時間ｔ１Ａが設定され、Ｂ駆動系では図６（Ｂ）に示されるバックラッシュ駆動時間ｔ１Ｂが設定されており、両者を反転駆動するものとする。この場合は、Ｂ駆動系のバックラッシュ駆動時間ｔ１Ｂの駆動が終了しても、直に次の新たな位置制御は行われず、Ａ駆動系のバックラッシュ駆動時間ｔ１Ａが終了したときを開始時点Ｔｐとして、Ａ，Ｂの両駆動系で新たな位置制御が開始される。従って、この場合はパン、チルトのいずれかの動作が遅れるということはなく、例えば、テレビカメラが意図しない曲がった軌跡を経ることなく、移動開始位置から移動終了位置へ真っ直ぐ移動し、操作通りの動きが達成できることになる。
【００４５】
また、図６（Ｃ）はＢ駆動系が正転駆動される場合を示しており、この場合はバックラッシュ駆動時間ｔ１Ｂが０となる。この場合も、Ａ駆動系のバックラッシュ分の駆動が終わるまで、Ｂ駆動系の動作を保留し、開始時点ＴｐからＡ，Ｂの両駆動系の次の新たな位置制御が開始される。この同時開始制御は、４つの駆動系の相互間で実行されるが、特にパンとチルトの関係、パン、チルト、フォーカスとズームの関係において重要となる。
【００４６】
以上、上記第１の実施の形態は、ショット位置情報やジョイスティック１２からの操作信号に基づく場合に限らず、駆動系の実質的な駆動を位置制御により行う場合に適用できる。
【００４７】
また、上記第１の実施の形態では、駆動系の実質的な駆動の制御をバックラッシュ分のモータ１８の駆動が完全に行われる前（バックラッシュ駆動時間ｔ１の経過時）に開始するようにしているが、バックラッシュ分の駆動が完全に行われたとき（時間ｔ１´経過時）に開始するようにしてもよい。
【００４８】
また、上記第１の実施の形態では、テレビカメラ及び雲台の制御について説明したが、これらの制御に限らず、本発明は各種の装置を位置制御するサーボ回路に適用することができる。また、手動操作手段として、ジョイスティックを用いた例を示したが、これに限らず、手動操作手段にはトラックボールのような他の操作手段を用いることができる。
【００４９】
次に、第２の実施の形態を図７〜図９に基づいて説明する。第２の実施の形態は、駆動系の実質的な駆動の制御が第１の実施の形態と同様にショット位置情報又はジョイスティック１２からの操作信号に基づいて位置制御により行われる場合に適用され、バックラッシュを除去するための制御が速度制御により行われる場合である。駆動系の実質的な駆動の制御がショット位置情報に基づいて行われる場合、ＣＰＵ２２は、上述のように所定の操作スイッチ１０が操作されたことを検出すると、ＲＡＭ２３に記憶されたショット位置情報を読み出し、そのショット位置情報に基づいて目標位置を設定し、その目標位置に対応した電圧の位置制御信号をサーボアンプ１７に出力する。これによってサーボアンプ１７がモータ１８を位置制御し、駆動対象物が前記目標位置へ駆動される。一方、目標位置と現在位置との比較（及び現在の駆動方向との比較）において、反転することになる駆動系が存在する場合は、バックラッシュを除去するための制御処理が実行される。この制御処理においてＣＰＵ２２は、位置／速度制御切替信号によりサーボアンプ１７を速度制御に切り替えると共に、ＲＯＭ２４からバックラッシュ駆動時間ｔ１を読み出し、そのバックラッシュ駆動時間ｔ１の間、バックラッシュ分だけモータ１８の駆動するための速度制御信号をサーボアンプ１７に出力する。
【００５０】
バックラッシュ駆動時間ｔ１が経過すると、ＣＰＵ２２は、位置／速度制御切替信号によりサーボアンプ１７を位置制御に切り替えると共に、ショット位置情報に基づいて駆動系の実質的な駆動の制御を開始する。即ち、ショット位置情報に基づく位置制御信号をサーボアンプ１７に出力する。
【００５１】
図７には、反転駆動する駆動系で位置Ｐ１から位置Ｐ２まで駆動対象物を移動させる場合の制御状態が示されており、図（Ａ）に示されるように、バックラッシュ駆動時間ｔ１の間では、速度制御電圧Ｖ１の速度制御信号がモータ１８へ与えられ、図（Ｂ）の位置制御信号は与えられない。これにより、図（Ｄ）に示されるバックラッシュ分Ｂが駆動され、モータ回転数は図（Ｅ）に示されるようなる。そして、バックラッシュ駆動時間ｔ１の後に、時間ｔ２の間で図（Ｂ）の位置信号電圧Ｖｐの位置制御信号が与えられ、これによって駆動対象物は位置Ｐ１から位置Ｐ２まで駆動される。このようにして、図（Ｅ）に示されるように、駆動対象物の実質的な駆動が開始されたときにはモータ１８では常に安定した回転数を維持することになる。従って、パン、チルト、ズーム、フォーカス動作における駆動対象物の急激な動きが防止され、自然な動きの駆動が達成される。
【００５２】
また、上記バックラッシュ駆動時間ｔ１における速度制御電圧Ｖ１は、バックラッシュ駆動時間ｔ１が経過する所定時間前まで（時間ｔ１´が経過するまで）モータ１８の回転速度が最大（駆動源の最高速度）となる電圧に設定されており、バックラッシュ分Ｂを駆動する時間の短縮化が図られている。ここで、反転駆動する駆動系で位置Ｐ１から位置Ｐ２まで駆動対象物を移動させる場合における従来の速度制御信号及び位置制御信号の状態と本実施の形態における速度制御信号及び位置制御信号の状態とをそれぞれ図８（Ａ）、図８（Ｂ）に比較して示すと、従来では、バックラッシュ駆動時間ｔ３における速度制御電圧が、駆動対象物を実際に駆動する時間ｔ４における位置制御信号による動作スピードと同一になるように設定されるため、駆動対象物を実際に駆動する際の動作スピードが遅いと、バックラッシュ駆動時間ｔ３も長くなる。これに対して、本実施の形態では、バックラッシュ駆動時間ｔ１における速度制御信号が、駆動対象物を実際に駆動する時間ｔ２における位置制御信号による動作スピードとは無関係に、モータ１８の回転速度が最大となるような電圧に設定されるため、駆動対象物を実際に駆動する際の動作スピードが遅くても、バックラッシュ駆動時間ｔ１は短く、ｔ１＜ｔ３となる。尚、バックラッシュ駆動時間ｔ１はモータ１８を最高速度で駆動した場合における値として設定されている。
【００５３】
次に、駆動系の実質的な駆動の制御がジョイスティック１２からの操作信号に基づいて行われる場合について図９のフローチャートを用いて説明する。尚、ＣＰＵ２２は、上述のようにジョイスティック１２からの操作信号に基づいて目標位置を設定して位置制御信号をサーボアンプ１７に出力するものとする。また、この場合における制御も図７に示した制御状態と同様に行われるため詳細な説明を省略する。まず、ステップ２０１で操作レバー２６の操作量がＣＰＵ２２へ入力されると、ステップ２０２にてその操作量が不感帯領域Ｄにあるか否かの判定を行う。そして、Ｙ（Ｙｅｓ）のときはステップ２０３でバックラッシュフラグ（ＢＦ）を０にリセットし、Ｎ（Ｎｏ）のときはステップ２０４へ移行して、上記操作レバー２６の操作量がバックラッシュ操作領域Ｅにあるか否かの判定を行う。このステップ２０４で、Ｙのとき、即ちバックラッシュ操作領域Ｅに操作レバー２６が操作されているときは、ステップ２０５に移行して現在の操作方向が前回の駆動方向と一致するか否かの判定を行う。即ち、ここでモータ１８が反転することになるか同方向回転となるかの判定が行われる。
【００５４】
そして、このステップ２０５で操作方向が前回の駆動方向と一致していると判定すれば（Ｙのとき）、今回の制御動作を終了するが、操作方向が前回の駆動方向と一致せず、反転動作となる場合（Ｎのとき）は、ステップ２０６にて、ＢＦが１であるか否かの判定を行う。即ち、バックラッシュ分が既に駆動されている場合は、このＢＦが１となるので、今回の操作でバックラッシュ分が駆動されているか否かを判定することになる。そして、このステップ２０６でバックラッシュフラグが１でないと判定したとき（Ｎのとき）は、次のステップ２０７で、図７（Ａ）のようにモータ１８の回転速度が最大となるような速度制御電圧Ｖ１の速度制御信号がサーボアンプ１７へ出力される。ここで、上述した図７の時間ｔ１に相当する操作時間でバックラッシュ分の駆動が、所定回転数のモータ１８により実行される。このバックラッシュ分の駆動が終了すると、次のステップ２０８へ移行し、上記ＢＦを１にセットして制御動作を終了する。
【００５５】
また、上記ステップ２０４にて、Ｎのとき、即ち操作レバー２６が実質的な操作領域Ｆにあるときは、ステップ２０９にて、位置信号電圧Ｖｐの位置制御信号をサーボアンプ１７へ出力して通常の位置制御を行い、ステップ２１０では、モータ１８の駆動方向をＲＡＭ２３へ記憶して、動作を終了する。従って、ここでは図７の時間ｔ２における安定した駆動が実行され、これによってパン、チルト、ズーム、フォーカスの各駆動系が操作レバー２６の操作量に応じて駆動される。
【００５６】
以上、上記第２の実施の形態は、ショット位置情報やジョイスティック１２からの操作信号に基づく場合に限らず、駆動系の実質的な駆動を位置制御により行う場合に適用できる。
【００５７】
また、上記第２の実施の形態では、テレビカメラ及び雲台の制御について説明したが、これらの制御に限らず、本発明は各種の装置を位置制御するサーボ回路に適用することができる。また、手動操作手段として、ジョイスティックを用いた例を示したが、これに限らず、手動操作手段にはトラックボールのような他の操作手段を用いることができる。
【００５８】
また、上述のようにいずれかの駆動系においてバックラッシュを除去するための駆動を行った場合において、各駆動系の実質的な駆動を同時に開始する場合の開始時の動作は、第１の実施の形態において図６で説明したのと同様に行うことができる。
【００５９】
次に、第３の実施の形態を図１０〜図１２に基づいて説明する。第３の実施の形態は、駆動系の実質的な駆動の制御がジョイスティック１２からの操作信号に基づいて速度制御により行われる場合に適用され、バックラッシュを除去するための制御も速度制御により行われる場合である。駆動系の実質的な駆動の制御がジョイスティック１２からの操作信号に基づいて速度制御により行われる場合、ＣＰＵ２２は、上述のようにジョイスティック１２から与えられた操作信号が指示する速度を目標速度とし、その目標速度に対応した電圧の速度制御信号をサーボアンプ１７に出力する。これによってサーボアンプ１７がモータ１８を速度制御し、駆動対象物が前記目標速度で駆動される。一方、ジョイスティック１２の操作方向と現在の駆動方向との比較において、反転することになる駆動系が存在する場合は、バックラッシュを除去するための制御処理が実行される。この制御処理においてＣＰＵ２２は、ＲＯＭ２４からバックラッシュ駆動時間ｔ１を読み出し、そのバックラッシュ駆動時間ｔ１の間、バックラッシュ分だけモータ１８の駆動するための速度制御信号をサーボアンプ１７に出力する。
【００６０】
バックラッシュ駆動時間ｔ１が経過すると、ＣＰＵ２２はジョイスティック１２からの操作信号に基づいて駆動系の実質的な駆動の制御を開始する。即ち、ジョイスティック１２からの操作信号に基づく位置制御信号をサーボアンプ１７に出力する。
【００６１】
図１０には、反転駆動する駆動系で位置Ｐ１から位置Ｐ２まで所定速度で駆動対象物を移動させる場合の制御状態が示されている。図（Ａ）に示されるように、バックラッシュ駆動時間ｔ１の間では、ＶCBの速度制御電圧の速度制御信号がサーボアンプ１７へ与えられ、その後、時間ｔ２の間で駆動対象物を位置Ｐ１から位置Ｐ２まで所定の速度で駆動するための速度制御電圧Ｖｃの速度制御信号が与えられる。即ち、上記速度制御電圧ＶCBは、バックラッシュ駆動時間ｔ１が経過する所定時間前まで（時間ｔ１´の間で）モータ１８の回転速度が最大（駆動源の最高速度）となる電圧に設定されており、バックラッシュ分Ｂを駆動する時間の短縮化が図られている。また、所定時間ｔ１´の経過後、バックラッシュ駆動時間ｔ１が経過するまでの間で、モータ１８の回転速度を、駆動対象物の実際の駆動時よりも低い速度となるように切り替えているため、駆動対象物は、同図（Ｂ）に示すように緩やかな立上がり部４００の速度で動くことになる。従って、パン、チルト、ズーム、フォーカス動作における駆動対象物の急激な動きが防止され、自然な動きの駆動が達成される。
【００６２】
反転駆動する駆動系で位置Ｐ１から位置Ｐ２まで所定の速度で駆動対象物を移動させる場合における従来の速度制御信号（速度制御電圧）の状態と本実施の形態における速度制御信号の状態とをそれぞれ図１１（Ａ）、図１１（Ｂ）に比較して示すと、従来では、バックラッシュ駆動時間ｔ３における速度制御電圧が、駆動対象物を実際に駆動する時間ｔ４における速度制御信号による動作スピードよりも小さくなるような電圧に設定されるため、駆動対象物を実際に駆動する際の動作スピードが遅いと、バックラッシュ駆動時間ｔ３も長くなる。これに対して、本実施の形態では、バックラッシュ駆動時間ｔ１における速度制御電圧が、駆動対象物を実際に駆動する時間ｔ２における速度制御信号とは無関係に、上述のようにモータ１８の回転速度が最大となるような電圧に設定されるため、駆動対象物を実際に駆動する際の動作スピードが遅くても、バックラッシュ駆動時間ｔ１は短く、ｔ１＜ｔ３となる。尚、バックラッシュ駆動時間ｔ１はモータ１８を最高速度で駆動した場合における値として設定されている。
【００６３】
図１２には、この場合におけるＣＰＵ２２の処理手順を示すフローチャートが示されている。まず、ステップ３０１で操作レバー２６の操作量がＣＰＵ２２へ入力されると、ステップ３０２にてその操作量が不感帯領域Ｄにあるか否かの判定を行う。そして、Ｙ（Ｙｅｓ）のときはステップ３０３でバックラッシュフラグ（ＢＦ）を０にリセットし、Ｎ（Ｎｏ）のときはステップ３０４へ移行して、上記操作レバー２６の操作量がバックラッシュ操作領域Ｅにあるか否かの判定を行う。このステップ３０４で、Ｙのとき、即ちバックラッシュ操作領域Ｅに操作レバー２６が操作されているときは、ステップ３０５に移行して現在の操作方向が前回の駆動方向と一致するか否かの判定を行う。即ち、ここでモータ１８が反転することになるか正転することになるかの判定が行われる。
【００６４】
そして、このステップ３０５で操作方向が前回の駆動方向と一致していると判定すれば（Ｙのとき）、今回の制御動作を終了するが、操作方向が前回の駆動方向と一致せず、反転動作となる場合（Ｎのとき）は、ステップ３０６にて、ＢＦが１であるか否かの判定を行う。即ち、バックラッシュ分が既に駆動されている場合は、このＢＦが１となるので、今回の操作でバックラッシュ分が駆動されているか否かを判定することになる。そして、このステップ３０６でバックラッシュフラグが１でないと判定したとき（Ｎのとき）は、次のステップ３０７で、図１０（Ａ）のようにモータ１８の回転速度が最大となるような速度制御電圧ＶCBの速度制御信号がサーボアンプ１７へ出力される。これによって、上述した図１０の時間ｔ１に相当する操作時間で最大速度によるバックラッシュ分の駆動がモータ１８により実行される。このバックラッシュ分の駆動が終了すると、次のステップ３０８へ移行し、上記ＢＦを１にセットして制御動作を終了する。
【００６５】
また、上記ステップ３０４にて、Ｎのとき、即ち操作レバー２６が実質的な操作領域Ｆにあるときは、ステップ３０９にて、速度制御電圧Ｖｃをサーボアンプ１７へ出力して通常の速度制御を行い、ステップ３１０では、モータ１８の駆動方向をＲＡＭ２３へ記憶して、動作を終了する。従って、バックラッシュ駆動後でも滑らかな駆動系の動作が行われ、その後は図１０の時間ｔ２における安定した駆動が実行される。このようにして、パン、チルト、ズーム、フォーカスの各駆動系が操作レバー２６の操作量に応じて駆動される。
【００６６】
以上、上記第３の実施の形態は、ジョイスティック１２からの操作信号に基づく場合に限らず、駆動系の実質的な駆動を速度制御により行う場合に適用できる。
【００６７】
また、上記第３の実施の形態のように駆動系の実質的な駆動の制御を速度制御により行う場合であっても、第１の実施の形態のようにバックラッシュを除去するための制御を位置制御により行うことも可能である。
【００６８】
また、上記第３の実施の形態では、テレビカメラ及び雲台の制御について説明したが、これらの制御に限らず、本発明は各種の装置を速度制御するサーボ回路に適用することができる。また、手動操作手段として、ジョイスティックを用いた例を示したが、これに限らず、手動操作手段にはトラックボールのような他の操作手段を用いることができる。
【００６９】
【発明の効果】
以上説明したように本発明に係るモータ制御装置によれば、モータを反転駆動する際にバックラッシュ分のモータの駆動を最高速度により行うようにしたため、駆動対象物が実際に動き出すまでの時間を短縮することができる。また、バックラッシュ分の駆動が終了する前にモータの速度を低速に切り替えることによって、駆動対象物の動き出しを好適に行うことができる。
【図面の簡単な説明】
【図１】図１は、本発明に係るモータ制御装置の実施の形態におけるサーボ回路の構成を示した図である。
【図２】図２は、ジョイスティックの操作領域の説明に使用した図である。
【図３】図３は、第1 の実施の形態において反転駆動する駆動系で位置Ｐ1 から位置Ｐ2 まで駆動対象物を移動させる場合の制御状態を示した図である。
【図４】図４は、従来と第１の実施の形態との比較に使用した図である。
【図５】図５は、第１の実施の形態においてジョイスティックによる制御動作を示したフローチャートである。
【図６】図６は、各駆動系が同時に駆動される場合の開始時の動作を示した図である。
【図７】図７は、第２の実施の形態において反転駆動する駆動系で位置Ｐ1 から位置Ｐ2 まで駆動対象物を移動させる場合の制御状態を示した図である。
【図８】図８は、従来と第２の実施の形態との比較に使用した図である。
【図９】図９は、第２の実施の形態においてジョイスティックによる制御動作を示したフローチャートである。
【図１０】図１０は、第３の実施の形態において反転駆動する駆動系で位置Ｐ１から位置Ｐ２まで駆動対象物を移動させる場合の制御状態を示した図である。
【図１１】図１１は、従来と第３の実施の形態との比較に使用した図である。
【図１２】図１２は、第３の実施の形態においてジョイスティックによる制御動作を示したフローチャートである。
【符号の説明】
１０…操作スイッチ、１２…ジョイスティック、１７…サーボアンプ、１８…モータ、１９…位置検出器、２２…ＣＰＵ、２３…ＲＡＭ、２４…ＲＯＭ、２５…速度検出器
【図１】
0004013041.tif 000002
【図２】
0004013041.tif 000003
【図３】
0004013041.tif 000004
【図４】
0004013041.tif 000005
【図５】
0004013041.tif 000006
【図６】
0004013041.tif 000007
【図７】
0004013041.tif 000008
【図８】
0004013041.tif 000009
【図９】
0004013041.tif 000010
【図１０】
0004013041.tif 000011
【図１１】
0004013041.tif 000012
【図１２】
0004013041.tif 000013