JP6026695B1 - Control device, moving body, control method, and program - Google Patents
Control device, moving body, control method, and program Download PDFInfo
- Publication number
- JP6026695B1 JP6026695B1 JP2016118003A JP2016118003A JP6026695B1 JP 6026695 B1 JP6026695 B1 JP 6026695B1 JP 2016118003 A JP2016118003 A JP 2016118003A JP 2016118003 A JP2016118003 A JP 2016118003A JP 6026695 B1 JP6026695 B1 JP 6026695B1
- Authority
- JP
- Japan
- Prior art keywords
- main body
- displacement
- posture
- unit
- lens
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims description 18
- 238000006073 displacement reaction Methods 0.000 claims abstract description 157
- 230000008859 change Effects 0.000 claims abstract description 68
- 238000003384 imaging method Methods 0.000 claims description 133
- 230000005484 gravity Effects 0.000 claims description 51
- 238000012546 transfer Methods 0.000 description 18
- 238000012790 confirmation Methods 0.000 description 9
- 230000003287 optical effect Effects 0.000 description 8
- 238000001514 detection method Methods 0.000 description 7
- 230000005540 biological transmission Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 230000009471 action Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Landscapes
- Accessories Of Cameras (AREA)
- Studio Devices (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Control Of Position Or Direction (AREA)
- Camera Bodies And Camera Details Or Accessories (AREA)
- Structure And Mechanism Of Cameras (AREA)
Abstract
【課題】変位部が変位した場合の本体部の姿勢の変化に基づいて、本体部の姿勢を速やかに制御することが要求される場合がある。【解決手段】制御装置は、本体部に対して変位可能に保持される変位部の変位先の位置を示す第1情報を取得する第1取得部と、第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する予測部と、予測部が予測した前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する制御部とを備える。【選択図】図6In some cases, it is required to quickly control the posture of a main body based on a change in the posture of the main body when the displacement portion is displaced. A control device includes: a first acquisition unit that acquires first information indicating a position of a displacement destination of a displacement unit that is held displaceably with respect to a main body unit; and the displacement unit based on the first information. A prediction unit that predicts the posture of the main body after being displaced to the position of the displacement destination, and a control unit that controls the posture of the main body based on the posture of the main body predicted by the prediction unit. . [Selection] Figure 6
Description
本発明は、制御装置、移動体、制御方法及びプログラムに関する。 The present invention relates to a control device, a moving body, a control method, and a program.
特許文献1には、カメラシステムが開示されている。カメラシステムは、外部ユニットと、本体ユニットとを備える。カメラの電源をONにすると、本体ユニットと外部ユニットとの間でユニット情報の交換が行われる。ユニット情報は、機種番号、ユニット種別、製造元種別、ファームウェアバージョン番号及び本体側ファームウェア有り無しの情報からなる。
特許文献1 特開2011−239301号公報
Patent Document 1 discloses a camera system. The camera system includes an external unit and a main unit. When the camera is turned on, unit information is exchanged between the main unit and the external unit. The unit information consists of model number, unit type, manufacturer type, firmware version number, and information on the presence or absence of firmware on the main body side.
Patent Document 1 JP 2011-239301 A
本体部に対して変位可能に保持される変位部が変位すると、本体部及び変位部の重心位置が変化する場合がある。これにより、本体部の姿勢が変化する場合がある。この本体部の姿勢の変化に基づいて本体部の姿勢を速やかに制御することが要求される場合がある。 If the displacement part hold | maintained displaceably with respect to a main-body part displaces, the gravity center position of a main-body part and a displacement part may change. Thereby, the attitude | position of a main-body part may change. In some cases, it is required to quickly control the posture of the main body based on the change in the posture of the main body.
一態様において、制御装置は、本体部に対して変位可能に保持される変位部の変位先の位置を示す第1情報を取得する第1取得部と、第1情報に基づいて、変位部が変位先の位置に変位した後の本体部の姿勢を予測する予測部と、予測部が予測した本体部の姿勢に基づいて、本体部の姿勢を制御する制御部とを備える。 In one aspect, the control device includes: a first acquisition unit that acquires first information indicating a position of a displacement destination of a displacement unit that is held displaceably with respect to the main body unit; and the displacement unit is based on the first information. A prediction unit that predicts the posture of the main body after being displaced to the position of the displacement destination, and a control unit that controls the posture of the main body based on the posture of the main body predicted by the prediction unit.
予測部は、変位部の質量及び第1情報に基づいて、変位部が変位先の位置に変位した後の本体部の姿勢を予測してよい。 The prediction unit may predict the posture of the main body after the displacement unit is displaced to the displacement destination position based on the mass of the displacement unit and the first information.
制御部は、予測部が予測した本体部の姿勢に基づいて、変位部が変位先の位置に変位することにより生じる本体部の姿勢の変化が抑制されるように、本体部の姿勢を制御してよい。 The control unit controls the posture of the main body unit based on the posture of the main body unit predicted by the prediction unit so that a change in the posture of the main body unit caused by the displacement unit being displaced to the position of the displacement destination is suppressed. It's okay.
予測部は、変位部が変位前の位置から変位先の位置まで変位するまでの期間内の複数のタイミングのそれぞれにおける変位部の位置を予測し、予測した複数の位置のそれぞれについて本体部の姿勢を予測し、制御部は、複数のタイミングのそれぞれにおいて、それぞれのタイミングにおける変位部の位置について予測部が予測した本体部の姿勢に基づいて、本体部の姿勢を制御してよい。 The prediction unit predicts the position of the displacement unit at each of a plurality of timings within a period until the displacement unit is displaced from the position before displacement to the position at the displacement destination, and the posture of the main body unit for each of the predicted plurality of positions. The control unit may control the posture of the main body at each of a plurality of timings based on the posture of the main body predicted by the prediction unit with respect to the position of the displacement portion at each timing.
制御部は、本体部の姿勢の目標値と、本体部の姿勢を取得するためのセンサによる本体部の姿勢の検出値と、予測部が予測した本体部の姿勢とに基づいて、本体部の姿勢を制御してよい。 Based on the target value of the posture of the main body, the detected value of the posture of the main body by the sensor for acquiring the posture of the main body, and the posture of the main body predicted by the prediction unit, the control unit You may control your attitude.
変位部は、可動レンズを含んでよい。 The displacement part may include a movable lens.
第1情報は、可動レンズを含むレンズ系の焦点距離に対応する可動レンズの変位先の位置を示す情報を含んでよい。 The first information may include information indicating the position of the displacement destination of the movable lens corresponding to the focal length of the lens system including the movable lens.
第1情報は、可動レンズを含むレンズ系のフォーカス位置に対応する可動レンズの変位先の位置を示す情報を含んでよい。 The first information may include information indicating the position of the displacement destination of the movable lens corresponding to the focus position of the lens system including the movable lens.
可動レンズの複数の位置に対応づけて、レンズ系を含むレンズ装置の重心位置を格納する格納部をさらに備え、予測部は、第1情報が示す可動レンズの変位先の位置に対応づけて格納部が格納している重心位置と、レンズ装置の質量とに基づいて、第1情報が示す可動レンズの変位先の位置に可動レンズが変位した後の本体部の姿勢を予測してよい。 A storage unit that stores the position of the center of gravity of the lens device including the lens system in association with a plurality of positions of the movable lens is further provided, and the prediction unit stores the position in association with the displacement destination position of the movable lens indicated by the first information. The posture of the main body after the movable lens is displaced to the position of the displacement destination of the movable lens indicated by the first information may be predicted based on the center-of-gravity position stored in the unit and the mass of the lens device.
可動レンズは、本体部に着脱可能な交換レンズが有するレンズ系に含まれ、制御装置は、本体部に装着されている交換レンズから、交換レンズの焦点距離及びフォーカス位置の少なくとも一方に対応する交換レンズの重心位置及び交換レンズの質量を示す第2情報を取得する第2取得部を備えてよい。 The movable lens is included in a lens system included in an interchangeable lens that can be attached to and detached from the main body, and the control device replaces the interchangeable lens that is mounted on the main body, corresponding to at least one of the focal length and the focus position of the interchangeable lens. You may provide the 2nd acquisition part which acquires the 2nd information which shows the gravity center position of a lens, and the mass of an interchangeable lens.
変位部は、撮像装置であってよい。 The displacement unit may be an imaging device.
撮像装置は、本体部に対して向きが可変に設けられ、変位部の変位は、撮像装置の向きの変化であってよい。 The imaging device may be provided with a variable orientation relative to the main body, and the displacement of the displacement unit may be a change in the orientation of the imaging device.
撮像装置は、本体部に着脱可能であり、制御装置は、本体部に装着されている撮像装置から、撮像装置の重心位置及び撮像装置の質量を示す第2情報を取得する第2取得部を備えてよい。 The imaging device can be attached to and detached from the main body, and the control device includes a second acquisition unit that acquires second information indicating the center of gravity of the imaging device and the mass of the imaging device from the imaging device attached to the main body. You may be prepared.
一態様において、移動体は、上記の制御装置と本体部とを備える。 In one mode, a mobile object is provided with the above-mentioned control device and a main part.
一態様において、制御方法は、本体部に対して変位可能に保持される変位部の変位先の位置を示す第1情報を取得する段階と、第1情報に基づいて、変位部が変位先の位置に変位した後の本体部の姿勢を予測する段階と、予測する段階で予測された本体部の姿勢に基づいて、本体部の姿勢を制御する段階とを備える。 In one aspect, the control method includes obtaining a first information indicating a position of a displacement destination of a displacement portion that is held displaceably with respect to the main body, and the displacement portion is a displacement destination based on the first information. A step of predicting a posture of the main body after being displaced to a position, and a step of controlling the posture of the main body based on the posture of the main body predicted in the step of predicting.
一態様において、プログラムは、上記制御方法をコンピュータに実行させる。 In one aspect, a program causes a computer to execute the control method.
上記の発明の概要は、本発明の特徴の全てを列挙したものではない。これらの特徴群のサブコンビネーションも発明となりうる。 The above summary of the present invention does not enumerate all of the features of the present invention. A sub-combination of these feature groups can also be an invention.
以下、発明の実施の形態を通じて本発明を説明するが、以下の実施形態は特許請求の範囲にかかる発明を限定するものではない。実施形態の中で説明されている特徴の組み合わせの全てが発明の解決手段に必須であるとは限らない。 Hereinafter, the present invention will be described through embodiments of the invention, but the following embodiments do not limit the invention according to the claims. Not all combinations of features described in the embodiments are essential for the solution of the invention.
特許請求の範囲、明細書、図面、及び要約書には、著作権による保護の対象となる事項が含まれる。著作権者は、これらの書類の何人による複製に対しても、特許庁のファイルまたはレコードに表示される通りであれば異議を唱えない。ただし、それ以外の場合、一切の著作権を留保する。 The claims, the description, the drawings, and the abstract include matters subject to copyright protection. The copyright owner will not object to any number of copies of these documents as they appear in the JPO file or record. However, in other cases, all copyrights are reserved.
図1は、システムの構成の一例を示す図である。システムは、無人航空機(UAV)100を備える。UAV100は、UAV本体101、ジンバル110、及び撮像装置190を備える。UAV本体101は、回転翼108a及び回転翼108bを含む複数の回転翼を有する。UAV本体101が有する複数の回転翼を、回転翼108と総称する場合がある。撮像装置190は、撮像部140及びレンズ装置160を備える。UAV100は、対象物を備えて移動する移動体の一例である。移動体とは、UAVの他、空中を移動する他の航空機、地上を移動する車両、水上を移動する船舶等を含む概念である。
FIG. 1 is a diagram illustrating an example of a system configuration. The system comprises an unmanned aerial vehicle (UAV) 100. The
UAV100は、回転翼108の回転を制御することで飛行する。UAV100は、例えば、4つの回転翼108を用いて飛行する。回転翼108の数は、4つには限定されない。UAV100は、回転翼108を有さない固定翼機でもよい。
The
ジンバル110は、ジンバル110に対する撮像装置190の姿勢を変更可能に撮像部140及びレンズ装置160を支持する。ジンバル110は、少なくとも1つの軸を中心に撮像装置190を回転可能に支持してよい。例えば、ジンバル110は、撮像装置190を、ピッチ軸、ロール軸、及びヨー軸のそれぞれを中心に回転可能に支持する。ジンバル110は、撮像部140を保持してもよし、レンズ装置160を保持してもよい。
The
撮像部140は、レンズ装置160を介して結像された光学像の画像データを生成して記録する。レンズ装置160は、いわゆる交換レンズである。レンズ装置160は、撮像部140に対して着脱可能である。
The
図2は、UAV100の機能ブロックの一例を示す。UAV100は、UAV本体101、ジンバル110及び撮像装置190を備える。UAV本体101は、通信インタフェース102、UAV制御部104、センサ120、メモリ106、ドライバ107、検出部105、モータ109及び回転翼108を有する。
FIG. 2 shows an example of functional blocks of the
ドライバ107及びモータ109は、UAV100を移動させる駆動部として機能する。ドライバ107は、モータ109を駆動する。モータ109は、回転翼108を駆動する。モータ109は、複数の回転翼108のそれぞれに1つ設けられる。ドライバ107は、モータ109のそれぞれの駆動軸の回転速度を制御する。回転速度は、例えば単位時間あたりの回転数である。回転翼108は、対応するモータ109の駆動軸の回転によって回転される。UAV100は、回転翼108が回転することで飛行する。
The
通信インタフェース102は、外部の送信機と通信する。通信インタフェース102は、遠隔の送信機から各種の命令を受信する。UAV制御部104は、送信機から受信した命令に従って、UAV100の飛行を制御する。UAV制御部104は、ジンバル110、撮像部140、及びレンズ装置160を制御する。
The
UAV制御部104は、CPU又はMPUなどのマイクロプロセッサ、MCUなどのマイクロコントローラなどにより構成されてよい。メモリ106は、UAV制御部104がジンバル110、撮像部140、及びレンズ装置160を制御するのに必要なプログラムなどを格納する。メモリ106は、コンピュータが可読な記録媒体でよく、SRAM、DRAM、EPROM、EEPROM、及びUSBメモリなどのフラッシュメモリの少なくとも1つを含んでよい。メモリ106は、UAV100の筐体に設けられてよい。メモリ106は、UAV100の筐体から取り外し可能に設けられてよい。UAV制御部104は、UAV100を制御装置として機能させてよい。この場合、UAV100の姿勢を調整するためのプログラムがメモリ106から読み出されて実行される。UAV制御部104は、UAV100を制御装置として機能させてよい。
The UAV control unit 104 may be configured by a microprocessor such as a CPU or MPU, a microcontroller such as an MCU, or the like. The
検出部105は、UAV100の状況、又はUAV100の周囲の状況を検出する。検出部105は、例えば、UAV100の緯度、経度、及び高度を含む位置、及びUAV100の機首の向きに対応する方位を検出する。検出部105は、UAV100の周囲を撮像するセンシング用の撮像装置を含んでよい。
The
UAV制御部104は、確認部188を含む。確認部188は、UAV100の飛行前のイニシャライズを実行する。確認部188は、ドライバ107、モータ109、回転翼108、及び検出部105の動作確認を実行する。確認部188は、UAV100の飛行前に、ドライバ107、モータ109、回転翼108、及び検出部105の動作確認を実行してよい。確認部188は、UAV100の状況を検出する各種センサの動作確認を実行してよい。イニシャライズが実行される期間は、UAV100に電源が投入されてからUAV100が移動し始めるまでの間の期間の一例である。
The UAV control unit 104 includes a
センサ120は、UAV本体101の姿勢を取得するためのセンサである。センサ120は、ジンバル110の姿勢を検出してよい。センサ120は、ジャイロセンサであってよい。センサ120による姿勢の検出値は、UAV制御部104に出力される。UAV制御部104は、センサ120による姿勢の検出値に基づいて、UAV本体101及びジンバル110を制御する。
The
ジンバル110は、少なくとも1つの軸を中心に撮像装置190を回転可能に支持する。ジンバル110は、ヨー軸、ピッチ軸、及びロール軸を中心に撮像装置190を回転可能に支持してよい。UAV制御部104は、ジンバル110に対する動作命令を出力する。動作命令は、ヨー角の目標値、ピッチ角の目標値、ロール角の目標値を含む。ヨー角は、ヨー軸まわりの撮像装置190の回転角度である。ピッチ角は、ピッチ軸まわりの撮像装置190の回転角度である。ロール角は、ロール軸まわりの撮像装置190の回転角度である。ジンバル110は、UAV制御部104から取得した動作命令に従って、ヨー軸、ピッチ軸、及びロール軸の少なくとも1つを中心に撮像装置190を回転させる。ジンバル110は、ヨー角、ピッチ角及びロール角をそれぞれの目標値に制御する。これにより、撮像装置190の向きが制御される。
The
撮像部140は、撮像制御部142、撮像素子144及びメモリ146を有する。撮像制御部142は、CPU又はMPUなどのマイクロプロセッサ、MCUなどのマイクロコントローラなどにより構成されてよい。撮像制御部142は、UAV制御部104からの撮像部140及びレンズ装置160の動作命令に応じて、撮像部140及びレンズ装置160を制御する。メモリ146は、コンピュータが可読な記録媒体でよく、SRAM、DRAM、EPROM、EEPROM、及びUSBメモリなどのフラッシュメモリの少なくとも1つを含んでよい。メモリ146は、撮像部140の筐体の内部に設けられてよい。撮像部140の筐体から取り外し可能に設けられてよい。
The
撮像素子144は、撮像部140の筐体の内部に保持され、レンズ装置160を介して結像された光学像の画像データを生成して、撮像制御部142に出力する。撮像制御部142は、撮像素子144から出力された画像データをメモリ146に格納する。撮像制御部142は、画像データを、UAV制御部104を介してメモリ106に出力して格納してもよい。
The
レンズ装置160は、レンズ制御部162、メモリ163、レンズ164、レンズ166、及びレンズ168を有する。レンズ164、レンズ166、及びレンズ168は、レンズ系を形成する。レンズ164、レンズ166、及びレンズ168は、レンズ装置160の鏡筒の内部に配置される。レンズ164、レンズ166、及びレンズ168の一部又は全部は、光軸に沿って変位可能に保持されてよい。光軸に沿って変位可能なレンズは、可動レンズの一例である。レンズ制御部162は、撮像制御部142からの命令に従って、レンズ164、レンズ166、及びレンズ168の少なくとも一つを光軸に沿って移動させる。レンズ装置160が有するレンズにより結像された像は、撮像部140により撮像される。
The
本実施形態では、UAV100が、UAV制御部104、撮像制御部142、及びレンズ制御部162を備える例について説明する。しかし、UAV制御部104、撮像制御部142、及びレンズ制御部162のうちの2つ又は3つで実行される処理をいずれか1つの制御部が実行してよい。UAV制御部104、撮像制御部142、及びレンズ制御部162で実行される処理を1つの制御部で実行してもよい。
In the present embodiment, an example in which the
UAV制御部104において、第1取得部170は、UAV本体101に対して変位可能に保持される変位部の変位先の位置を示す第1情報を取得する。レンズ装置160が有する可動レンズは、変位部の一例である。撮像装置190は、変位部の一例である。UAV本体101は、本体部の一例である。
In the UAV control unit 104, the
予測部130は、第1情報に基づいて、変位部が変位先の位置に変位した後のUAV本体101の姿勢を予測する。制御部180は、予測部130が予測したUAV本体101の姿勢に基づいて、UAV本体101の姿勢を制御する。
The
予測部130は、第1情報及び変位部の質量に基づいて、変位部が変位先の位置に変位した後のUAV本体101の姿勢を予測する。制御部180は、予測部130が予測したUAV本体101の姿勢に基づいて、変位部が変位先の位置に変位することにより生じるUAV本体101の姿勢の変化が抑制されるように、UAV本体101の姿勢を制御する。
The
予測部130は、変位部が変位前の位置から変位先の位置まで変位するまでの期間内の複数のタイミングのそれぞれにおける変位部の位置を予測する。予測部130は、予測した複数の位置のそれぞれについてUAV本体101の姿勢を予測する。制御部180は、複数のタイミングのそれぞれにおいて、それぞれのタイミングにおける変位部の位置について予測部130が予測したUAV本体101の姿勢に基づいて、UAV本体101の姿勢を制御する。
The
制御部180は、UAV本体101の姿勢の目標値と、センサによるUAV本体101の姿勢の検出値と、予測部130が予測したUAV本体101の姿勢とに基づいて、UAV本体101の姿勢を制御する。制御部180は、予測部130が予測したUAV本体101の姿勢に基づくフィードフォワード制御を行う。
The
変位部が可動レンズを含む場合、第1情報は、可動レンズを含むレンズ系の焦点距離に対応する可動レンズの変位先の位置を示す情報を含んでよい。第1情報は、焦点距離の変更先を示す情報であってよい。第1情報は、可動レンズを含むレンズ系のフォーカス位置に対応する可動レンズの変位先の位置を示す情報を含んでよい。第1情報は、フォーカス位置の変更先を示す情報であってよい。 When the displacement unit includes a movable lens, the first information may include information indicating the position of the displacement destination of the movable lens corresponding to the focal length of the lens system including the movable lens. The first information may be information indicating a change destination of the focal length. The first information may include information indicating the position of the displacement destination of the movable lens corresponding to the focus position of the lens system including the movable lens. The first information may be information indicating a change destination of the focus position.
メモリ106は、可動レンズの複数の位置に対応づけて、レンズ系を含むレンズ装置の重心位置を格納する。予測部130は、第1情報が示す可動レンズの変位先の位置に対応づけてメモリ106が格納している重心位置と、レンズ装置の質量とに基づいて、第1情報が示す可動レンズの変位先の位置に可動レンズが変位した後のUAV本体101の姿勢を予測する。
The
可動レンズが、UAV本体101に着脱可能な交換レンズが有するレンズ系に含まれる場合、第2取得部172は、UAV本体101に装着されている交換レンズから、交換レンズの焦点距離及びフォーカス位置の少なくとも一方に対応する交換レンズの重心位置及び交換レンズの質量を示す第2情報を取得してよい。第2取得部172は、UAV100の飛行前のイニシャライズを実行している期間に、第2情報を取得してよい。
When the movable lens is included in the lens system of the interchangeable lens that can be attached to and detached from the UAV
撮像装置190がUAV本体101に対して向きが可変に設けられる場合、撮像装置190は変位部の一例である。変位部の変位は、撮像装置の向きの変化に対応する。
When the
撮像装置190は、UAV本体101に着脱可能であってよい。この場合、第2取得部172は、UAV本体101に装着されている撮像装置190から、撮像装置190の重心位置及び撮像装置の質量を示す第2情報を取得してよい。第2取得部172は、UAV100の飛行前のイニシャライズを実行している期間に、第2情報を取得してよい。
The
図3は、レンズ装置160がテレ端の状態にある場合の一例を示す。図3が示すレンズ装置160の状態は、図1が示すレンズ装置160の状態とは異なる。例えば、図1はレンズ装置160がワイド端の状態を示す。この点を除いて、図3が示すUAV100の状態は、図1が示す状態と同じである。
FIG. 3 shows an example when the
レンズ装置160の焦点距離は、レンズ装置160が有する可動レンズを変位させることで調整される。レンズ装置160のフォーカス位置は、レンズ装置160が有する可動レンズを変位させることで調整される。可動レンズが変位することで、レンズ装置160の重心位置が変化する。レンズ装置160の重心位置は、可動レンズの変位の他に、可動レンズを保持する可動鏡筒やレンズ枠の変位によって変化する。レンズ装置160の重心位置が変化することによって、UAV100の重心位置が変化する。
The focal length of the
G1は、UAV100が図1の状態にある場合のUAV100の重心位置を示す。G2は、UAV100が図3の状態にある場合のUAV100の重心位置を示す。UAV100が図1に示される状態から、レンズ装置160をテレ端の状態に変化させた場合、レンズ装置160の重心位置の変化によって、UAV100の重心位置はG1の位置からG2の位置に変化する。そのため、レンズ装置160をテレ端の状態にした場合においても、UAV100の姿勢が変化しないようにするためには、例えば回転翼108aの回転速度を低下させ、回転翼108bの回転速度を上昇させる必要がある。
G1 indicates the position of the center of gravity of the
制御部180は、センサ120によるUAV100の姿勢の検出値を用いるフィードバック制御により、UAV100の姿勢を制御する。例えば、制御部180は、PID制御により、UAV100の姿勢を制御する。これにより、例えばUAV100の姿勢の変化が生じると、UAV100の姿勢の変化をキャンセルするように回転翼108の回転速度を増減させる。
The
制御部180は、フィードバック制御に加えて、レンズ装置160の可動レンズの変位に基づくフィードフォワード制御により、UAV100の姿勢を制御する。具体的には、予測部130は、可動レンズの変位により生じるレンズ装置160の重心位置の変化量と、レンズ装置160の質量とを用いて、UAV100の姿勢の変化を予測する。制御部180は、予測されたUAV100の姿勢の変化に応じたフィードフォワード補償値を、レンズ装置160の可動レンズの変位に同期して、PID制御の入力に加算する。これにより、レンズ装置160の重心位置の変化分を事前に計算して回転翼108の回転速度を速やかに制御することができる。そのため、フィードフォワード制御を用いずにフィードバック制御のみを用いる場合に比べて、レンズ装置160の重心位置の変化に起因して生じるUAV100の揺れを抑制することができる。
The
図4は、メモリ163に格納されるレンズ情報の一例を示す。レンズ情報は、レンズ種別ID、質量情報、及び重心情報を含む。レンズ種別IDは、例えばレンズの型番である。質量情報は、レンズ装置160の質量を示す情報である。重心情報は、レンズ装置160の重心位置を示す情報である。
FIG. 4 shows an example of lens information stored in the
図5は、重心情報の一例を示す。重心情報は、レンズ位置及びレンズ位置に対応する重心位置を含む。レンズ装置160が1つの可動レンズを有する場合、レンズ位置は、当該1つの可動レンズの位置を示す。重心位置は、対応するレンズ位置に可動レンズがある場合のレンズ装置160の重心位置を示す。レンズ装置160が2以上の可動レンズを有する場合、レンズ位置は、当該2以上の可動レンズのそれぞれの位置を示す。重心位置は、対応するレンズ位置が示す各可動レンズの位置にそれぞれの可動レンズがある場合のレンズ装置160の重心位置を示す。このように、重心情報は、複数のレンズ位置にそれぞれレンズ装置160の重心位置を対応づける。
FIG. 5 shows an example of centroid information. The centroid information includes a lens position and a centroid position corresponding to the lens position. When the
重心位置は、予め定められた基準位置を原点とした場合のレンズ装置160の重心位置の座標であってよい。基準位置は、例えば、撮像部140の撮像素子144の位置であってよい。基準位置は、レンズ装置160の光軸上に設けられてよい。重心位置は、光軸に沿って測定される、撮像素子144からの距離であってよい。レンズ装置160が交換レンズである場合、基準位置は、レンズ装置160をマウントする撮像部140のマウント面内に設けられてよい。
The barycentric position may be coordinates of the barycentric position of the
UAV制御部104において、第2取得部172は、メモリ163に格納されているレンズ情報を、レンズ制御部162及び撮像制御部142を通じて取得する。例えば、第2取得部172は、取得したレンズ情報をメモリ106に格納する。メモリ106に格納されたレンズ情報は、予測部130及び制御部180の処理に用いられる。
In the UAV control unit 104, the
図6は、UAV100におけるUAV100の姿勢制御に関するブロック線図の一例を示す。ブロック線図は、加え合わせ点200、伝達要素210、伝達要素220、伝達要素230、加え合わせ点202、伝達要素240、作用素250、伝達要素260、伝達要素270、伝達要素280、及び加え合わせ点204を含む。
FIG. 6 shows an example of a block diagram regarding the attitude control of the
図6のブロック線図において、制御対象は、伝達要素230で表されるUAV100である。制御量は、UAV100の姿勢角の角速度又はUAV100の姿勢角である。UAV100の姿勢角の角速度は、伝達要素240で表されるセンサ120により検出される。センサ120による検出値の状態変数は、積分要素である作用素250によって姿勢角の状態変数に変換される。
In the block diagram of FIG. 6, the control target is the
Rは、UAV100の姿勢角の目標値の状態変数を表す。加え合わせ点200は、目標値の状態変数の加算を行う。加え合わせ点200は、作用素250の出力の状態変数の減算を行う。伝達要素210は、制御部180のPID制御を表す。具体的には、伝達要素210は、制御部180が誤差信号に基づいて、ドライバ107に対する駆動信号を生成する動作を表す。伝達要素220は、ドライバ107が駆動信号に基づいてモータ109の駆動電流を生成する動作を表す伝達要素である。伝達要素230は、モータ109が駆動電流により駆動されて回転翼108が回転して、UAV100の姿勢角の角速度が変化する現象を表す。加え合わせ点202は、UAV100の姿勢角の角速度の状態変数に、回転翼108以外の作用で生じる姿勢角の角速度の状態変数を加算する。伝達要素210、伝達要素220、伝達要素230、加え合わせ点202、伝達要素240、作用素250、加え合わせ点200により、フィードバック制御系を形成する。
R represents a state variable of the target value of the posture angle of the
伝達要素260は、レンズ制御部162が可動レンズを変位させる第1情報を出力する動作を表す。第1情報に応じて可動レンズが変位すると、レンズ装置160の重心位置が変化する。レンズ装置160の重心位置の変化により、UAV100の姿勢角の角速度が変化する。伝達要素270は、第1情報の出力により、レンズ装置160の重心位置が変化して、UAV100の姿勢角の角速度が変化する現象を表す。加え合わせ点204は、姿勢角の角速度の変化量の状態変数の加算を行う。加え合わせ点204は、外乱による姿勢角の角速度の変化量を表す状態変数の加算を行う。外乱としては、風等によるUAV100の姿勢角の変化を例示できる。加え合わせ点204が出力する状態変数は、加え合わせ点202において、伝達要素230が出力するUAV100の姿勢角の角速度の状態変数に加算される。
The
伝達要素280は、予測部130が第1情報に基づいてUAV100の姿勢角の変化量の予測値を生成する動作を表す。加え合わせ点200は、予測部130が生成した予測値を示す状態変数の加算を行う。このように、伝達要素280により生成される予測値の状態変数は、フィードフォワード補償値として制御ループの入力に加算される。
The
図7は、UAV100の姿勢を制御する制御フローの一例を示すフローチャートである。S310において、レンズ制御部162は、可動レンズに対し第1情報を出力する。第1情報は、レンズ装置160の可動レンズを変位させることを示す情報である。
FIG. 7 is a flowchart illustrating an example of a control flow for controlling the attitude of the
例えば、レンズ制御部162は、レンズ装置160の焦点距離を変更する命令を撮像制御部142から取得すると、レンズ装置160が有する1以上の可動レンズの変位先の位置である将来位置と、変位タイミングとを決定する。可動レンズの将来位置は、焦点距離により定まる。変位タイミングは、可動レンズが変位を開始する時刻であってよい。例えば、レンズ制御部162は、30ms後に可動レンズの変位を開始することを決定する。変位タイミングは、可動レンズが変位を終了する時刻であってよい。第1情報は、可動レンズの将来位置と、変位タイミングとを示す情報を含む。第1情報は、撮像制御部142を通じてUAV制御部104にも出力される。
For example, when the
S320において、第1情報に基づいて、可動レンズが変位する。S330において、制御部180は、可動レンズが変位するタイミングで第2情報をPID制御に出力する。第2情報は、フィードフォワード補償値を示す情報である。S330における処理の一例は、図8に関連して説明する。
In S320, the movable lens is displaced based on the first information. In S330, the
S340において、センサ120がジンバル110の角速度を検出することにより、UAV100の姿勢角の角速度を検出する。S350において、ドライバ107が、回転翼108の回転速度を制御する。例えば、制御部180のPID制御には、UAV100の姿勢角の目標値とフィードフォワード補償値との加算値と、センサ120によるUAV100の姿勢角の検出値との誤差信号が入力される。制御部180のPID制御において、誤差信号に基づいてドライバ107の駆動信号が生成される。ドライバ107が駆動信号に従ってモータ109を駆動することにより、回転翼108の回転速度が制御される。
In S340, the
図8は、UAV制御部104が第1情報の受信から第2情報をPID制御に出力するまでの制御フローの一例を示すフローチャートである。S400において、第1取得部170は、第1情報を受信する。S410において、第1取得部170は、レンズ装置160の可動レンズの現在位置、将来位置、変位速度、変位開始時刻及びUAV100の姿勢角を取得する。第1取得部170は、可動レンズの現在位置及び変位速度をレンズ制御部162から取得する。
FIG. 8 is a flowchart illustrating an example of a control flow from when the UAV control unit 104 receives the first information until it outputs the second information to the PID control. In S400, the
S410において、予測部130は、可動レンズの停止時刻を算出する。停止時刻は、可動レンズの変位が終了する時刻である。予測部130は、レンズ装置160の可動レンズの現在位置、将来位置及び変位速度に基づいて、可動レンズの停止時刻を算出する。
In S410, the
S430において、予測部130は、現在時刻が可動レンズの停止時刻に一致する又は現在時刻が可動レンズの停止時刻を過ぎたかを判断する。現在時刻が可動レンズの停止時刻に一致する又は現在時刻が可動レンズの停止時刻を過ぎた場合は、制御フローを終了する。現在時刻が可動レンズの停止時刻より前である場合は、S440に処理を進める。
In S430, the
S440において、予測部130は、主制御ループのフレーム時間を取得する。主制御ループは、例えば、図6に示すフィードバックループである。フレーム時間は、フィードバックループにおける制御周期である。
In S440, the
S450において、予測部130は、可動レンズの変位開始時刻と停止時刻との間の各フレームにおいて、UAV100の姿勢角の変化量の予測値を生成する。例えば、変位開始時刻から変位終了時刻までの期間が10msであり、フレーム時間が1msである場合、予測部130は、10フレームの各フレームにおいて、UAV100の姿勢角の変化量の予測値を生成する。各フレームにおけるUAV100の姿勢角の変化量の予測値は、各フレームにおけるフィードフォワード補償値の一例である。
In S450, the
予測部130は、各フレームにおける姿勢角の変化量を、レンズ装置160の現在の重心位置からの重心位置の変化量及びレンズ装置160の質量に基づいて、予測する。予測部130は、レンズ装置160の質量を図4に示すレンズ情報から特定する。予測部130は、レンズ装置160の重心位置の変化量を、図5に示す重心情報を用いて特定する。例えば、予測部130は、現在の可動レンズの位置に基づいて、レンズ装置160の現在の重心位置を特定する。予測部130は、各フレームにおける可動レンズの位置に基づいて、各フレームにおけるレンズ装置160の重心位置を特定する。予測部130は、各フレームにおけるレンズ装置160の重心位置と、レンズ装置160の現在の重心位置とに基づいて、各フレームにおける重心位置の変化量を特定する。
The
S460において、制御部180は、現在時刻が可動レンズの変位開始時刻より前であるか否かを判断する。現在時刻が可動レンズの変位開始時刻より前である場合、現在時刻が可動レンズの変位開始時刻に一致する又は現在時刻が可動レンズの変位開始時刻を超えるまで、S460の判断を繰り返す。現在時刻が可動レンズの変位開始時刻に一致する又は現在時刻が可動レンズの変位開始時刻を超えた場合、S470に処理を進める。
In S460,
S470において、制御部180は、予測部130がS450で予測した各フレームにおける姿勢角の変化量の予測値の出力を開始する。例えば、制御部180は、予測部130が予測した各フレームにおける姿勢角の変化量の予測値を、対応するフレームにおいてPID制御へ出力する。姿勢角の変化量の予測値の出力を開始するフレームは、変位開始時刻に対応するフレームでなくてよい。姿勢角の変化量の予測値の出力を開始するフレームは、変位開始時刻に対応するフレームより後のフレームであってよい。フィードバックループにおけるフレームとの対応関係が保たれていれば、変位開始時刻に対応するフレームより後のフレームから、姿勢角の変化量の予測値の出力を開始してよい。制御部180は、変位停止時刻に対応するフレームにおいて姿勢角の変化量の予測値を出力すると、制御フローを終了する。
In S470, the
図9は、撮像装置190の向きが変化した状態の一例を示す。図9が示す撮像装置190の状態は、図1が示す撮像装置190の状態とは異なる。例えば、図9は、撮像装置190のピッチ角が変化した状態にある。この点を除いて、図9が示すUAV100の状態は、図1が示す状態と同じである。
FIG. 9 shows an example of a state in which the orientation of the
G3は、UAV100が図9の状態にある場合のUAV100の重心位置を示す。UAV100が図1に示される状態から、撮像装置190のピッチ角を図9の状態に変化させた場合、UAV100の重心位置はG1の位置からG3の位置に変化する。そのため、UAV100の姿勢が変化しないようにするためには、例えば回転翼108aの回転速度を上昇させ、回転翼108bの回転速度を低下させる必要がある。
G3 indicates the position of the center of gravity of the
制御部180は、レンズ装置160の重心位置が変化した場合と同様に、撮像装置190の向きの変化に基づくフィードフォワード制御により、UAV100の姿勢を制御する。具体的には、予測部130は、撮像部140の向きの変化により生じる撮像部140及びレンズ装置160の重心位置の変化量と、撮像部140の質量と、レンズ装置160の質量とを用いて、UAV100の姿勢の変化を予測する。このように、予測部130は、撮像装置190の向きの変化により生じる撮像装置190の重心位置の変化量と、撮像装置190の質量とを用いて、UAV100の姿勢の変化量を予測する。UAV100の姿勢の変化量の予測値は、フィードフォワード補償値として生成される。
The
制御部180は、生成したフィードフォワード補償値を、撮像装置190の向きの変化に同期して、PID制御の入力に加算する。これにより、撮像装置190の重心位置の変化分を事前に計算して回転翼108の回転速度を速やかに制御することができる。そのため、フィードフォワード制御を用いずにフィードバック制御のみを用いる場合に比べて、UAV100の揺れを抑制することができる。
The
図9に関連して、ピッチ角の変化により生じる撮像装置190の重心位置の変化を説明した。ピッチ角の変化だけでなく、ヨー角の変化によっても撮像装置190の重心位置が変化する。したがって、撮像装置190の重心位置は、ピッチ角及びヨー角の組み合わせによって変化する。本実施形態では、ロール角の変化によっては変化しないとする。撮像装置190の重心位置がロール軸上にある場合は、ロール角の変化によっては撮像装置190の重心位置は変化しない。
With reference to FIG. 9, the change in the gravity center position of the
図10は、メモリ146に格納される撮像部情報の一例を示す。撮像部情報は、撮像部種別ID、質量情報、及び重心位置情報を含む。撮像部種別IDは、例えば撮像部140の型番である。質量情報は、撮像部140の質量を示す情報である。重心位置情報は、撮像部140の重心位置を示す情報である。
FIG. 10 shows an example of imaging unit information stored in the
重心位置は、予め定められた基準位置を原点として表される座標であってよい。基準位置は、例えば、ジンバル110が撮像部140を把持する把持位置であってよい。基準位置は、ピッチ軸上に設けられてよい。
The barycentric position may be coordinates expressed with a predetermined reference position as an origin. The reference position may be a grip position where the
UAV制御部104において、第2取得部172は、メモリ146に格納される撮像部情報を、撮像制御部142を通じて取得する。例えば、第2取得部172は、取得した撮像部情報をメモリ106に格納する。メモリ106に格納された撮像部情報は、予測部130及び制御部180の処理に用いられる。
In the UAV control unit 104, the
予測部130及び制御部180は、図4及び図5に示すレンズ情報及び図10に示す撮像部情報に基づいて、レンズ装置160の可動レンズの位置、ピッチ角、及びヨー角の組み合わせにおける撮像装置190の重心位置を算出できる。予測部130及び制御部180は、図4に示すレンズ情報及び図10に示す撮像部情報に基づいて、撮像装置190の質量を算出できる。予測部130及び制御部180は、レンズ装置160の可動レンズの位置及び撮像装置190の向きの少なくとも一方を変化させる場合における、重心位置の変化を算出できる。これにより、予測部130及び制御部180は、レンズ装置160の可動レンズの位置及び撮像装置190の向きの少なくとも一方を変化させる場合において予測される重心位置の変化を算出できる。予測部130及び制御部180は、算出した撮像装置190の重心位置の変化及び撮像装置190の質量に基づいて、UAV100の姿勢角の変化又は姿勢角の角速度の変化を予測できる。
Based on the lens information shown in FIGS. 4 and 5 and the imaging unit information shown in FIG. 10, the
撮像装置190の向きの変化に対応する制御系は、図6に示す制御系に、撮像装置190の向きの変化に関する状態変数及び伝達要素を加えることで実現できる。
The control system corresponding to the change in the orientation of the
撮像装置190の向きの変化に対応する制御フローは、図7及び図8に示す制御フローにおけるレンズの変位に関する制御に加えて、撮像装置190の向きの変化に関する制御を加えることで実現できる。例えば、図7に示す制御フローにおいては、第1情報として、可動レンズの変位及び撮像装置190の変向を示す情報を適用すればよい。図8に示す制御フローにおいては、可動レンズの位置及び変位速度に加えて、撮像装置190の向き及び変向速度に関する制御を適用すればよい。
The control flow corresponding to the change in the orientation of the
上記の実施形態において、レンズ装置160は、交換レンズである。しかし、レンズ装置160は、撮像部140と一体的に設けられてよい。この形態において、レンズ装置160及び撮像部140を含む撮像装置190は、ジンバル110に着脱可能であってよい。
In the above embodiment, the
レンズ装置160が撮像部140と一体的に設けられる形態において、レンズ装置160及び撮像部140を含む撮像装置190は、ジンバル110に着脱可能でなくてよい。撮像装置190は、ジンバル110に固定されていてよい。
In the form in which the
上記の実施形態における可動レンズ及び撮像装置190は、変位部の一例である。レンズ装置160が可動レンズを有しない場合、又は、可動レンズの変位によるUAV100の重心位置の変化量が予め定められた値より小さい場合、撮像装置190のみが変位部である形態を採用できる。撮像装置190の向きが固定である場合、又は、撮像装置190の向きの変化によるUAV100の重心位置の変化量が予め定められた値より小さい場合、レンズ装置160のみが変位部である形態を採用できる。
The movable lens and
変位部は、可動レンズ及び撮像装置190以外の部材であってよい。例えば、変位部は、可動アーム等の部材であってよい。変位部は、UAV100に取り付けられた部材に限られない。変位部は、UAV100が把持した部材を含んでよい。UAV100が能動的に変位させることができる部材であれば、どのような部材も変位部とみなすことができる。
The displacement part may be a member other than the movable lens and the
上記の実施形態に示される複数の段階の少なくとも1つの段階は、ハードウェア、又は関連するハードウェアに命令するプログラムによって実装されてよい。プログラムは、コンピュータが可読な記録媒体に格納されてよい。記録媒体は、ROM、磁気ディスク、及び光ディスクの少なくとも1つを含んでよい。 At least one of the steps shown in the above embodiments may be implemented by hardware or a program instructing related hardware. The program may be stored in a computer-readable recording medium. The recording medium may include at least one of a ROM, a magnetic disk, and an optical disk.
以上、本発明を実施の形態を用いて説明したが、本発明の技術的範囲は上記実施の形態に記載の範囲には限定されない。上記実施の形態に、多様な変更又は改良を加えることが可能であることが当業者に明らかである。その様な変更又は改良を加えた形態も本発明の技術的範囲に含まれ得ることが、特許請求の範囲の記載から明らかである。 As mentioned above, although this invention was demonstrated using embodiment, the technical scope of this invention is not limited to the range as described in the said embodiment. It will be apparent to those skilled in the art that various modifications or improvements can be added to the above embodiment. It is apparent from the description of the scope of claims that embodiments with such changes or improvements can be included in the technical scope of the present invention.
特許請求の範囲、明細書、及び図面中において示した装置、システム、プログラム、及び方法における動作、手順、ステップ、及び段階等の各処理の実行順序は、特段「より前に」、「先立って」等と明示しておらず、前の処理の出力を後の処理で用いるのでない限り、任意の順序で実現可能である。特許請求の範囲、明細書、及び図面中の動作フローに関して、便宜上「まず、」、「次に、」等を用いて説明したとしても、この順で実施することが必須であることを意味するものではない。「垂直」との記載は、「交わる」状態であってもよい。 The execution order of each process such as operation, procedure, step, and stage in the apparatus, system, program, and method shown in the claims, the description, and the drawings is particularly “before” or “prior to”. ”And the like, and can be realized in any order unless the output of the previous process is used in the subsequent process. Regarding the operation flow in the claims, the specification, and the drawings, even if it is described using “first”, “next”, etc. for the sake of convenience, it means that it is essential to carry out in this order. It is not a thing. The description of “vertical” may be “intersecting”.
100 UAV
101 UAV本体
102 通信インタフェース
104 UAV制御部
105 検出部
106 メモリ
107 ドライバ
108 回転翼
109 モータ
110 ジンバル
120 センサ
130 予測部
140 撮像部
142 撮像制御部
144 撮像素子
146 メモリ
160 レンズ装置
162 レンズ制御部
163 メモリ
164、166、168 レンズ
170 第1取得部
172 第2取得部
180 制御部
188 確認部
190 撮像装置
200、202、204 加え合わせ点
210、220、230、240、260、270、280 伝達要素
250 作用素
100 UAV
101 UAV
190
250 operator
Claims (19)
前記変位部の質量及び前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する予測部と、
前記予測部が予測した前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する制御部と
を備える制御装置。 A first acquisition unit for acquiring first information indicating a position of a displacement destination of the displacement unit held so as to be displaceable with respect to the main body unit;
Based on the mass of the displacement part and the first information, a prediction part that predicts the posture of the main body part after the displacement part is displaced to the position of the displacement destination;
And a control unit that controls the posture of the main body based on the posture of the main body predicted by the prediction unit.
請求項1に記載の制御装置。 Based on the posture of the main body predicted by the prediction unit, the control unit suppresses a change in the posture of the main body caused by the displacement of the displacement portion being displaced to the position of the displacement destination. The control device according to claim 1 , wherein the control device controls the posture of the main body.
前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する予測部と、
前記予測部が予測した前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する制御部と
を備え、
前記予測部は、前記変位部が変位前の位置から前記変位先の位置まで変位するまでの期間内の複数のタイミングのそれぞれにおける前記変位部の位置を予測し、予測した複数の前記位置のそれぞれについて前記本体部の姿勢を予測し、
前記制御部は、前記複数のタイミングのそれぞれにおいて、それぞれのタイミングにおける前記変位部の位置について前記予測部が予測した前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する
制御装置。 A first acquisition unit for acquiring first information indicating a position of a displacement destination of the displacement unit held so as to be displaceable with respect to the main body unit;
A predicting unit that predicts the posture of the main body after the displacement unit is displaced to the position of the displacement destination based on the first information;
A control unit that controls the posture of the main body based on the posture of the main body predicted by the prediction unit;
With
The prediction unit predicts the position of the displacement unit at each of a plurality of timings within a period until the displacement unit is displaced from the position before displacement to the position of the displacement destination, and each of the plurality of predicted positions Predict the posture of the main body with respect to
The said control part is a control apparatus which controls the attitude | position of the said main-body part based on the attitude | position of the said main-body part which the said estimation part estimated about the position of the said displacement part in each timing in each of these several timings.
前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する予測部と、
前記本体部の姿勢の目標値と、前記本体部の姿勢を取得するためのセンサによる前記本体部の姿勢の検出値と、前記予測部が予測した前記本体部の姿勢とに基づいて、前記本体部の姿勢を制御する制御部と
を備える制御装置。 A first acquisition unit for acquiring first information indicating a position of a displacement destination of the displacement unit held so as to be displaceable with respect to the main body unit;
A predicting unit that predicts the posture of the main body after the displacement unit is displaced to the position of the displacement destination based on the first information;
Based on the target value of the posture of the main body, the detected value of the posture of the main body by a sensor for acquiring the posture of the main body, and the posture of the main body predicted by the prediction unit A control unit for controlling the posture of the unit
A control device comprising:
前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する予測部と、
前記予測部が予測した前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する制御部と
を備え、
前記変位部は、可動レンズを含む
制御装置。 A first acquisition unit for acquiring first information indicating a position of a displacement destination of the displacement unit held so as to be displaceable with respect to the main body unit;
A predicting unit that predicts the posture of the main body after the displacement unit is displaced to the position of the displacement destination based on the first information;
A control unit that controls the posture of the main body based on the posture of the main body predicted by the prediction unit;
With
The said displacement part is a control apparatus containing a movable lens.
請求項5に記載の制御装置。 The control device according to claim 5 , wherein the first information includes information indicating a displacement destination position of the movable lens corresponding to a focal length of a lens system including the movable lens.
請求項5又は6に記載の制御装置。 The control device according to claim 5 or 6 , wherein the first information includes information indicating a displacement destination position of the movable lens corresponding to a focus position of a lens system including the movable lens.
をさらに備え、
前記予測部は、前記第1情報が示す前記可動レンズの変位先の位置に対応づけて前記格納部が格納している前記重心位置と、前記レンズ装置の質量とに基づいて、前記第1情報が示す前記可動レンズの変位先の位置に前記可動レンズが変位した後の前記本体部の姿勢を予測する
請求項6又は7に記載の制御装置。 A storage unit that stores the position of the center of gravity of the lens device including the lens system in association with a plurality of positions of the movable lens;
The prediction unit is configured to associate the first information based on the position of the center of gravity stored in the storage unit in association with the position of the displacement destination of the movable lens indicated by the first information and the mass of the lens device. control device according to claim 6 or 7 for predicting the posture of the main body portion after said movable lens is displaced in the displacement destination position of the movable lens indicated.
前記制御装置は、
前記本体部に装着されている前記交換レンズから、前記交換レンズの焦点距離及びフォーカス位置の少なくとも一方に対応する前記交換レンズの重心位置及び前記交換レンズの質量を示す第2情報を取得する第2取得部
を備える請求項5から8のいずれか一項に記載の制御装置。 The movable lens is included in a lens system of an interchangeable lens that can be attached to and detached from the main body.
The controller is
Second information is acquired from the interchangeable lens mounted on the main body to obtain second information indicating the position of the center of gravity of the interchangeable lens and the mass of the interchangeable lens corresponding to at least one of the focal length and the focus position of the interchangeable lens. The control device according to any one of claims 5 to 8, further comprising an acquisition unit.
前記第1情報に基づいて、前記撮像装置が前記変位先の位置に変位した後の前記本体部の姿勢を予測する予測部と、
前記予測部が予測した前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する制御部と
を備える制御装置。 A first acquisition unit that acquires first information indicating a position of a displacement destination of the imaging device that is held displaceably with respect to the main body;
A prediction unit that predicts the posture of the main body after the imaging device is displaced to the position of the displacement destination based on the first information;
A control unit that controls the posture of the main body based on the posture of the main body predicted by the prediction unit;
A control device comprising:
前記撮像装置の変位は、前記撮像装置の向きの変化である
請求項10に記載の制御装置。 The imaging device is provided with a variable orientation with respect to the main body,
Displacement of the imaging device, the control device according to claim 10 wherein the change in orientation of the imaging device.
前記制御装置は、
前記本体部に装着されている前記撮像装置から、前記撮像装置の重心位置及び前記撮像装置の質量を示す第2情報を取得する第2取得部
を備える請求項10又は11に記載の制御装置。 The imaging device is detachable from the main body,
The controller is
The control device according to claim 10 or 11 , further comprising: a second acquisition unit that acquires second information indicating a gravity center position of the imaging device and a mass of the imaging device from the imaging device mounted on the main body.
前記本体部と
を備える移動体。 Moving body and a main body portion and a control device according to any one of claims 1 to 12.
前記変位部の質量及び前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する段階と、
前記予測する段階で予測された前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する段階と
を備える制御方法。 Obtaining first information indicating a position of a displacement destination of a displacement portion held so as to be displaceable with respect to the main body portion;
Predicting the posture of the main body after the displacement portion is displaced to the position of the displacement destination based on the mass of the displacement portion and the first information;
A control method comprising: controlling the posture of the main body based on the posture of the main body predicted in the predicting step.
前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する段階と、 Predicting the posture of the main body after the displacement portion is displaced to the position of the displacement destination based on the first information;
前記予測する段階で予測された前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する段階と Controlling the posture of the main body based on the posture of the main body predicted in the predicting step;
を備え、With
前記予測する段階は、前記変位部が変位前の位置から前記変位先の位置まで変位するまでの期間内の複数のタイミングのそれぞれにおける前記変位部の位置を予測し、予測した複数の前記位置のそれぞれについて前記本体部の姿勢を予測し、 The step of predicting predicts the position of the displacement part at each of a plurality of timings within a period until the displacement part is displaced from the position before displacement to the position of the displacement destination. Predict the posture of the body for each,
前記制御する段階は、前記複数のタイミングのそれぞれにおいて、それぞれのタイミングにおける前記変位部の位置について前記予測する段階で予測された前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する The controlling step controls the posture of the main body at each of the plurality of timings based on the posture of the main body predicted in the step of predicting the position of the displacement portion at each timing.
制御方法。Control method.
前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する段階と、 Predicting the posture of the main body after the displacement portion is displaced to the position of the displacement destination based on the first information;
前記本体部の姿勢の目標値と、前記本体部の姿勢を取得するためのセンサによる前記本体部の姿勢の検出値と、前記予測する段階で予測された前記本体部の姿勢とに基づいて、前記本体部の姿勢を制御する段階と Based on the target value of the posture of the main body, the detected value of the posture of the main body by a sensor for obtaining the posture of the main body, and the posture of the main body predicted in the prediction step, Controlling the posture of the body part;
を備える制御方法。A control method comprising:
前記第1情報に基づいて、前記変位部が前記変位先の位置に変位した後の前記本体部の姿勢を予測する段階と、 Predicting the posture of the main body after the displacement portion is displaced to the position of the displacement destination based on the first information;
前記予測する段階で予測された前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する段階と Controlling the posture of the main body based on the posture of the main body predicted in the predicting step;
を備え、With
前記変位部は、可動レンズを含む The displacement part includes a movable lens.
制御方法。Control method.
前記第1情報に基づいて、前記撮像装置が前記変位先の位置に変位した後の前記本体部の姿勢を予測する段階と、 Predicting the posture of the main body after the imaging device is displaced to the position of the displacement destination based on the first information;
前記予測する段階で予測された前記本体部の姿勢に基づいて、前記本体部の姿勢を制御する段階と Controlling the posture of the main body based on the posture of the main body predicted in the predicting step;
を備える制御方法。A control method comprising:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016118003A JP6026695B1 (en) | 2016-06-14 | 2016-06-14 | Control device, moving body, control method, and program |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016118003A JP6026695B1 (en) | 2016-06-14 | 2016-06-14 | Control device, moving body, control method, and program |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016201100A Division JP6501080B2 (en) | 2016-10-12 | 2016-10-12 | Unmanned aerial vehicle, unmanned aerial vehicle control method and program |
Publications (2)
Publication Number | Publication Date |
---|---|
JP6026695B1 true JP6026695B1 (en) | 2016-11-16 |
JP2017224094A JP2017224094A (en) | 2017-12-21 |
Family
ID=57326596
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2016118003A Expired - Fee Related JP6026695B1 (en) | 2016-06-14 | 2016-06-14 | Control device, moving body, control method, and program |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6026695B1 (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106843245A (en) * | 2016-12-01 | 2017-06-13 | 北京京东尚科信息技术有限公司 | A kind of UAV Attitude control method, device and unmanned plane |
JP2018125699A (en) * | 2017-01-31 | 2018-08-09 | キヤノンマーケティングジャパン株式会社 | Information processing unit and control method and program of information processing unit |
WO2018185940A1 (en) * | 2017-04-07 | 2018-10-11 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッド | Imaging control device, imaging device, imaging system, mobile body, imaging control method and program |
WO2022160175A1 (en) * | 2021-01-28 | 2022-08-04 | 深圳市大疆创新科技有限公司 | Control method and unmanned aerial vehicle |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05158540A (en) * | 1991-12-06 | 1993-06-25 | Fujitsu Ltd | Arm control system for spacecraft, and attitude control system for spacecraft with arm |
JP2009107032A (en) * | 2007-10-26 | 2009-05-21 | Toyota Motor Corp | Legged robot and its control method |
JP2011239301A (en) * | 2010-05-12 | 2011-11-24 | Ricoh Co Ltd | Camera system, camera body unit, external unit, and control method of camera system |
-
2016
- 2016-06-14 JP JP2016118003A patent/JP6026695B1/en not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05158540A (en) * | 1991-12-06 | 1993-06-25 | Fujitsu Ltd | Arm control system for spacecraft, and attitude control system for spacecraft with arm |
JP2009107032A (en) * | 2007-10-26 | 2009-05-21 | Toyota Motor Corp | Legged robot and its control method |
JP2011239301A (en) * | 2010-05-12 | 2011-11-24 | Ricoh Co Ltd | Camera system, camera body unit, external unit, and control method of camera system |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106843245A (en) * | 2016-12-01 | 2017-06-13 | 北京京东尚科信息技术有限公司 | A kind of UAV Attitude control method, device and unmanned plane |
CN106843245B (en) * | 2016-12-01 | 2022-02-01 | 北京京东乾石科技有限公司 | Unmanned aerial vehicle attitude control method and device and unmanned aerial vehicle |
JP2018125699A (en) * | 2017-01-31 | 2018-08-09 | キヤノンマーケティングジャパン株式会社 | Information processing unit and control method and program of information processing unit |
WO2018185940A1 (en) * | 2017-04-07 | 2018-10-11 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッド | Imaging control device, imaging device, imaging system, mobile body, imaging control method and program |
JPWO2018185940A1 (en) * | 2017-04-07 | 2019-04-11 | エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd | Imaging control apparatus, imaging apparatus, imaging system, moving object, imaging control method, and program |
WO2022160175A1 (en) * | 2021-01-28 | 2022-08-04 | 深圳市大疆创新科技有限公司 | Control method and unmanned aerial vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP2017224094A (en) | 2017-12-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20220066439A1 (en) | Adaptive rate gain controller | |
CN108549399B (en) | Aircraft yaw angle correction method and device and aircraft | |
JP6026695B1 (en) | Control device, moving body, control method, and program | |
WO2017206072A1 (en) | Pan-tilt control method and apparatus, and pan-tilt | |
CN108521814B (en) | Control method and controller of cloud deck and cloud deck | |
WO2020042159A1 (en) | Rotation control method and apparatus for gimbal, control device, and mobile platform | |
JP6501080B2 (en) | Unmanned aerial vehicle, unmanned aerial vehicle control method and program | |
CN105045293A (en) | Cradle head control method, external carrier control method and cradle head | |
WO2019210467A1 (en) | Pan-tilt control method and apparatus, pan-tilt system, unmanned aerial vehicle and computer-readable storage medium | |
WO2019126932A1 (en) | Cradle head control method and control device | |
CN109725652B (en) | Method for resolving and controlling course of unmanned aerial vehicle holder | |
JP6318455B1 (en) | Control device, imaging device, moving object, control method, and program | |
WO2020019113A1 (en) | Method for controlling mobile robot, device, and mobile robot system | |
JP6103672B1 (en) | Control device, imaging device, moving object, control method, and program | |
JP2019082539A (en) | Control device, lens device, flying body, control method, and program | |
JP2019041536A (en) | Control apparatus, imaging apparatus, moving body, control method, and program | |
JP2018078433A (en) | Mobile imaging device and control method thereof, and imaging apparatus and control method thereof, drone, program, recording medium | |
JP6146520B1 (en) | Optical apparatus, moving body, holding position adjusting method, and program | |
JP6888215B2 (en) | Control devices, imaging devices, imaging systems, moving objects, control methods, and programs | |
JP6331180B1 (en) | Control device, imaging device, imaging system, flying object, control method, and program | |
JP2020020878A (en) | Moving vehicle, focus control method, program, and recording medium | |
US11265456B2 (en) | Control device, photographing device, mobile object, control method, and program for image acquisition | |
WO2018109847A1 (en) | Control device, imaging device, mobile body, control method, and program | |
CN114641746A (en) | Movable platform and control method and device thereof | |
JP6347299B2 (en) | Flight apparatus, method, and program |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20160823 |
|
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: 20160913 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20161012 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6026695 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |