CN109143968B - 控制装置、位置控制系统、位置控制方法及记录媒体 - Google Patents
控制装置、位置控制系统、位置控制方法及记录媒体 Download PDFInfo
- Publication number
- CN109143968B CN109143968B CN201810151201.XA CN201810151201A CN109143968B CN 109143968 B CN109143968 B CN 109143968B CN 201810151201 A CN201810151201 A CN 201810151201A CN 109143968 B CN109143968 B CN 109143968B
- Authority
- CN
- China
- Prior art keywords
- control
- related data
- time
- determination unit
- data
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000005259 measurement Methods 0.000 claims abstract description 55
- 238000003384 imaging method Methods 0.000 claims description 26
- 230000005540 biological transmission Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 description 18
- 230000002123 temporal effect Effects 0.000 description 11
- 238000010586 diagram Methods 0.000 description 7
- 230000003111 delayed effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T1/00—General purpose image data processing
- G06T1/0014—Image feed-back for automatic industrial control, e.g. robot with camera
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- 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
- B25J13/088—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
- B25J13/089—Determining the position of the robot with reference to its environment
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/401—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for measuring, e.g. calibration and initialisation, measuring workpiece for machining purposes
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/70—Determining position or orientation of objects or cameras
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04N—PICTORIAL COMMUNICATION, e.g. TELEVISION
- H04N7/00—Television systems
- H04N7/18—Closed-circuit television [CCTV] systems, i.e. systems in which the video signal is not broadcast
- H04N7/181—Closed-circuit television [CCTV] systems, i.e. systems in which the video signal is not broadcast for receiving images from a plurality of remote sources
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/35—Nc in input of data, input till input file format
- G05B2219/35408—Calculate new position data from actual data to compensate for contour error
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39391—Visual servoing, track end effector with camera image feedback
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Robotics (AREA)
- Human Computer Interaction (AREA)
- Mechanical Engineering (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Theoretical Computer Science (AREA)
- Multimedia (AREA)
- Signal Processing (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Control Of Position Or Direction (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明提供一种控制装置、位置控制系统、位置控制方法及记录媒体,利用简单的构成及处理来实现高速且高精度的定位控制。控制器(10)具备反馈控制部(11)及位置决定部(12)。位置决定部(12)以周期(Tc)取得来自驱动器(20)的编码器值(PVm)。位置决定部(12)以较周期(Tc)长的时间间隔取得测量位置(PVv),此测量位置(PVv)是通过图像处理测量控制对象位置与目标位置的位置关系所得。位置决定部(12)使用编码器值(PVm)及测量位置(PVv),决定与控制对象位置对应的估算插补位置(PV)。反馈控制部(11)使用由位置决定部(12)所决定的估算插补位置(PV),将使控制对象位置调整到目标位置的控制数据输出至驱动器(20)。
Description
技术领域
本发明涉及一种使用伺服电机(servo motor)及图像传感器的控制装置、位置控制系统、位置控制方法及记录媒体。
背景技术
在工厂自动化(Factory Automation,FA)中,已实际应用使用伺服电机将工件等的预定位置(控制对象位置)调整到目标位置的各种技术(定位技术)。
此时,作为测量控制对象位置与目标位置的差(距离)的方法,有使用伺服电机的编码器值的方法、及使用利用图像传感器进行图像处理的方法等。
使用编码器值的方法通过将以规定周期获得的编码器值依次相加,而算出控制对象位置的移动距离。
使用图像处理的方法以包含控制对象位置和目标位置的方式进行拍摄,并对拍摄的图像进行分析,由此算出(测量)控制对象位置与目标位置的距离。
在进行图像处理的方法中,已认识到会因图像处理所耗的时间等而产生延迟,影响位置控制的精度。因此,专利文献1中使用卡尔曼滤波器(Kalman filter)对通过图像处理所测量的距离进行校正。
[现有技术文献]
[专利文献]
[专利文献1]日本专利特开2015-213139号公报
发明内容
[发明所要解决的问题]
但是,专利文献1所记载的方法不得不设定针对卡尔曼滤波器中的延迟的模型。因此,为了进行高精度的校正而需要高度的技术水平,高精度的校正并不容易。另外,若未适当地设定初始值则无法进行高精度的校正,另外即便能进行高精度的校正,在稳定地输出经校正的距离之前也需要时间。因此,不适于需要高速且高精度控制的FA。
另外,在仅使用编码器值来决定距离的情况下,能实现高速的定位控制。但是,预计通过有效运用由图像处理所得的测量距离而进一步提高定位精度。
因此,本发明的目的在于利用简单的构成及处理来实现高速且高精度的定位控制。
[解决问题的技术手段]
本发明的控制装置具备位置决定部及反馈控制部。位置决定部重复取得来自使控制对象物移动的驱动装置的与控制对象物有关的位置关联数据。位置决定部以较位置关联数据的取得间隔长的时间间隔,取得通过图像处理测量控制对象物与目标位置的位置关系所得的测量数据。位置决定部使用位置关联数据及测量数据,决定与控制对象位置对应的估算位置。反馈控制部使用由位置决定部所决定的估算位置,将使控制对象物调整到目标位置的控制数据输出至驱动装置。
所述构成中,位置决定部估算图像处理中所用的图像的拍摄时刻的位置关联数据。位置决定部使用拍摄时刻的位置关联数据、测量数据及与此测量数据相同时刻的位置关联数据,决定估算位置。
所述构成中,使用估算的拍摄时刻的位置关联数据,校正当前时刻的控制对象位置。
另外,所述控制装置中,位置决定部将同一时刻的测量数据与位置关联数据的相加值减去估算的拍摄时刻的位置关联数据,由此决定估算位置。
所述构成中,示出所述校正运算的具体一例。由此,估算位置是通过简单的运算而算出。
另外,所述控制装置中,位置决定部根据接近拍摄时刻的多个时刻的位置关联数据的内推插补值,估算拍摄时刻的位置关联数据。
所述构成中,示出所述校正运算的具体一例。由此,估算位置是通过更简单的运算而算出。
另外,所述控制装置中,位置决定部使用与拍摄有关的延迟时间及与位置关联数据的传输有关的延迟时间,算出内推插补值。
所述构成中,示出所述校正运算的更具体的一例。由此,控制对象位置是通过更简单的运算以良好精度算出。
[发明的效果]
根据本发明,能利用简单的构成及处理来实现高速且高精度的定位控制。
附图说明
图1为表示本发明的第一实施例的位置控制系统的构成的功能方块图。
图2(A)和图2(B)为表示本发明的第一实施例的位置控制系统的应用例的外观立体图。
图3为表示本发明的第一实施例的位置控制系统的控制装置的处理的流程图。
图4(A)为表示编码器值PVm及测量位置PVv的时间变化的图表,图4(B)是表示估算插补位置PV的时间变化的图表。
图5为表示拍摄时刻的编码器值的估算算出方法的流程图。
图6为表示拍摄时刻的编码器值的算出概念的图。
图7(A)为表示进行估算插补的情况(本申请构成)与不进行估算插补的情况(比较构成)下的目标位置与控制对象位置的距离的时间变化的图,图7(B)为表示不进行估算插补的情况下的测量距离的时间变化的图,图7(C)为表示进行估算插补的情况下的测量距离与估算插补距离(目标位置与控制对象位置的距离)的时间变化的图。
图8为表示本发明的第二实施例的位置控制系统的构成的功能方块图。
[符号的说明]
1、1A:位置控制系统;
10:控制器;
11:反馈控制部;
12:位置决定部;
20、20A:驱动器;
30、31、32:电机;
40、40A:图像传感器;
91:工作台;
92:工件;
93:拧紧机;
401、402:相机;
920:螺孔;
930:螺钉;
MV;操作量;
PV:估算插补位置;
PVm、PVms、PVm(n-k)、PVm(n-k+1)、PVm(n-k+2)、PVm(n-k+3)、PVm(n)、PVms(ni):编码器值;
PVv、PVv(n):测量位置;
S11~S21、S61~S63:步骤;
SP:目标位置;
Tc:周期(控制周期);
tc0:控制开始时间;
Ted、Tsd:传输延迟时间;
TRp:拍摄触发;
tn、t(n-k)、t(n-k+1)、t(n-k+2)、t(n-k+3):算出时刻;
ti、tv1、tvi:拍摄时刻;
tm:取得时刻;
ΔPVm:变化部分。
具体实施方式
参照图对本发明的第一实施例的位置控制技术进行说明。图1为表示本发明的第一实施例的位置控制系统的构成的功能方块图。此外图1中,实线的箭头表示由信号线等连接,虚线的箭头表示以非接触方式取得对象物的信息的构成。
如图1所示,位置控制系统1具备控制器10、驱动器20、电机30及图像传感器40。
控制器10例如为所谓可编程逻辑控制器(Programmable logic Controller,PLC),进行各种FA控制。控制器10具备反馈控制部11及位置决定部12。
反馈控制部11使用目标位置SP及与控制对象位置对应的估算插补位置(对应于本发明的“估算位置”)PV,以目标位置SP与估算插补位置PV一致的方式执行比例-积分-微分(Proportional-Integral-Derivative,PID)控制等运算。反馈控制部11通过进行此运算而算出操作量MV。反馈控制部11将操作量MV输出至驱动器20。
位置决定部12使用来自驱动器20的编码器值PVm及来自图像传感器40的测量位置PVv,算出与控制对象位置对应的估算插补位置PV,详细处理将于下文中描述。位置决定部12将估算插补位置PV输出至反馈控制部11。
所述反馈控制是以控制周期Tc重复执行。即,反馈控制部11在每个控制周期Tc中输出操作量MV。此外,所谓操作量MV,是指对驱动器20的指令位置、指令速度、指令转矩中的任一个。
驱动器20使用操作量MV进行电机30的动作控制。另外,驱动器20取得来自电机30的编码器值PVm,并输出至位置决定部12。此时,驱动器20以与控制周期Tc相同的周期将编码器值PVm输出至位置决定部12。
电机30例如为伺服电机,接受来自驱动器20的动作控制而动作。通过电机30的动作,工作台91移动,控制对象位置移动。
驱动器20及电机30是依控制对象位置的移动方向数、即依位置控制的可动轴的个数而分别设置。
图像传感器40拍摄工作台91、更具体而言工作台91上的包含控制对象位置和目标位置SP的区域。此时,图像传感器40响应来自控制器10的拍摄触发TRp而进行拍摄。控制器10以较控制周期Tc长的时间间隔输出拍摄触发TRp。即,图像传感器40以较控制周期Tc长的时间间隔进行拍摄。
图像传感器40对拍摄的图像进行图像处理,算出控制对象位置相对于目标位置SP的测量位置(目标位置SP与控制对象位置的测量距离)PVv。图像传感器40将测量位置PVv输出至位置决定部12。
此种位置控制系统1例如被应用于图2(A)、图2(B)所示般的作业的自动化。图2(A)为表示本发明的第一实施例的位置控制系统的应用例的外观透视图,图2(B)为表示本发明的第一实施例的位置控制系统的应用例的平面图。图2(B)中省略拧紧机的记载。
如图2(A)、图2(B)所示,工件92中设有螺孔920。将工件92安装在工作台91的顶面上。工作台91为所谓XY平台,沿着与顶面平行的正交两轴而可动。在构成工作台91的两个可动平台的其中一个中固定着电机31的驱动轴,在另一个中固定着电机32的驱动轴。由此,通过使电机31及电机32驱动,工作台91在正交两轴方向上移动。因此,螺孔920的位置成为控制对象位置。
在工作台91的上方配置着拧紧机93。在拧紧机93的下端安装着螺钉930。通过省略图示的驱动部使拧紧机93在上下方向上移动。因此,拧紧机93下降而接触工作台91的位置成为目标位置SP。
在工作台91的外周配置着相机401及相机402。相机401及相机402为图像传感器40的构成要素的一部分。相机401及相机402是以螺钉930的前端和螺孔920成为拍摄范围内的方式配置。即,相机401及相机402是以控制对象位置和目标位置SP成为拍摄范围内的方式配置。相机401为主要拍摄由电机31的驱动所致的螺孔920的位置移动的传感器,相机402为主要拍摄由电机32的驱动所致的螺孔920的位置移动的传感器。为了实现所述拍摄,例如只要如图2(B)所示,使相机401的拍摄轴与电机31使工作台91移动的方向正交,使相机402的拍摄轴与电机32使工作台91移动的方向正交即可。此外,所述正交关系也可有误差。
相机401及相机402将拍摄的图像输出至图像处理部。图像处理部为图像传感器40的构成要素的一部分。图像处理部进行图像分析,算出螺钉930的前端与螺孔920的距离、即对应于所述控制对象位置与目标位置SP的距离的测量位置PVv。
此种构成的位置控制系统1中,控制器10的位置决定部12进行图3的流程图所示般的处理,由此算出估算插补位置PV。图3为表示本发明的第一实施例的位置控制系统的控制装置的处理的流程图。
位置决定部12将估算插补位置PV及编码器值PVm初始化(S11)。
从驱动器20开始输出编码器值PVm后,位置决定部12依次接受编码器值PVm的输入(S12)。
位置决定部12检测是否获得了来自图像传感器40的测量位置PVv(S13)。若为获得了测量位置PVv的时刻(S13:是),则位置决定部12检测测量位置PVv是否为正常值(S14)。若测量位置PVv为正常值(S14:是),则位置决定部12接受测量位置PVv的输入(S15)。
位置决定部12接受测量位置PVv的输入后,估算作为测量位置PVv的计算基础的拍摄时刻的编码器值PVms(S16)。此估算的具体方法将于下文中描述。此外,在相机401、相机402的曝光时间长的情况下,拍摄时刻例如是根据曝光开始时刻(相机的快门打开的时刻)与曝光结束时刻(相机的快门关闭的时刻)的中间时刻来设定。
位置决定部12使用同一时刻的测量位置PVv及编码器值PVm、以及作为所述测量位置PVv的计算基础的拍摄时刻的编码器值PVms,算出估算插补位置PV(S17)。具体而言,步骤S17中,位置决定部12使用以下的(式1)算出估算插补位置PV。
PV=PVv+(PVm-PVms) -(式1)
位置决定部12算出估算插补位置PV后,将此估算插补位置PV输出至反馈控制部11(S18)。另外,位置决定部12将所述估算插补位置PV作为参照估算插补位置PVp,将此时刻的编码器值PVm作为参照编码器值PVmp而更新存储。
若为未获得来自图像传感器40的测量位置PVv的时刻(S13:否),则位置决定部12检测测量位置PVv的输出是否为1次以上(S20)。另外,若测量位置PVv并非正常值(S14:否),则位置决定部12同样地检测测量位置PVv的输出是否为1次以上(S20)。
若测量位置PVv的输出为1次以上(S20:是),则位置决定部12使用编码器值PVm、参照估算插补位置PVp及参照编码器值PVmp,算出估算插补位置PV(S21)。具体而言,步骤S21中,位置决定部12使用以下的(式2)算出估算插补位置PV。
PV=PVp+PVm-PVmp -(式2)
若测量位置PVv的输出1次也不存在(S20:否),则位置决定部12将估算插补位置PV维持初始值。
每一次输入编码器值PVm后,位置决定部12执行所述处理,若控制未结束(S19:否),则回到步骤S12(接受新的编码器值PVm的输入)而继续进行处理。若控制结束(S19:是),则位置决定部12结束处理。
通过执行此种处理,控制器10能在输入由图像处理所得的高精度的测量位置PVv的时刻,使用此高精度的测量位置PVv算出估算插补位置PV,实现高精度的定位控制。此处,输入测量位置PVv的时间间隔长。但是,在时间轴上相邻的测量位置PVv的输入时刻间,控制器10在输入周期短的编码器值PVm的每个输入时刻算出估算插补位置PV,进行位置控制。由此,能实现高精度且短周期的定位控制。而且,此时控制器10进行所述使用简单四则运算的处理,因此能利用简单的构成及处理实现高速且高精度的定位控制。
此时,控制器10通过进行所述处理,能如图4(A)所示般算出估算插补位置。因此,控制器10能使用由图像处理所得的测量位置PVv,高精度地算出估算插补位置PV。图4(A)为表示编码器值PVm及测量位置PVv的时间变化的图表,图4(B)为表示估算插补位置PV的时间变化的图表。
如图4(A)所示,与测量位置PVv对应的测量距离的算出需要图像传感器40的拍摄及图像处理的时间,因此更新周期长。所以,即便在估算插补位置PV的算出时刻tn获得了测量位置PVv,此测量位置PVv也是由较算出时刻tn靠前的拍摄时刻tv1拍摄的图像所得,高精度地算出了拍摄时刻tv1的控制对象位置。其中,tc0为控制开始时间。
从拍摄时刻tv1到算出时刻tn经过了时间(tn-tv1),控制对象位置已移动。因此,此控制对象位置的移动部分必须校正。
此处,由于电机30的控制周期短,因此编码器值PVm是以较测量位置PVv的算出周期短的周期更新。利用这一情况,控制器10的位置决定部12进行(式1)所示的运算。具体而言,位置决定部12取得拍摄时刻tv1的编码器值PVms及算出时刻tn的编码器值PVm。位置决定部12对测量位置PVv加上时间(tn-tv1)部分的编码器值PVm的变化部分ΔPVm(PVm-PVms),由此将算出时刻tn的估算插补位置PV算出。此时,估算插补位置PV在算出时刻tn变得不连续,此情况下,通过使用对估算插补位置PV的平滑处理(例如移动平均处理)等,能使估算插补位置PV的时间变化平稳,从而更优选。
通过使用所述处理,估算插补位置PV高精度地反映算出时刻tn的控制对象位置。因此,能进行高精度的定位控制。
进而,控制器10的位置决定部12使用下文所示的处理,算出拍摄时刻的编码器值PVms。图5为表示拍摄时刻的编码器值的估算算出方法的流程图。图6为表示拍摄时刻的编码器值的算出概念的图。
如图5所示,位置决定部12取得拍摄时刻(S61)。位置决定部12取得接近拍摄时刻的多个时刻的编码器值PVm(S62)。位置决定部12算出多个时刻的编码器值PVm的内推插补值,作为拍摄时刻的编码器值PVms(S63)。此外,在拍摄时刻与编码器值的算出时刻一致的情况下,只要直接使用此编码器值即可。
具体而言,位置决定部12使用图6所示的概念,算出拍摄时刻的编码器值PVms。算出时刻t以周期Tc重复,周期Tc对应于控制器10的控制周期。
位置决定部12在获得测量位置PVv并算出估算插补位置PV的算出时刻tn取得编码器值PVm(n)。位置决定部12取得较算出时刻tn靠前的拍摄时刻tvi。位置决定部12检测接近拍摄时刻tvi的两个时刻,例如在时间轴上隔着拍摄时刻tvi的以往的算出时刻t(n-k)与以往的算出时刻t(n-k+1)。
位置决定部12取得算出时刻t(n-k)的编码器值PVm(n-k)及算出时刻t(n-k+1)的编码器值PVm(n-k+1)。以往的编码器值能通过在控制器10中配备存储部而预先存储。
位置决定部12使用编码器值PVm(n-k)与编码器值PVm(n-k+1)的内推插补值,算出拍摄时刻tvi的编码器值PVms(ni)。
具体而言,位置决定部12使用以下的(式3)算出拍摄时刻tvi的编码器值PVms(ni)。
PVms(ni)=PVm(n-k)+Kk×(PVm(n-k+2)-PVm(n-k+1)) -(式3)
此处,Kk为内推插补系数。在将控制周期设为Tc、编码器值PVm的传输延迟时间设为Ted、拍摄触发TRp的传输延迟时间设为Tsd、在Tc-Ted≤Tsd<2Tc-Ted的情况下,内推插补系数Kk是使用以下的(式4)而算出。
Kk=(Tsd-(Tc-Ted)}/Tc -(式4)
通过使用此种内推插补值的算出方法,能高精度地算出拍摄时刻tvi的编码器值PVms(ni)。由此,能算出更高精度的估算插补位置PV,从而能实现更高精度的定位控制。
图7(A)为表示进行估算插补的情况(本申请构成)与不进行估算插补的情况(比较构成)下的目标位置与控制对象位置的距离的时间变化的图。图7(B)为表示不进行估算插补的情况下的测量距离的时间变化的图。图7(C)为表示进行估算插补的情况下的测量距离与估算插补距离(目标位置与控制对象位置的距离)的时间变化的图。
如图7(A)所示,通过进行估算插补,能使目标位置与控制对象位置的距离位置控制高速化。另外,如图7(B)、图7(C)所示,通过进行估算插补控制,测量距离(对应于测量位置PVv)也高速地收敛,能实现向目标位置的高速且高精度的位置控制。其原因如下。测量位置PVv为更新周期长且滞后的位置信息,因此容易产生超调(overshoot)或振动,不太能增强反馈控制的增益。相对于此,通过使用估算插补位置PV,能增强反馈控制增益。
其次,参照图对本发明的第二实施例的位置控制技术进行说明。图8为表示本发明的第二实施例的位置控制系统的构成的功能方块图。
如图8所示,相对于第一实施例的位置控制系统1,第二实施例的位置控制系统1A中驱动器20A及图像传感器40A的处理不同。位置控制系统1A的其他处理与位置控制系统1相同,省略相同部分的说明。
控制器10、驱动器20A及图像传感器40A具有经同步的计时功能。
驱动器20A以独自决定的周期将编码器值PVm输出至位置决定部12。此时,驱动器20A将取得时刻tm与各编码器值PVm相关联而输出。
图像传感器40A以独自的时间间隔进行拍摄,将测量位置PVv及拍摄时刻ti输出至位置决定部12。
位置决定部12使用编码器值的取得时刻tm及拍摄时刻ti,进行与所述第一实施例相同的处理,由此算出估算插补位置PV。
即便是此种构成及处理,也能与第一实施例同样地利用简单的构成及处理来实现高速且高精度的定位控制。
Claims (7)
1.一种控制装置,其特征在于包括:
位置决定部,重复取得来自使控制对象物移动的驱动装置的与所述控制对象物有关的位置关联数据,并以较所述位置关联数据的取得间隔长的时间间隔,取得通过图像处理测量所述控制对象物与目标位置的位置关系所得的测量数据,使用所述位置关联数据及所述测量数据,决定所述控制对象物的估算位置;以及
反馈控制部,使用由所述位置决定部决定的所述估算位置,将使所述控制对象物调整到所述目标位置的控制数据输出至所述驱动装置;且
所述位置决定部:
估算所述图像处理中所用的图像的拍摄时刻的所述位置关联数据,以及
使用所述拍摄时刻的位置关联数据、所述测量数据及与所述测量数据相同时刻的所述位置关联数据,决定所述估算位置,其中
所述位置决定部对所述测量数据加上和所述测量数据相同时刻的所述位置关联数据与所述拍摄时刻的位置关联数据的差值,由此决定所述估算位置。
2.根据权利要求1所述的控制装置,其特征在于:所述位置决定部利用接近所述拍摄时刻的多个时刻的所述位置关联数据的内推插补值,估算所述拍摄时刻的位置关联数据。
3.根据权利要求2所述的控制装置,其特征在于:所述位置决定部使用与所述拍摄有关的延迟时间及与所述位置关联数据的传输有关的延迟时间,算出所述内推插补值。
4.根据权利要求3所述的控制装置,其特征在于:所述位置关联数据是以一定周期取得,
所述位置决定部使用所述周期算出所述内推插补值。
5.一种位置控制系统,其特征在于包括:
根据权利要求1至4中任一项所述的控制装置;
所述驱动装置;以及
进行所述图像处理的图像传感器。
6.一种位置控制方法,其特征在于包括:
重复取得来自使控制对象物移动的驱动装置的与所述控制对象物有关的位置关联数据的工序;
以较所述位置关联数据的取得间隔长的间隔,取得通过图像处理测量所述控制对象物与目标位置的位置关系所得的测量数据的工序;
位置决定工序,使用所述位置关联数据及所述测量数据,决定所述控制对象物的估算位置;以及
反馈控制工序,使用所述位置决定工序中决定的所述估算位置,将使所述控制对象物调整到所述目标位置的控制数据输出至所述驱动装置;且
所述位置决定工序中,
估算所述图像处理中所用的图像的拍摄时刻的所述位置关联数据,
使用所述拍摄时刻的位置关联数据、所述测量数据及与所述测量数据相同时刻的所述位置关联数据,决定所述估算位置,其中
所述位置决定工序中对所述测量数据加上和所述测量数据相同时刻的所述位置关联数据与所述拍摄时刻的位置关联数据的差值,由此决定所述估算位置。
7.一种记录媒体,其存储位置控制程序,所述位置控制程序使计算机执行以下处理:
重复取得来自使控制对象物移动的驱动装置的与所述控制对象物有关的位置关联数据的处理;
以较所述位置关联数据的取得间隔长的间隔,取得通过图像处理测量所述控制对象物与目标位置的位置关系所得的测量数据的处理;
位置决定处理,使用所述位置关联数据及所述测量数据,决定所述控制对象物的估算位置;以及
反馈控制处理,使用所述位置决定处理中决定的所述估算位置,将使所述控制对象物的位置调整到所述目标位置的控制数据输出至所述驱动装置;且
在所述位置决定处理中,使所述计算机执行以下处理:
估算所述图像处理中所用的图像的拍摄时刻的所述位置关联数据,
使用所述拍摄时刻的位置关联数据、所述测量数据及与所述测量数据相同时刻的所述位置关联数据,决定所述估算位置,其中
所述位置决定处理中对所述测量数据加上和所述测量数据相同时刻的所述位置关联数据与所述拍摄时刻的位置关联数据的差值,由此决定所述估算位置。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017117319A JP7003454B2 (ja) | 2017-06-15 | 2017-06-15 | 制御装置、位置制御システム、位置制御方法、および、位置制御プログラム |
JP2017-117319 | 2017-06-15 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109143968A CN109143968A (zh) | 2019-01-04 |
CN109143968B true CN109143968B (zh) | 2021-04-30 |
Family
ID=61563093
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810151201.XA Active CN109143968B (zh) | 2017-06-15 | 2018-02-13 | 控制装置、位置控制系统、位置控制方法及记录媒体 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20180365791A1 (zh) |
EP (1) | EP3416007A1 (zh) |
JP (1) | JP7003454B2 (zh) |
CN (1) | CN109143968B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7059968B2 (ja) | 2019-03-01 | 2022-04-26 | オムロン株式会社 | 制御装置および位置合わせ装置 |
WO2023238405A1 (ja) * | 2022-06-10 | 2023-12-14 | 三菱電機株式会社 | モータ制御装置 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5946449A (en) * | 1996-04-05 | 1999-08-31 | Georgia Tech Research Corporation | Precision apparatus with non-rigid, imprecise structure, and method for operating same |
CN1861880A (zh) * | 2006-06-08 | 2006-11-15 | 广东工业大学 | 基于视觉跟踪的单针绗缝智能控制系统及其控制方法 |
JP5803189B2 (ja) | 2011-03-23 | 2015-11-04 | セイコーエプソン株式会社 | ロボット装置 |
CN103123477B (zh) * | 2011-11-18 | 2014-12-24 | 中国科学院沈阳计算技术研究所有限公司 | 一种基于电机和机床位置双反馈的轴运动控制方法 |
JP6228120B2 (ja) * | 2012-08-02 | 2017-11-08 | 富士機械製造株式会社 | 多関節型ロボットを備えた作業機および電気部品装着機 |
JP2015213139A (ja) | 2014-05-07 | 2015-11-26 | 国立大学法人 東京大学 | 位置決め装置 |
CN104647388A (zh) * | 2014-12-30 | 2015-05-27 | 东莞市三瑞自动化科技有限公司 | 基于机器视觉的工业机器人智能控制方法及系统 |
US9889566B2 (en) * | 2015-05-01 | 2018-02-13 | General Electric Company | Systems and methods for control of robotic manipulation |
-
2017
- 2017-06-15 JP JP2017117319A patent/JP7003454B2/ja active Active
-
2018
- 2018-02-13 CN CN201810151201.XA patent/CN109143968B/zh active Active
- 2018-02-13 US US15/894,946 patent/US20180365791A1/en not_active Abandoned
- 2018-02-14 EP EP18156627.4A patent/EP3416007A1/en active Pending
Also Published As
Publication number | Publication date |
---|---|
JP2019003388A (ja) | 2019-01-10 |
EP3416007A1 (en) | 2018-12-19 |
JP7003454B2 (ja) | 2022-01-20 |
US20180365791A1 (en) | 2018-12-20 |
CN109143968A (zh) | 2019-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111565895B (zh) | 机器人系统及机器人控制方法 | |
US6701212B2 (en) | Lost motion correction system and lost motion correction method for numerical control machine tool | |
JP5211944B2 (ja) | ロボット装置の制御方法及びロボット装置 | |
JP5318727B2 (ja) | 情報処理方法及び装置並びにプログラム | |
CN109143968B (zh) | 控制装置、位置控制系统、位置控制方法及记录媒体 | |
CN110581946B (zh) | 控制系统、控制装置、图像处理装置以及存储介质 | |
JP2015213139A (ja) | 位置決め装置 | |
CN110636923B (zh) | 一种机器人的运动控制方法、机器人及控制器 | |
JP2019181610A (ja) | モータエンコーダ及びセンサを用いて学習制御を行うロボットシステム | |
CN110581945B (zh) | 控制系统、控制装置、图像处理装置以及存储介质 | |
JP6950631B2 (ja) | 位置決めシステム、制御方法およびプログラム | |
TWI499197B (zh) | 電動機控制方法及裝置 | |
WO2019202944A1 (ja) | 制御システム、制御方法およびプログラム | |
JP7059968B2 (ja) | 制御装置および位置合わせ装置 | |
JP7172151B2 (ja) | 制御システム、制御装置およびプログラム | |
JP7040567B2 (ja) | 制御装置、制御装置の制御方法、情報処理プログラム、および記録媒体 | |
CN111886556B (zh) | 控制系统、控制方法以及计算机可读存储介质 | |
JP6922829B2 (ja) | 制御システム、制御方法、および制御プログラム | |
JP6048174B2 (ja) | 数値制御装置とロストモーション補償方法 | |
JP2011175308A (ja) | 工作機械の送り駆動系の制御方法及び制御装置 | |
CN116615701A (zh) | 马达控制装置 | |
JP2023038747A (ja) | コントローラシステムおよびその制御方法 | |
JP2020089927A (ja) | ロボット制御システム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |