JP7264931B2 - ジンバル及びそれを有するシステム - Google Patents

ジンバル及びそれを有するシステム Download PDF

Info

Publication number
JP7264931B2
JP7264931B2 JP2021051616A JP2021051616A JP7264931B2 JP 7264931 B2 JP7264931 B2 JP 7264931B2 JP 2021051616 A JP2021051616 A JP 2021051616A JP 2021051616 A JP2021051616 A JP 2021051616A JP 7264931 B2 JP7264931 B2 JP 7264931B2
Authority
JP
Japan
Prior art keywords
angle
information
motor
rotation
gimbal
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2021051616A
Other languages
English (en)
Other versions
JP2022149448A (ja
Inventor
陽平 山本
大毅 小林
誠世 會津
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Canon Precision Inc
Original Assignee
Canon Precision Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Canon Precision Inc filed Critical Canon Precision Inc
Priority to JP2021051616A priority Critical patent/JP7264931B2/ja
Priority to US17/565,799 priority patent/US11966237B2/en
Priority to CN202210170249.1A priority patent/CN115126992A/zh
Publication of JP2022149448A publication Critical patent/JP2022149448A/ja
Application granted granted Critical
Publication of JP7264931B2 publication Critical patent/JP7264931B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00Control of position or direction
    • G05D3/12Control of position or direction using feedback
    • G05D3/20Control of position or direction using feedback using a digital comparing device
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/12Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting in more than one direction
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/10Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting around a horizontal axis
    • F16M11/105Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting around a horizontal axis the horizontal axis being the roll axis, e.g. for creating a landscape-portrait rotation
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/04Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand
    • F16M11/06Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting
    • F16M11/12Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting in more than one direction
    • F16M11/121Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting in more than one direction constituted of several dependent joints
    • F16M11/123Means for attachment of apparatus; Means allowing adjustment of the apparatus relatively to the stand allowing pivoting in more than one direction constituted of several dependent joints the axis of rotation intersecting in a single point, e.g. by using gimbals
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/02Heads
    • F16M11/18Heads with mechanism for moving the apparatus relatively to the stand
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M11/00Stands or trestles as supports for apparatus or articles placed thereon ; Stands for scientific apparatus such as gravitational force meters
    • F16M11/20Undercarriages with or without wheels
    • F16M11/2007Undercarriages with or without wheels comprising means allowing pivoting adjustment
    • F16M11/2035Undercarriages with or without wheels comprising means allowing pivoting adjustment in more than one direction
    • F16M11/2064Undercarriages with or without wheels comprising means allowing pivoting adjustment in more than one direction for tilting and panning
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M13/00Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M13/00Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles
    • F16M13/04Other supports for positioning apparatus or articles; Means for steadying hand-held apparatus or articles for supporting on, or holding steady relative to, a person, e.g. by chains, e.g. rifle butt or pistol grip supports, supports attached to the chest or head
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D11/00Component parts of measuring arrangements not specially adapted for a specific variable
    • G01D11/30Supports specially adapted for an instrument; Supports specially adapted for a set of instruments
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D21/00Measuring or testing not otherwise provided for
    • G01D21/02Measuring two or more variables by means not covered by a single other subclass
    • GPHYSICS
    • G03PHOTOGRAPHY; CINEMATOGRAPHY; ANALOGOUS TECHNIQUES USING WAVES OTHER THAN OPTICAL WAVES; ELECTROGRAPHY; HOLOGRAPHY
    • G03BAPPARATUS OR ARRANGEMENTS FOR TAKING PHOTOGRAPHS OR FOR PROJECTING OR VIEWING THEM; APPARATUS OR ARRANGEMENTS EMPLOYING ANALOGOUS TECHNIQUES USING WAVES OTHER THAN OPTICAL WAVES; ACCESSORIES THEREFOR
    • G03B17/00Details of cameras or camera bodies; Accessories therefor
    • G03B17/56Accessories
    • G03B17/563Camera grips, handles
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M2200/00Details of stands or supports
    • F16M2200/04Balancing means
    • F16M2200/041Balancing means for balancing rotational movement of the head
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16MFRAMES, CASINGS OR BEDS OF ENGINES, MACHINES OR APPARATUS, NOT SPECIFIC TO ENGINES, MACHINES OR APPARATUS PROVIDED FOR ELSEWHERE; STANDS; SUPPORTS
    • F16M2200/00Details of stands or supports
    • F16M2200/04Balancing means
    • F16M2200/041Balancing means for balancing rotational movement of the head
    • F16M2200/042Balancing means for balancing rotational movement of the head for panning movement
    • GPHYSICS
    • G03PHOTOGRAPHY; CINEMATOGRAPHY; ANALOGOUS TECHNIQUES USING WAVES OTHER THAN OPTICAL WAVES; ELECTROGRAPHY; HOLOGRAPHY
    • G03BAPPARATUS OR ARRANGEMENTS FOR TAKING PHOTOGRAPHS OR FOR PROJECTING OR VIEWING THEM; APPARATUS OR ARRANGEMENTS EMPLOYING ANALOGOUS TECHNIQUES USING WAVES OTHER THAN OPTICAL WAVES; ACCESSORIES THEREFOR
    • G03B17/00Details of cameras or camera bodies; Accessories therefor
    • G03B17/56Accessories
    • G03B17/561Support related camera accessories

Landscapes

  • Engineering & Computer Science (AREA)
  • General Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position Or Direction (AREA)
  • Accessories Of Cameras (AREA)
  • Studio Devices (AREA)

Description

本発明は、ジンバル及びそれを有するシステムに関する。
ジンバルは一般的に、ステータ及びロータを備えるモータと、ステータに対するロータの回転角度を検出する角度検出センサとを有する。特許文献1には、摩擦抵抗の低減と制御性向上のために非接触式の角度検出センサを有するジンバルが開示されている。
特表2017-501667号公報
特許文献1のジンバルにおいて、角度検出センサの校正を行うためには校正装置に接続するための部品が必要となり、ジンバルの小型化が困難となる。
本発明は、角度検出センサの校正が可能な小型のジンバル及びそれを有するシステムを提供することを目的とする。
本発明の一側面としてのジンバルは、被支持部を所定の姿勢で安定させるジンバルであって、被支持部の加速度を検出する加速度センサと、加速度を用いて被支持部の姿勢情報を算出する第1算出部と、ステータ部材に対して回転可能なロータ部材を備える回転部と、回転部の回転角度を検出する角度検出センサと、姿勢情報と回転角度に基づく回転部の角度情報とを用いて角度情報の補正値を算出する第2算出部とを有することを特徴とする。
本発明によれば、角度検出センサの校正が可能な小型のジンバル及びそれを有するシステムを提供することができる。
実施例1のジンバルを有するシステムの構成を示す概略図である。 実施例1のジンバルの構成を示す概略図である。 実施例1の第1回転駆動部の構成を示す概略図である。 実施例1のモータの角度情報の補正値の算出方法を示すフローチャートである。 実施例2のジンバルの構成を示す概略図である。 実施例2の第1回転駆動部の構成を示す概略図である。 実施例2のモータの角度情報の補正値の算出方法を示すフローチャートである。 実施例3のジンバルの構成を示す概略図である。 実施例3のモータの角度情報の補正値の算出方法を示すフローチャートである。
以下、本発明の実施形態について、図面を参照しながら詳細に説明する。各図において、同一の部材については同一の参照番号を付し、重複する説明は省略する。
図1は、実施例1のジンバルを有するシステム100の構成を示す概略図である。システム100は、ジンバル、及びジンバルによって固定される被支持部101を有する。ジンバルは、被支持部101を所定の姿勢で安定させることが可能である。被支持部101は、デジタルスチルカメラやデジタルビデオカメラ等の撮像装置でもよいし、センサ等の検出装置でもよい。
ジンバルは、被支持部101を支持する支持部102を有する。また、ジンバルは、第1回転駆動部103、第2回転駆動部104、及び第3回転駆動部105を有する。第1乃至第3回転駆動部103,104,105はそれぞれ、被支持部101をX軸周り、Y軸周り、Z軸周りに回転させる。また、ジンバルは、使用者がジンバルを保持するための保持部106を有する。更に、ジンバルは、支持部102と第1回転駆動部103とを連結する連結部材107、第1回転駆動部103と第2回転駆動部104とを連結する連結部材108、及び第2回転駆動部104と第3回転駆動部105とを連結する連結部材109を有する。
図2は、本実施例のジンバルの構成を示す概略図である。支持部102は、第1加速度センサ110、第2加速度センサ111、及び第3加速度センサ112を有する。第1乃至第3加速度センサ110,111,112はそれぞれ、被支持部101のX軸方向、Y軸方向、及びZ軸方向の加速度を検出する。また、第1乃至第3加速度センサ110,111,112は、検出した加速度を制御部113に出力する。
第1回転駆動部103は、第1モータ118、第1角度検出センサ119、及び第1モータ駆動部120を有する。第2回転駆動部104は、第2モータ121、第2角度検出センサ122、及び第2モータ駆動部123を有する。第3回転駆動部105は、第3モータ124、第3角度検出センサ125、及び第3モータ駆動部126を有する。
制御部113は、姿勢推定部(第1算出部)114、駆動指令部115、信号処理部(第2算出部)116、及び記憶部117を有する。
姿勢推定部114は、CPU、GPU、DSP、A/D変換素子等の素子や、FPGA、ASIC等の回路から構成される。姿勢推定部114は、第1乃至第3加速度センサ110,111,112により検出された加速度を用いて以下の式(1)乃至(3)で表される被支持部101の姿勢情報(θ,θ,θ)を算出する。なお、姿勢情報とは本実施例では、被支持部101のモータの回転軸周りの角度に関する情報である。
Figure 0007264931000001
ここで、ATAN2(X,Y)は、象限を判別して位相0~2πに変化する逆正接演算関数である。αx,αy,αzはそれぞれ、被支持部101のX軸方向、Y軸方向、及びZ軸方向の加速度である。
駆動指令部115は、CPU、GPU、DSP、A/D変換素子等の素子や、FPGA、ASIC等の回路から構成される。駆動指令部115は、姿勢推定部114により算出された被支持部101の姿勢情報と信号処理部116により算出された各回転駆動部のモータ(回転部)の角度情報とを用いて被支持部101が所定の姿勢で安定するようにモータの駆動量を算出する。駆動指令部115は、算出した駆動量に対応する駆動信号を各回転駆動部に送信する。駆動信号は例えば、パルス信号、PWM信号、又はシリアル信号等である。
信号処理部116は、CPU、GPU、DSP、A/D変換素子等の素子や、FPGA、ASIC等の回路から構成される。信号処理部116は、各回転駆動部の角度検出センサにより検出される各モータの回転角度を用いてモータの角度情報(φ,φ,φ)を算出する。また、信号処理部116は、姿勢推定部114により算出された被支持部101の姿勢情報とモータの角度情報とを用いてモータの角度情報の補正値を算出する。なお、信号処理部116は、姿勢推定部114及び駆動指令部115の少なくとも一方の動作を実行してもよい。
以下、第1回転駆動部103の第1モータ118の角度情報の補正値の具体的な算出方法を説明する。
まず、信号処理部116は、所定の姿勢情報θxn(n=1、2・・・N)に対応する第1モータ118の角度情報φxnを取得する。姿勢情報θxn及び角度情報φxnは、予め値の小さい順に並べ替えられていてもよい。
次に、信号処理部116は、以下の式(4)で表される所定の姿勢における第1モータ118の角度情報φxnの角度誤差INL(φxn)を算出する。
Figure 0007264931000002
角度情報φに対応する角度誤差INL(φ)は、フーリエ級数展開により、以下の式(5)で近似される。
Figure 0007264931000003
係数Ax0,Axm(m=1,2,3,4),Bxm(m=1,2,3,4)を求めることで、角度情報φに対応する角度誤差INL(φ)の近似値を算出することができる。
係数Ax0,Axm,Bxmはそれぞれ、以下の式(6)乃至(8)で求められる。
Figure 0007264931000004
係数Ax0,Axm,Bxmは、第1モータ118の角度情報の補正値として記憶部117に記憶される。なお、本実施例では、角度誤差INL(φ)は、4次の近似式で表されているが、5次以上の近似式で表されてもよい。
信号処理部116は、同様の処理を行うことで第2回転駆動部104の第2モータ121、及び第3回転駆動部105の第3モータ124の角度情報の補正値を算出することができる。
信号処理部116は、算出した補正値を用いてモータの角度情報(φ,φ,φ)を補正し、以下の式(9)乃至(11)で表されるモータの補正後の角度情報(φ’,φ’,φ’)を算出する。
Figure 0007264931000005
なお、本実施例では、信号処理部116が角度情報を補正する補正部として機能するが、信号処理部116とは別に補正部を設けてもよい。
角度情報の精度を向上させるために、補正値の算出と記憶、及び角度情報の補正を複数回行ってもよい。
記憶部117は、ROM、RAM、及びハードディスク等の記憶媒体から構成される。記憶部117は、信号処理部116により算出されたモータの角度情報の補正値を記憶する。また、記憶部117は、姿勢推定部114、駆動指令部115、及び信号処理部116に実行させるプログラムを記憶してもよい。補正値やプログラムは、記憶部117の不揮発性記憶媒体に保存される。なお、記憶部117は、1つの記憶媒体から構成されてもよいし、複数の記憶媒体から構成されてもよい。
図3は、第1回転駆動部103の構成を示す概略図である。第2及び第3回転駆動部104,105の構成は第1回転駆動部103の構成と同様であるため、本実施例では第2及び第3回転駆動部104,105の構成の詳細な説明は省略する。
第1モータ118は、ステータ部材127、ロータ部材128、回転軸129、上側軸受け130、及び下側軸受け131を有する。上側軸受け130及び下側軸受け131はそれぞれ、回転軸129の第1端側及び第2端側に設けられている。ロータ部材128は、ステータ部材127に対して回転可能である。本実施例では、ステータ部材127にコイル132が取り付けられ、ロータ部材128にマグネット133が取り付けられているが、ステータ部材127にマグネット133が取り付けられ、ロータ部材128にコイル132が取り付けられてもよい。
第1角度検出センサ119は、マグネット134及び磁気センサ135を有する。マグネット134は、円盤状の形状を有し、回転軸129の第1端に取り付けられている。磁気センサ135は、マグネット134と対向する位置に配置されている。第1角度検出センサ119は本実施例では磁気式エンコーダ(電磁誘導式エンコーダ)であるが、本発明はこれに限定されない。第1角度検出センサ119は、光学式エンコーダや、静電容量式エンコーダであってもよい。なお、磁気センサ135は、本実施例では第1モータ駆動部120に取り付けられているが、第1モータ駆動部120に取り付けられている必要はない。
第1モータ駆動部120は、CPU、GPU、A/D変換素子、FET等の素子や、FPGA、ASIC等の回路から構成される。第1モータ駆動部120は、ケーブル137を介して制御部113に接続される電気接続部136を有する。第1モータ駆動部120は、駆動指令部115からの駆動信号を受信し、第1モータ118を回転させる。
図4は、本実施例の第1乃至第3モータ118,121,124の角度情報の補正値の算出方法を示すフローチャートである。本実施例では、第1モータ118の角度情報の補正値を算出する場合について説明する。
ステップS100では、支持部102を手動により、又は第1モータ118により、X軸周りに回転させる。なお、第3回転駆動部103の角度情報の補正値を算出する際に支持部102をZ軸周りに回転させる場合、予め支持部102をX軸周り、又はY軸周りに90度回転させておく。
ステップS101では、姿勢推定部114は、第2及び第3加速度センサ111,112により検出された加速度を用いて被支持部101の姿勢情報θを算出する。
ステップS102では、制御部113は、姿勢情報θが予め設定した所定の姿勢情報であるかどうかを判定する。姿勢情報θが所定の姿勢情報である場合と判定された場合、ステップS103に進み、そうでないと判定された場合、ステップS100に戻る。
ステップS103では、信号処理部116は、第1角度検出センサ119により検出された第1モータ118の回転角度を用いて第1モータ118の角度情報φを算出する。
ステップS104では、制御部113は、支持部102が360度以上回転し、所定の全姿勢での第1モータ118の角度情報φの算出が完了したかどうかを判定する。支持部102が360度以上回転し、所定の全姿勢での第1モータ118の角度情報φの算出が完了されたと判定された場合、ステップS105に進み、そうでないと判定された場合、ステップS100に戻る。
ステップS105では、信号処理部116は、被支持部101の姿勢情報θと第1モータ118の角度情報φとを用いて第1モータ118の角度情報φの補正値を算出する。
ステップS106では、記憶部117は、第1モータ118の角度情報φの補正値を記憶する。
図4のフロー終了後、記憶部117に記憶された補正値は、モータの角度情報を補正する際に用いられる。
なお、同様の処理を実行することで、第2及び第3モータ121,124の角度情報の補正値を算出することができる。
以上説明したように、本実施例では被支持部101の姿勢情報とモータの角度情報とを用いてモータの角度情報の補正値を算出する。モータの角度情報の補正値を算出する際に姿勢情報を用いることで、校正装置を接続しなくても、角度検出センサの校正を行うことができる。また、モータの角度情報を補正することで、高精度かつ高効率なジンバルを実現することができる。また、本実施例のジンバルでは、組み立てた後でも、モータの角度情報の補正値を算出可能である。
本実施例のジンバルを有するシステムの構成は、基本的には実施例1のシステムと同様である。本実施例では、実施例1と異なる構成について説明し、実施例1と同様の構成については説明を省略する。
図5は、本実施例のジンバルの構成を示す概略図である。支持部102は、第1乃至第3加速度センサ110,111,112に加えて第1ジャイロセンサ201、第2ジャイロセンサ202、及び第3ジャイロセンサ203を有する。第1乃至第3ジャイロセンサ201,202,203はそれぞれ、被支持部101のX軸周り、Y軸周り、及びZ軸周りの角加速度を検出する。また、第1乃至第3ジャイロセンサ201,202,203は、検出した角加速度を制御部113に出力する。
姿勢推定部114は、第1乃至第3加速度センサ110,111,112により検出された加速度、及び第1乃至第3ジャイロセンサ201,202,203により検出された角加速度を用いて被支持部101の姿勢情報(θ,θ,θ)を算出する。姿勢情報は、加速度センサ及びジャイロセンサの出力に対してMadgwick Filter処理を実施することで算出される。本実施例では、加速度センサの出力に加えて、ジャイロセンサの出力を用いることで、姿勢情報をより高精度に算出することができる。
図6は、第1回転駆動部103の構成を示す概略図である。第2及び第3回転駆動部104,105の構成は第1回転駆動部103の構成と同様であるため、本実施例では第2及び第3回転駆動部104,105の構成の詳細な説明は省略する。
第1モータ118は、ステータ部材127、ロータ部材128、回転軸204、上側軸受け130、及び下側軸受け131を有する。回転軸204は中空構造で、回転軸204の内部にはケーブル137が通っている。
第1角度検出センサ119は、マグネット205及び磁気センサ206を有する。マグネット205は、リング状の形状を有し、回転軸204の端部に取り付けられている。磁気センサ206は、マグネット205の径方向(第1モータの回転軸に直交する方向)においてマグネット205と対向する位置に配置されている。
中空構造の回転軸204を採用すると共に、磁気センサ206をマグネット205の径方向の位置に配置することで、第1モータ駆動部120と第1モータ118との間の距離を小さくすることができ、第1回転駆動部103を小型化することができる。
図7は、本実施例の第1乃至第3モータ118,121,124の角度情報の補正値の算出方法を示すフローチャートである。本実施例では、第1モータ118の角度情報の補正値を算出する場合について説明する。
ステップS200の処理は、図4のステップS100の処理と同様であるため、詳細な説明は省略する。
ステップS201では、姿勢推定部114は、加速度センサにより検出された加速度及びジャイロセンサにより検出された角加速度を用いて被支持部101の姿勢情報θを算出する。
ステップS202乃至ステップS206の処理はそれぞれ、図4のステップS102乃至ステップS106の処理と同様であるため、詳細な説明は省略する。
なお、同様の処理を実行することで、第2及び第3モータ121,124の角度情報の補正値を算出することができる。
本実施例では、姿勢情報を実施例1に比べて精度よく算出することできるため、より高精度かつ高効率なジンバルを実現することができる。また、本実施例では、回転駆動部の構成を実施例1の回転駆動部の異なる構成とすることで、ジンバルをより小型化することができる。なお、本実施例の角度検出センサの配置では、角度検出センサの校正は必須である。
本実施例のジンバルを有するシステムの構成は、基本的には実施例1のシステムと同様である。本実施例では、実施例1と異なる構成について説明し、実施例1と同様の構成については説明を省略する。
図8は、本実施例のジンバルの構成を示す概略図である。支持部102は、慣性姿勢計測装置(Intertioal Measurement Unit。以下、IMU。)301を有する。IMU301は、加速度センサ、ジャイロセンサ、及び磁気センサを組み合わせた装置である。
姿勢推定部114は、IMU301の出力を用いて被支持部101の姿勢情報(θ,θ,θ)を算出する。姿勢情報は、IMU301の出力に対してMadgwick Filter処理を実施することで算出される。本実施例では、磁気センサの出力を用いることで、外乱による誤差の影響を敬遠できるため、姿勢情報をより高精度に算出することができる。
駆動指令部115は、姿勢推定部114により算出された被支持部101の姿勢情報と信号処理部116が取得したモータの補正後の角度情報とを用いて被支持部101が所定の姿勢で安定するようにモータの駆動量を算出する。
信号処理部116は、各回転駆動部の信号処理部からモータの補正後の角度情報(φ’,φ’,φ’)を取得する。
記憶部117は、姿勢推定部114、駆動指令部115、及び信号処理部116に実行させるプログラムを記憶する。
第1回転駆動部103は、第1モータ118、第1角度検出センサ119、第1モータ駆動部120、第1信号処理部302、及び第1記憶部303を有する。第2回転駆動部104は、第1モータ121、第2角度検出センサ122、第2モータ駆動部123、第2信号処理部304、及び第2記憶部305を有する。第3回転駆動部105は、第3モータ124、第3角度検出センサ125、第3モータ駆動部126、第3信号処理部306、及び第3記憶部307を有する。本実施例では、第1乃至第3信号処理部302,304,306がモータの角度情報の補正値を算出する第2算出部として機能する。
第1信号処理部302は、第1角度検出センサ119により検出される第1モータ118の回転角度を用いて第1モータ118の角度情報φを算出する。また、第1信号処理部302は、姿勢推定部114により算出された被支持部101の姿勢情報と第1モータ118の角度情報とを用いて第1モータ118の角度情報の補正値を算出する。
また、第1信号処理部302は、算出した補正値を用いて第1モータ118の補正後の角度情報φを補正し、補正後の角度情報φを信号処理部116に送信する。
なお、本実施例では、第1乃至第3信号処理部302,304,306が角度情報を補正する補正部として機能するが、第1乃至第3信号処理部302,304,306とは別に補正部を設けてもよい。
第1記憶部303は、第1信号処理部302により算出された第1モータ118の角度情報の補正値を記憶する。また、第1記憶部303は、第1モータ駆動部120や、第1信号処理部302に実行させるプログラムを記憶してもよい。補正値やプログラムは、第1記憶部303の不揮発性記憶媒体に保存される。
同様に、第2及び第3信号処理部304,306はそれぞれ、第2及び第3モータ121,124の補正後の角度情報φ’,φ’を算出し、算出した補正後の角度情報φ’,φ’を信号処理部116に送信する。
各回転駆動部に信号処理部と記憶部を設けることで、全てのモータの角度情報の補正値を同時に算出可能である。
図9は、本実施例のモータの角度情報の補正値の算出方法を示すフローチャートである。
ステップS300では、支持部102を手動により、又は第1乃至第3モータ118,121,124により、X軸周り、Y軸周り、及びZ軸周りに回転させる。
ステップS301では、姿勢推定部114は、IMU301の出力を用いて被支持部101の姿勢情報(θ,θ,θ)を算出する。
ステップS302では、制御部113は、姿勢情報(θ,θ,θ)が予め設定した所定の姿勢情報であるかどうかを判定する。姿勢情報(θ,θ,θ)が所定の姿勢情報である場合と判定された場合、ステップS303に進み、そうでないと判定された場合、ステップS300に戻る。
ステップS303では、第1信号処理部302は、第1角度検出センサ119により検出される第1モータ118の回転角度を用いて第1モータの角度情報φを算出する。第2信号処理部304は、第2角度検出センサ122により検出される第2モータ121の回転角度を用いて第2モータ121の角度情報φを算出する。第3信号処理部306は、第3角度検出センサ125により検出される第3モータ124の回転角度を用いて第3モータ124の角度情報φを算出する。
ステップS304では、制御部113は、支持部102が全ての回転軸周りに360度以上回転し、所定の全姿勢での角度情報の算出が完了したかどうかを判定する。支持部102が全ての回転軸周りに360度以上回転し、所定の全姿勢での角度情報の算出が完了されたと判定された場合、ステップS305に進み、そうでないと判定された場合、ステップS300に戻る。
ステップS305では、第1信号処理部302は、被支持部101の姿勢情報と第1モータ118の角度情報とを用いて第1モータ118の角度情報の補正値を算出する。第2信号処理部304は、被支持部101の姿勢情報と第2モータ121の角度情報とを用いて第2モータ121の角度情報の補正値を算出する。第3信号処理部306は、被支持部101の姿勢情報と第3モータ124の角度情報とを用いて第3モータ124の角度情報の補正値を算出する。
ステップS306では、第1記憶部303は、第1モータ118の角度情報の補正値を記憶する。第2記憶部305は、第2モータ121の角度情報の補正値を記憶する。第3記憶部307は、第3モータ124の角度情報の補正値を記憶する。
本実施例の構成によれば、複数のモータの角度情報の補正値を同時に算出可能であり、補正値算出の処理に係る時間を短縮することができる。
以上、本発明の好ましい実施形態について説明したが、本発明は、これらの実施形態に限定されず、その要旨の範囲内で種々の変形及び変更が可能である。
101 被支持部
110 第1加速度センサ(加速度センサ)
111 第2加速度センサ(加速度センサ)
112 第3加速度センサ(加速度センサ)
114 姿勢推定部(第1算出部)
116 信号処理部(第2算出部)
118 第1モータ(回転部)
119 第1角度検出センサ(角度検出センサ)
121 第2モータ(回転部)
122 第2角度検出センサ(角度検出センサ)
124 第3モータ(回転部)
125 第3角度検出センサ(角度検出センサ)
127 ステータ部材
128 ロータ部材
302 第1信号処理部(第2算出部)
304 第2信号処理部(第2算出部)
306 第3信号処理部(第2算出部)

Claims (11)

  1. 被支持部を所定の姿勢で安定させるジンバルであって、
    前記被支持部の加速度を検出する加速度センサと、
    前記加速度を用いて前記被支持部の姿勢情報を算出する第1算出部と、
    ステータ部材に対して回転可能なロータ部材を備える回転部と、
    前記回転部の回転角度を検出する角度検出センサと、
    前記姿勢情報と前記回転角度に基づく前記回転部の角度情報とを用いて前記角度情報の補正値を算出する第2算出部とを有することを特徴とするジンバル。
  2. 前記姿勢情報は、前記被支持部の前記回転部の回転軸周りの角度に関する情報であることを特徴とする請求項1に記載のジンバル。
  3. 前記補正値を用いて前記角度情報を補正する補正部を更に有することを特徴とする請求項1又は2に記載のジンバル。
  4. 前記補正値を記憶する記憶部を更に有する請求項1乃至3の何れか一項に記載のジンバル。
  5. 前記被支持部の角加速度を検出するジャイロセンサを更に有し、
    前記第1算出部は、前記加速度と前記角加速度とを用いて前記姿勢情報を算出することを特徴とする請求項1乃至4の何れか一項に記載のジンバル。
  6. 前記回転部は、第1回転部及び第2回転部を含み、
    前記角度検出センサは、前記第1回転部の第1回転角度を検出する第1角度検出センサ、及び前記第2回転部の第2回転角度を検出する第2角度検出センサを含み、
    前記第2算出部は、前記姿勢情報と前記第1回転角度に基づく前記第1回転部の第1角度情報とを用いて算出される前記第1角度情報の補正値と、前記姿勢情報と前記第2回転角度に基づく前記第2回転部の第2角度情報とを用いて算出される前記第2角度情報の補正値とを同時に算出することを特徴とする請求項1乃至5の何れか一項に記載のジンバル。
  7. 前記角度検出センサは、前記ロータ部材に固定されるマグネットを備える磁気式エンコーダであることを特徴とする請求項1乃至6の何れか一項に記載のジンバル。
  8. 前記角度検出センサは、前記回転部の回転軸に直交する方向において前記マグネットと対向する位置に配置される磁気センサを備えることを特徴とする請求項7に記載のジンバル。
  9. 前記被支持部を支持する支持部を更に有することを特徴とする請求項1乃至8の何れか一項に記載のジンバル。
  10. 請求項1乃至9の何れか一項に記載のジンバルと、
    前記ジンバルによって支持される被支持部とを有することを特徴とするシステム。
  11. 前記被支持部は、撮像装置であることを特徴とする請求項10に記載のシステム。
JP2021051616A 2021-03-25 2021-03-25 ジンバル及びそれを有するシステム Active JP7264931B2 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2021051616A JP7264931B2 (ja) 2021-03-25 2021-03-25 ジンバル及びそれを有するシステム
US17/565,799 US11966237B2 (en) 2021-03-25 2021-12-30 Gimbal and system having the same
CN202210170249.1A CN115126992A (zh) 2021-03-25 2022-02-24 万向架和具有万向架的***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021051616A JP7264931B2 (ja) 2021-03-25 2021-03-25 ジンバル及びそれを有するシステム

Publications (2)

Publication Number Publication Date
JP2022149448A JP2022149448A (ja) 2022-10-06
JP7264931B2 true JP7264931B2 (ja) 2023-04-25

Family

ID=83364673

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021051616A Active JP7264931B2 (ja) 2021-03-25 2021-03-25 ジンバル及びそれを有するシステム

Country Status (3)

Country Link
US (1) US11966237B2 (ja)
JP (1) JP7264931B2 (ja)
CN (1) CN115126992A (ja)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018093463A (ja) 2016-11-30 2018-06-14 株式会社リコー 振動抑制装置および電子機器
JP2020020878A (ja) 2018-07-30 2020-02-06 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd 移動体、合焦制御方法、プログラム、及び記録媒体

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103825408A (zh) 2014-02-28 2014-05-28 深圳市大疆创新科技有限公司 电机、应用电机的云台和应用云台的拍摄装置
CN108496300B (zh) * 2016-02-22 2022-05-27 深圳市大疆灵眸科技有限公司 电机位置感测
WO2018107330A1 (en) * 2016-12-12 2018-06-21 SZ DJI Technology Co., Ltd. Method and system for stabilizing a payload
CN110312913A (zh) * 2017-03-24 2019-10-08 深圳市大疆灵眸科技有限公司 用于自适应云台的方法和***
WO2019056381A1 (zh) * 2017-09-25 2019-03-28 深圳市大疆灵眸科技有限公司 云台的控制方法、云台控制器及云台
KR102387819B1 (ko) * 2017-12-27 2022-04-15 에스지 디제이아이 테크놀러지 코., 엘티디 짐벌 작동 모드 전환 방법, 컨트롤러 및 이미지 안정화 장치
CN110300941A (zh) * 2018-08-31 2019-10-01 深圳市大疆创新科技有限公司 一种云台的转动控制方法、装置及控制设备、移动平台
CN110809689B (zh) * 2018-10-31 2021-07-09 深圳市大疆创新科技有限公司 云台、手持云台和手持拍摄装置
CN111279113B (zh) * 2019-01-04 2022-01-25 深圳市大疆创新科技有限公司 手持云台控制方法和手持云台

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018093463A (ja) 2016-11-30 2018-06-14 株式会社リコー 振動抑制装置および電子機器
JP2020020878A (ja) 2018-07-30 2020-02-06 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd 移動体、合焦制御方法、プログラム、及び記録媒体

Also Published As

Publication number Publication date
CN115126992A (zh) 2022-09-30
JP2022149448A (ja) 2022-10-06
US11966237B2 (en) 2024-04-23
US20220308601A1 (en) 2022-09-29

Similar Documents

Publication Publication Date Title
JP5043358B2 (ja) 傾斜角演算方法及び傾斜角演算装置
US8229694B2 (en) Coordinate measuring machine
JP5333863B2 (ja) 回転角検出装置
JP4858837B2 (ja) 回転角度検出装置
US20090093984A1 (en) Method and apparatus for calibrating gyro-sensor
JP2004502951A (ja) 座標測定マシン(cmm)の振動に起因した座標測定誤差を補正する方法および装置
JPWO2007099599A1 (ja) 磁気式ジャイロ
US20180184004A1 (en) Method for calibrating driving amount of actuator configured to correct blurring of image taken by camera
JP4749154B2 (ja) ロータリエンコーダ
JP7381707B2 (ja) 検出装置、方法、システム、算出装置、および算出方法
JP2006029937A (ja) 回転角度検出装置の回転角補正方法
JP5177639B2 (ja) 磁気式エンコーダ装置及びこれを用いた位置検出方法
JP7264931B2 (ja) ジンバル及びそれを有するシステム
JP2009300262A (ja) 変位検出装置
TW201727199A (zh) 編碼器
JP6619974B2 (ja) エンコーダ
JP6518090B2 (ja) 回転角度検出装置
JP5190134B2 (ja) 角速度検出方法及びその装置
JP2006119008A (ja) ジャイロセンサの温度特性調整方法及びジャイロセンサ
JP7441061B2 (ja) アブソリュートエンコーダ、アブソリュートエンコーダの角度誤差情報出力プログラム、アブソリュートエンコーダの角度誤差情報出力方法
US9671248B2 (en) Method for calibrating an inertial navigation system with a limited mechanical turning range
JP2004264137A (ja) 非接触回転角度センサにおける補正値の決定方法および非接触回転角度センサ
JP3634058B2 (ja) 傾斜角測定装置
CN115135962A (zh) 用于基于MEMS的加速度计的零g偏移校准的方法和装置
WO2013005509A1 (ja) 磁気式ジャイロ

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220721

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230327

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230413

R150 Certificate of patent or registration of utility model

Ref document number: 7264931

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150