JP2019188551A - Control system, control method, and control program - Google Patents
Control system, control method, and control program Download PDFInfo
- Publication number
- JP2019188551A JP2019188551A JP2018085123A JP2018085123A JP2019188551A JP 2019188551 A JP2019188551 A JP 2019188551A JP 2018085123 A JP2018085123 A JP 2018085123A JP 2018085123 A JP2018085123 A JP 2018085123A JP 2019188551 A JP2019188551 A JP 2019188551A
- Authority
- JP
- Japan
- Prior art keywords
- control
- control parameter
- unit
- imaging
- visual sensor
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims description 36
- 230000033001 locomotion Effects 0.000 claims abstract description 95
- 230000007246 mechanism Effects 0.000 claims abstract description 72
- 238000003384 imaging method Methods 0.000 claims abstract description 62
- 230000000007 visual effect Effects 0.000 claims abstract description 56
- 230000007704 transition Effects 0.000 claims abstract description 28
- 230000008859 change Effects 0.000 claims description 25
- 238000005457 optimization Methods 0.000 claims description 11
- 238000001514 detection method Methods 0.000 claims description 7
- 239000013643 reference control Substances 0.000 claims description 4
- 238000012545 processing Methods 0.000 description 39
- 230000008569 process Effects 0.000 description 25
- 230000015654 memory Effects 0.000 description 17
- 238000004891 communication Methods 0.000 description 14
- 238000010586 diagram Methods 0.000 description 9
- 238000005259 measurement Methods 0.000 description 9
- 238000003860 storage Methods 0.000 description 9
- 230000005540 biological transmission Effects 0.000 description 5
- 239000000872 buffer Substances 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 238000004519 manufacturing process Methods 0.000 description 5
- 230000007423 decrease Effects 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004044 response Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 239000011521 glass Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 239000000758 substrate Substances 0.000 description 2
- 238000000354 decomposition reaction Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000007639 printing Methods 0.000 description 1
- 230000003936 working memory Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J13/00—Controls for manipulators
- B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D3/00—Control of position or direction
- G05D3/12—Control of position or direction using feedback
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Studio Devices (AREA)
- Manipulator (AREA)
- Feedback Control In General (AREA)
Abstract
Description
本開示は、視覚センサによって計測されたワークの位置に基づいて、ワークの位置決めを行なうための技術に関する。 The present disclosure relates to a technique for positioning a workpiece based on the position of the workpiece measured by a visual sensor.
FA(ファクトリー オートメーション)において、ワークなどの対象物の位置を目標位置に合わせる技術(位置決め技術)が各種実用化されている。この際、対象物の位置と目標位置との偏差(距離)を計測する方法として、視覚センサによって撮像された画像を用いる方法がある。 In FA (Factory Automation), various technologies (positioning technologies) for aligning the position of an object such as a workpiece with a target position have been put into practical use. At this time, as a method for measuring the deviation (distance) between the position of the object and the target position, there is a method using an image captured by a visual sensor.
特開2017−24134号公報(特許文献1)には、可動台と、可動台を移動させる移動機構と、可動台に載置されたワークを繰り返し撮像し、当該ワークの位置を繰り返し検出する視覚センサとを備えるワーク位置決め装置が開示されている。ワーク位置決め装置は、視覚センサによって位置が検出されるごとに、検出された位置と目標位置との差を算出し、当該差が許容範囲内であると判定されたときに、可動台の移動を停止する。ワーク位置決め装置は、可動台の移動停止後に視覚センサによって検出された位置と目標位置との差を算出し、算出された差が許容範囲内であるか否かを判定する。差が許容範囲外であると判定されると、当該差を小さくする可動台の移動方向が決定され、決定された移動方向へ可動台を移動させるように、移動機構が制御される。 Japanese Patent Laid-Open No. 2017-24134 (Patent Document 1) discloses a visual system in which a movable base, a moving mechanism for moving the movable base, and a work placed on the movable base are repeatedly imaged and the position of the work is repeatedly detected. A workpiece positioning device including a sensor is disclosed. Each time the position is detected by the visual sensor, the workpiece positioning device calculates the difference between the detected position and the target position, and moves the movable base when it is determined that the difference is within the allowable range. Stop. The workpiece positioning device calculates the difference between the position detected by the visual sensor after the movable table stops moving and the target position, and determines whether the calculated difference is within an allowable range. If it is determined that the difference is outside the allowable range, the moving direction of the movable table that reduces the difference is determined, and the moving mechanism is controlled to move the movable table in the determined moving direction.
視覚センサによるワークの実位置の計測処理と、計測された実位置を目標位置に合わせる位置合わせ処理とを繰り返して行なう場合、実位置から目標位置までの必要移動距離に応じて移動機構に対する移動指令を変えるフィードバック制御が有効である。 When the measurement processing of the actual position of the workpiece by the visual sensor and the alignment processing for aligning the measured actual position with the target position are repeatedly performed, the movement command to the moving mechanism according to the required moving distance from the actual position to the target position The feedback control that changes is effective.
フィードバック制御の一例として、比例制御(すなわち、P制御)が知られている。比例制御では、必要移動量に比例ゲインを乗じた値が移動指令となる。比例ゲインが小さ過ぎると、ワークが目標位置に到達するまでの時間(以下、「アライメント時間」ともいう。)が長くなる。一方で、比例ゲインが大き過ぎると、ワークが目標位置を超えるオーバーシュートが生じたり、オーバーシュートとアンダーシュートとが繰り返される振動が生じたりする。その結果、アライメント時間が長くなる。 As an example of feedback control, proportional control (that is, P control) is known. In the proportional control, a value obtained by multiplying the required movement amount by a proportional gain is a movement command. If the proportional gain is too small, the time until the workpiece reaches the target position (hereinafter also referred to as “alignment time”) becomes long. On the other hand, if the proportional gain is too large, an overshoot in which the workpiece exceeds the target position occurs, or vibration in which overshoot and undershoot are repeated occurs. As a result, the alignment time becomes long.
したがって、アライメント時間を短縮するためには、フィードバック制御の制御パラメータを最適化する必要がある。しかしながら、最適な制御パラメータを設定するには経験が必要であり、特に、経験の少ないユーザにとってはパラメータ設定に工数がかかる。 Therefore, in order to shorten the alignment time, it is necessary to optimize the control parameter of the feedback control. However, experience is required to set the optimal control parameter, and it takes time for parameter setting especially for users with little experience.
本開示は上述のような問題点を解決するためになされたものであって、ある局面における目的は、フィードバック制御に関する制御パラメータの調整工数を削減することが可能な制御システムを提供することである。他の局面における目的は、フィードバック制御に関する制御パラメータの調整工数を削減することが可能な制御方法を提供することである。他の局面における目的は、フィードバック制御に関する制御パラメータの調整工数を削減することが可能な制御プログラムを提供することである。 The present disclosure has been made to solve the above-described problems, and an object in one aspect is to provide a control system capable of reducing the man-hours for adjusting control parameters related to feedback control. . The objective in the other situation is to provide the control method which can reduce the adjustment man-hour of the control parameter regarding feedback control. An object in another aspect is to provide a control program capable of reducing the man-hours for adjusting control parameters related to feedback control.
本開示の一例では、制御システムは、対象物を移動させるための移動機構と、撮像指示を受け付けたことに基づいて上記対象物を撮像し、撮像により得られた画像から上記対象物の実位置を計測するための視覚センサと、上記撮像指示が上記視覚センサに出力される間隔よりも短い予め定められた制御周期ごとに上記移動機構の位置に関する位置関連情報を検出するための検出部と、上記実位置と上記位置関連情報とに基づいて、現時点における上記対象物の推定位置を上記制御周期ごとに決定するための位置決定部と、設定されている制御パラメータに従って、上記推定位置を上記対象物の目標位置に合わせるための移動指令を上記制御周期ごとに生成し、当該移動指令を上記制御周期ごとに上記移動機構に出力するフィードバック制御部と、予め決められた移動指令を上記移動機構に順次出力して上記検出部から得られるフィードバック値としての位置関連情報の推移に基づいて、上記制御パラメータを調整するための調整部とを備える。 In an example of the present disclosure, the control system captures an image of the object based on a moving mechanism for moving the object and an imaging instruction, and the actual position of the object from an image obtained by the imaging. A detection unit for detecting position-related information regarding the position of the moving mechanism for each predetermined control cycle shorter than the interval at which the imaging instruction is output to the visual sensor; Based on the actual position and the position-related information, the position determination unit for determining the estimated position of the target object at the present time for each control period, and the estimated position according to the set control parameter A feedback control unit that generates a movement command for matching the target position of an object for each control cycle and outputs the movement command to the movement mechanism for each control cycle , Based on the movement instruction which is determined in advance in transition position-related information as a feedback value obtained from the sequentially output to the detection unit to the moving mechanism, and an adjusting unit for adjusting the control parameter.
この開示によれば、フィードバック制御に関する制御パラメータが自動で調整される。これにより、制御システムは、フィードバック制御に関する制御パラメータの調整工数を削減することができる。 According to this disclosure, control parameters relating to feedback control are automatically adjusted. Thereby, the control system can reduce the adjustment man-hour of the control parameter regarding feedback control.
本開示の一例では、制御システムは、対象物を移動させるための移動機構と、撮像指示を受け付けたことに基づいて上記対象物を撮像し、撮像により得られた画像から上記対象物の実位置を計測するための視覚センサと、上記撮像指示が上記視覚センサに出力される間隔よりも短い予め決められた制御周期ごとに、所定の制御パラメータに従って、上記実位置を上記対象物の目標位置に合わせるための移動指令を生成し、当該移動指令を上記移動機構に出力するフィードバック制御部と、予め決められた移動指令を上記移動機構に順次出力して上記視覚センサから得られるフィードバック値としての実位置の推移に基づいて、上記制御パラメータを調整するための調整部とを備える。 In an example of the present disclosure, the control system captures an image of the object based on a moving mechanism for moving the object and an imaging instruction, and the actual position of the object from an image obtained by the imaging. And at each predetermined control cycle shorter than the interval at which the imaging instruction is output to the visual sensor, the actual position is set to the target position of the object according to a predetermined control parameter. A feedback control unit that generates a movement command for matching and outputs the movement command to the movement mechanism, and a feedback value obtained from the visual sensor by sequentially outputting a predetermined movement command to the movement mechanism. And an adjusting unit for adjusting the control parameter based on the transition of the position.
この開示によれば、フィードバック制御に関する制御パラメータが自動で調整される。これにより、制御システムは、フィードバック制御に関する制御パラメータの調整工数を削減することができる。 According to this disclosure, control parameters relating to feedback control are automatically adjusted. Thereby, the control system can reduce the adjustment man-hour of the control parameter regarding feedback control.
本開示の一例では、上記調整部は、上記推移に基づいて決定された上記制御パラメータの値を基準として、上記フィードバック制御部に設定され得る複数の制御パラメータ候補を生成し、上記複数の制御パラメータ候補の各々を上記フィードバック制御部に順次設定するとともに、各制御パラメータ候補について、上記対象物を所定位置から上記目標位置に移動するまでに要したアライメント時間を計測し、上記複数の制御パラメータ候補の内、上記アライメント時間が最短となる制御パラメータ候補を最適化結果としての上記制御パラメータとして選択する。 In an example of the present disclosure, the adjustment unit generates a plurality of control parameter candidates that can be set in the feedback control unit on the basis of the value of the control parameter determined based on the transition, and the plurality of control parameters Each of the candidates is sequentially set in the feedback control unit, and for each control parameter candidate, an alignment time required for moving the object from a predetermined position to the target position is measured, and the plurality of control parameter candidates are determined. Among them, the control parameter candidate having the shortest alignment time is selected as the control parameter as the optimization result.
この開示によれば、制御システムは、フィードバック制御に関する制御パラメータをさらに最適化することができる。 According to this disclosure, the control system can further optimize the control parameters related to feedback control.
本開示の一例では、上記調整部は、予め決められた複数の倍率のそれぞれを上記基準の制御パラメータに乗算することで、上記複数の制御パラメータ候補を生成する。 In an example of the present disclosure, the adjustment unit generates the plurality of control parameter candidates by multiplying the reference control parameter by each of a plurality of predetermined magnifications.
この開示によれば、制御システムは、基準の制御パラメータから容易に制御パラメータ候補を生成することができる。 According to this disclosure, the control system can easily generate control parameter candidates from the reference control parameters.
本開示の一例では、上記調整部は、上記推移における単位時間当たりの最大変化率を算出し、上記推移において上記最大変化率が表れる時点と、上記最大変化率とに基づいて、上記フィードバック制御部による制御対象の遅れ時間を算出し、上記遅れ時間に基づいて、上記制御パラメータを決定する。 In an example of the present disclosure, the adjustment unit calculates a maximum rate of change per unit time in the transition, and the feedback control unit is based on the time point when the maximum rate of change appears in the transition and the maximum rate of change. The delay time of the object to be controlled by is calculated, and the control parameter is determined based on the delay time.
この開示によれば、上記制御パラメータが遅れ時間に基づいて決定されることで、制御システムは、フィードバック制御に関する制御パラメータをより最適に調整することができる。 According to this disclosure, since the control parameter is determined based on the delay time, the control system can adjust the control parameter related to feedback control more optimally.
本開示の一例では、上記制御パラメータは、上記フィードバック制御部の比例制御に用いられる比例ゲインを含む。 In an example of the present disclosure, the control parameter includes a proportional gain used for proportional control of the feedback control unit.
この開示によれば、比例ゲインが自動で調整される。これにより、制御システムは、比例ゲインの調整工数を削減することができる。 According to this disclosure, the proportional gain is automatically adjusted. Thereby, the control system can reduce the man-hour for adjusting the proportional gain.
本開示の他の例では、対象物を移動させるための移動機構の制御方法は、撮像指示を視覚センサに出力することで上記対象物を撮像し、撮像により得られた画像から上記対象物の実位置を上記視覚センサに計測させるステップと、上記撮像指示が上記視覚センサに出力される間隔よりも短い予め定められた制御周期ごとに上記移動機構の位置に関する位置関連情報を検出するステップと、上記実位置と上記位置関連情報とに基づいて、現時点における上記対象物の推定位置を上記制御周期ごとに決定するステップと、設定されている制御パラメータに従って、上記推定位置を上記対象物の目標位置に合わせるための移動指令を上記制御周期ごとに生成し、当該移動指令を上記制御周期ごとに上記移動機構に出力するステップと、予め決められた移動指令を上記移動機構に順次出力して上記検出するステップで得られるフィードバック値としての位置関連情報の推移に基づいて、上記制御パラメータを調整するステップとを備える。 In another example of the present disclosure, a moving mechanism control method for moving an object captures the object by outputting an imaging instruction to a visual sensor, and the image of the object is obtained from an image obtained by imaging. A step of causing the visual sensor to measure an actual position; a step of detecting position-related information relating to the position of the moving mechanism for each predetermined control period shorter than an interval at which the imaging instruction is output to the visual sensor; Based on the actual position and the position-related information, a step of determining an estimated position of the object at a current time for each control period, and the estimated position is determined according to a set control parameter. Generating a movement command for adjusting to each control cycle, and outputting the movement command to the movement mechanism for each control cycle; The movement command sequentially outputted to the moving mechanism on the basis of transition of the location-related information as a feedback value obtained in said step of detecting includes a step of adjusting the control parameter.
この開示によれば、フィードバック制御に関する制御パラメータが自動で調整される。これにより、制御システムは、フィードバック制御に関する制御パラメータの調整工数を削減することができる。 According to this disclosure, control parameters relating to feedback control are automatically adjusted. Thereby, the control system can reduce the adjustment man-hour of the control parameter regarding feedback control.
本開示の一例では、対象物を移動させるための移動機構の制御プログラムは、上記移動機構を制御するためのコントローラに、撮像指示を視覚センサに出力することで上記対象物を撮像し、撮像により得られた画像から上記対象物の実位置を上記視覚センサに計測させるステップと、上記撮像指示が上記視覚センサに出力される間隔よりも短い予め定められた制御周期ごとに上記移動機構の位置に関する位置関連情報を検出するステップと、上記実位置と上記位置関連情報とに基づいて、現時点における上記対象物の推定位置を上記制御周期ごとに決定するステップと、設定されている制御パラメータに従って、上記推定位置を上記対象物の目標位置に合わせるための移動指令を上記制御周期ごとに生成し、当該移動指令を上記制御周期ごとに上記移動機構に出力するステップと、予め決められた移動指令を上記移動機構に順次出力して上記検出するステップで得られるフィードバック値としての位置関連情報の推移に基づいて、上記制御パラメータを調整するステップとを実行させる。 In an example of the present disclosure, a control program for a moving mechanism for moving an object captures the object by outputting an imaging instruction to a visual sensor to a controller for controlling the moving mechanism. The step of causing the visual sensor to measure the actual position of the object from the obtained image, and the position of the moving mechanism for each predetermined control cycle shorter than the interval at which the imaging instruction is output to the visual sensor. Detecting the position-related information; determining the estimated position of the target object for each control period based on the actual position and the position-related information; and according to the set control parameter, A movement command for adjusting the estimated position to the target position of the object is generated every control cycle, and the movement command is generated every control cycle. The control parameter is adjusted based on the transition of the position related information as a feedback value obtained in the step of outputting to the moving mechanism and the step of detecting and sequentially outputting a predetermined movement command to the moving mechanism. Step.
この開示によれば、フィードバック制御に関する制御パラメータが自動で調整される。これにより、制御システムは、フィードバック制御に関する制御パラメータの調整工数を削減することができる。 According to this disclosure, control parameters relating to feedback control are automatically adjusted. Thereby, the control system can reduce the adjustment man-hour of the control parameter regarding feedback control.
ある局面において、フィードバック制御に関する制御パラメータの調整工数を削減することができる。 In one aspect, it is possible to reduce the man-hours for adjusting control parameters related to feedback control.
以下、図面を参照しつつ、本発明に従う各実施の形態について説明する。以下の説明では、同一の部品および構成要素には同一の符号を付してある。それらの名称および機能も同じである。したがって、これらについての詳細な説明は繰り返さない。 Embodiments according to the present invention will be described below with reference to the drawings. In the following description, the same parts and components are denoted by the same reference numerals. Their names and functions are also the same. Therefore, detailed description thereof will not be repeated.
<A.適用例1>
まず、図1を参照して、本発明が適用される場面の一例について説明する。図1は、本実施の形態に従う制御システム1の概要を示す模式図である。
<A. Application Example 1>
First, an example of a scene to which the present invention is applied will be described with reference to FIG. FIG. 1 is a schematic diagram showing an outline of a
制御システム1は、画像処理を用いてアライメントを行なう。アライメントは、典型的には、工業製品の製造過程などにおいて、対象物(以下、「ワークW」ともいう。)を生産ラインの本来の位置に配置する処理などを意味する。このようなアライメントの一例として、制御システム1は、液晶パネルの生産ラインにおいて、ガラス基板に回路パターンの焼付処理(露光処理)前に、露光マスクに対するガラス基板の位置決めを行なう。
The
制御システム1は、たとえば、視覚センサ50と、コントローラ200と、移動機構400と、エンコーダ450とを含む。視覚センサ50は、たとえば、撮像部52と、画像処理部54とを含む。移動機構400は、たとえば、サーボドライバ402と、サーボモータ410と、ステージ420とで構成されている。
The
撮像部52は、撮像視野に存在する被写体を撮像して画像データを生成する撮像処理を行なうものであり、ステージ420に載置されるワークWを撮像する。撮像部52は、コントローラ200からの撮像トリガTRに応じて撮像を行なう。撮像部52によって生成された画像データは、画像処理部54に順次出力される。画像処理部54は、撮像部52から得られた画像データに対して画像解析を行ない、ワークWの実位置PVvを計測する。実位置PVvは、計測される度にコントローラ200に出力される。
The
コントローラ200は、たとえばPLC(プログラマブル ロジック コントローラ)であり、各種のFA制御を行なう。コントローラ200は、機能構成の一例として、位置決定部252と、フィードバック制御部254と、調整部264とを含む。
The
位置決定部252は、視覚センサ50によって計測された実位置PVvと、視覚センサ50による撮像間隔Tbよりも短い制御周期Tsごとに得られるエンコーダ値PVm(位置関連情報)とに基づいて、制御周期TsごとにワークWの位置(以下、「推定位置PV」ともいう。)を推定する。一例として、撮像周期Tbは、撮像状況などに応じて変動し、たとえば約60msである。制御周期Tsは、固定であり、たとえば1msである。推定位置PVは、制御周期Tsごとにフィードバック制御部254に出力される。
The
フィードバック制御部254は、制御パラメータ262に従って、推定位置PVを目標位置SVに合わせるための移動指令MVを制御周期Tsごとに生成し、制御周期Tsごとに移動指令MVをサーボドライバ402に出力する。移動指令MVは、たとえば、サーボドライバ402に対する指令位置、指令速度、または指令トルクのいずれかである。
The
ある局面において、目標位置SPは、生産工程ごとに予め決められており、現在の生産工程に応じて順次切り替えられる。他の局面において、目標位置SPは、視覚センサ50が所定の画像処理を行なうことにより画像内から検出される。この場合、視覚センサ50は、予め定められたマークを画像から検出し、当該マークを目標位置SPとして認識する。
In one aspect, the target position SP is determined in advance for each production process and is sequentially switched according to the current production process. In another aspect, the target position SP is detected from the image by the
フィードバック制御部254によるフィードバック制御は、たとえば、PID(Proportional Integral Differential)制御、PI制御、PD制御、またはP制御により実現される。図1の例では、P制御を行なうフィードバック制御部254が示されている。フィードバック制御部254は、減算部256と、乗算部258とで構成されている。
The feedback control by the
減算部256は、目標位置SPから、位置決定部252によって決定された推定位置PVを減算し、その減算結果を乗算部258に出力する。乗算部258は、減算部256による減算結果を、制御パラメータ262に規定される比例ゲインKp倍に増幅/減衰する。乗算部258による乗算結果は、積分処理された上で位置指令としてサーボドライバ402に出力される。あるいは、乗算部258による乗算結果は、そのまま速度指令としてサーボドライバ402に出力される。
The
サーボドライバ402は、制御周期Tsごとに受ける移動指令MVに従って、サーボモータ410を駆動する。より具体的には、サーボドライバ402は、制御周期Tsごとにエンコーダ450(検出部)からエンコーダ値PVmを取得する。サーボドライバ402は、エンコーダ値PVmにより示される速度/位置を、移動指令MVにより示される速度/位置に合わせるように、サーボモータ410をフィードバック制御する。一例として、サーボドライバ402によるフィードバック制御は、PID制御、PI制御、PD制御、またはP制御により実現される。
The
調整部264は、フィードバック制御部254に関する制御パラメータ262を調整する。より具体的には、コントローラ200は、動作モードとして、通常の制御モードと、制御パラメータ262の調整モードとを有する。動作モードが通常の制御モードに設定された場合、フィードバック制御部254とサーボドライバ402とが接続されるようにスイッチSWが切り替えられる。一方で、動作モードが調整モードに設定された場合には、調整部264とサーボドライバ402とが接続されるようにスイッチSWが切り替えられる。
The
調整モードにおいて、調整部264は、予め決められた移動指令MVnを移動機構400に順次出力し、エンコーダ450(検出部)からエンコーダ値PVmをフィードバック値として順次取得する。その後、調整部264は、取得されたエンコーダ値PVmの推移に基づいて制御パラメータ262を調整する。制御パラメータ262の調整方法の詳細については後述する。このように、制御パラメータ262が自動で調整されることで、制御パラメータ262の調整工数が削減される。
In the adjustment mode, the
なお、図1には、位置決定部252、フィードバック制御部254、調整部264、サーボドライバ402、サーボモータ410、およびエンコーダ450のコンポーネント群が1つしか示されていないが、これらのコンポーネント群は、ステージ420を駆動する軸数の分だけ設けられる。各コンポーネント群は、ステージ420の1つの軸方向における制御を担うことになる。この場合、視覚センサ50によって計測された実位置PVvは、各軸方向における実位置に分解され、分解後の各実位置が対応のコンポーネント群に出力されることとなる。
In FIG. 1, only one component group of the
<B.適用例2>
次に、図2を参照して、本発明が適用される場面の他の例について説明する。図2は、変形例に従う制御システム1の概要を示す模式図である。
<B. Application Example 2>
Next, another example of a scene to which the present invention is applied will be described with reference to FIG. FIG. 2 is a schematic diagram showing an outline of the
図1の例では、調整部264は、予め決められた移動指令MVnを移動機構400に入力してエンコーダ450から得られるエンコーダ値PVmの推移に基づいて、制御パラメータ262を調整していた。これに対して、図2の例では、調整部264は、予め決められた移動指令MVnを移動機構400に入力して視覚センサ50から得られる実位置PVvの推移に基づいて制御パラメータ262を調整する。制御パラメータ262の調整方法の詳細については後述する。
In the example of FIG. 1, the
また、図2に示される制御システム1は、位置決定部252を有さない点、エンコーダ値PVmがコントローラ200にフィードバックされない点で、図1に示される制御システム1と異なる。図2に示される制御システム1のその他の点について図1に示される制御システム1と同じであるので、それらの説明については繰り返さない。
Further, the
<C.制御システム1の装置構成>
図3は、制御システム1の装置構成の一例を説明する。図3に示されるように、制御システム1は、視覚センサ50と、コントローラ200と、移動機構400とを含む。視覚センサ50は、画像処理装置100と、1つ以上のカメラ(図3の例では、カメラ102および104)とを含む。移動機構400は、ベースプレート4,7と、ボールネジ6,9と、サーボドライバ402(図3の例では、サーボドライバ402X,402Y)と、ステージ420と、1つ以上のサーボモータ410(図3の例では、サーボモータ410X,410Y)とで構成されている。
<C. Device configuration of
FIG. 3 illustrates an example of a device configuration of the
画像処理装置100は、カメラ102,104がワークWを撮影して得られた画像データに基づいて、ワークWの特徴部分12(たとえば、ネジ穴など)を検出する。画像処理装置100は、検出した特徴部分12の位置をワークWの実位置PVvとして検出する。
The
コントローラ200には、1つ以上のサーボドライバ402(図3の例では、サーボドライバ402X,402Y)が接続されている。サーボドライバ402Xは、コントローラ200からの受けるX方向の移動指令に従って、制御対象のサーボモータ410Xを駆動する。サーボドライバ402Yは、コントローラ200からの受けるY方向の移動指令に従って、制御対象のサーボモータ410Yを駆動する。
One or more servo drivers 402 (
コントローラ200は、X方向に対して生成された目標軌道TGxに従って、サーボドライバ402Xに対してX方向の目標位置を指令値として与える。また、コントローラ200は、Y方向に対して生成された目標軌道TGyに従って、サーボドライバ402Yに対してY方向の目標位置を指令値として与える。X,Y方向のそれぞれの目標位置が順次更新されることで、ワークWが目標位置SPに移動させられる。
The
コントローラ200およびサーボドライバ402は、フィールドネットワークを介してデイジーチェーンで接続されている。フィールドネットワークには、たとえば、EtherCAT(登録商標)が採用される。但し、フィールドネットワークは、EtherCATに限定されず、任意の通信手段が採用され得る。一例として、コントローラ200およびサーボドライバ402は、信号線で直接接続されてもよい。また、コントローラ200およびサーボドライバ402は、一体的に構成されてもよい。
The
ベースプレート4には、ステージ420をX方向に沿って移動させるボールネジ6が配置されている。ボールネジ6は、ステージ420に含まれるナットと係合されている。ボールネジ6の一端に連結されたサーボモータ410Xが回転駆動することで、ステージ420に含まれるナットとボールネジ6とが相対回転し、その結果、ステージ420がX方向に沿って移動する。
A ball screw 6 that moves the
ベースプレート7は、ステージ420およびベースプレート4をY方向に沿って移動させるボールネジ9が配置されている。ボールネジ9は、ベースプレート4に含まれるナットと係合されている。ボールネジ9の一端に連結されたサーボモータ410Yが回転駆動することで、ベースプレート4に含まれるナットとボールネジ9とが相対回転し、その結果、ステージ420およびベースプレート4がY方向に沿って移動する。
The base plate 7 is provided with a ball screw 9 that moves the
なお、図3には、サーボモータ410X,410Yによる2軸駆動の移動機構400が示されているが、移動機構400は、XY平面上の回転方向(θ方向)にステージ420を駆動するサーボモータがさらに組み込まれてもよい。
3 shows a biaxially driven moving
<D.ハードウェア構成>
図4および図5を参照して、視覚センサ50を構成する画像処理装置100およびコントローラ200のハードウェア構成について順に説明する。
<D. Hardware configuration>
With reference to FIG. 4 and FIG. 5, the hardware configuration of the
(D1.画像処理装置100のハードウェア構成)
図4は、視覚センサ50を構成する画像処理装置100のハードウェア構成の一例を示す模式図である。図4を参照して、画像処理装置100は、典型的には、汎用的なコンピュータアーキテクチャに従う構造を有しており、予めインストールされたプログラムをプロセッサが実行することで、後述するような各種の画像処理を実現する。
(D1. Hardware configuration of image processing apparatus 100)
FIG. 4 is a schematic diagram illustrating an example of a hardware configuration of the
より具体的には、画像処理装置100は、CPU(Central Processing Unit)やMPU(Micro-Processing Unit)などのプロセッサ110と、RAM(Random Access Memory)112と、表示コントローラ114と、システムコントローラ116と、I/O(Input Output)コントローラ118と、ハードディスク120と、カメラインターフェイス122と、入力インターフェイス124と、コントローラインターフェイス126と、通信インターフェイス128と、メモリカードインターフェイス130とを含む。これらの各部は、システムコントローラ116を中心として、互いにデータ通信可能に接続される。
More specifically, the
プロセッサ110は、システムコントローラ116との間でプログラム(コード)などを交換して、これらを所定順序で実行することで、目的の演算処理を実現する。
The
システムコントローラ116は、プロセッサ110、RAM112、表示コントローラ114、およびI/Oコントローラ118とそれぞれバスを介して接続されており、各部との間でデータ交換などを行なうとともに、画像処理装置100全体の処理を司る。
The
RAM112は、典型的には、DRAM(Dynamic Random Access Memory)などの揮発性の記憶装置であり、ハードディスク120から読み出されたプログラムや、カメラ102および104によって取得されたカメラ画像(画像データ)、カメラ画像に対する処理結果、およびワークデータなどを保持する。
The
表示コントローラ114は、表示部132と接続されており、システムコントローラ116からの内部コマンドに従って、各種の情報を表示するための信号を表示部132へ出力する。
The
I/Oコントローラ118は、画像処理装置100に接続される記録媒体や外部機器との間のデータ交換を制御する。より具体的には、I/Oコントローラ118は、ハードディスク120と、カメラインターフェイス122と、入力インターフェイス124と、コントローラインターフェイス126と、通信インターフェイス128と、メモリカードインターフェイス130と接続される。
The I /
ハードディスク120は、典型的には、不揮発性の磁気記憶装置であり、プロセッサ110で実行される制御プログラム150に加えて、各種設定値などが格納される。このハードディスク120にインストールされる制御プログラム150は、メモリカード136などに格納された状態で流通する。なお、ハードディスク120に代えて、フラッシュメモリなどの半導体記憶装置やDVD−RAM(Digital Versatile Disk Random Access Memory)などの光学記憶装置を採用してもよい。
The
カメラインターフェイス122は、ワークを撮影することで生成された画像データを受け付ける入力部に相当し、プロセッサ110とカメラ102,104との間のデータ伝送を仲介する。カメラインターフェイス122は、カメラ102および104からの画像データをそれぞれ一時的に蓄積するための画像バッファ122aおよび122bを含む。複数のカメラに対して、カメラの間で共有できる単一の画像バッファを設けてもよいが、処理高速化のため、それぞれのカメラに対応付けて独立に複数配置することが好ましい。
The
入力インターフェイス124は、プロセッサ110とキーボード134、マウス、タッチパネル、専用コンソールなどの入力装置との間のデータ伝送を仲介する。
The
コントローラインターフェイス126は、プロセッサ110とコントローラ200との間のデータ伝送を仲介する。
The
通信インターフェイス128は、プロセッサ110と図示しない他のパーソナルコンピュータやサーバ装置などとの間のデータ伝送を仲介する。通信インターフェイス128は、典型的には、イーサネット(登録商標)やUSB(Universal Serial Bus)などからなる。
The
メモリカードインターフェイス130は、プロセッサ110と記録媒体であるメモリカード136との間のデータ伝送を仲介する。メモリカード136には、画像処理装置100で実行される制御プログラム150などが格納された状態で流通し、メモリカードインターフェイス130は、このメモリカード136から制御プログラムを読み出す。メモリカード136は、SD(Secure Digital)などの汎用的な半導体記憶デバイスや、フレキシブルディスク(Flexible Disk)などの磁気記録媒体や、CD−ROM(Compact Disk Read Only Memory)などの光学記録媒体等からなる。あるいは、通信インターフェイス128を介して、配信サーバなどからダウンロードしたプログラムを画像処理装置100にインストールしてもよい。
The
上述のような汎用的なコンピュータアーキテクチャに従う構造を有するコンピュータを利用する場合には、本実施の形態に従う機能を提供するためのアプリケーションに加えて、コンピュータの基本的な機能を提供するためのOS(Operating System)がインストールされていてもよい。この場合には、本実施の形態に従う制御プログラムは、OSの一部として提供されるプログラムモジュールのうち、必要なモジュールを所定の順序および/またはタイミングで呼び出して処理を実行するものであってもよい。 When a computer having a structure conforming to the general-purpose computer architecture as described above is used, in addition to an application for providing a function according to the present embodiment, an OS for providing a basic function of the computer ( Operating System) may be installed. In this case, the control program according to the present embodiment may execute processing by calling necessary modules out of program modules provided as part of the OS in a predetermined order and / or timing. Good.
さらに、本実施の形態に従う制御プログラムは、他のプログラムの一部に組み込まれて提供されるものであってもよい。その場合にも、プログラム自体には、上記のような組み合わせられる他のプログラムに含まれるモジュールを含んでおらず、当該他のプログラムと協働して処理が実行される。すなわち、本実施の形態に従う制御プログラムとしては、このような他のプログラムに組み込まれた形態であってもよい。 Furthermore, the control program according to the present embodiment may be provided by being incorporated in a part of another program. Even in that case, the program itself does not include the modules included in the other programs to be combined as described above, and the processing is executed in cooperation with the other programs. That is, the control program according to the present embodiment may be in a form incorporated in such another program.
なお、代替的に、制御プログラムの実行により提供される機能の一部もしくは全部を専用のハードウェア回路として実装してもよい。 Alternatively, part or all of the functions provided by executing the control program may be implemented as a dedicated hardware circuit.
(D2.コントローラ200のハードウェア構成)
図5は、コントローラ200のハードウェア構成を示す模式図である。図5を参照して、コントローラ200は、主制御ユニット210とを含む。図5には、3軸分のサーボモータ410X,410Y,410θが示されており、この軸数に応じた数のサーボドライバ402X,402Y,402が設けられる。
(D2. Hardware configuration of controller 200)
FIG. 5 is a schematic diagram illustrating a hardware configuration of the
主制御ユニット210は、チップセット212と、プロセッサ214と、不揮発性メモリ216と、主メモリ218と、システムクロック220と、メモリカードインターフェイス222と、通信インターフェイス228と、内部バスコントローラ230と、フィールドバスコントローラ238とを含む。チップセット212と他のコンポーネントとの間は、各種のバスを介してそれぞれ結合されている。
The
プロセッサ214およびチップセット212は、典型的には、汎用的なコンピュータアーキテクチャに従う構成を有している。すなわち、プロセッサ214は、チップセット212から内部クロックに従って順次供給される命令コードを解釈して実行する。チップセット212は、接続されている各種コンポーネントとの間で内部的なデータを遣り取りするとともに、プロセッサ214に必要な命令コードを生成する。システムクロック220は、予め定められた周期のシステムクロックを発生してプロセッサ214に提供する。チップセット212は、プロセッサ214での演算処理の実行の結果得られたデータなどをキャッシュする機能を有する。
The
主制御ユニット210は、記憶手段として、不揮発性メモリ216および主メモリ218を有する。不揮発性メモリ216は、OS、システムプログラム、ユーザプログラム、データ定義情報、ログ情報などを不揮発的に保持する。主メモリ218は、揮発性の記憶領域であり、プロセッサ214で実行されるべき各種プログラムを保持するとともに、各種プログラムの実行時の作業用メモリとしても使用される。
The
主制御ユニット210は、通信手段として、通信インターフェイス228と、内部バスコントローラ230と、フィールドバスコントローラ238とを有する。これらの通信回路は、データの送信および受信を行なう。
The
通信インターフェイス228は、画像処理装置100との間でデータを遣り取りする。
内部バスコントローラ230は、内部バス226を介したデータの遣り取りを制御する。より具体的には、内部バスコントローラ230は、バッファメモリ236と、DMA(Dynamic Memory Access)制御回路232と、内部バス制御回路234とを含む。
The
The
メモリカードインターフェイス222は、主制御ユニット210に対して着脱可能なメモリカード224とプロセッサ214とを接続する。
The
フィールドバスコントローラ238は、フィールドネットワークに接続するための通信インターフェイスである。コントローラ200は、フィールドバスコントローラ238を介してサーボドライバ402(たとえば、サーボドライバ402X,402Y,402θ)と接続される。当該フィールドネットワークには、たとえば、EtherCAT(登録商標)、EtherNet/IP(登録商標)、CompoNet(登録商標)などが採用される。
The
<E.制御パラメータ262の調整処理>
図6および図7を参照して、調整部264による制御パラメータ262の調整フローについて説明する。
<E. Adjustment processing of
The adjustment flow of the
図6は、制御パラメータ262の調整処理の流れを表わすフローチャートである。図6に示される処理は、コントローラ200のプロセッサ214が調整部264として機能することにより実現される。他の局面において、図6に示される処理の一部または全部が、回路素子またはその他のハードウェアによって実行されてもよい。
FIG. 6 is a flowchart showing the flow of the adjustment process for the
図6に示される処理は、ある軸方向に対する制御フローを表わす。実際には、図6に示される各処理は、軸方向の分だけ並列に実行される。 The process shown in FIG. 6 represents a control flow for a certain axial direction. Actually, the processes shown in FIG. 6 are executed in parallel in the axial direction.
ステップS110において、調整部264は、初期化処理を実行する。一例として、プロセッサ214は、計測時間tを0に初期化し、フィードバック値を記憶するための変数PVn−1を0に初期化する。ここでいう「フィードバック値」とは、図1の例ではエンコーダ450によって検出されたエンコーダ値PVmに相当し、図2の例では視覚センサ50によって計測された実位置PVvに相当する。
In step S110, the
ステップS112において、調整部264は、下記の(式1)に従って、サーボドライバ402に出力するための移動指令MVnを生成し、移動指令MVnをサーボドライバ402に出力する。
In step S <
MVn=Rmv*t ・・・(式1)
ステップS114において、調整部264は、移動指令MVnの応答としてフィードバック値PVnを取得する。上述のように、「フィードバック値」とは、図1の例ではエンコーダ450によって検出されたエンコーダ値PVmに相当し、図2の例では視覚センサ50によって計測された実位置PVvに相当する。
MV n = R mv * t (Formula 1)
In step S114, the
ステップS120において、調整部264は、下記(式2)に従って、フィードバック値PVnの時間当たりの変化率が現時点での最大変化率Rmaxを超えているか否かを判断する。より具体的には、調整部264は、今回のフィードバック値PVnから前回のフィードバック値PVn−1を差分し、当該差分結果を制御周期Tsで除算し、当該除算結果が現時点での最大変化率Rmaxを超えているか否かを判断する。
In step S120, the
(PVn−PVn−1)/Ts>Rmax ・・・(式2)
調整部264は、フィードバック値PVnの時間当たりの変化率が現時点での最大変化率Rmaxを超えていると判断した場合(ステップS120においてYES)、制御をステップS122に切り替える。そうでない場合には(ステップS120においてNO)、調整部264は、制御をステップS130に切り替える。
(PV n -PV n-1) / Ts> R max ··· ( Equation 2)
ステップS122において、調整部264は、下記(式3)に従って、現時点で記録されている最大変化率Rmaxを新たに更新された最大変化率に書き換える。
In step S122, the adjusting
Rmax=(PVn−PVn−1)/Ts ・・・(式3)
また、調整部264は、最大変化率Rmaxが出現した時点におけるフィードバック値PVnをフィードバック値PVrとして記憶する。また、調整部264は、最大変化率Rmaxが出現した時間を時間Trとして記憶する。ステップS122で記憶される各種情報は、たとえば、コントローラ200の記憶部(たとえば、不揮発性メモリ216または主メモリ218(図5参照))に格納する。
R max = (PV n −PV n−1 ) / Ts (Formula 3)
Further, the
ステップS124において、調整部264は、今回のフィードバック値PVnで前回のフィードバック値PVn−1を更新する。また、調整部264は、計測時間tに制御周期Tsを加算し、計測時間tを更新する。
In step S124, the adjusting
ステップS130において、調整部264は、フィードバック値の計測を終了するか否かを判断する。一例として、調整部264は、予め定められた計測終了条件が満たされた場合に、フィードバック値の計測を終了すると判断する。ある局面において、計測終了条件は、ステップS130の処理の実行回数が予め定められた回数に達した場合に満たされる。他の局面において、計測終了条件は、最大変化率Rmaxが一定値に収束した場合に満たされる。調整部264は、フィードバック値の計測を終了すると判断した場合(ステップS130においてYES)、制御をステップS140に切り替える。そうでない場合には(ステップS130においてNO)、調整部264は、制御をステップS112に戻す。
In step S130, the
図7は、移動機構400に入力された移動指令MVnと、その応答として移動機構400から出力されるフィードバック値PVnとの関係を時間軸上に示す図である。
FIG. 7 is a diagram showing, on the time axis, the relationship between the movement command MV n input to the moving
ステップS112の処理が繰り返されることで、図7に示されるランプ状の移動指令MVnがサーボドライバ402に入力されることになる。なお、移動指令MVnが位置指令である場合には、サーボドライバ402に入力される移動指令MVnは、図7に示されるようなランプ状になるが、移動指令MVnが速度指令である場合には、サーボドライバ402に入力される移動指令MVnは一定値となる。
By repeating the process of step S112, the ramp-shaped movement command MV n shown in FIG. 7 is input to the
調整部264は、予め決められた移動指令MVnを移動機構400に順次出力して得られたフィードバック値PVnの推移に基づいて、フィードバック制御部254に係る制御パラメータ262(たとえば、比例ゲインKp)を調整する。
The
より具体的には、ステップS140において、調整部264は、下記(式4)に従って、定常ゲインKを算出する。
More specifically, in step S140, the
K=Rmax/Rmv ・・・(式4)
(式4)に示される「Rmax」は、ステップS122で記憶された最大変化率に相当する。「Rmv」は、移動指令MVnの推移における傾き(すなわち、変化率)を表わす。
K = R max / R mv (Formula 4)
“R max ” shown in (Expression 4) corresponds to the maximum change rate stored in step S122. “R mv ” represents an inclination (that is, a change rate) in the transition of the movement command MV n .
ステップS142において、調整部264は、フィードバック制御部254の制御対象の遅れ時間を算出する。「遅れ時間」とは、フィードバック制御部254の制御対象に対して移動指令を与えてから、当該移動指令に応じた出力が現れるまでの時間を表わす。フィードバック制御部254の制御対象は、図1に示される制御システム1の例では、移動機構400とエンコーダ450とを含む制御系を指す。一方で、フィードバック制御部254の制御対象は、図2に示される制御システム1の例では、視覚センサ50と、移動機構400と、エンコーダ450とを含む制御系を指す。
In step S142, the
調整部264は、フィードバック値PVnの推移において最大変化率Rmaxが出現した時間Trと、最大変化率Rmaxとに基づいて、フィードバック制御部254による制御対象の遅れ時間Lを算出する。一例として、遅れ時間Lは、下記(式5)に基づいて算出される。
L=Tr−PVr/Rmax ・・・(式5)
ステップS144において、調整部264は、ステップS140で算出した定常ゲインKと、ステップS142で算出した遅れ時間Lとに基づいて、比例ゲインKpを算出する。比例ゲインKpは、たとえば、下記(式6)に基づいて算出される。
L = T r −PV r / R max (Formula 5)
In step S144, the
Kp=α/(K・L) ・・・(式6)
(式6)に示される「α」は、予め定められた係数である。(式6)に示されるように、遅れ時間Lが長いほど、調整部264は、比例ゲインKpを小さくする。異なる言い方をすれば、遅れ時間Lが短いほど、調整部264は、比例ゲインKpを大きくする。また、定常ゲインが大きいほど、調整部264は、比例ゲインKpを小さくする。異なる言い方をすれば、定常ゲインが小さいほど、調整部264は、比例ゲインKpを大きくする。
Kp = α / (K · L) (Formula 6)
“Α” shown in (Expression 6) is a predetermined coefficient. As shown in (Expression 6), as the delay time L is longer, the
ステップS146において、調整部264は、ステップS144で算出した比例ゲインKpをフィードバック制御部254の制御パラメータ262として設定する。
In step S146, the
なお、上述では、ステップS140で定常ゲインKが算出される例について説明を行なったが、図1に示される制御システム1のように、入力値としての移動指令MVと、出力値としてのフィードバック値PVnとが定常的に一致する場合には、定常ゲインKが1となるので、ステップS140の処理は省略されてもよい。「K=1」となる場合、比例ゲインKpは、上記(式6)に示されるように、遅れ時間Lに基づいて決められる。また、「K=1」となる場合、遅れ時間Lは、下記(式7)に基づいて算出される。
In the above description, the example in which the steady gain K is calculated in step S140 has been described. However, as in the
L=Tr−PVr/Rmv ・・・(式7)
また、図6の例では、ステップS110において、フィードバック値PVn−1の初期値が0に設定される例について説明を行なったが、フィードバック値PVn−1の初期値は、必ずしも0に設定される必要はない。一例として、フィードバック値の初期値が一定値PV0に安定している場合には、遅れ時間Lは、下記(式8)に基づいて算出される。
L = T r −PV r / R mv (Formula 7)
In the example of FIG. 6, the example in which the initial value of the feedback value PV n−1 is set to 0 in step S110 has been described. However, the initial value of the feedback value PV n−1 is not necessarily set to 0. There is no need to be done. As an example, when the initial value of the feedback value is stable at the constant value PV0, the delay time L is calculated based on the following (Equation 8).
L=Tr−(PVr−PV0)/Rmax ・・・(式8)
また、図6の例では、フィードバック値PVnの最大変化率RmaxがステップS122で逐次更新される例について説明を行なったが、調整部264は、ステップS114で計測されたフィードバック値PVnを全て記憶しておき、記憶された全てのフィードバック値PVnから最大変化率Rmaxを算出してもよい。
L = T r − (PV r −PV 0) / R max (Equation 8)
In the example of FIG. 6, the example in which the maximum change rate R max of the feedback value PV n is sequentially updated in step S122 has been described. However, the
<F.制御パラメータ262の最適化処理>
図8を参照して、上記「E.制御パラメータ262の調整処理」で決定された制御パラメータ262の最適化処理について説明する。
<F. Optimization processing of
With reference to FIG. 8, the optimization process of the
図8は、制御パラメータ262の最適化処理の流れ表わすフローチャートである。図8に示される処理は、コントローラ200のプロセッサ214が調整部264として機能することにより実現される。他の局面において、図8に示される処理の一部または全部が、回路素子またはその他のハードウェアによって実行されてもよい。
FIG. 8 is a flowchart showing the flow of the optimization process for the
以下では、上記「E.制御パラメータ262の調整処理」で決定された制御パラメータ262を「基準の比例ゲインKp」ともいう。
Hereinafter, the
ステップS150において、調整部264は、基準の比例ゲインKpに乗じる倍率β(i)を取得する。倍率β(i)は、予め定められていてもよいし、ユーザによって任意に設定されてもよい。倍率β(i)は、たとえば、変数「β(1)〜β(n)」を管理する配列データである。
In step S150, the
ステップS152において、調整部264は、変数iを1に初期化する。
ステップS154において、調整部264は、基準の比例ゲインKpに倍率β(i)を乗算し、設定候補の比例ゲインKp(i)を生成する。
In step S152, the
In step S154, the
ステップS156において、調整部264は、ステップS154で生成した設定候補の比例ゲインKp(i)をフィードバック制御部254に設定するとともに、所定のアライメント処理をフィードバック制御部254に実行させる。一例として、当該所定のアライメント処理は、予め定められた開始位置から予め定められた目標位置SPまでワークWを移動する処理である。このとき、調整部264は、予め定められた開始位置から予め定められた目標位置SPまでワークWを移動するまでに要するアライメント時間Ta(i)を計測しておく。
In step S156, the
ステップS158において、調整部264は、ステップS156で計測されたアライメント時間Ta(i)をコントローラ200の記憶部(たとえば、不揮発性メモリ216または主メモリ218(図5参照))に格納する。
In step S158, the
ステップS160において、調整部264は、変数iをインクリメントする。すなわち、調整部264は、変数iに1を加算する。
In step S160, the
ステップS170において、調整部264は、変数iが所定値nよりも小さいか否かを判断する。所定値nは、ステップS154,S156,S158,S160の実行回数を表し、予め規定されている。調整部264は、変数iが所定値nよりも小さいと判断した場合(ステップS170においてYES)、制御をステップS154に戻す。そうでない場合には(ステップS170においてNO)、調整部264は、制御をステップS172に切り替える。
In step S170, the
ステップS172において、調整部264は、制御パラメータ候補Kp(i)の内、アライメント時間Ta(i)が最短となる制御パラメータ候補を最適結果としての制御パラメータ262として選択する。
In step S172, the
以上のように、調整部264は、予め決められた倍率β(i)のそれぞれを基準の比例ゲインKpに乗算することで制御パラメータ候補Kp(i)を生成する。そして、調整部264は、制御パラメータ候補Kp(i)の各々をフィードバック制御部254の制御パラメータ262に順次設定するとともに、各制御パラメータ候補について、ワークWを所定位置から目標位置SPに移動するまでに要したアライメント時間Ta(i)を計測する。その後、調整部264は、制御パラメータ候補Kp(i)の内、アライメント時間Ta(i)が最短となる制御パラメータ候補を最適化結果としての制御パラメータ262として選択する。これにより、調整部264は、上記「E.制御パラメータ262の調整処理」で決定された制御パラメータ262をさらに最適化することができる。
As described above, the
なお、図8の例では、アライメント時間Ta(i)が最短となる制御パラメータ候補を最適化結果として選択する例について説明を行なったが、その他の評価指標に基づいて、制御パラメータ262が最適化されてもよい。一例として、調整部264は、各制御パラメータ候補について最大オーバーシュート距離を算出し、最大オーバーシュート距離が最小となる制御パラメータ候補を最適化結果として選択してもよい。あるいは、調整部264は、各制御パラメータ候補について移動距離を算出し、移動距離が最小となる制御パラメータ候補を最適化結果として選択してもよい。
In the example of FIG. 8, the example in which the control parameter candidate having the shortest alignment time Ta (i) is selected as the optimization result has been described. However, the
<G.推定位置PVの決定処理>
図9は、図1に示される位置決定部252による推定位置PVの決定処理を表わすフローチャートである。以下では、図9を参照して、位置決定部252による推定位置PVの決定処理について説明する。
<G. Determination process of estimated position PV>
FIG. 9 is a flowchart showing a process for determining estimated position PV by
ステップS421において、位置決定部252は、視覚センサ50から実位置PVvが得られているか否かを検出する。位置決定部252は、実位置PVvが得られている時刻であれば(ステップS421においてYES)、制御をステップS422に切り替える。そうでない場合には(ステップS421においてNO)、位置決定部252は、制御をステップS427に切り替える。
In step S <b> 421, the
ステップS422において、位置決定部252は、実位置PVvが正常値であるか否かを判断する。たとえば、位置決定部252は、実位置PVvが所定範囲内の値であれば正常値であると判断する。位置決定部252は、実位置PVvが正常値であると判断した場合(ステップS422においてYES)、制御をステップS423に切り替える。そうでない場合には(ステップS427においてNO)、位置決定部252は、制御をステップS427に切り替える。
In step S422, the
ステップS423において、位置決定部252は、実位置PVvの入力を受け付ける。ステップS424において、位置決定部252は、実位置PVvの入力を受け付けると、当該実位置PVvの算出の元となる撮像時刻のエンコーダ値PVmsの推定を行なう。なお、撮像部52の露光時間が長い場合、撮像時刻は、たとえば、露光開始時刻(撮像部52のシャッターが開となる時刻)と露光終了時刻(撮像部52のシャッターが閉となる時刻)との中間の時刻によって設定される。
In step S423, the
ステップS425において、位置決定部252は、同時刻の実位置PVvおよびエンコーダ値PVmと、当該実位置PVvの算出元となる撮像時刻のエンコーダ値PVmsとを用いて、推定位置PVを算出する。より具体的には、ステップS425では、位置決定部252は、次の(式9)を用いて、推定位置PVを算出する。
In step S425, the
PV=PVv+(PVm−PVms) ・・・(式9)
ステップS426において、位置決定部252は、算出した推定位置PVをフィードバック制御部254に出力する。また、位置決定部252は、この推定位置PVを参照推定位置PVpとし、この時刻のエンコーダ値PVmを参照エンコーダ値PVmpとして記憶する。
PV = PV v + (PV m −PV ms ) (Equation 9)
In step S <b> 426, the
ステップS427において、位置決定部252は、実位置PVvの出力が1回以上であるか否かを判断する。位置決定部252は、実位置PVvの出力が1回以上であると判断した場合(ステップS427においてYES)、制御をステップS428に切り替える。そうでない場合には(ステップS427においてNO)、プロセッサ214は、制御をステップS426に切り替える。
In step S427, the
ステップS428において、位置決定部252は、エンコーダ値PVm、参照推定位置PVp、および、参照エンコーダ値PVmpを用いて、推定位置PVを算出する。より具体的には、ステップS428では、位置決定部252は、次の(式10)を用いて、推定位置PVを算出する。
In step S428, the
PV=PVp+PVm―PVmp ・・・(式10)
<H.付記>
以上のように、本実施形態は以下のような開示を含む。
PV = PV p + PV m −PV mp (Equation 10)
<H. Addendum>
As described above, the present embodiment includes the following disclosure.
[構成1]
対象物を移動させるための移動機構(400)と、
撮像指示を受け付けたことに基づいて前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を計測するための視覚センサ(50)と、
前記撮像指示が前記視覚センサ(50)に出力される間隔よりも短い予め定められた制御周期ごとに前記移動機構(400)の位置に関する位置関連情報を検出するための検出部(450)と、
前記実位置と前記位置関連情報とに基づいて、現時点における前記対象物の推定位置を前記制御周期ごとに決定するための位置決定部(252)と、
設定されている制御パラメータに従って、前記推定位置を前記対象物の目標位置に合わせるための移動指令を前記制御周期ごとに生成し、当該移動指令を前記制御周期ごとに前記移動機構(400)に出力するフィードバック制御部(254)と、
予め決められた移動指令を前記移動機構(400)に順次出力して前記検出部(450)から得られるフィードバック値としての位置関連情報の推移に基づいて、前記制御パラメータを調整するための調整部(264)とを備える、制御システム(1)。
[Configuration 1]
A moving mechanism (400) for moving the object;
A visual sensor (50) for imaging the object based on receiving an imaging instruction and measuring an actual position of the object from an image obtained by imaging;
A detection unit (450) for detecting position-related information regarding the position of the moving mechanism (400) for each predetermined control cycle shorter than the interval at which the imaging instruction is output to the visual sensor (50);
A position determination unit (252) for determining an estimated position of the object at a current time for each control period based on the actual position and the position related information;
According to the set control parameter, a movement command for adjusting the estimated position to the target position of the object is generated for each control cycle, and the movement command is output to the movement mechanism (400) for each control cycle. A feedback control unit (254) for
An adjustment unit for adjusting the control parameter based on a transition of position-related information as a feedback value obtained by sequentially outputting a predetermined movement command to the movement mechanism (400) and obtained from the detection unit (450). (264), a control system (1).
[構成2]
対象物を移動させるための移動機構(400)と、
撮像指示を受け付けたことに基づいて前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を計測するための視覚センサ(50)と、
前記撮像指示が前記視覚センサ(50)に出力される間隔よりも短い予め決められた制御周期ごとに、所定の制御パラメータに従って、前記実位置を前記対象物の目標位置に合わせるための移動指令を生成し、当該移動指令を前記移動機構(400)に出力するフィードバック制御部(254)と、
予め決められた移動指令を前記移動機構(400)に順次出力して前記視覚センサ(50)から得られるフィードバック値としての実位置の推移に基づいて、前記制御パラメータを調整するための調整部(264)とを備える、制御システム(1)。
[Configuration 2]
A moving mechanism (400) for moving the object;
A visual sensor (50) for imaging the object based on receiving an imaging instruction and measuring an actual position of the object from an image obtained by imaging;
For each predetermined control period shorter than the interval at which the imaging instruction is output to the visual sensor (50), a movement command for adjusting the actual position to the target position of the target object according to a predetermined control parameter. A feedback control unit (254) that generates and outputs the movement command to the movement mechanism (400);
An adjustment unit (adjustment unit) for adjusting the control parameter based on a transition of an actual position as a feedback value obtained by sequentially outputting predetermined movement commands to the movement mechanism (400) and obtained from the visual sensor (50). H.264), a control system (1).
[構成3]
前記調整部(264)は、
前記推移に基づいて決定された前記制御パラメータの値を基準として、前記フィードバック制御部(254)に設定され得る複数の制御パラメータ候補を生成し、
前記複数の制御パラメータ候補の各々を前記フィードバック制御部(254)に順次設定するとともに、各制御パラメータ候補について、前記対象物を所定位置から前記目標位置に移動するまでに要したアライメント時間を計測し、
前記複数の制御パラメータ候補の内、前記アライメント時間が最短となる制御パラメータ候補を最適化結果としての前記制御パラメータとして選択する、構成1または2に記載の制御システム(1)。
[Configuration 3]
The adjustment unit (264)
Generating a plurality of control parameter candidates that can be set in the feedback control unit (254) based on the value of the control parameter determined based on the transition,
Each of the plurality of control parameter candidates is sequentially set in the feedback control unit (254), and for each control parameter candidate, an alignment time required for moving the object from a predetermined position to the target position is measured. ,
The control system (1) according to
[構成4]
前記調整部(264)は、予め決められた複数の倍率のそれぞれを前記基準の制御パラメータに乗算することで、前記複数の制御パラメータ候補を生成する、構成3に記載の制御システム(1)。
[Configuration 4]
The control system (1) according to Configuration 3, wherein the adjustment unit (264) generates the plurality of control parameter candidates by multiplying each of a plurality of predetermined magnifications by the reference control parameter.
[構成5]
前記調整部(264)は、
前記推移における単位時間当たりの最大変化率を算出し、
前記推移において前記最大変化率が表れる時点と、前記最大変化率とに基づいて、前記フィードバック制御部(254)による制御対象の遅れ時間を算出し、
前記遅れ時間に基づいて、前記制御パラメータを決定する、構成1〜4のいずれか1項に記載の制御システム(1)。
[Configuration 5]
The adjustment unit (264)
Calculate the maximum rate of change per unit time in the transition,
Based on the time when the maximum rate of change appears in the transition and the maximum rate of change, the delay time of the object to be controlled by the feedback control unit (254) is calculated,
The control system (1) according to any one of
[構成6]
前記制御パラメータは、前記フィードバック制御部(254)の比例制御に用いられる比例ゲインを含む、構成1〜5のいずれか1項に記載の制御システム(1)。
[Configuration 6]
The control system (1) according to any one of
[構成7]
対象物を移動させるための移動機構(400)の制御方法であって、
撮像指示を視覚センサ(50)に出力することで前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を前記視覚センサ(50)に計測させるステップと、
前記撮像指示が前記視覚センサ(50)に出力される間隔よりも短い予め定められた制御周期ごとに前記移動機構(400)の位置に関する位置関連情報を検出するステップと、
前記実位置と前記位置関連情報とに基づいて、現時点における前記対象物の推定位置を前記制御周期ごとに決定するステップと、
設定されている制御パラメータに従って、前記推定位置を前記対象物の目標位置に合わせるための移動指令を前記制御周期ごとに生成し、当該移動指令を前記制御周期ごとに前記移動機構(400)に出力するステップと、
予め決められた移動指令を前記移動機構(400)に順次出力して前記検出するステップで得られるフィードバック値としての位置関連情報の推移に基づいて、前記制御パラメータを調整するステップとを備える、制御方法。
[Configuration 7]
A control method of a moving mechanism (400) for moving an object,
Imaging the object by outputting an imaging instruction to the visual sensor (50), and causing the visual sensor (50) to measure the actual position of the object from an image obtained by imaging;
Detecting position related information related to the position of the moving mechanism (400) for each predetermined control period shorter than the interval at which the imaging instruction is output to the visual sensor (50);
Determining an estimated position of the object at a current time for each control period based on the actual position and the position related information;
According to the set control parameter, a movement command for adjusting the estimated position to the target position of the object is generated for each control cycle, and the movement command is output to the movement mechanism (400) for each control cycle. And steps to
A step of adjusting the control parameter based on a transition of position related information as a feedback value obtained in the step of sequentially outputting a predetermined movement command to the movement mechanism (400) and detecting the control. Method.
[構成8]
対象物を移動させるための移動機構(400)の制御プログラムであって、
前記制御プログラムは、前記移動機構(400)を制御するためのコントローラに、
撮像指示を視覚センサ(50)に出力することで前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を前記視覚センサ(50)に計測させるステップと、
前記撮像指示が前記視覚センサ(50)に出力される間隔よりも短い予め定められた制御周期ごとに前記移動機構(400)の位置に関する位置関連情報を検出するステップと、
前記実位置と前記位置関連情報とに基づいて、現時点における前記対象物の推定位置を前記制御周期ごとに決定するステップと、
設定されている制御パラメータに従って、前記推定位置を前記対象物の目標位置に合わせるための移動指令を前記制御周期ごとに生成し、当該移動指令を前記制御周期ごとに前記移動機構(400)に出力するステップと、
予め決められた移動指令を前記移動機構(400)に順次出力して前記検出するステップで得られるフィードバック値としての位置関連情報の推移に基づいて、前記制御パラメータを調整するステップとを実行させる、制御プログラム。
[Configuration 8]
A control program for a moving mechanism (400) for moving an object,
The control program stores a controller for controlling the moving mechanism (400).
Imaging the object by outputting an imaging instruction to the visual sensor (50), and causing the visual sensor (50) to measure the actual position of the object from an image obtained by imaging;
Detecting position related information related to the position of the moving mechanism (400) for each predetermined control period shorter than the interval at which the imaging instruction is output to the visual sensor (50);
Determining an estimated position of the object at a current time for each control period based on the actual position and the position related information;
According to the set control parameter, a movement command for adjusting the estimated position to the target position of the object is generated for each control cycle, and the movement command is output to the movement mechanism (400) for each control cycle. And steps to
Performing a step of adjusting the control parameter based on a transition of position-related information as a feedback value obtained by sequentially outputting a predetermined movement command to the movement mechanism (400) and detecting the predetermined value; Control program.
今回開示された実施の形態は全ての点で例示であって制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて特許請求の範囲によって示され、特許請求の範囲と均等の意味および範囲内での全ての変更が含まれることが意図される。 The embodiments disclosed this time should be considered as illustrative in all points and not restrictive. The scope of the present invention is defined by the terms of the claims, rather than the description above, and is intended to include any modifications within the scope and meaning equivalent to the terms of the claims.
1 制御システム、4,7 ベースプレート、6,9 ボールネジ、12 特徴部分、50 視覚センサ、52 撮像部、54 画像処理部、100 画像処理装置、102,104 カメラ、110,214 プロセッサ、112 RAM、114 表示コントローラ、116 システムコントローラ、118 I/Oコントローラ、120 ハードディスク、122 カメラインターフェイス、122a 画像バッファ、124 入力インターフェイス、126 コントローラインターフェイス、128,228 通信インターフェイス、130,222 メモリカードインターフェイス、132 表示部、134 キーボード、136,224 メモリカード、150 制御プログラム、210 主制御ユニット、212 チップセット、216 不揮発性メモリ、218 主メモリ、220 システムクロック、226 内部バス、230 内部バスコントローラ、232 制御回路、234 内部バス制御回路、236 バッファメモリ、238 フィールドバスコントローラ、252 位置決定部、254 フィードバック制御部、256 減算部、258 乗算部、262 制御パラメータ、264 調整部、400 移動機構、402,402X,402Y サーボドライバ、410,410X,410Y サーボモータ、420 ステージ、450 エンコーダ。
DESCRIPTION OF
Claims (8)
撮像指示を受け付けたことに基づいて前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を計測するための視覚センサと、
前記撮像指示が前記視覚センサに出力される間隔よりも短い予め定められた制御周期ごとに前記移動機構の位置に関する位置関連情報を検出するための検出部と、
前記実位置と前記位置関連情報とに基づいて、現時点における前記対象物の推定位置を前記制御周期ごとに決定するための位置決定部と、
設定されている制御パラメータに従って、前記推定位置を前記対象物の目標位置に合わせるための移動指令を前記制御周期ごとに生成し、当該移動指令を前記制御周期ごとに前記移動機構に出力するフィードバック制御部と、
予め決められた移動指令を前記移動機構に順次出力して前記検出部から得られるフィードバック値としての位置関連情報の推移に基づいて、前記制御パラメータを調整するための調整部とを備える、制御システム。 A moving mechanism for moving the object;
A visual sensor for imaging the object based on receiving an imaging instruction and measuring the actual position of the object from an image obtained by imaging;
A detection unit for detecting position-related information regarding the position of the moving mechanism for each predetermined control cycle shorter than the interval at which the imaging instruction is output to the visual sensor;
Based on the actual position and the position related information, a position determination unit for determining an estimated position of the object at the present time for each control period;
Feedback control for generating a movement command for adjusting the estimated position to the target position of the target object for each control cycle in accordance with a set control parameter and outputting the movement command to the moving mechanism for each control cycle And
A control system comprising: an adjustment unit for adjusting the control parameter based on a transition of position related information as a feedback value obtained by sequentially outputting a predetermined movement command to the movement mechanism and obtained from the detection unit; .
撮像指示を受け付けたことに基づいて前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を計測するための視覚センサと、
前記撮像指示が前記視覚センサに出力される間隔よりも短い予め決められた制御周期ごとに、所定の制御パラメータに従って、前記実位置を前記対象物の目標位置に合わせるための移動指令を生成し、当該移動指令を前記移動機構に出力するフィードバック制御部と、
予め決められた移動指令を前記移動機構に順次出力して前記視覚センサから得られるフィードバック値としての実位置の推移に基づいて、前記制御パラメータを調整するための調整部とを備える、制御システム。 A moving mechanism for moving the object;
A visual sensor for imaging the object based on receiving an imaging instruction and measuring the actual position of the object from an image obtained by imaging;
For each predetermined control period shorter than the interval at which the imaging instruction is output to the visual sensor, a movement command for adjusting the actual position to the target position of the object is generated according to a predetermined control parameter, A feedback control unit that outputs the movement command to the movement mechanism;
A control system comprising: an adjustment unit that adjusts the control parameter based on a transition of an actual position as a feedback value obtained by sequentially outputting predetermined movement commands to the movement mechanism and obtained from the visual sensor.
前記推移に基づいて決定された前記制御パラメータの値を基準として、前記フィードバック制御部に設定され得る複数の制御パラメータ候補を生成し、
前記複数の制御パラメータ候補の各々を前記フィードバック制御部に順次設定するとともに、各制御パラメータ候補について、前記対象物を所定位置から前記目標位置に移動するまでに要したアライメント時間を計測し、
前記複数の制御パラメータ候補の内、前記アライメント時間が最短となる制御パラメータ候補を最適化結果としての前記制御パラメータとして選択する、請求項1または2に記載の制御システム。 The adjustment unit is
Based on the value of the control parameter determined based on the transition, generate a plurality of control parameter candidates that can be set in the feedback control unit,
Each of the plurality of control parameter candidates is sequentially set in the feedback control unit, and for each control parameter candidate, the alignment time required to move the object from a predetermined position to the target position is measured,
The control system according to claim 1 or 2, wherein a control parameter candidate having the shortest alignment time among the plurality of control parameter candidates is selected as the control parameter as an optimization result.
前記推移における単位時間当たりの最大変化率を算出し、
前記推移において前記最大変化率が表れる時点と、前記最大変化率とに基づいて、前記フィードバック制御部による制御対象の遅れ時間を算出し、
前記遅れ時間に基づいて、前記制御パラメータを決定する、請求項1〜4のいずれか1項に記載の制御システム。 The adjustment unit is
Calculate the maximum rate of change per unit time in the transition,
Based on the time when the maximum rate of change appears in the transition and the maximum rate of change, the delay time of the control object by the feedback control unit is calculated,
The control system according to claim 1, wherein the control parameter is determined based on the delay time.
撮像指示を視覚センサに出力することで前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を前記視覚センサに計測させるステップと、
前記撮像指示が前記視覚センサに出力される間隔よりも短い予め定められた制御周期ごとに前記移動機構の位置に関する位置関連情報を検出するステップと、
前記実位置と前記位置関連情報とに基づいて、現時点における前記対象物の推定位置を前記制御周期ごとに決定するステップと、
設定されている制御パラメータに従って、前記推定位置を前記対象物の目標位置に合わせるための移動指令を前記制御周期ごとに生成し、当該移動指令を前記制御周期ごとに前記移動機構に出力するステップと、
予め決められた移動指令を前記移動機構に順次出力して前記検出するステップで得られるフィードバック値としての位置関連情報の推移に基づいて、前記制御パラメータを調整するステップとを備える、制御方法。 A method for controlling a moving mechanism for moving an object,
Imaging the object by outputting an imaging instruction to a visual sensor, and causing the visual sensor to measure the actual position of the object from an image obtained by imaging;
Detecting position related information related to the position of the moving mechanism for each predetermined control cycle shorter than the interval at which the imaging instruction is output to the visual sensor;
Determining an estimated position of the object at a current time for each control period based on the actual position and the position related information;
Generating a movement command for adjusting the estimated position to the target position of the object for each control cycle according to a set control parameter, and outputting the movement command to the movement mechanism for each control cycle; ,
And a step of adjusting the control parameter based on a transition of position-related information as a feedback value obtained by sequentially outputting a predetermined movement command to the movement mechanism and detecting it.
前記制御プログラムは、前記移動機構を制御するためのコントローラに、
撮像指示を視覚センサに出力することで前記対象物を撮像し、撮像により得られた画像から前記対象物の実位置を前記視覚センサに計測させるステップと、
前記撮像指示が前記視覚センサに出力される間隔よりも短い予め定められた制御周期ごとに前記移動機構の位置に関する位置関連情報を検出するステップと、
前記実位置と前記位置関連情報とに基づいて、現時点における前記対象物の推定位置を前記制御周期ごとに決定するステップと、
設定されている制御パラメータに従って、前記推定位置を前記対象物の目標位置に合わせるための移動指令を前記制御周期ごとに生成し、当該移動指令を前記制御周期ごとに前記移動機構に出力するステップと、
予め決められた移動指令を前記移動機構に順次出力して前記検出するステップで得られるフィードバック値としての位置関連情報の推移に基づいて、前記制御パラメータを調整するステップとを実行させる、制御プログラム。 A control program for a moving mechanism for moving an object,
The control program is a controller for controlling the moving mechanism,
Imaging the object by outputting an imaging instruction to a visual sensor, and causing the visual sensor to measure the actual position of the object from an image obtained by imaging;
Detecting position related information related to the position of the moving mechanism for each predetermined control cycle shorter than the interval at which the imaging instruction is output to the visual sensor;
Determining an estimated position of the object at a current time for each control period based on the actual position and the position related information;
Generating a movement command for adjusting the estimated position to the target position of the object for each control cycle according to a set control parameter, and outputting the movement command to the movement mechanism for each control cycle; ,
A control program for executing a step of adjusting the control parameter based on a transition of position-related information as a feedback value obtained by sequentially outputting a predetermined movement command to the movement mechanism and detecting the predetermined movement command.
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018085123A JP6922829B2 (en) | 2018-04-26 | 2018-04-26 | Control systems, control methods, and control programs |
PCT/JP2019/014129 WO2019208109A1 (en) | 2018-04-26 | 2019-03-29 | Control system, control method and control program |
CN201980018736.2A CN111868658B (en) | 2018-04-26 | 2019-03-29 | Control system, control method, and computer-readable storage medium |
KR1020207026085A KR102612470B1 (en) | 2018-04-26 | 2019-03-29 | Control system, control method and computer readable storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018085123A JP6922829B2 (en) | 2018-04-26 | 2018-04-26 | Control systems, control methods, and control programs |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2019188551A true JP2019188551A (en) | 2019-10-31 |
JP6922829B2 JP6922829B2 (en) | 2021-08-18 |
Family
ID=68295246
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2018085123A Active JP6922829B2 (en) | 2018-04-26 | 2018-04-26 | Control systems, control methods, and control programs |
Country Status (4)
Country | Link |
---|---|
JP (1) | JP6922829B2 (en) |
KR (1) | KR102612470B1 (en) |
CN (1) | CN111868658B (en) |
WO (1) | WO2019208109A1 (en) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07210250A (en) * | 1994-01-14 | 1995-08-11 | Yaskawa Electric Corp | Compliance controller for manipulator |
JPH09247975A (en) * | 1996-03-12 | 1997-09-19 | Matsushita Electric Ind Co Ltd | Motor drive device |
JP2003330510A (en) * | 2002-05-14 | 2003-11-21 | Yaskawa Electric Corp | Synchronous control method of numerical control apparatus |
JP2009122779A (en) * | 2007-11-12 | 2009-06-04 | Mitsubishi Electric Corp | Control system and control support device |
JP2013013950A (en) * | 2011-07-01 | 2013-01-24 | Seiko Epson Corp | Robot, robot control device, robot control method and robot control program |
JP2015213139A (en) * | 2014-05-07 | 2015-11-26 | 国立大学法人 東京大学 | Positioning device |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH06242803A (en) * | 1993-02-16 | 1994-09-02 | Matsushita Electric Ind Co Ltd | Automatic control servo controller |
JP4745798B2 (en) * | 2005-11-11 | 2011-08-10 | 株式会社日立産機システム | Automatic adjustment method and apparatus for motor control device |
JP2007219691A (en) * | 2006-02-15 | 2007-08-30 | Seiko Epson Corp | Pid controller and control parameter updating method |
JP2011134169A (en) * | 2009-12-25 | 2011-07-07 | Mitsubishi Heavy Ind Ltd | Control parameter adjusting method and adjusting device |
WO2013165841A1 (en) * | 2012-04-30 | 2013-11-07 | Johnson Controls Technology Company | Control system |
WO2014115263A1 (en) * | 2013-01-23 | 2014-07-31 | 株式会社日立製作所 | Positioning control system |
JP6167622B2 (en) * | 2013-04-08 | 2017-07-26 | オムロン株式会社 | Control system and control method |
CN104898568B (en) * | 2015-05-20 | 2018-01-19 | 西安交通大学 | NC machine tool feed system Optimization about control parameter method based on rigidity identification |
JP6174636B2 (en) | 2015-07-24 | 2017-08-02 | ファナック株式会社 | Work positioning device for positioning work |
JP6551184B2 (en) * | 2015-11-18 | 2019-07-31 | オムロン株式会社 | Simulation apparatus, simulation method, and simulation program |
JP6844158B2 (en) * | 2016-09-09 | 2021-03-17 | オムロン株式会社 | Control device and control program |
-
2018
- 2018-04-26 JP JP2018085123A patent/JP6922829B2/en active Active
-
2019
- 2019-03-29 KR KR1020207026085A patent/KR102612470B1/en active IP Right Grant
- 2019-03-29 WO PCT/JP2019/014129 patent/WO2019208109A1/en active Application Filing
- 2019-03-29 CN CN201980018736.2A patent/CN111868658B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07210250A (en) * | 1994-01-14 | 1995-08-11 | Yaskawa Electric Corp | Compliance controller for manipulator |
JPH09247975A (en) * | 1996-03-12 | 1997-09-19 | Matsushita Electric Ind Co Ltd | Motor drive device |
JP2003330510A (en) * | 2002-05-14 | 2003-11-21 | Yaskawa Electric Corp | Synchronous control method of numerical control apparatus |
JP2009122779A (en) * | 2007-11-12 | 2009-06-04 | Mitsubishi Electric Corp | Control system and control support device |
JP2013013950A (en) * | 2011-07-01 | 2013-01-24 | Seiko Epson Corp | Robot, robot control device, robot control method and robot control program |
JP2015213139A (en) * | 2014-05-07 | 2015-11-26 | 国立大学法人 東京大学 | Positioning device |
Also Published As
Publication number | Publication date |
---|---|
JP6922829B2 (en) | 2021-08-18 |
KR20210004957A (en) | 2021-01-13 |
CN111868658A (en) | 2020-10-30 |
KR102612470B1 (en) | 2023-12-12 |
WO2019208109A1 (en) | 2019-10-31 |
CN111868658B (en) | 2024-08-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6167622B2 (en) | Control system and control method | |
CN110581945B (en) | Control system, control device, image processing device, and storage medium | |
CN110581946B (en) | Control system, control device, image processing device, and storage medium | |
TW202029879A (en) | Control device and control method | |
JP2015036692A (en) | Automatic focus adjustment device | |
CN111886556B (en) | Control system, control method, and computer-readable storage medium | |
WO2019208109A1 (en) | Control system, control method and control program | |
JP2006293624A (en) | Multiaxis controller | |
WO2020003945A1 (en) | Position determination system, control method, and program | |
KR102613860B1 (en) | Control system, control method and computer readable storage medium | |
JP7003454B2 (en) | Control device, position control system, position control method, and position control program | |
JP7020262B2 (en) | Control systems, control methods and programs | |
US20220134570A1 (en) | Control device and alignment device | |
CN110581944B (en) | Control system, control device, and storage medium | |
JP2010272686A (en) | Moving body controller, exposure device and moving body control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200309 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210216 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210406 |
|
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: 20210629 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210712 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6922829 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |