JP7162574B2 - Identification method of controller and frequency characteristics - Google Patents

Identification method of controller and frequency characteristics Download PDF

Info

Publication number
JP7162574B2
JP7162574B2 JP2019128472A JP2019128472A JP7162574B2 JP 7162574 B2 JP7162574 B2 JP 7162574B2 JP 2019128472 A JP2019128472 A JP 2019128472A JP 2019128472 A JP2019128472 A JP 2019128472A JP 7162574 B2 JP7162574 B2 JP 7162574B2
Authority
JP
Japan
Prior art keywords
moving image
mechanical system
frequency
camera
value
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
JP2019128472A
Other languages
Japanese (ja)
Other versions
JP2021015355A (en
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.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
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 Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2019128472A priority Critical patent/JP7162574B2/en
Publication of JP2021015355A publication Critical patent/JP2021015355A/en
Application granted granted Critical
Publication of JP7162574B2 publication Critical patent/JP7162574B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Testing And Monitoring For Control Systems (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position Or Direction (AREA)

Description

本発明は、可動部の制御を行う制御装置および周波数特性の同定方法に関する。 The present invention relates to a control device for controlling a movable part and a frequency characteristic identification method.

電子部品実装機、半導体製造装置などの産業機械では、サーボモータ、リニアモータなどのアクチュエータの駆動により、実装ヘッドなどの可動部を目標位置に移動させる位置決め制御が行われている。また、産業機械には、ワークの形状のばらつき、ワークの変形、装置自体の熱膨張などによって発生する位置決め制御の位置誤差を抑制するために、可動部にカメラが取り付けられる場合がある。産業機械は、カメラが撮影した撮影画像を画像処理することによって得られた、可動部の位置と目標位置との相対位置に基づいて、位置誤差を補正することができる。 2. Description of the Related Art In industrial machines such as electronic component mounters and semiconductor manufacturing apparatuses, positioning control is performed to move a movable part such as a mounting head to a target position by driving actuators such as servo motors and linear motors. Further, in some industrial machines, a camera is attached to a movable part in order to suppress positional errors in positioning control caused by variations in workpiece shape, workpiece deformation, thermal expansion of the device itself, and the like. The industrial machine can correct the position error based on the relative position between the position of the movable part and the target position obtained by image processing the captured image captured by the camera.

また、産業機械の位置決め制御のさらなる高速化および高精度化を実現するために、カメラの撮影画像に基づいて制御対象の機械系の周波数特性を同定する方法が知られている。カメラ撮影の露光時間および画像データの転送時間などの制約により、カメラ撮影の撮影周期は、アクチュエータの制御周期と比較して大きくせざるを得ない。このため、カメラの撮影画像に基づいて制御対象の機械系の周波数特性を同定する方法を用いて位置決め制御を行う場合、カメラ撮影の撮影周期のサンプリング周波数に基づいて算出されるナイキスト周波数以上の周波数帯域の周波数特性を得ることが困難となり、制御に必要な周波数特性を得ることができない場合がある。特許文献1では、制御対象の機械系を2慣性系に近似し、アクチュエータからのフィードバック値を用いて、ナイキスト周波数以上の周波数帯域を含む周波数帯域における機械系の周波数特性を同定する方法が開示されている。 Also, in order to realize further speeding-up and high-precision positioning control of industrial machinery, a method of identifying frequency characteristics of a mechanical system to be controlled based on images captured by a camera is known. Due to restrictions such as the exposure time of camera photography and the transfer time of image data, the photography cycle of camera photography has to be made larger than the control cycle of the actuator. For this reason, when performing positioning control using a method of identifying the frequency characteristics of a mechanical system to be controlled based on an image captured by a camera, frequencies equal to or higher than the Nyquist frequency calculated based on the sampling frequency of the imaging cycle of camera imaging It becomes difficult to obtain the frequency characteristics of the band, and the frequency characteristics required for control may not be obtained. Patent Document 1 discloses a method of approximating a mechanical system to be controlled to a two-inertia system and identifying the frequency characteristics of the mechanical system in a frequency band including a frequency band equal to or higher than the Nyquist frequency using feedback values from actuators. ing.

特開2017-004033号公報JP 2017-004033 A

しかしながら、制御対象の低剛性部位の質量が小さい場合など、制御対象の振動特性がアクチュエータのフィードバック値に反映されにくい制御対象である場合、特許文献1に記載される方法の適用が困難である場合があるという問題があった。 However, in the case where the vibration characteristics of the controlled object are difficult to reflect in the feedback value of the actuator, such as when the mass of the low-rigidity part of the controlled object is small, it is difficult to apply the method described in Patent Document 1. There was a problem that there is

本発明は、上記に鑑みてなされたものであって、アクチュエータのフィードバック値を用いることなくナイキスト周波数よりも高い周波数の周波数特性を同定することができる制御装置を得ることを目的とする。 SUMMARY OF THE INVENTION It is an object of the present invention to provide a control device capable of identifying frequency characteristics at frequencies higher than the Nyquist frequency without using actuator feedback values.

上述した課題を解決し、目的を達成するために、本発明にかかる制御装置は、可動部と、可動部の移動に伴って目標物との相対位置が変化し、目標物の静止画像および目標物の動画像を取得するカメラと、を有する機械系を制御する制御装置であって、カメラの撮影周期に基づくナイキスト周波数よりも高い周波数帯域を含む加振周波数を算出して出力する加振周波数算出部と、加振周波数に基づき加振指令を生成して出力する加振指令生成部と、加振指令に基づき可動部の駆動制御を行う駆動部と、機械系の時間応答および周波数特性の特徴を表す機械系応答特徴量の探索値と加振指令と静止画像とに基づき、カメラの露光時間中の相対位置の変化とカメラのセンサ特性とをシミュレーションすることで模擬動画像を生成する模擬動画像生成部と、動画像と模擬動画像とを比較することで、動画像と模擬動画像との誤差である動画像誤差を算出する動画像比較部と、探索値を変更し、変更された探索値のそれぞれに対応する動画像誤差を取得し、複数の動画像誤差を用いて動画像誤差を最小化する機械系応答特徴量の最適値を探索する探索部と、加振周波数と最適値とに基づき、機械系の周波数特性を算出する周波数特性算出部と、を備えることを特徴とする。 In order to solve the above-described problems and achieve the object, a control device according to the present invention changes the relative position between a movable part and a target as the movable part moves, and A control device for controlling a mechanical system having a camera for capturing a moving image of an object, the excitation frequency calculating and outputting an excitation frequency including a frequency band higher than the Nyquist frequency based on the imaging cycle of the camera A calculation unit, a vibration command generation unit that generates and outputs a vibration command based on the vibration frequency, a drive unit that controls the driving of the movable part based on the vibration command, and the time response and frequency characteristics of the mechanical system. A simulation that generates a simulated moving image by simulating changes in the relative position during the exposure time of the camera and the sensor characteristics of the camera based on the search value of the mechanical system response feature value representing the feature, the vibration command, and the still image. a moving image generation unit; a moving image comparing unit that compares the moving image and the simulated moving image to calculate a moving image error that is an error between the moving image and the simulated moving image; A search unit that obtains the motion image error corresponding to each of the search values and searches for the optimum value of the mechanical system response feature value that minimizes the motion image error using a plurality of motion image errors; and a frequency characteristic calculator that calculates the frequency characteristic of the mechanical system based on the value.

本発明によれば、アクチュエータのフィードバック値を用いることなくナイキスト周波数よりも高い周波数の周波数特性を同定することができる制御装置を得ることができるという効果を奏する。 ADVANTAGE OF THE INVENTION According to this invention, it is effective in the ability to obtain the control apparatus which can identify the frequency characteristic of the frequency higher than a Nyquist frequency, without using the feedback value of an actuator.

実施の形態にかかる制御装置の構成を示す模式図Schematic diagram showing the configuration of a control device according to an embodiment 実施の形態にかかる制御装置の第1の状態を示す図FIG. 4 is a diagram showing a first state of the control device according to the embodiment; 実施の形態にかかる制御装置の第2の状態を示す図FIG. 4 is a diagram showing a second state of the control device according to the embodiment; 実施の形態にかかる制御装置の第3の状態を示す図The figure which shows the 3rd state of the control apparatus concerning embodiment 実施の形態にかかる制御装置の機能ブロックを示す図FIG. 3 is a diagram showing functional blocks of the control device according to the embodiment; 実施の形態にかかる制御回路の構成例を示す図FIG. 4 is a diagram showing a configuration example of a control circuit according to an embodiment; 実施の形態にかかる模擬動画像生成部の内部構成の一例を示すブロック図FIG. 2 is a block diagram showing an example of an internal configuration of a simulated moving image generator according to an embodiment; 実施の形態にかかる校正マークの静止画像の一例を示す図FIG. 4 is a diagram showing an example of a still image of calibration marks according to the embodiment; 実施の形態にかかる模擬動画像の第1の時刻のときの第1の画像を示す図FIG. 4 is a diagram showing a first image at a first time of the simulated moving image according to the embodiment; 実施の形態にかかる模擬動画像の第2の時刻のときの第2の画像を示す図FIG. 10 is a diagram showing a second image at a second time of the simulated moving image according to the embodiment; 実施の形態にかかる模擬動画像の第3の時刻のときの第3の画像を示す図FIG. 10 is a diagram showing a third image at a third time of the simulated moving image according to the embodiment; 実施の形態にかかるフィルタの各ピクセル座標のフィルタ係数を図示した一例を示す図FIG. 4 is a diagram showing an example of filter coefficients for each pixel coordinate of the filter according to the embodiment; 実施の形態にかかる制御装置が位置決め制御をするときのデータの流れを示す図FIG. 4 is a diagram showing the flow of data when the control device according to the embodiment performs positioning control; 実施の形態にかかる制御装置のX軸の周波数特性の同定の手順を示すフローチャート4 is a flowchart showing a procedure for identifying X-axis frequency characteristics of the control device according to the embodiment; 実施の形態にかかる動画像誤差を最小化する機械系応答特徴量を算出する詳細な動作の一例を示すフローチャート4 is a flowchart showing an example of detailed operation for calculating a mechanical system response feature quantity that minimizes moving image error according to the embodiment; 実施の形態にかかる複数の加振データから算出した機械系の周波数特性の一例を示す第1の図FIG. 1 is a first diagram showing an example of frequency characteristics of a mechanical system calculated from a plurality of excitation data according to the embodiment; 実施の形態にかかる複数の加振データから算出した機械系の周波数特性の一例を示す第2の図FIG. 2 is a second diagram showing an example of frequency characteristics of a mechanical system calculated from a plurality of excitation data according to the embodiment;

以下に、本発明の実施の形態にかかる制御装置および周波数特性の同定方法を図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。 A control device and a frequency characteristic identification method according to embodiments of the present invention will be described below in detail with reference to the drawings. In addition, this invention is not limited by this embodiment.

実施の形態.
図1は、実施の形態にかかる制御装置10の構成を示す模式図である。制御装置10は、制御部1と制御部1の制御対象である機械系2とで構成される。本実施の形態では、機械系2は、電子部品を基板上に実装する電子部品実装機である。機械系2は、X軸モータ200と、Y軸モータ201と、可動部となるヘッド部203と、カメラ202と、吸着ノズル204と、プリント基板搬送機構205と、を有する。X軸およびY軸は、水平方向に広がる平面内で互いに直交する軸であり、Z軸は、鉛直方向の軸である。
Embodiment.
FIG. 1 is a schematic diagram showing the configuration of a control device 10 according to an embodiment. The control device 10 is composed of a control unit 1 and a mechanical system 2 that is controlled by the control unit 1 . In this embodiment, the mechanical system 2 is an electronic component mounter that mounts electronic components on a board. The mechanical system 2 has an X-axis motor 200 , a Y-axis motor 201 , a head section 203 that is a movable section, a camera 202 , a suction nozzle 204 , and a printed circuit board transport mechanism 205 . The X-axis and Y-axis are axes perpendicular to each other in a horizontally extending plane, and the Z-axis is the vertical axis.

X軸モータ200およびY軸モータ201は、ヘッド部203の位置を変化させるアクチュエータである。なお、図1ではX軸モータ200とY軸モータ201はリニアモータを想定しているが、回転型のサーボモータとボールねじとを組み合わせるなど、他の直動機構を用いてもよい。 The X-axis motor 200 and the Y-axis motor 201 are actuators that change the position of the head section 203 . Although the X-axis motor 200 and the Y-axis motor 201 are assumed to be linear motors in FIG. 1, other linear motion mechanisms such as a combination of a rotary servomotor and a ball screw may be used.

カメラ202は、ヘッド部203に固定されており、ヘッド部203の移動に伴って移動する。また、カメラ202は、視野内の静止画像および動画像である撮影画像を取得する。 The camera 202 is fixed to the head section 203 and moves as the head section 203 moves. In addition, the camera 202 acquires captured images, which are still images and moving images within the field of view.

ヘッド部203は、電子部品を実装する実装ヘッドであり、X軸モータ200およびY軸モータ201によって、プリント基板206の表面と平行に移動させられる。ヘッド部203は、吸着ノズル204を用いて、電子部品を保持したり、電子部品をプリント基板206上に載置したりする。 The head unit 203 is a mounting head that mounts electronic components, and is moved parallel to the surface of the printed circuit board 206 by the X-axis motor 200 and the Y-axis motor 201 . The head unit 203 uses suction nozzles 204 to hold electronic components and place electronic components on printed circuit boards 206 .

プリント基板搬送機構205は、プリント基板206を搬送する。プリント基板搬送機構205の表面には、あらかじめ定められた形状の校正マーク209が形成されている。校正マーク209は目標物である。カメラ202は、ヘッド部203の移動に伴って校正マーク209との相対位置が変化し、カメラ202の視野内の校正マーク209の静止画像および校正マーク209の動画像を取得する。 The printed circuit board transport mechanism 205 transports the printed circuit board 206 . A calibration mark 209 having a predetermined shape is formed on the surface of the printed circuit board transfer mechanism 205 . A fiducial mark 209 is a target. The camera 202 changes its position relative to the calibration mark 209 as the head unit 203 moves, and obtains a still image of the calibration mark 209 and a moving image of the calibration mark 209 within the field of view of the camera 202 .

図2は、実施の形態にかかる制御装置10の第1の状態を示す図である。図3は、実施の形態にかかる制御装置10の第2の状態を示す図である。図4は、実施の形態にかかる制御装置10の第3の状態を示す図である。図2~4では、ヘッド部203の吸着ノズル204が電子部品208を吸着してから、目標実装位置207に電子部品208を配置するまでの動作を説明する。図2~4では、カメラ202の視野領域をVとして示す。また、図2~4では吸着ノズル204の中心軸をCとして示す。目標実装位置207は、例えば、はんだ付け用の銅箔つまり、ランドの位置であり、図2~4において斜線で示される。図2~4では、制御装置10は、ランドの位置を画像処理によって計測し、後述するデフォルト目標位置P0がランドの位置と一致するようにデフォルト目標位置P0の位置を修正する。 FIG. 2 is a diagram showing the first state of the control device 10 according to the embodiment. FIG. 3 is a diagram showing a second state of the control device 10 according to the embodiment. FIG. 4 is a diagram showing a third state of the control device 10 according to the embodiment. 2 to 4, the operation after the suction nozzle 204 of the head unit 203 picks up the electronic component 208 until the electronic component 208 is arranged at the target mounting position 207 will be described. 2-4, the field of view of camera 202 is indicated as V. FIG. 2 to 4 show the central axis of the suction nozzle 204 as C. As shown in FIG. The target mounting position 207 is, for example, a copper foil for soldering, that is, a land position, and is indicated by hatched lines in FIGS. 2 to 4, the control device 10 measures the position of the land by image processing, and corrects the position of the default target position P0 so that the default target position P0, which will be described later, matches the position of the land.

図2は、ヘッド部203の位置決め制御中において、目標実装位置207がカメラ202の視野領域V内に含まれていない状態を示している。この場合、制御部1は、プリント基板206の設計データに基づいてあらかじめ設定された電子部品208の位置であるデフォルト目標位置P0を用いてヘッド部203の位置決め制御を行う。しかし、プリント基板206の歪み、機械系2の熱膨張などにより誤差が生じ、本来、電子部品208を配置すべき位置である目標実装位置207がデフォルト目標位置P0と一致しない場合がある。このような場合、ヘッド部203をデフォルト目標位置P0に位置決めした状態で電子部品208をプリント基板206に配置すると、目標実装位置207とずれた位置に電子部品208を配置してしまうこととなる。 FIG. 2 shows a state in which the target mounting position 207 is not included in the visual field V of the camera 202 during positioning control of the head unit 203 . In this case, the control unit 1 controls the positioning of the head unit 203 using the default target position P0, which is the position of the electronic component 208 set in advance based on the design data of the printed circuit board 206 . However, errors may occur due to distortion of the printed circuit board 206, thermal expansion of the mechanical system 2, and the like, and the target mounting position 207, which is the position where the electronic component 208 should be placed, may not match the default target position P0. In such a case, if the electronic component 208 is placed on the printed circuit board 206 with the head unit 203 positioned at the default target position P0, the electronic component 208 will be placed at a position that deviates from the target mounting position 207 .

ここで、本実施の形態では、制御装置10は、目標実装位置207とデフォルト目標位置P0との誤差を補正しながら位置決め制御を行う。図3に示すように、ヘッド部203の位置決め制御を続けていくと、目標実装位置207がカメラ202の視野領域Vに入ってくる。カメラ202が目標実装位置207を視野領域V内に捉えると、制御部1は、画像処理により算出した吸着ノズル204と目標実装位置207との間の相対位置に基づき、目標実装位置207とデフォルト目標位置P0との誤差を補正しながら位置決め制御を行う。このような制御を行うことにより最終的に、図4に示すように吸着ノズル204の中心軸Cと目標実装位置207の中心位置とを一致させることができ、位置決め制御が完了する。 Here, in the present embodiment, the control device 10 performs positioning control while correcting the error between the target mounting position 207 and the default target position P0. As shown in FIG. 3 , as the positioning control of the head unit 203 continues, the target mounting position 207 comes into the field of view V of the camera 202 . When the camera 202 captures the target mounting position 207 within the visual field V, the control unit 1 calculates the target mounting position 207 and the default target based on the relative position between the suction nozzle 204 and the target mounting position 207 calculated by image processing. Positioning control is performed while correcting the error from the position P0. By performing such control, the center axis C of the suction nozzle 204 and the center position of the target mounting position 207 can finally be aligned as shown in FIG. 4, and the positioning control is completed.

ここで、機械系2のヘッド部203、吸着ノズル204などの各機械要素は有限の剛性を有している、つまり低剛性部位である。このため、ヘッド部203を高加速度で駆動すると、ヘッド部203、吸着ノズル204などに振動が発生し、これらが制御装置10の位置決めの高速化を阻害する要因となる場合がある。画像処理によって算出した吸着ノズル204と目標実装位置207との間の相対位置を用いたフィードバック制御によって振動を抑制できればよいが、カメラ202の撮影の露光時間、カメラ202の画像データの転送時間などの制約により画像フィードバックの制御周期を高速化することは困難である。このため、画像フィードバックで振動を抑制することができる振動周波数は、画像フィードバックの制御周期から定まるナイキスト周波数よりも低い周波数に限られる。 Here, each mechanical element such as the head portion 203 and the suction nozzle 204 of the mechanical system 2 has finite rigidity, that is, it is a low-rigidity portion. Therefore, when the head unit 203 is driven at high acceleration, vibrations occur in the head unit 203, the suction nozzle 204, and the like, which may hinder the high-speed positioning of the control device 10. FIG. Vibration can be suppressed by feedback control using the relative position between the suction nozzle 204 and the target mounting position 207 calculated by image processing. Due to restrictions, it is difficult to speed up the control period of image feedback. Therefore, the vibration frequency at which vibration can be suppressed by image feedback is limited to a frequency lower than the Nyquist frequency determined from the control cycle of image feedback.

ここで、本実施の形態では、制御装置10は、あらかじめ撮影した校正マーク209の静止画像と動画像とに基づき、機械系2の周波数特性を同定する。周波数特性を同定するときに用いる動画像は、機械系2をX軸モータ200またはY軸モータ201で加振しながら一定周期で校正マーク209を連続撮影することで得た動画像である。制御装置10は、この同定結果に基づいたフィードフォワード制御により機械系2の振動を抑制した位置決め制御を行う。 Here, in the present embodiment, control device 10 identifies the frequency characteristic of mechanical system 2 based on a still image and a moving image of calibration mark 209 photographed in advance. A moving image used for identifying the frequency characteristic is a moving image obtained by continuously photographing the calibration mark 209 at a constant period while vibrating the mechanical system 2 with the X-axis motor 200 or the Y-axis motor 201 . The control device 10 performs positioning control that suppresses vibration of the mechanical system 2 by feedforward control based on this identification result.

図5は、実施の形態にかかる制御装置10の機能ブロックを示す図である。制御部1は、加振周波数算出部101と、加振指令生成部102と、X軸駆動部103と、Y軸駆動部104と、探索部105と、模擬動画像生成部106と、動画像比較部107と、周波数特性算出部108と、振動パラメータ算出部109と、位置決め指令生成部110と、を備える。X軸駆動部103およびY軸駆動部104は駆動部である。 FIG. 5 is a diagram showing functional blocks of the control device 10 according to the embodiment. The control unit 1 includes a vibration frequency calculation unit 101, a vibration command generation unit 102, an X-axis drive unit 103, a Y-axis drive unit 104, a search unit 105, a simulated moving image generation unit 106, and a moving image A comparison unit 107 , a frequency characteristic calculation unit 108 , a vibration parameter calculation unit 109 and a positioning command generation unit 110 are provided. The X-axis driving section 103 and the Y-axis driving section 104 are driving sections.

加振周波数算出部101は、あらかじめ設定された加振周波数の上下限値と、後述する周波数特性の同定の手順に基づき、ヘッド部203を駆動させる加振周波数を算出し、加振周波数を加振指令生成部102に出力する。ヘッド部203を駆動させる加振周波数は、カメラ202の撮影周期に基づくナイキスト周波数よりも高い周波数帯域を含む。加振指令生成部102は、加振周波数算出部101が出力した加振周波数の正弦波に基づく加振指令を生成し、X軸駆動部103およびY軸駆動部104に出力する。X軸駆動部103およびY軸駆動部104は、加振指令にX軸モータ200およびY軸モータ201が追従するように、X軸モータ200およびY軸モータ201のフィードフォワード制御およびフィードバック制御を実行することでヘッド部203の駆動制御を行う。 The excitation frequency calculation unit 101 calculates the excitation frequency for driving the head unit 203 based on preset upper and lower limit values of the excitation frequency and a procedure for identifying frequency characteristics to be described later, and applies the excitation frequency. Output to the vibration command generation unit 102 . The excitation frequency for driving the head unit 203 includes a frequency band higher than the Nyquist frequency based on the imaging cycle of the camera 202 . Vibration command generator 102 generates a vibration command based on the sine wave of the vibration frequency output from vibration frequency calculator 101 , and outputs the vibration command to X-axis drive unit 103 and Y-axis drive unit 104 . The X-axis driving unit 103 and the Y-axis driving unit 104 execute feedforward control and feedback control of the X-axis motor 200 and the Y-axis motor 201 so that the X-axis motor 200 and the Y-axis motor 201 follow the vibration command. By doing so, drive control of the head unit 203 is performed.

探索部105は、機械系2の時間応答および機械系2の周波数特性の特徴を表す量である機械系応答特徴量を後述する方法を用いて探索することにより機械系応答特徴量の最適値を算出する。また、探索部105は、模擬動画像生成部106に機械系応答特徴量の探索値を、周波数特性算出部108に機械系応答特徴量の最適値をそれぞれ出力する。機械系応答特徴量の探索値は、探索部105によって変更される。本実施の形態では、機械系応答特徴量として、加振周波数における機械系2の周波数特性のゲインと位相との組を用いる。本実施の形態では、機械系2を正弦波で加振しているため、制御対象の特性をゲインと位相だけでパラメトライズすることができる。また、探索部105は、カメラ202が撮影した動画像を取得する。機械系応答特徴量の探索値および機械系応答特徴量の最適値の算出方法の詳細については後述する。 The search unit 105 searches for the mechanical system response feature amount, which is the amount representing the time response of the mechanical system 2 and the frequency characteristic feature of the mechanical system 2, by using a method described later to obtain the optimum value of the mechanical system response feature amount. calculate. Further, the searching unit 105 outputs the search value of the mechanical system response feature amount to the simulated moving image generating unit 106 and outputs the optimum value of the mechanical system response feature amount to the frequency characteristic calculation unit 108 . The search value of the mechanical system response feature quantity is changed by the search unit 105 . In this embodiment, a set of the gain and phase of the frequency characteristic of the mechanical system 2 at the vibration frequency is used as the mechanical system response feature amount. In this embodiment, since the mechanical system 2 is excited with a sine wave, the characteristics of the controlled object can be parameterized only by the gain and phase. Also, the search unit 105 acquires a moving image captured by the camera 202 . The details of the method of calculating the search value of the mechanical system response feature amount and the optimum value of the mechanical system response feature amount will be described later.

模擬動画像生成部106は、機械系応答特徴量の探索値と、加振指令と、校正マーク209の静止画像とを用いて、露光時間中のカメラ202と校正マーク209との相対位置の変化、およびカメラ202のセンサ特性を後述の方法でシミュレーションする。このようにすることで、模擬動画像生成部106は、機械系2を加振しながらカメラ202で校正マーク209を連続撮影した結果を模擬した模擬動画像を生成する。模擬動画像生成部106の詳細な動作については後述する。 The simulated moving image generation unit 106 uses the search value of the mechanical system response feature amount, the excitation command, and the still image of the calibration mark 209 to determine the change in the relative position between the camera 202 and the calibration mark 209 during the exposure time. , and the sensor characteristics of the camera 202 are simulated in the manner described below. By doing so, the simulated moving image generator 106 generates a simulated moving image that simulates the result of continuously photographing the calibration mark 209 with the camera 202 while vibrating the mechanical system 2 . Detailed operations of the simulated moving image generator 106 will be described later.

動画像比較部107は、機械系2を加振しながら校正マーク209を一定周期で連続撮影することで得た実際の動画像と、模擬動画像生成部106が出力した模擬動画像とを比較する。また、動画像比較部107は、実際の動画像と模擬動画像との誤差を表す量である動画像誤差、および動画像誤差の機械系応答特徴量に関する勾配を、探索部105に出力する。動画像誤差の算出方法は、例えば、同一時刻の画像同士の画素ごとに輝度値の差分を算出し、これらを2乗した量の全時刻および全ピクセルの合計値を動画像誤差とすることが挙げられる。または、輝度値の差分の2乗和の代わりに、輝度値の絶対値の和を使用することも可能である。 A moving image comparison unit 107 compares an actual moving image obtained by continuously photographing the calibration mark 209 at a constant period while vibrating the mechanical system 2 with the simulated moving image output by the simulated moving image generating unit 106 . do. In addition, the moving image comparison unit 107 outputs to the search unit 105 the moving image error, which is the amount representing the error between the actual moving image and the simulated moving image, and the gradient of the mechanical system response feature amount of the moving image error. As a method of calculating the moving image error, for example, the difference in the brightness value of each pixel between the images at the same time is calculated, and the sum of the values obtained by squaring the difference for all times and all pixels is used as the moving image error. mentioned. Alternatively, the sum of the absolute values of the luminance values can be used instead of the sum of the squares of the differences of the luminance values.

周波数特性算出部108は、加振周波数算出部101が出力した加振周波数と、探索部105が出力した機械系応答特徴量の最適値を用いて、加振周波数と加振周波数に対応した機械系応答特徴量の組を加振データとしてメモリに保存する。加振データを保存するメモリは、周波数特性算出部108に設けられていてもよいし、周波数特性算出部108の外部に設けられていてもよい。また、周波数特性算出部108は、後述する同定手順の最後のステップにおいて、複数の加振データを用いて機械系2の周波数特性を算出する。 The frequency characteristic calculation unit 108 uses the excitation frequency output by the excitation frequency calculation unit 101 and the optimum value of the mechanical system response feature amount output by the search unit 105 to determine the excitation frequency and the mechanical characteristics corresponding to the excitation frequency. A set of system response feature quantities is stored in memory as excitation data. The memory that stores the excitation data may be provided in the frequency characteristic calculation section 108 or may be provided outside the frequency characteristic calculation section 108 . Further, the frequency characteristic calculator 108 calculates the frequency characteristic of the mechanical system 2 using a plurality of excitation data in the final step of the identification procedure described later.

振動パラメータ算出部109は、周波数特性算出部108が算出した機械系2の周波数特性に基づき、機械系2の振動パラメータを算出する。位置決め指令生成部110は、振動パラメータ算出部109が算出した振動パラメータに基づき、機械系2の振動を抑制した、ヘッド部203を目標実装位置207に移動させるために用いる指令である位置決め指令を生成する。また、位置決め指令生成部110は、生成した位置決め指令をX軸駆動部103およびY軸駆動部104に出力する。 The vibration parameter calculator 109 calculates vibration parameters of the mechanical system 2 based on the frequency characteristics of the mechanical system 2 calculated by the frequency characteristic calculator 108 . The positioning command generation unit 110 generates a positioning command, which is a command used to move the head unit 203 to the target mounting position 207 while suppressing the vibration of the mechanical system 2, based on the vibration parameters calculated by the vibration parameter calculation unit 109. do. Positioning command generator 110 also outputs the generated positioning command to X-axis driving unit 103 and Y-axis driving unit 104 .

本実施の形態にかかる制御部1のハードウェア構成について説明する。加振周波数算出部101、加振指令生成部102、X軸駆動部103、Y軸駆動部104、探索部105、模擬動画像生成部106、動画像比較部107、周波数特性算出部108、振動パラメータ算出部109、および位置決め指令生成部110は、各処理を行う電子回路である処理回路により実現される。 A hardware configuration of the control unit 1 according to this embodiment will be described. Vibration frequency calculation unit 101, vibration command generation unit 102, X-axis drive unit 103, Y-axis drive unit 104, Search unit 105, Simulated video generation unit 106, Video comparison unit 107, Frequency characteristic calculation unit 108, Vibration The parameter calculator 109 and the positioning command generator 110 are implemented by a processing circuit, which is an electronic circuit that performs each process.

本処理回路は、専用のハードウェアであっても、メモリ及びメモリに格納されるプログラムを実行するCPU(Central Processing Unit、中央演算装置)を備える制御回路であってもよい。ここでメモリとは、例えば、RAM(Random Access Memory)、ROM(Read Only Memory)、フラッシュメモリなどの、不揮発性または揮発性の半導体メモリなどが該当する。図6は、実施の形態にかかる制御回路400の構成例を示す図である。処理回路が、専用のハードウェアである場合、処理回路は、例えば、ASIC(Application Specific Integrated Circuit)、FPGA(Field Programmable Gate Array)、またはこれらを組み合わせたものである。 The processing circuit may be dedicated hardware, or may be a control circuit including a memory and a CPU (Central Processing Unit) that executes a program stored in the memory. Here, the memory corresponds to, for example, non-volatile or volatile semiconductor memory such as RAM (Random Access Memory), ROM (Read Only Memory), flash memory, and the like. FIG. 6 is a diagram showing a configuration example of the control circuit 400 according to the embodiment. When the processing circuit is dedicated hardware, the processing circuit is, for example, an ASIC (Application Specific Integrated Circuit), an FPGA (Field Programmable Gate Array), or a combination thereof.

図6に示すように、制御回路400は、CPUであるプロセッサ400aと、メモリ400bとを備える。図6に示す制御回路400により実現される場合、プロセッサ400aがメモリ400bに記憶された、各処理に対応するプログラムを読みだして実行することにより実現される。また、メモリ400bは、プロセッサ400aが実施する各処理における一時メモリとしても使用される。 As shown in FIG. 6, the control circuit 400 includes a processor 400a, which is a CPU, and a memory 400b. When implemented by the control circuit 400 shown in FIG. 6, it is implemented by the processor 400a reading and executing a program corresponding to each process stored in the memory 400b. The memory 400b is also used as temporary memory in each process performed by the processor 400a.

図7は、実施の形態にかかる模擬動画像生成部106の内部構成の一例を示すブロック図である。模擬動画像生成部106は、予測値算出部301と、フィルタ算出部302と、移動画像生成部303と、を備える。 FIG. 7 is a block diagram showing an example of the internal configuration of the simulated moving image generator 106 according to the embodiment. The simulated moving image generator 106 includes a predicted value calculator 301 , a filter calculator 302 , and a moving image generator 303 .

予測値算出部301は、加振指令と機械系応答特徴量とに基づき各時刻のカメラ202と校正マーク209との相対位置の予測値を算出する。相対位置の予測値は、カメラ202の各撮影周期におけるカメラ202の露光時間ごとに算出される。ここで、機械系2のX軸方向の周波数特性を取得するための加振方向をX軸方向とし、X軸モータ200を振幅A、加振周波数ωである加振指令u(t)で駆動させる場合、加振指令u(t)の時間関数は、式(1)で表すことができる。 A predicted value calculation unit 301 calculates a predicted value of the relative position between the camera 202 and the calibration mark 209 at each time based on the vibration command and the mechanical system response feature quantity. The predicted value of the relative position is calculated for each exposure time of the camera 202 in each shooting cycle of the camera 202 . Here, the excitation direction for obtaining the frequency characteristics in the X-axis direction of the mechanical system 2 is assumed to be the X-axis direction, and the X-axis motor 200 is driven by an excitation command u x (t) having an amplitude A and an excitation frequency ω. When driving, the time function of the excitation command u x (t) can be expressed by Equation (1).

Figure 0007162574000001
Figure 0007162574000001

また、機械系応答特徴量のゲインをG、位相をφとすると、カメラ202と校正マーク209との相対位置x(t)の予測値hat(x(t))は、式(2)で表すことができる。なお、本明細書の文中において、ハット付の関数をhat(関数)と表す。 Further, when the gain of the mechanical system response feature amount is G and the phase is φ, the predicted value hat(x(t)) of the relative position x(t) between the camera 202 and the calibration mark 209 is expressed by Equation (2). be able to. In the text of this specification, a function with a hat is represented as hat (function).

Figure 0007162574000002
Figure 0007162574000002

フィルタ算出部302は、予測値算出部301が出力した相対位置の予測値hat(x(t))に基づき、カメラ202の各撮影周期における校正マーク209の平行移動と被写体ぶれを表すフィルタを算出する。ここで、k番目の撮影周期の露光開始時刻をT 、露光終了時刻をT 、露光時間をT、X軸の画像1ピクセルあたりの長さをΔXとする。このとき、k番目の撮影における校正マーク209の平行移動と被写体ぶれを表すフィルタFのピクセル座標Xにおけるフィルタ係数の算出式の一例は、式(3)のようになる。 The filter calculation unit 302 calculates a filter representing the parallel movement of the calibration mark 209 and subject blur in each imaging cycle of the camera 202 based on the predicted value hat(x(t)) of the relative position output by the predicted value calculation unit 301. do. Here, let T 1 k be the exposure start time of the k-th imaging cycle, T 2 k be the exposure end time, T e be the exposure time, and ΔX be the length per pixel of the image on the X axis. At this time, an example of a formula for calculating the filter coefficient at the pixel coordinate X of the filter Fk representing the translation of the calibration mark 209 and the blurring of the subject in the k-th photographing is shown in formula (3).

Figure 0007162574000003
Figure 0007162574000003

式(3)は、相対位置の予測値hat(x(t))をピクセル単位に変換した量でオフセットさせたデルタ関数を時刻[T ,T ]で積分したのち、周囲の±1/2ピクセルの範囲で平均をとったものである。なお、加振方向がY軸方向である場合は、式(1)~(3)のX軸に関する定数および変数を、Y軸に関する定数および変数に置き換えればよい。 Equation (3) integrates the delta function offset by the amount obtained by converting the predicted value hat(x(t)) of the relative position in units of pixels at time [T 1 k , T 2 k ], and then calculates the surrounding ± It is the average over a half pixel range. If the excitation direction is the Y-axis direction, the constants and variables relating to the X-axis in equations (1) to (3) may be replaced with constants and variables relating to the Y-axis.

移動画像生成部303は、静止画像にフィルタFを作用させることでカメラ202の各撮影周期における校正マーク209の平行移動と被写体ぶれを伴った画像を生成する。具体的には、移動画像生成部303は、フィルタ算出部302が出力した各撮影周期のフィルタFと校正マーク209の静止画像との畳み込み和を算出することでカメラ202の各撮影周期における校正マーク209の平行移動と被写体ぶれを伴った画像を生成し、生成した各撮影周期の画像をまとめることで模擬動画像を生成し、生成した模擬動画像を動画像比較部107に出力する。 The movement image generating unit 303 applies the filter Fk to the still image to generate an image accompanied by parallel movement of the calibration mark 209 and subject blur in each imaging cycle of the camera 202 . Specifically, the moving image generation unit 303 calculates the convolution sum of the filter Fk of each imaging cycle output by the filter calculation unit 302 and the still image of the calibration mark 209 , thereby performing calibration in each imaging cycle of the camera 202 . An image with parallel movement of the mark 209 and subject blurring is generated, and a simulated moving image is generated by combining the generated images of each imaging cycle, and the generated simulated moving image is output to the moving image comparison unit 107 .

図8は、実施の形態にかかる校正マーク209の静止画像の一例を示す図である。図8では、校正マーク209は、十字の形をしているが十字の形に限定されない。図9は、実施の形態にかかる模擬動画像の第1の時刻のときの第1の画像を示す図である。図10は、実施の形態にかかる模擬動画像の第2の時刻のときの第2の画像を示す図である。図11は、実施の形態にかかる模擬動画像の第3の時刻のときの第3の画像を示す図である。第1の画像、第2の画像、および第3の画像は、それぞれ移動画像生成部303が校正マーク209とフィルタFとを用いて生成した模擬動画像の、ある時刻における画像の一例である。例えば、第1の画像は模擬動画像の時刻[T ,T ]における画像である。 FIG. 8 is a diagram showing an example of a still image of the calibration mark 209 according to the embodiment. In FIG. 8, the fiducial mark 209 has a cross shape, but is not limited to a cross shape. FIG. 9 is a diagram showing a first image of the simulated moving image at a first time according to the embodiment; FIG. 10 is a diagram showing a second image of the simulated moving image at a second time according to the embodiment; FIG. 11 is a diagram illustrating a third image of the simulated moving image at a third time according to the embodiment; The first image, the second image, and the third image are examples of simulated moving images generated by the moving image generation unit 303 using the calibration mark 209 and the filter Fk at a certain time. . For example, the first image is the image at time [T 1 k , T 2 k ] of the simulated moving image.

図12は、実施の形態にかかるフィルタFの各ピクセル座標のフィルタ係数を図示した一例を示す図である。図12において、フィルタ係数がゼロのピクセルは黒く描画されている。また、図12において、フィルタ係数がゼロでないピクセルは、フィルタ係数の大きさに応じて明るく、つまり白く描画されている。第1の画像、第2の画像、および第3の画像は、それぞれ校正マーク209と、図12に示すフィルタFとの畳み込み和を算出することで得ることができる。これらの動作を行うことで、模擬動画像生成部106は、機械系応答特徴量が与えられたときのカメラ202と校正マーク209との相対位置の時間応答を算出し、この時間応答に基づいて校正マーク209の平行移動と、被写体ぶれと、を考慮した模擬動画像を生成することができる。 FIG. 12 is a diagram illustrating an example of filter coefficients for each pixel coordinate of the filter Fk according to the embodiment; In FIG. 12, pixels with zero filter coefficients are drawn black. Also, in FIG. 12, pixels with non-zero filter coefficients are drawn brighter, ie, white, according to the magnitude of the filter coefficients. The first image, the second image, and the third image can each be obtained by calculating the convolution sum of the calibration mark 209 and the filter Fk shown in FIG. By performing these operations, the simulated moving image generation unit 106 calculates the time response of the relative position between the camera 202 and the calibration mark 209 when the mechanical system response feature amount is given, and based on this time response, A simulated moving image can be generated in consideration of the translation of the calibration mark 209 and the blurring of the subject.

図13は、実施の形態にかかる制御装置10が位置決め制御をするときのデータの流れを示す図である。図5では、加振指令生成部102が出力した加振指令が、X軸駆動部103およびY軸駆動部104に入力されていた。図13では、位置決め指令生成部110が出力した位置決め指令が、X軸駆動部103およびY軸駆動部104に入力されている。つまり、X軸駆動部103およびY軸駆動部104に入力されるデータは、機械系2を加振するときと位置決め制御をするときで異なる。 FIG. 13 is a diagram showing the flow of data when the control device 10 according to the embodiment performs positioning control. In FIG. 5 , the vibration command output by the vibration command generator 102 is input to the X-axis drive unit 103 and the Y-axis drive unit 104 . In FIG. 13 , the positioning command output by the positioning command generating section 110 is input to the X-axis driving section 103 and the Y-axis driving section 104 . In other words, the data input to the X-axis drive unit 103 and the Y-axis drive unit 104 are different when the mechanical system 2 is vibrated and when the positioning control is performed.

位置決め指令生成部110が位置決め指令を算出する方法について説明する。位置決め指令生成部110は、振動パラメータとして例えば、機械系2の機械特性を2慣性系で表した場合のX軸の***振周波数ωと、機械系2の機械特性を2慣性系で表した場合のY軸の***振周波数ωと、X軸の減衰係数ζと、Y軸の減衰係数ζと、を用いる。これらの計4つのパラメータを振動パラメータに選んだ場合、機械系2の振動を抑制した位置決め指令は、式(4)に基づいて算出することができる。 A method of calculating a positioning command by the positioning command generator 110 will be described. The positioning command generating unit 110 uses, as vibration parameters, for example, an X-axis anti-resonance frequency ω x when the mechanical characteristics of the mechanical system 2 are expressed in a two-inertia system, and the mechanical characteristics of the mechanical system 2 are expressed in a two-inertia system. The anti-resonance frequency ω y on the Y axis, the damping coefficient ζ x on the X axis, and the damping coefficient ζ y on the Y axis are used. When these four parameters are selected as vibration parameters, a positioning command that suppresses vibration of the mechanical system 2 can be calculated based on equation (4).

Figure 0007162574000004
Figure 0007162574000004

ここで、r(t)およびr(t)は振動抑制前の位置決め指令を、u(t)およびu(t)は振動抑制後の位置決め指令をそれぞれ表している。また、L[・]はラプラス変換を表す。sはラプラス演算子を表す。M(s)およびM(s)は、あらかじめ設定されたX軸およびY軸の指令フィルタの伝達関数をそれぞれ表す。 Here, r x (t) and r y (t) represent positioning commands before vibration suppression, and u x (t) and u y (t) represent positioning commands after vibration suppression, respectively. Also, L[·] represents the Laplace transform. s represents the Laplacian operator. M x (s) and M y (s) represent the transfer functions of the preset X-axis and Y-axis command filters, respectively.

制御装置10が機械系2の周波数特性を同定する手順について説明する。図14は、実施の形態にかかる制御装置10のX軸の周波数特性の同定の手順を示すフローチャートである。なお、Y軸の周波数特性の同定の手順は、図14においてX軸がY軸に書き換えられたフローチャートと同じ手順である。 A procedure for the control device 10 to identify the frequency characteristic of the mechanical system 2 will be described. FIG. 14 is a flow chart showing the procedure for identifying the X-axis frequency characteristic of the control device 10 according to the embodiment. The procedure for identifying the Y-axis frequency characteristics is the same procedure as the flowchart in FIG. 14, in which the X-axis is rewritten as the Y-axis.

位置決め指令生成部110は、X軸駆動部103およびY軸駆動部104を介してX軸モータ200およびY軸モータ201の位置決め制御を行うことで、カメラ202を校正マーク209の上方まで移動させる(ステップS1)。カメラ202は、模擬動画像生成部106に入力させるための、校正マーク209の静止画像を撮影する(ステップS2)。このとき、カメラ202は、1回撮影した静止画像を模擬動画像生成部106に出力してもよいし、静止画像を複数回撮影し、これらを平均化した画像を模擬動画像生成部106に出力してもよい。平均化した画像を用いることで、模擬動画像生成部106は、撮影画像に含まれるノイズの影響を低減して模擬動画像を生成することができる。 Positioning command generator 110 controls positioning of X-axis motor 200 and Y-axis motor 201 via X-axis drive unit 103 and Y-axis drive unit 104, thereby moving camera 202 above calibration mark 209 ( step S1). The camera 202 captures a still image of the calibration mark 209 to be input to the simulated moving image generator 106 (step S2). At this time, the camera 202 may output a still image captured once to the simulated moving image generation unit 106 , or may capture still images a plurality of times and average the images to send the image to the simulated moving image generation unit 106 . may be output. By using the averaged image, the simulated moving image generating unit 106 can generate the simulated moving image by reducing the influence of noise included in the captured image.

加振周波数算出部101は、あらかじめ設定された加振周波数の下限値を現在値にすることで初期化を行う(ステップS3)。なお、加振周波数算出部101は、加振周波数の下限値ではなく、あらかじめ設定された加振周波数の上限値を現在値にすることで初期化を行ってもよい。加振指令生成部102は、加振周波数算出部101によって設定された加振周波数の現在値と、あらかじめ設定された指令振幅とに基づき加振指令を生成し、X軸駆動部103を介してX軸モータ200を駆動することで、ヘッド部203のX軸方向の加振動作を開始する(ステップS4)。 The excitation frequency calculation unit 101 performs initialization by setting the preset lower limit of the excitation frequency to the current value (step S3). Note that the excitation frequency calculation unit 101 may perform initialization by setting the preset upper limit of the excitation frequency to the current value instead of the lower limit of the excitation frequency. The vibration command generator 102 generates a vibration command based on the current value of the vibration frequency set by the vibration frequency calculator 101 and the preset command amplitude, and transmits the vibration command via the X-axis drive unit 103. By driving the X-axis motor 200, the head unit 203 starts vibrating in the X-axis direction (step S4).

カメラ202は、あらかじめ定められた撮影周期、露光時間、および撮影回数に基づき校正マーク209の動画像を撮影する(ステップS5)。このとき、ステップS4による加振動作が開始してから十分に時間が経過した後に撮影を開始することが望ましい。ステップS4の動作から十分に時間が経過した後に撮影を開始することで、加振動作開始時のヘッド部203の過渡的な応答の影響を排除することができる。あらかじめ定められた撮影回数の撮影が完了した後、加振指令生成部102は加振指令の生成を停止することで、ヘッド部203のX軸方向の加振動作を終了する(ステップS6)。 The camera 202 takes a moving image of the calibration mark 209 based on the predetermined shooting cycle, exposure time, and number of shots (step S5). At this time, it is desirable to start photographing after a sufficient amount of time has passed since the excitation operation in step S4 started. By starting photographing after a sufficient amount of time has passed since the operation of step S4, it is possible to eliminate the influence of the transient response of the head unit 203 at the start of the vibration excitation operation. After the predetermined number of times of imaging is completed, the vibration command generation unit 102 stops generation of the vibration command, thereby ending the vibration excitation operation of the head unit 203 in the X-axis direction (step S6).

制御部1は、探索部105と、模擬動画像生成部106と、動画像比較部107と、を連携させることで、動画像誤差を最小化する機械系応答特徴量の最適値を算出する(ステップS7)。動画像誤差を最小化する機械系応答特徴量の最適値を算出する詳細な方法については後述する。ステップS7によって動画像誤差を最小化する機械系応答特徴量の最適値を算出した後、周波数特性算出部108は、加振周波数算出部101が出力した加振周波数と、探索部105が出力した機械系応答特徴量の最適値と、の組を加振データとしてメモリに保存する(ステップS8)。 The control unit 1 causes the searching unit 105, the simulated moving image generating unit 106, and the moving image comparing unit 107 to cooperate to calculate the optimum value of the mechanical system response feature that minimizes the moving image error ( step S7). A detailed method for calculating the optimum value of the mechanical system response feature amount that minimizes the moving image error will be described later. After calculating the optimum value of the mechanical system response feature quantity that minimizes the moving image error in step S7, the frequency characteristic calculation unit 108 calculates the excitation frequency output by the excitation frequency calculation unit 101 and the excitation frequency output by the search unit 105. The combination of the optimum value of the mechanical system response feature quantity and the set of the mechanical system response feature quantity is stored in the memory as vibration data (step S8).

加振周波数算出部101は、加振周波数の現在値が上限値に達しているか確認する(ステップS9)。加振周波数の現在値が上限値に達していない場合(ステップS9,No)、あらかじめ設定された加振周波数のステップ幅に基づいて加振周波数の現在値を更新し(ステップS10)、ステップS4に戻る。なお、ステップS3で、あらかじめ設定された加振周波数の上限値を現在値にすることで初期化を行っていた場合、加振周波数算出部101は、加振周波数の現在値が下限値に達しているか確認する。加振周波数の現在値が上限値に達している場合(ステップS9,Yes)、ステップS11に進み、周波数特性算出部108は、これまでにメモリに保存した複数の加振データに基づき、機械系2の周波数特性を算出する(ステップS11)。振動パラメータ算出部109は、周波数特性算出部108がステップS11で算出した機械系2の周波数特性に基づき、機械系2の振動を抑制する位置決め制御のための振動パラメータを算出し(ステップS12)、一連の同定手順を終了する。振動パラメータの算出方法は、例えば、ステップS11で算出した機械系2の周波数特性のゲインがピーク値をとる周波数に基づいて算出してもよいし、フィッティングによって求めた周波数特性の伝達関数のパラメータに基づいて算出してもよい。 The excitation frequency calculator 101 checks whether the current value of the excitation frequency has reached the upper limit (step S9). If the current value of the excitation frequency has not reached the upper limit (step S9, No), the current value of the excitation frequency is updated based on the preset step width of the excitation frequency (step S10), and step S4. back to Note that in step S3, if initialization is performed by setting the preset upper limit value of the excitation frequency to the current value, the excitation frequency calculation unit 101 determines that the current value of the excitation frequency has reached the lower limit value. Check to see if If the current value of the excitation frequency has reached the upper limit (step S9, Yes), the process proceeds to step S11, and the frequency characteristic calculation unit 108 calculates the mechanical system based on the plurality of excitation data stored in the memory so far. 2 is calculated (step S11). The vibration parameter calculator 109 calculates vibration parameters for positioning control for suppressing vibration of the mechanical system 2 based on the frequency characteristics of the mechanical system 2 calculated by the frequency characteristic calculator 108 in step S11 (step S12), End the series of identification procedures. Vibration parameters may be calculated, for example, based on the frequency at which the gain of the frequency characteristics of the mechanical system 2 calculated in step S11 takes a peak value, or may be calculated based on the parameters of the transfer function of the frequency characteristics obtained by fitting. may be calculated based on

図15は、実施の形態にかかる動画像誤差を最小化する機械系応答特徴量を算出する詳細な動作の一例を示すフローチャートである。図14のステップS7の詳細な動作について説明する。探索部105は、機械系応答特徴量の探索値の初期値を設定する(ステップS71)。探索値の初期値の設定方法としては、直前の加振周波数における機械系応答特徴量の最適値を使用する、あらかじめ設定された固定値を使用する、乱数を使って初期値を算出するなどの方法を用いることができる。 FIG. 15 is a flowchart illustrating an example of detailed operation of calculating a mechanical system response feature amount that minimizes moving image error according to the embodiment. Detailed operation of step S7 in FIG. 14 will be described. The search unit 105 sets the initial value of the search value of the mechanical system response feature quantity (step S71). There are several ways to set the initial value of the search value, such as using the optimum value of the mechanical system response feature value at the previous excitation frequency, using a preset fixed value, or calculating the initial value using random numbers. method can be used.

模擬動画像生成部106は、探索部105が設定した機械系応答特徴量の探索値に基づき、校正マーク209の平行移動と被写体ぶれと、を模擬した模擬動画像を生成する(ステップS72)。動画像比較部107は、ステップS72で生成した模擬動画像と、ステップS5で撮影した実際の動画像とを比較することで、動画像誤差の機械系応答特徴量に関する勾配を算出する(ステップS73)。探索部105は、ステップS73で算出した動画像誤差の勾配のノルムがあらかじめ設定された規定値よりも小さいか確認する(ステップS74)。勾配のノルムが規定値以上である場合(ステップS74,No)、探索部105は、勾配に基づき、動画像誤差が小さくなるよう機械系応答特徴量の探索値を変更し(ステップS75)、ステップS72に戻る。動画像誤差の勾配のノルムがあらかじめ設定された規定値よりも小さい場合(ステップS74,Yes)、探索部105は、機械系応答特徴量の最適化算出を終了し、機械系応答特徴量の探索値を機械系応答特徴量の最適値として出力する(ステップS76)。つまり、ステップS72からS75では、探索部105は、探索値を変更し、変更された探索値のそれぞれに対応する動画像誤差を取得し、複数の動画像誤差を用いて動画像誤差を最小化する機械系応答特徴量の最適値を探索している。 The simulated moving image generation unit 106 generates a simulated moving image simulating the parallel movement of the calibration mark 209 and subject blur based on the search value of the mechanical system response feature amount set by the searching unit 105 (step S72). The moving image comparison unit 107 compares the simulated moving image generated in step S72 with the actual moving image captured in step S5 to calculate the gradient of the mechanical system response feature amount of the moving image error (step S73 ). The search unit 105 checks whether the norm of the gradient of the moving image error calculated in step S73 is smaller than a preset specified value (step S74). If the norm of the gradient is equal to or greater than the prescribed value (step S74, No), the searching unit 105 changes the search value of the mechanical system response feature amount based on the gradient so as to reduce the moving image error (step S75). Return to S72. When the norm of the gradient of the moving image error is smaller than the preset specified value (step S74, Yes), the search unit 105 terminates the optimization calculation of the mechanical system response feature amount, and searches for the mechanical system response feature amount. The value is output as the optimum value of the mechanical system response feature quantity (step S76). That is, in steps S72 to S75, the search unit 105 changes the search value, acquires the moving image error corresponding to each of the changed search values, and uses a plurality of moving image errors to minimize the moving image error. We are searching for the optimum value of the mechanical system response feature quantity to be used.

なお、図15では、動画像誤差の勾配に基づいて動画像誤差を最小化する機械系応答特徴量を算出する方法のフローチャートを示しているが、動画像誤差を最小化する方法は、図15に示される方法に限らず、粒子群最適化(PSO:Particle Swarm Optimization)、またはベイズ最適化等の評価関数の勾配を使用しない最適化アルゴリズムを用いることも可能である。これらのアルゴリズムを採用した場合、動画像比較部107は、動画像誤差の勾配ではなく動画像誤差を出力するように構成される。また、探索部105は、動画像誤差を用いて機械系応答特徴量の最適値を算出する。 Note that FIG. 15 shows a flowchart of a method of calculating the mechanical system response feature amount that minimizes the moving image error based on the gradient of the moving image error. It is also possible to use an optimization algorithm that does not use the gradient of the evaluation function, such as particle swarm optimization (PSO) or Bayesian optimization. When these algorithms are employed, the moving image comparison unit 107 is configured to output the moving image error instead of the gradient of the moving image error. Also, the search unit 105 calculates the optimum value of the mechanical system response feature using the moving image error.

図16は、実施の形態にかかる複数の加振データから算出した機械系2の周波数特性の一例を示す第1の図である。図16では、縦軸をゲイン[dB]、横軸を周波数[Hz]で示す。図16では、実線を周波数特性、丸を加振データで示す。図17は、実施の形態にかかる複数の加振データから算出した機械系2の周波数特性の一例を示す第2の図である。図17では、縦軸を位相[deg]、横軸を周波数[Hz]で示す。図17では、周波数特性を実線で、加振データを丸で示す。このように、機械系2の周波数特性の求め方は、図16および図17のように加振データを関数近似して求めてもよいし、周波数特性の伝達関数をあらかじめ仮定し伝達関数のパラメータをフィッティングにより求めてもよい。 FIG. 16 is a first diagram showing an example of frequency characteristics of the mechanical system 2 calculated from a plurality of excitation data according to the embodiment. In FIG. 16, the vertical axis indicates gain [dB] and the horizontal axis indicates frequency [Hz]. In FIG. 16, the solid line indicates frequency characteristics, and the circles indicate excitation data. FIG. 17 is a second diagram showing an example of frequency characteristics of the mechanical system 2 calculated from a plurality of excitation data according to the embodiment. In FIG. 17, the vertical axis indicates phase [deg] and the horizontal axis indicates frequency [Hz]. In FIG. 17, the frequency characteristic is indicated by a solid line, and the excitation data is indicated by circles. As described above, the frequency characteristics of the mechanical system 2 may be obtained by function approximation of the excitation data as shown in FIGS. may be obtained by fitting.

以上説明したように、本実施の形態では、制御装置10は、カメラ202の露光時間中にヘッド部203が動くことによって生じる撮影画像の被写体ぶれを考慮しながら加振動作中の撮影画像をシミュレーションする。また、制御装置10は、アクチュエータのフィードバック値を用いずシミュレーション結果と実際の撮影画像との比較に基づいて機械系2の周波数特性を同定することができる。このため、制御装置10は、撮影周期から定まるナイキスト周波数、または有限の露光時間によって生じる被写体ぶれによる画像処理の誤差の制限を受けずに、機械系2の周波数特性の同定を行うことができる。つまり、制御装置10は、高い周波数帯域の周波数特性を、画像処理を用いて同定し、機械系2の振動を抑制する位置決め制御系を構成することにより、位置決め制御を高速および高精度化することができる。また、制御装置10は、カメラ撮影の撮影周期から定まるナイキスト周波数よりも高い周波数帯域を含む周波数特性を同定することができるため、ナイキスト周波数よりも高い周波数の振動を抑制することができる。 As described above, in the present embodiment, the control device 10 simulates the captured image during the excitation operation while considering the subject blurring of the captured image caused by the movement of the head unit 203 during the exposure time of the camera 202. do. Moreover, the control device 10 can identify the frequency characteristic of the mechanical system 2 based on the comparison between the simulation result and the actually captured image without using the feedback value of the actuator. Therefore, the control device 10 can identify the frequency characteristics of the mechanical system 2 without being restricted by the Nyquist frequency determined from the imaging cycle or by the image processing error due to subject blur caused by a finite exposure time. In other words, the control device 10 identifies the frequency characteristics of the high frequency band using image processing, and configures a positioning control system that suppresses vibration of the mechanical system 2, thereby increasing the speed and accuracy of the positioning control. can be done. In addition, since the control device 10 can identify frequency characteristics including a frequency band higher than the Nyquist frequency determined from the photographing cycle of the camera, it is possible to suppress vibrations at frequencies higher than the Nyquist frequency.

本実施の形態では、制御装置10がヘッド部203を正弦波で加振するため、機械系2の応答波形も正弦波となる。したがって、機械系2の機械系応答特徴量としてゲインと位相という2つの情報が同定できればよく、この2つの情報を同定できれば、ナイキスト周波数以下のサンプリングからナイキスト周波数以上の周波数特性を同定できる。また、制御装置10は、探索部105と動画像比較部107とを備え、動画像誤差が最小となるような機械系応答特徴量を探索することで、制御対象の機械系応答特徴量を同定することができる。また、模擬動画像生成部106を備えることにより、カメラ202の露光中の被写体の動きによる撮影画像のぶれを考慮することができる。このため、制御装置10は、被写体ぶれが無視できないような高い周波数帯域の同定を精度よく行うことができる。 In the present embodiment, since the control device 10 vibrates the head section 203 with a sine wave, the response waveform of the mechanical system 2 is also a sine wave. Therefore, it is sufficient to identify two pieces of information, the gain and the phase, as the mechanical system response feature quantity of the mechanical system 2. If these two pieces of information can be identified, the frequency characteristics above the Nyquist frequency can be identified from the sampling below the Nyquist frequency. Further, the control device 10 includes a search unit 105 and a moving image comparison unit 107, and identifies the mechanical system response feature amount of the controlled object by searching for the mechanical system response feature amount that minimizes the moving image error. can do. In addition, by providing the simulated moving image generating unit 106, it is possible to take into consideration the blurring of the photographed image due to the movement of the subject during the exposure of the camera 202. FIG. Therefore, the control device 10 can accurately identify a high frequency band in which subject blur cannot be ignored.

また、制御装置10が、振動パラメータ算出部109と、位置決め指令生成部110とを備えることで、動画像のフレームレートから定まるナイキスト周波数よりも高い周波数の機械振動を抑制するようなサーボ制御をフィードフォワード制御により実現することができる。また、制御装置10は、予測値算出部301と、フィルタ算出部302と、移動画像生成部303とを備える。このため、制御装置10は、機械系応答特徴量の探索値と加振指令とから、カメラ202と校正マーク209との相対位置の時間応答を予測し、この時間応答から校正マーク209の平行移動と被写体ぶれと、を伴った画像を計算することで、動画撮影のシミュレーションを行うことができる。 In addition, the control device 10 includes the vibration parameter calculation unit 109 and the positioning command generation unit 110, thereby feeding servo control to suppress mechanical vibration at a frequency higher than the Nyquist frequency determined from the frame rate of the moving image. It can be realized by forward control. The control device 10 also includes a predicted value calculator 301 , a filter calculator 302 , and a moving image generator 303 . Therefore, the control device 10 predicts the time response of the relative position between the camera 202 and the calibration mark 209 from the search value of the mechanical system response feature amount and the vibration command, and from this time response, the parallel movement of the calibration mark 209 is predicted. Calculation of an image accompanied by motion blur and subject blur enables simulation of moving image shooting.

なお、本実施の形態では、位置決め制御を行う制御装置10を用いて周波数特性の同定方法について説明したが、本発明の周波数特性の同定方法は、軌跡制御装置、ロール・ツー・ロール方式の機械系など、位置決め制御以外のモーション制御装置の同定にも適用可能である。また、本実施の形態では、カメラ202がヘッド部203に設置されている制御装置10について説明したが、本発明は、カメラ202ではなく校正マーク209がヘッド部203に設置されており、校正マーク209の移動に伴ってカメラ202と校正マーク209との相対位置が変化するように構成されている制御装置に適用することも可能である。 In the present embodiment, the method of identifying frequency characteristics has been described using the control device 10 that performs positioning control. It can also be applied to identification of motion control devices other than positioning control, such as systems. Further, in this embodiment, the control device 10 in which the camera 202 is installed on the head section 203 has been described, but in the present invention, instead of the camera 202, the calibration mark 209 is installed on the head section 203. It can also be applied to a control device configured so that the relative position between the camera 202 and the calibration mark 209 changes as the camera 209 moves.

また、本実施の形態では、機械系応答特徴量として、加振周波数における機械系2の周波数特性のゲインと位相との組を用いていたが、これ以外にも、例えば、ゲインと位相とを表す複素数値を用いることも可能である。この場合、式(2)において、ゲインGを複素数値の絶対値とし、位相φを複素数値の偏角として、相対位置の予測値の時間関数を算出すればよい。この機械系応答特徴量を用いることにより、位相の±2πnの周期性によって機械系応答特徴量の最適値が一意に定まらない問題を回避することができる。 Further, in the present embodiment, a set of gain and phase of the frequency characteristics of the mechanical system 2 at the vibration frequency is used as the mechanical system response feature amount. It is also possible to use complex values to represent In this case, in Equation (2), the gain G is the absolute value of the complex value, the phase φ is the argument of the complex value, and the time function of the predicted value of the relative position is calculated. By using this mechanical system response feature amount, it is possible to avoid the problem that the optimum value of the mechanical system response feature amount is not uniquely determined due to the periodicity of ±2πn of the phase.

以上の実施の形態に示した構成は、本発明の内容の一例を示すものであり、別の公知の技術と組み合わせることも可能であるし、本発明の要旨を逸脱しない範囲で、構成の一部を省略、変更することも可能である。 The configuration shown in the above embodiment shows an example of the content of the present invention, and it is possible to combine it with another known technology, and one configuration can be used without departing from the scope of the present invention. It is also possible to omit or change the part.

1 制御部、2 機械系、10 制御装置、101 加振周波数算出部、102 加振指令生成部、103 X軸駆動部、104 Y軸駆動部、105 探索部、106 模擬動画像生成部、107 動画像比較部、108 周波数特性算出部、109 振動パラメータ算出部、110 位置決め指令生成部、200 X軸モータ、201 Y軸モータ、202 カメラ、203 ヘッド部、204 吸着ノズル、205 プリント基板搬送機構、206 プリント基板、207 目標実装位置、208 電子部品、209 校正マーク、301 予測値算出部、302 フィルタ算出部、303 移動画像生成部、400 制御回路、400a プロセッサ、400b メモリ。 Reference Signs List 1 control unit 2 mechanical system 10 control device 101 vibration frequency calculation unit 102 vibration command generation unit 103 X-axis drive unit 104 Y-axis drive unit 105 search unit 106 simulated moving image generation unit 107 moving image comparison unit, 108 frequency characteristic calculation unit, 109 vibration parameter calculation unit, 110 positioning command generation unit, 200 X-axis motor, 201 Y-axis motor, 202 camera, 203 head unit, 204 suction nozzle, 205 printed circuit board transport mechanism, 206 printed circuit board, 207 target mounting position, 208 electronic component, 209 calibration mark, 301 predicted value calculator, 302 filter calculator, 303 moving image generator, 400 control circuit, 400a processor, 400b memory.

Claims (8)

可動部と、前記可動部の移動に伴って目標物との相対位置が変化し、前記目標物の静止画像および前記目標物の動画像を取得するカメラと、を有する機械系を制御する制御装置であって、
前記カメラの撮影周期に基づくナイキスト周波数よりも高い周波数帯域を含む加振周波数を算出して出力する加振周波数算出部と、
前記加振周波数に基づき加振指令を生成して出力する加振指令生成部と、
前記加振指令に基づき前記可動部の駆動制御を行う駆動部と、
前記機械系の時間応答および周波数特性の特徴を表す機械系応答特徴量の探索値と前記加振指令と前記静止画像とに基づき、前記カメラの露光時間中の前記相対位置の変化と前記カメラのセンサ特性とをシミュレーションすることで模擬動画像を生成する模擬動画像生成部と、
前記動画像と前記模擬動画像とを比較することで、前記動画像と前記模擬動画像との誤差である動画像誤差を算出する動画像比較部と、
前記探索値を変更し、変更された前記探索値のそれぞれに対応する前記動画像誤差を取得し、複数の前記動画像誤差を用いて前記動画像誤差を最小化する機械系応答特徴量の最適値を探索する探索部と、
前記加振周波数と前記最適値とに基づき、前記機械系の周波数特性を算出する周波数特性算出部と、
を備えることを特徴とする制御装置。
A control device for controlling a mechanical system having a movable part and a camera that acquires a still image of the target and a moving image of the target, the relative position of which changes with the movement of the movable part and the target. and
an excitation frequency calculation unit that calculates and outputs an excitation frequency including a frequency band higher than the Nyquist frequency based on the shooting cycle of the camera;
a vibration command generator that generates and outputs a vibration command based on the vibration frequency;
a driving unit that controls driving of the movable unit based on the vibration command;
change in the relative position during the exposure time of the camera and the position of the camera based on the search value of the mechanical system response feature quantity representing the characteristics of the time response and frequency characteristics of the mechanical system, the excitation command, and the still image; a simulated moving image generator that generates a simulated moving image by simulating sensor characteristics;
a moving image comparison unit that compares the moving image and the simulated moving image to calculate a moving image error that is an error between the moving image and the simulated moving image;
Optimizing a mechanical system response feature amount by changing the search value, obtaining the moving image error corresponding to each of the changed search values, and minimizing the moving image error using a plurality of the moving image errors. a search unit for searching for a value;
a frequency characteristic calculator that calculates the frequency characteristic of the mechanical system based on the excitation frequency and the optimum value;
A control device comprising:
前記動画像比較部は、
前記動画像誤差の勾配を算出し、
前記探索部は、
前記勾配を用いて前記最適値を探索することを特徴とする請求項1に記載の制御装置。
The moving image comparison unit
calculating a gradient of the moving image error;
The search unit is
2. The control device according to claim 1, wherein the gradient is used to search for the optimum value.
前記探索部は、
勾配法、ベイズ最適化または粒子群最適化を用いて前記最適値を探索することを特徴とする請求項1に記載の制御装置。
The search unit is
2. The controller according to claim 1, wherein the optimum value is searched using a gradient method, Bayesian optimization or particle swarm optimization.
前記周波数特性に基づき前記機械系の振動パラメータを算出する振動パラメータ算出部と、
前記振動パラメータに基づき前記機械系の振動を抑制した位置決め指令を生成して前記駆動部に出力する位置決め指令生成部と、
を備えることを特徴とする請求項1から3のいずれか1つに記載の制御装置。
a vibration parameter calculator that calculates vibration parameters of the mechanical system based on the frequency characteristics;
a positioning command generation unit that generates a positioning command that suppresses vibration of the mechanical system based on the vibration parameter and outputs the positioning command to the driving unit;
4. The control device according to any one of claims 1 to 3, comprising:
前記模擬動画像生成部は、
前記加振指令と前記機械系応答特徴量に基づき前記カメラの各撮影周期における前記カメラの露光時間中の各時刻の前記相対位置の予測値を算出する予測値算出部と、
前記相対位置の予測値に基づき前記カメラの各撮影周期における前記目標物の平行移動と被写体ぶれを表すフィルタを算出するフィルタ算出部と、
前記静止画像に前記フィルタを作用させることで前記カメラの各撮影周期における前記目標物の平行移動と被写体ぶれを伴った画像を生成する移動画像生成部と、
を備えることを特徴とする請求項1から4のいずれか1つに記載の制御装置。
The simulated moving image generation unit is
a predicted value calculation unit that calculates a predicted value of the relative position at each time during the exposure time of the camera in each shooting cycle of the camera based on the excitation command and the mechanical system response feature quantity;
a filter calculation unit that calculates a filter representing parallel movement of the target and subject blur in each imaging cycle of the camera based on the predicted value of the relative position;
a moving image generation unit that generates an image accompanied by parallel movement of the target and subject blur in each shooting cycle of the camera by applying the filter to the still image;
5. A control device according to any one of claims 1 to 4, characterized in that it comprises:
前記機械系応答特徴量は、
前記加振周波数における前記機械系の周波数特性のゲインと位相との組であることを特徴とする請求項1から5のいずれか1つに記載の制御装置。
The mechanical system response feature quantity is
6. The control device according to any one of claims 1 to 5, characterized in that it is a set of gain and phase of frequency characteristics of said mechanical system at said excitation frequency.
前記機械系応答特徴量は、
複素数値であり、
前記複素数値の絶対値は、
前記加振周波数における前記機械系の周波数特性のゲインに相当し、
前記複素数値の偏角は、
前記加振周波数における前記機械系の周波数特性の位相に相当することを特徴とする請求項1から6のいずれか1つに記載の制御装置。
The mechanical system response feature quantity is
is a complex value and
The absolute value of said complex value is
Corresponding to the gain of the frequency characteristic of the mechanical system at the excitation frequency,
The argument of the complex value is
7. The control device according to any one of claims 1 to 6, which corresponds to the phase of the frequency characteristic of the mechanical system at the excitation frequency.
可動部と、前記可動部の移動に伴って目標物との相対位置が変化し、前記目標物の静止画像および前記目標物の動画像を取得するカメラと、を有する機械系を制御する制御装置において、
前記カメラが前記目標物の静止画像を取得する第1のステップと、
前記カメラが前記目標物の動画像を取得する第2のステップと、
前記カメラの撮影周期に基づくナイキスト周波数よりも高い周波数帯域を含む加振周波数を算出して出力する第3のステップと、
前記加振周波数に基づき加振指令を生成して出力する第4のステップと、
前記加振指令に基づき前記可動部の駆動制御を行う第5のステップと、
前記機械系の時間応答および周波数特性の特徴を表す機械系応答特徴量の探索値と前記加振指令と前記静止画像とに基づき、前記カメラの露光時間中の前記相対位置の変化と前記カメラのセンサ特性とをシミュレーションすることで模擬動画像を生成する第6のステップと、
前記動画像と前記模擬動画像とを比較することで、前記動画像と前記模擬動画像との誤差である動画像誤差の勾配を算出する第7のステップと、
前記探索値を変更し、変更された前記探索値のそれぞれに対応する前記動画像誤差を取得し、複数の前記動画像誤差を用いて前記動画像誤差を最小化する機械系応答特徴量の最適値を探索する第8のステップと、
前記加振周波数と前記最適値とに基づき、前記機械系の周波数特性を算出する第9のステップと、
を含むことを特徴とする周波数特性の同定方法。
A control device for controlling a mechanical system having a movable part and a camera that acquires a still image of the target and a moving image of the target, the relative position of which changes with the movement of the movable part and the target. in
a first step in which the camera acquires a still image of the target;
a second step in which the camera acquires a moving image of the target;
a third step of calculating and outputting an excitation frequency including a frequency band higher than the Nyquist frequency based on the shooting cycle of the camera;
a fourth step of generating and outputting a vibration command based on the vibration frequency;
a fifth step of performing drive control of the movable portion based on the vibration command;
change in the relative position during the exposure time of the camera and the position of the camera based on the search value of the mechanical system response feature quantity representing the characteristics of the time response and frequency characteristics of the mechanical system, the excitation command, and the still image; a sixth step of generating a simulated moving image by simulating the sensor characteristics;
a seventh step of calculating a gradient of a moving image error, which is an error between the moving image and the simulated moving image, by comparing the moving image and the simulated moving image;
Optimizing a mechanical system response feature amount by changing the search value, obtaining the moving image error corresponding to each of the changed search values, and minimizing the moving image error using a plurality of the moving image errors. an eighth step of searching for a value;
a ninth step of calculating frequency characteristics of the mechanical system based on the excitation frequency and the optimum value;
A method for identifying frequency characteristics, comprising:
JP2019128472A 2019-07-10 2019-07-10 Identification method of controller and frequency characteristics Active JP7162574B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019128472A JP7162574B2 (en) 2019-07-10 2019-07-10 Identification method of controller and frequency characteristics

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019128472A JP7162574B2 (en) 2019-07-10 2019-07-10 Identification method of controller and frequency characteristics

Publications (2)

Publication Number Publication Date
JP2021015355A JP2021015355A (en) 2021-02-12
JP7162574B2 true JP7162574B2 (en) 2022-10-28

Family

ID=74531482

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019128472A Active JP7162574B2 (en) 2019-07-10 2019-07-10 Identification method of controller and frequency characteristics

Country Status (1)

Country Link
JP (1) JP7162574B2 (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010133718A (en) 2008-12-02 2010-06-17 Seiko Epson Corp Position detection method and position detection apparatus of work object
JP2015158734A (en) 2014-02-21 2015-09-03 ファナック株式会社 Numerical controller with function for calculating frequency characteristics of control loop

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017004033A (en) * 2015-06-04 2017-01-05 国立大学法人 東京大学 Positioning control system and frequency characteristic identification method

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010133718A (en) 2008-12-02 2010-06-17 Seiko Epson Corp Position detection method and position detection apparatus of work object
JP2015158734A (en) 2014-02-21 2015-09-03 ファナック株式会社 Numerical controller with function for calculating frequency characteristics of control loop

Also Published As

Publication number Publication date
JP2021015355A (en) 2021-02-12

Similar Documents

Publication Publication Date Title
JP2015213139A (en) Positioning device
JP7185860B2 (en) Calibration method for a multi-axis movable vision system
JP2018051670A (en) Robot, control device of robot, and position teaching method for robot
JP7073828B2 (en) Visual inspection system, setting device and inspection method
JP6605611B2 (en) Robot system
JP5774230B2 (en) Motion analysis by shape correction and warping
KR102537029B1 (en) Control device and control method
JP7162574B2 (en) Identification method of controller and frequency characteristics
CN110581945B (en) Control system, control device, image processing device, and storage medium
JP6668321B2 (en) Error compensation apparatus and method
WO2019208074A1 (en) Control system, control method, and program
JPWO2017138113A1 (en) Surface mounter, recognition error correction method
JP7059968B2 (en) Control device and alignment device
JP2017004033A (en) Positioning control system and frequency characteristic identification method
JPH06160022A (en) Image position correcting device
JP6595646B2 (en) Component mounting line and board inspection equipment
JP4689457B2 (en) Component mounting equipment
JP7172151B2 (en) Control systems, controllers and programs
JP7040567B2 (en) Control device, control method of control device, information processing program, and recording medium
JPH05241660A (en) Thermal deformation correcting method for electronic part loader
KR102448583B1 (en) Angle adjustment device of panoramic video camera using multi-image sensor
JP6907526B2 (en) Robot and imaging method
CN115452866A (en) Control system, control method, and storage medium
CN117351092A (en) Calibration method and calibration device of fly shooting device based on CAD model
JPH06139335A (en) Method for correcting coordinate data of electronic parts mounting device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211111

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220908

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221018

R150 Certificate of patent or registration of utility model

Ref document number: 7162574

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150