CN102346030A - 依据温度校正测距装置量测的待测距离的方法及其装置 - Google Patents

依据温度校正测距装置量测的待测距离的方法及其装置 Download PDF

Info

Publication number
CN102346030A
CN102346030A CN2010102453756A CN201010245375A CN102346030A CN 102346030 A CN102346030 A CN 102346030A CN 2010102453756 A CN2010102453756 A CN 2010102453756A CN 201010245375 A CN201010245375 A CN 201010245375A CN 102346030 A CN102346030 A CN 102346030A
Authority
CN
China
Prior art keywords
temperature
distance
image sensor
measuring equipment
distance measuring
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
Application number
CN2010102453756A
Other languages
English (en)
Other versions
CN102346030B (zh
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.)
Pixart Imaging Inc
Original Assignee
Pixart Imaging Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Pixart Imaging Inc filed Critical Pixart Imaging Inc
Priority to CN201010245375.6A priority Critical patent/CN102346030B/zh
Publication of CN102346030A publication Critical patent/CN102346030A/zh
Application granted granted Critical
Publication of CN102346030B publication Critical patent/CN102346030B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

本发明公开了一种依据环境温度以校正测距装置所量测的待测物的待测距离的校正方法及其装置,该方法包括提供温度传感器以量测该测距装置的该环境温度、依据该环境温度与该测距装置测距时的成像位置,以计算校正成像位置,以及依据该校正成像位置,以计算经校正后的该待测距离。如此,当测距装置测距时,可依据该校正方法,以避免因环境温度的变化而产生的误差。

Description

依据温度校正测距装置量测的待测距离的方法及其装置
技术领域
本发明涉及一种校正方法及其相关装置,更明确地说,本发明涉及一种依据环境温度以校正测距装置所量测的待测物的待测距离的方法及其相关装置。
背景技术
在公知技术中,测距装置对待测物发射侦测光,并接收由待测物反射侦测光所产生的反射光。测距装置可通过反射光的成像位置的差异以推算测距装置与待测物之间的距离。然而,测距装置在感测待测物所产生的反射光时,会同时受到背景光与闪烁现象(如因电源系统的频率而造成的日光灯闪烁)的影响,而产生量测误差,得到不正确的待测距离。除此之外,于生产过程中,当组装测距装置时,由于测距装置内部的组件的位置会因组装误差而产生偏移或旋转角度,因此测距装置在量测距离时会受到组装误差的影响,而得到不正确的待测距离,造成使用者的不便。
发明内容
本发明提供一种依据环境温度以校正测距装置所量测的待测物的待测距离的校正方法。该测距装置具有发光组件、第一镜头、影像传感器。该发光组件发射侦测光至待测物以产生反射光。该反射光通过该第一镜头汇聚于该影像传感器,以成像于第一成像位置。该测距装置依据该第一成像位置、该第一镜头的焦距、该发光组件与该影像传感器之间的第一已知距离,以计算该测距装置与该待测物之间的该待测距离。该校正方法包括提供温度传感器以量测该测距装置的该环境温度、依据该环境温度与该第一成像位置,以计算第一校正成像位置。以及依据该第一校正成像位置,以计算经校正后的该待测距离。
本发明还提供一种用来依据环境温度以校正测距装置所量测的待测物的待测距离的校正装置。该测距装置具有发光组件、第一镜头、影像传感器。该发光组件发射侦测光至待测物以产生反射光。该反射光通过该第一镜头汇聚于该影像传感器,以成像于第一成像位置。该测距装置依据该第一成像位置、该第一镜头的焦距、该发光组件与该影像传感器之间的第一已知距离,以计算该测距装置与该待测物之间的该待测距离。该校正装置包括温度传感器,以及温度补偿计算电路。该温度传感器用来量测该测距装置的该环境温度。该温度补偿计算电路用来依据该环境温度与该第一成像位置,以计算第一校正成像位置,并提供该第一校正成像位置给该测距装置,以使该测距装置计算经校正后的该待测距离。
附图说明
图1与图2为说明本发明的利用成像位置差异以测距的测距装置的结构及工作原理的示意图。
图3为说明测距装置减少闪烁现象的工作原理的示意图。
图4为说明校正发光组件所发出的侦测光的发光误差角度的方法的示意图。
图5与图6为说明因组装误差而使影像传感器旋转感测误差角度的校正方法的示意图。
图7为说明本发明的影像传感器的结构的第一实施例的示意图。
图8为说明利用图7的影像传感器以侦测反射光的成像位置的工作原理的示意图。
图9为说明本发明的影像传感器的结构的还一实施例的示意图。
图10为说明利用图9的影像传感器以侦测反射光的成像位置的工作原理的示意图。
图11为说明本发明的影像传感器的结构的还一实施例的示意图。
图12为说明本发明的依据环境温度以校正测距装置所量测的待测物的待测距离的校正方法的流程图。
图13为说明当该影像传感器接收到电源以进入工作模式时,温度传感器量测启动温度与稳定温度以得到工作温差的示意图。
图14为说明当该影像传感器自省电模式进入工作模式时,温度传感器重新量测稳定温度以得到工作温差的示意图。
图15为说明成像位置的变化量正比于环境温度的变化量的示意图。
图16为说明本发明的依据环境温度以校正测距装置所量测的待测物的待测距离的校正装置的示意图。
其中,附图标记说明如下:
100                        测距装置
110                        发光/感测控制电路
120                        发光组件
130、700、900、1100        影像传感器
140                        距离计算电路
150                        参数计算电路
1200                       校正方法
1210~1230                 步骤
1600                       校正装置
1610                       温度传感器
1620                       温度感测控制电路
1630                       温度补偿计算电路
B1~BM                     背景光的能量
CS1~CSM、CS11~CSNK、CSNQ 感测单元
LEN1、LEN2                 镜头
CO1、CO2                   校正物
DC1、DC2                   已知距离
DCS、DCSI、DCSJ、DCS_CAB、 成像位置
DCS2~DCS3、DCS_STD
DCSX                投影距离
DF                  焦距
DM                  待测距离
L                   已知距离
LB                  背景光
LID                 侦测光
LF                  直线
LRD                 反射光
MO                  待测物
OF                  焦点
P1、P2              功率
RK                  反射光的能量
SAB                 参数信号
SALS、SALS1~SALS2N 累计光感测信号
SLD                 发光脉冲信号
SLS                 光感测信号
SP                  阶段信号
SRE                 读取信号
SST                 快门脉冲信号
T1+、T2+            距离感测阶段
T1-、T2-            噪声感测阶段
TC、TR              脉冲宽度
TF                  交流电周期
TSTEADY             已知时间间隔
TEMPAMB             环境温度
TEMPDETECT                    芯片工作温度
TEMPPRE1、TEMPPRE2            已知环境温度
TEMPSTART1                    启动温度
TEMPSTEADT1、TEMPSTEADT2      稳定温度
TEMPSTD                       基准环境温度
θ1、θ2、θ1I、θ2I、θ1J、  角度
θ2J
θLD                          发光误差角度
θCS1、θCS2                  感测误差角度
ΔTEMPIC1、ΔTEMPIC2          工作温差
具体实施方式
请参考图1与图2。图1与图2为说明本发明的利用成像位置差异以测距的测距装置100的结构及工作原理的示意图。测距装置110用来量测待测物MO与测距装置100之间的待测距离DM。测距装置100包含一发光/感测控制电路110、一发光组件120、一影像传感器130、一距离计算电路140、一参数计算电路150,以及一镜头LEN1。测距装置100的内部各组件的耦接关系如图1所示,故不再赘述。
发光/感测控制电路110用来产生发光脉冲信号SLD、快门脉冲信号SST、阶段信号SP、读取信号SRE,以及已知距离信号SD。测距装置100于测距时可分为两阶段:1.距离感测阶段;2.噪声感测阶段。当测距装置100于距离感测阶段时,发光/感测控制电路110同时产生表示「发光」的发光脉冲信号SLD与表示「开启」的快门脉冲信号SST,且二者的脉冲宽度皆为TC;然后发光/感测控制电路110再同时产生表示「读取」的读取信号SRE与表示「总和」的阶段信号SP,且二者的脉冲宽度皆为TR。当测距装置100于噪声感测阶段时,发光/感测控制电路110产生表示「开启」的快门脉冲信号SST且同时发光脉冲信号SLD表示「不发光」,且快门脉冲信号的脉冲宽度为TC;然后发光/感测控制电路110再同时产生表示「读取」的读取信号SRE与表示「噪声」的阶段信号SP,且二者的脉冲宽度皆为TR
发光组件120,用来根据发光脉冲信号SLD,以发出侦测光LID射向待测物MO,以使待测物MO产生反射光LRD。更明确地说,当发光脉冲信号SLD表示「发光」时,发光组件120发出侦测光LID射向待测物MO;当发光脉冲信号SLD表示「不发光」时,发光组件120不发出侦测光LID。此外,发光组件120可为发光二极管(Light-Emitting Diode,LED)或雷射二极管(laser diode)。当发光组件120为发光二极管时,测距装置100可选择性地包含一镜头LEN2,以用来汇聚侦测光LID以射向待测物MO。
镜头LEN1用来汇聚背景光LB或反射光LRD至影像传感器130。影像传感器130包含M个并排的感测单元CS1~CSM,且每个感测单元的宽度皆等于像素宽度WPIX,意即M个并排的感测单元CS1~CSM的总宽度为M×WPIX。感测单元CS1~CSM用来根据快门脉冲信号SST,以感测镜头LEN1所汇聚的光的能量。更明确地说,当快门脉冲信号SST表示「开启」时,感测单元CS1~CSM感测镜头LEN1所汇聚的光(如背景光LB或反射光LRD)的能量以据以产生光感测信号;当快门脉冲信号SST表示「关闭」时,感测单元CS1~CSM不感测镜头LEN1所汇聚的光的能量。举例来说,当快门脉冲信号SST表示「开启」时,感测单元CS1感测镜头LEN1所汇聚的光的能量并据以产生光感测信号SLS1;感测单元CS2感测镜头LEN1所汇聚的光的能量并据以产生光感测信号SLS2;依此类推,感测单元CSM感测镜头LEN1所汇聚的光的能量并据以产生光感测信号SLSM。此外,当读取信号SRE表示「读取」时,感测单元CS1~CSM分别输出光感测信号SLS1~SLSM
距离计算电路140包含复数个储存单元,分别用来储存感测单元CS1~CSM所输出的光感测信号SLS1~SLSM,且根据阶段信号SP,设定所接收的光感测信号的属性。在本实施例中,以距离计算电路140包含M个储存单元M1~MM作举例说明。当阶段信号SP表示「总和」时,储存单元M1~MM将所接收的光感测信号SLS1~SLSM设定为正,意即所接收的光感测信号SLS1~SLSM根据阶段信号SP表示「总和」而被标记为正光感测信号SLS1+~SLSM+;当阶段信号SP表示「噪声」时,储存单元M1~MM将所接收的光感测信号SLS1~SLSM设定为负,意即所接收的光感测信号SLS1~SLSM根据阶段信号SP表示「噪声」而被标记为负光感测信号SLS1-~SLSM-。距离计算电路140便可根据正光感测信号SLS1+~SLSM+与负光感测信号SLS1-~SLSM-,计算出待测距离DM。以下将说明距离计算电路140计算待测距离DM的工作原理。
如图2左半部所示,于距离感测阶段内,发光/感测控制电路110会产生代表「发光」的发光脉冲信号SLD,而使得发光组件120发出侦测光LID射向待测物MO,以使待测物MO产生反射光LRD。此时,发光/感测控制电路110产生代表「开启」的快门脉冲信号SST,而使得感测单元CS1~CSM感测反射光LRD与背景光LB的能量,以分别产生光感测信号SLS1~SLSM。然后发光/感测控制电路110会输出代表「读取」的读取信号SRE,以使影像传感器130输出光感测信号SLS1~SLSM至距离计算电路140,且发光/感测控制电路110会产生代表「总和」的阶段信号SP以指示距离计算电路140此时所接收的光感测信号为距离感测阶段内的光感测信号,意即为正光感测信号SLS1+~SLSM+。设于距离感测阶段内,反射光LRD主要汇聚成像于感测单元CSK,则此时距离计算电路140所接收的正光感测信号SLS1+~SLSM+的值如图2右上半部所示,感测单元CSK同时感测到背景光LB与反射光LRD(意即待测物MO成像于感测单元CSK上)。因此,感测信号SLSK+等于感测单元CSK感测背景光LB所累积的能量BK加上感测单元CSK感测反射光LRD所累积的能量RK,而其它感测单元则只接收到背景光LB。因此,感测信号SLS1+等于感测单元CS1感测背景光LB所累积的能量B1;感测信号SLS21+等于感测单元CS2感测背景光LB所累积的能量B2;依此类推,感测信号SLSM+等于感测单元CSM感测背景光LB所累积的能量BM
如图2左半部所示,于噪声感测阶段内,发光/感测控制电路110会产生代表「开启」的快门脉冲信号SST,而使得感测单元CS1~CSM感测镜头LEN1所汇聚的光,以产生光感测信号SLS1~SLSM。然而,此时发光/感测控制电路110会产生代表「不发光」的发光脉冲信号SLD,因此发光组件120不会发出侦测光LID射向待测物MO,且待测物MO也不会产生反射光LRD。然后发光/感测控制电路110会输出代表「读取」的读取信号SRE,以使影像传感器130输出光感测信号SLS1~SLSM至距离计算电路140,且发光/感测控制电路110会产生代表「噪声」的阶段信号SP以指示距离计算电路140此时所接收的光感测信号为噪声感测阶段内的光感测信号,意即为负光感测信号SLS1-~SLSM-。此时距离计算电路140所接收的光感测信号SLS1-~SLSM-的值如图2右下半部所示。由于快门脉冲信号SST于距离感测阶段与噪声感测阶段的脉冲宽度相同(皆为时间长度TC)。因此感测单元CS1~CSM在距离感测阶段与噪声感测阶段所产生的光感测信号SLS1~SLSM对应于背景光LB累积的部分会相等。换句话说,正光感测信号SLS1+~SLSM+中的背景光累积的能量会等于负光感测信号SLS1-~SLSM-中的背景光累积的能量(B1~BM)。
在经过距离感测阶段与噪声感测阶段后,发光/感测控制电路110会产生代表「计算距离」的阶段信号SP。此时距离计算电路140会将储存单元中的正光感测信号与负光感测信号相减,并选出相减之后所储存的值最大的储存单元并据以判断反射光LRD于影像传感器130上的成像位置。也就是说,距离计算电路140的储存单元M1~MM所储存的值分别等于正光感测信号SLS1+~SLSM+的值减去负光感测信号SLS1-~SLSM-的值。更明确地说,储存单元M1储存正光感测信号SLS1+与负光感测信号SLS1-,由于正光感测信号SLS1+等于B1且负光感测信号SLS1-等于B1,因此储存单元M1经过相减之后所储存的值为零;储存单元M2储存正光感测信号SLS2+与负光感测信号SLS2-,由于正光感测信号SLS2+等于B2且负光感测信号SLS2-等于B2,因此储存单元M2经过相减之后所储存的值为零;依此类推,储存单元MK储存正光感测信号SLSK+与负光感测信号SLSK-,由于正光感测信号SLS2+等于(BK+RK)且负光感测信号SLS2-等于BK,因此储存单元MK余相减之后所储存的值为RK;储存单元MM储存正光感测信号SLSM+与负光感测信号SLSM-,由于正光感测信号SLSM+等于BM且负光感测信号SLSM-等于BM,因此储存单元MM相减之后所储存的值为零。换句话说,在储存单元M1~MM之中,储存单元MK的值等于RK,而其它储存单元的值皆等于零,因此距离计算电路140可据以选择储存单元MK,意即储存单元MK所储存的光感测信号具有对应于反射光LRD的能量。由于储存单元MK为储存感测单元CSK所产生的光感测信号,因此距离计算电路140可判断出待测物MO所产生的反射光LRD主要汇聚成像于感测单元CSK。如此,距离计算电路140可更进一步地根据待测物MO所产生的反射光LRD主要汇聚成像于感测单元CSK,而由下式推算出图1中反射光LRD的成像位置DCS
DCS=K×WPIX…(1);
此外,由于在图1中镜头LEN1的焦点OF1与感测单元CS1之间所形成的直线LF平行于侦测光LID,因此侦测光LID及反射光LRD的夹角θ1与直线LF及反射光LRD的夹角θ2相等。换句话说tanθ1与tanθ2的关系可以下式表示:
tanθ1=L/DM=tanθ2=DCS/DF…(2);
其中L代表发光组件120与影像传感器130(侦测光LID与直线LF)之间的已知距离、DCS代表反射光LRD的成像位置、DF代表镜头LEN1的焦距。根据式(2),待测距离DM可以下式表示:
DM=(DF×L)/DCS…(3);
因此,距离计算电路140可借由式(1)先计算出成像位置DCS,再借由式(3),根据已知距离L、焦距DF,以计算出待测距离DM
综上所述,在测距装置100之中,于距离感测阶段内,发光/感测控制电路110控制发光组件120发出侦测光LID射至待测物MO,且将感测单元CS1~CSM感测镜头LEN1所汇聚的光(如反射光LRD与背景光LB)而据以产生的正光感测信号SLS1+~SLSM+储存于储存单元M1~MM。于噪声感测阶段内,发光/感测控制电路110控制发光组件120不发出侦测光LID,且将感测单元CS1~CSM感测镜头LEN1所汇聚的光(如背景光LB)而据以产生的负光感测信号SLS1+~SLSM+储存于储存单元M1~MM。此时,储存单元M1~MM的值会等于正光感测信号SLS1+~SLSM+减去负光感测信号SLS1-~SLSM-。因此,对应于反射光LRD所汇聚的感测单元CSK的储存单元MK的值会大于其它储存单元的值。如此,距离计算电路140可判断出反射光LRD所汇聚的感测单元CSK,并据以计算出反测光LRD的成像位置DCS。因此,距离计算电路140可根据成像位置DCS、镜头LEN1的焦距DF、已知距离L以计算出待测距离DM
此外,在测距装置100中,距离感测阶段与噪声感测阶段可反复进行多次(如Y次),以使储存单元M1~MM可储存对应于Y个距离感测阶段的正光感测信号,与对应于Y个噪声感测阶段的负光感测信号。由于每个距离感测阶段的正光感测信号对应于背景光的能量的部分,会被对应的噪声感测阶段的负光感测信号所抵销,因此除了对应于反射光LRD所汇聚成像的感测单元CSK的储存单元MK的值会等于(Y×RK)之外,其它储存单元的值皆等于零。如此一来,即使因反射光LRD的能量较弱而使感测单元CSK所据以累积的能量RK较小,测距装置100仍可借由进行多次的距离感测阶段与噪声感测阶段(也就是说,将Y变大),以放大储存单元MK的值与其它储存单元之间的差异,而让距离计算电路140可正确地找出具有最大值的储存单元MK,并据以计算出反射光LRD的成像位置DCS,以提高准确度。
请参考图3。图3为说明测距装置100减少闪烁现象的工作原理的示意图。由于一般室内光源所接收的电源为交流电,因此除了背景光LB外,另一部分的背景光(闪烁光)LF会受到交流电的频率的影响而闪烁。举例而言,室内的日光灯的电源为交流电,因此日光灯所发射的光会受到交流电的频率的影响而闪烁。在图3中,设交流电的周期为TF(如交流电的频率为60Hz、交流电的周期为0.0167秒)。交流电的功率P会随着时间不停的变动,因此闪烁光LF的功率也会随着时间不停的变动。然而,交流电的功率P每隔半交流电周期(TF/2)就会循环一次。举例而言,当时间为T时,交流电的功率P等于PT;则当时间为(T+TF/2)时,交流电的功率P仍等于PT。又闪烁光LF的功率正比于交流电的功率P,因此闪烁光LF的功率会类似交流电的功率,以每隔半交流电周期(TF/2)就会循环一次。如此一来,在测距装置100中,发光/感测控制电路110可借由控制距离感测阶段(如图3所示的T1+与T2+)与噪声感测阶段(如图3所示的T1-与T2-)的时间间隔等于半交流电周期(TF/2),以减低闪烁现象的影响。更明确地说,发光/感测控制电路110,控制感测单元CS1~CSM于距离感测阶段T1+(或T2+)感测对应于交流电的功率P1(或P2)的闪烁光LF,而使得感测单元CS1~CSM所产生的正光感测信号对应于闪烁光LF的部分会等于F11~FM1(或F12~FM2)。且发光/感测控制电路110控制距离感测阶段T1+(或T2+)与噪声感测阶段T1-(或T2-)的时间间隔等于半交流电周期TF/2(如0.0083秒)。因此,感测单元CS1~CSM于噪声感测阶段T1-(或T2-)内所感测的闪烁光LF的功率与感测单元CS1~CSM于距离感测阶段T1+(或T2+)内所感测的闪烁光LF的功率相同。如此于噪声感测阶段T1-(或T2-)内,感测单元CS1~CSM所产生的负光感测信号对应于闪烁光LF的部分也会等于F11~FM1(或F12~FM2)。因此,距离感测阶段T1+(或T2+)的正光感测信号对应于闪烁光LF的部分,会被对应的噪声感测阶段T1-(或T2-)的负光感测信号所抵销。换句话说,除了对应于反射光LRD所汇聚成像的感测单元CSK的储存单元MK的值会等于RK之外,其它储存单元的值皆等于零。因此即使感测单元CS1~CSM会感测到闪烁光LF,发光/感测控制电路110仍可借由控制距离感测阶段T1+或T2+分别与噪声感测阶段T1-或T2-的时间间隔等于半交流电周期(TF/2),以减低闪烁现象的影响,而使距离计算电路140可正确地判断出反射光LRD的成像位置DCS且计算出待测距离DM
由于在生产过程中,当组装测距装置100时,测距装置100内部的组件的位置会因组装误差而产生偏移,因此测距装置100在量测距离时会受到组装误差的影响。因此测距装置100所包含的参数计算电路150用来校正测距装置100的组装误差。以下将说明参数计算电路150的工作原理。
参数计算电路150接收发光/感测控制电路110所输出的距离信号SD,而得到已知距离DC1与已知距离DC2。其中已知距离DC1为校正物CO1与测距装置100之间的距离,已知距离DC2为校正物CO2与测距装置100之间的距离。借由如同图2所述的方法,发光组件120发出侦测光LID射向校正物CO1或CO2,而使参数计算电路150可根据影像传感器130所输出的光感测信号而得到反射光LRD的成像位置,并据以校正测距装置100的组装误差角度。
首先假设发光组件120因组装误差而使发光组件120所发出的侦测光LID旋转发光误差角度θLD
请参考图4。图4为说明校正发光组件120所发出的侦测光LID的发光误差角度θLD的方法的示意图。发光/感测控制电路110控制发光组件120发射侦测光LID射向校正物CO1。其中校正物CO1与测距装置100的距离为已知距离DC1。由于侦测光LRD受到发光组件120的组装误差的影响,因此侦测光LID会以一发光误差角度θLD入射校正物CO1,而校正物CO1反射侦测光LID所产生的反射光LRD会汇聚成像于感测单元CSI。侦测光LID与反射光LRD的夹角为θ1I,而直线LF与反射光LRD的夹角为θ2I。如图4所示,由于直线LF平行于校正物的平面的法线,因此(θ1ILD)会等于θ2I。也就是说,tan(θ1ILD)等于tanθ2I。因此可得下列公式:
DC1=1/[1/(DF×L)×DCSI+B]…(4);
B=tanθLD/L…(5);
其中B代表用来校正发光误差角度θLD的校正参数、DCSI代表反射光LRD的成像位置。因此,参数计算电路150根据式(4)可计算得到校正参数B。如此,参数计算电路150可通过参数信号SAB以输出校正参数B至距离计算电路140,以使距离计算电路140可将式(2)校正如下式,以计算经校正后的待测距离DM
DM=1/[1/(DF×L)×DCS+B]…(6);
因此,即使测距装置100因组装误差而使发光组件120所发出的侦测光LID旋转发光误差角度θLD,测距装置100仍可借由参数计算电路150计算出可校正发光误差角度θLD的校正参数B,以让距离计算电路140根据校正参数B、镜头LEN1的焦距DF、已知距离L,以及量测待测物MO时反射光的成像位置DCS,而正确地计算出待测距离DM
请参考图5与图6。图5、图6为说明因组装误差而使影像传感器130旋转感测误差角度θCS1与θCS2的校正方法的示意图。图5为测距装置100的上视图。如图5所示,影像传感器130的感测误差角度θCS1处于XY平面上。图6为测距装置100的侧视图。此外,从图6可看出影像传感器130所旋转的感测误差角度θCS1与θCS2。发光/感测控制电路110控制发光组件120发射侦测光LID射向校正物CO2,其中校正物CO2与测距装置100的距离为已知距离DC2。此时假设发光组件120没有组装误差(意即假设发光误差角度θLD为零),侦测光LID会入射校正物CO1,而校正物CO1反射侦测光LID所产生的反射光LRD会汇聚成像于感测单元CSJ。侦测光LID与反射光LRD的夹角为θ1J,而直线LF与反射光LRD的夹角为θ2J。由图6可看出,DCSX为反射光LRD的成像位置DCSJ投影至X轴的投影距离,且成像位置DCSJ与投影距离DCSX的关系可以下式表示:
DCSX=DCSJ×cosθCS2×cosθCS1…(6);
又在图5中,直线L与侦测光LID平行,因此直线L与反射光LRD的夹角θ2J等于侦测光LID与反射光LRD的夹角θ1J。也就是说,tanθ1J等于tanθ2J。如此,已知距离DC2与投影距离DCSX的关系可以下式表示:
L/DC2=DCSX/DF…(7);
因此,根据式(6)与(7)可得到下列公式;
DC2=1/(A×DCSJ)…(8);
A=(cosθCS2×cosθCS1)/(DF×L)…(9);
其中A代表用来校正感测误差角度θCS2与θCS1的校正参数。因此,参数计算电路150根据式(8)计算得到校正参数A。如此,参数计算电路150可通过参数信号SAB以输出校正参数A至距离计算电路140,以使距离计算电路140可将式(2)校正如下式,以计算经校正后的待测距离DM
DM=1/(A×DCS)…(10);
由此可知,即使测距装置100因组装误差而使影像传感器130旋转感测误差角度θCS1与θCS2,测距装置100仍可借由参数计算电路150计算出可校正感测误差角度θCS2与θCS1的校正参数A,以让距离计算电路140可借由校正参数A与量测待测物MO时反射光的成像位置DCS,而正确地计算出待测距离DM
假设测距装置100因组装误差而使发光组件120所发出的侦测光LID旋转发光误差角度θLD,且同时影像传感器130旋转感测误差角度θCS1与θCS2。借由图4、图5、图6的说明可知,测距装置100可借由发光组件120发出侦测光LID至校正物CO1与CO2,以分别得到对应于校正物CO1的反射光LRD的成像位置DCS1、与对应于校正物CO2的反射光LRD的成像位置DCS2。又成像位置DCS1与DCS2、测距装置100与校正物CO1之间的已知距离DC1、测距装置100与校正物CO2之间的已知距离DC2,以及校正参数A与B的关系可以下式表示:
DC1=1/[A×DCS1+B]…(11);
DC2=1/[A×DCS2+B]…(12);
此时,参数计算电路150可根据式(11)与式(12)计算出可校正感测误差角度θCS1与θCS2的校正参数A,以及可校正发光误差角度θLD的校正参数B。参数计算电路150可通过参数信号SAB以输出校正参数A与B至距离计算电路140,以使距离计算电路140可将式(2)校正如下式,以计算经校正后的待测距离DM
DM=1/[A×DCS+B]…(13);
如此,即使测距装置100因组装误差而使发光组件120所发出的侦测光LID旋转发光误差角度θLD,且同时影像传感器130旋转感测误差角度θCS1与θCS2。测距装置100仍可借由参数计算电路150计算出可校正感测误差角度θCS2与θCS1的校正参数A与可校正发光误差角度θLD的校正参数B,以让距离计算电路140可正确地计算出待测距离DM
除此之外,根据式(13)可知,当距离计算电路140计算待测距离DM时,只需要参数计算电路150所输出的校正参数A、校正参数B与量测待测物MO时反射光LRD的成像位置DCS,而不需镜头LEN1的焦距DF与已知距离L。换句话说,即使在生产过程中,镜头LEN1的焦距DF有误差,或是已知距离L因组装而产生误差,距离计算电路140仍可根据式(13)以正确地计算出待测距离DM
请参考图7。图7为说明本发明的影像传感器的结构的第一实施例700的示意图。如图7所示,影像传感器700的M个感测单元排列成N行K列。在影像传感器700中,每一行感测单元的水平方向(或图7所示的X轴的方向)上的位置皆相同。更进一步地说,设感测单元CS11~CSNK的宽度皆为WPIX,且设感测单元CS11的左侧于水平方向的位置可表示为零,如此,以每一行感测单元的中心来代表其水平方向上的位置,则第1行感测单元CS11~CS1K于水平方向的位置可表示为1/2×WPIX;第2行感测单元CS21~CS2K于水平方向的位置可表示为3/2×WPIX;第N行感测单元CSN1~CSNK于水平方向的位置可表示为[(2×N-1)×WPIX]/2,其它可依此类推,故不再赘述。因此,由上述说明可知,在影像传感器700中,每一列感测单元于水平方向上的位置皆可表示为{1/2×WPIX,3/2×WPIX,…,[(2×N-1)×WPIX]/2},因此每一列感测单元于水平方向上的位置皆相同。
请参考图8。图8为说明利用影像传感器700以侦测反射光LRD的成像位置DCS的工作原理的示意图。图8的上半部所示的圆圈用来表示反射光LRD于影像传感器700成像的位置,也就是说,被圆圈所覆盖的感测单元,可感测到反射光LRD的能量,而产生较大的光感测信号SLS。为了得到反射光LRD的成像位置DCS,此时,可将每一行感测单元所产生的光感测信号SLS相加(如图8下半部所示),以得到水平方向(X轴方向)上的累计光感测信号SALS。举例而言,根据第1行感测单元CS11~CS1K的光感测信号相加而产生的累计光感测信号为SALS1;根据第2行感测单元CS21~CS2K的光感测信号相加而产生的累计光感测信号为SALS2;根据第N行感测单元CSN1~CSNK的光感测信号相加而产生的累计光感测信号为SALSN,其它可依此类推,故不再赘述。由于接收到反射光LRD的感测单元会产生较高的光感测信号,因此接近反射光LRD的成像位置DCS(意即圆圈中心)的感测单元皆会产生较高的光感测信号。换句话说,若在累计光感测信号SALS1~SALSN中,对应于第F行感测单元CSF1~CSFK的累计光感测信号SALSF具有最大值,则表示反射光LRD的成像位置(圆圈中心)位于第F行感测单元。如此一来,即可以第F行感测单元于水平方向上的位置来代表反射光LRD的成像位置DCS。举例而言,如图8所示,第5行感测单元CS51~CS5K所对应的累计光感测信号SALS5具有最大值,因此可判断反射光LRD的成像位置(圆圈中心)位于第5行感测单元,如此一来,即可以第5行感测单元于水平方向上的位置9/2×WPIX来代表反射光LRD的成像位置DCS
请参考图9。图9为说明本发明的影像传感器的结构的另一实施例900的示意图。如图9所示,影像传感器900的M个感测单元排列成N行K列。相较于影像传感器700,影像传感器900的每一列感测单元与其相邻的其它列感测单元的水平方向(或图9所示的X轴的方向)上的位置相隔一位移距离DSF(在图9中假设位移距离DSF等于WPIX/2)。举例而言,第1列感测单元CS11~CSN1于水平方向上的位置可表示为{1/2×WPIX,3/2×WPIX,…,[(2×N+1)×WPIX]/2};第2列感测单元CS12~CSN2于水平方向上的位置可表示为{WPIX,2×WPIX,…,[2×N×WPIX]/2};第K列感测单元CS1K~CSNK于水平方向上的位置可表示为{[1/2+(K-1)/2]×WPIX,[3/2+(K-1)/2]×WPIX,…,[(2×N-1)/2+(K-1)/2]×WPIX},其它可依此类推,故不再赘述。
请参考图10。图10为说明利用影像传感器900以侦测反射光LRD的成像位置DCS的工作原理的示意图。图10的上半部所示的圆圈用来表示反射光LRD于影像传感器900成像的位置。根据影像传感器900的感测单元CS11~CSNK的光感测信号而产生的累计光感测信号为SALS1~SALS2N。其中累计光感测信号SALS1所对应的感测范围为水平方向上位置0~WPIX/2,由于在感测单元CS11~CSNK之中,仅有感测单元CS11的感测范围涵盖累计光感测信号SALS1所对应的感测范围,因此累计光感测信号SALS1等于感测单元CS11的光感测信号的值;累计光感测信号SALS2所对应的感测范围为水平方向上位置WPIX/2~WPIX,由于在感测单元CS11~CSNK之中,感测单元CS11与CS12的感测范围皆涵盖累计光感测信号SALS2所对应的感测范围,因此累计光感测信号SALS2可借由相加感测单元CS11与CS21的光感测信号而得,其它累计光感测信号可由类似方法而得,故不再赘述。若在累计光感测信号SALS1~SALS2N中,累计光感测信号SALSF具有最大值,则表示反射光LRD的成像位置(圆圈中心)位于对应于累计光感测信号SALSF的水平方向上的位置。举例而言,如图10所示,累计光感测信号SALS10具有最大值,因此可判断反射光LRD的成像位置(圆圈中心)位于对应于累计光感测信号SALS10的水平方向上的位置。由于累计光感测信号SALS10所对应的感测范围为9/2×WPIX~5×WPIX,因此累计光感测信号SALS10所对应的水平方向上的位置可表示为19/4×WPIX。如此,反射光LRD的成像位置(圆圈中心)可以累计光感测信号SALS10水平方向上的位置19/4×WPIX来表示。
此外,相较于影像传感器700,影像传感器900具有更高的分辨率。举例而言,当利用影像传感器700来侦测反射光LRD的成像位置DCS时,若反射光LRD的成像位置DCS(圆圈中心)于水平方向上的实际位置为(17/4)×WPIX,则此时累计光感测信号SALS5具有最大值,因此反射光LRD的成像位置DCS会以影像传感器700的第5行感测单元于水平方向上的位置9/2×WPIX来表示;若反射光LRD的成像位置DCS(圆圈中心)于水平方向上的实际位置略为移动,而变成为(19/4)×WPIX,此时累计光感测信号SALS5仍然具有最大值,也就是说,虽然反射光LRD的成像位置DCS(圆圈中心)于水平方向上的实际位置已经从(17/4)×WPIX变为(19/4)×WPIX,但是反射光LRD的成像位置DCS仍会以影像传感器700的第5行感测单元于水平方向上的位置9/2×WPIX来表示。
然而,当利用影像传感器900来侦测反射光LRD的成像位置DCS时,若反射光LRD的成像位置DCS(圆圈中心)于水平方向上的实际位置为(17/4)×WPIX,则此时累计光感测信号SALS9具有最大值,因此反射光LRD的成像位置DCS会以累计光感测信号SALS9于水平方向上的位置17/4×WPIX来表示;然而,若反射光LRD的成像位置DCS(圆圈中心)于水平方向上的实际位置略为移动,而变成为(19/4)×WPIX,则此时累计光感测信号SALS10具有最大值,因此反射光LRD的成像位置DCS会以累计光感测信号SALS10于水平方向上的位置19/4×WPIX来表示。由此可知,利用影像传感器900可更精确地侦测到反射光LRD的成像位置DCS。更进一步地说,相较于影像传感器700,在影像传感器900中,借由调整每一列感测单元与其相邻的其它列感测单元的水平方向上的位置相隔的位移距离,可使影像传感器900具有更高的分辨率。
此外,在影像传感器900中,每一列感测单元与其相邻的其它列感测单元的水平方向(或图9所示的X轴的方向)上的位置相隔的位移距离并不限定要相同。举例而言,第1列感测单元与第2列的感测单元之间的位移距离为WPIX/2,而第2列感测单元与第3列的感测单元之间的位移距离为WPIX/4。此时,仍可图10所述的方法以利用影像传感器900来侦测反射光LRD的成像位置DCS
请参考图11。图11为说明本发明的影像传感器的结构的另一实施例1100的示意图。如图11所示,影像传感器1100的M个感测单元排列成N行Q列。影像传感器1100与700的不同之处在于,影像传感器700的每一感测单元为一正方形,而影像传感器1100的每一感测单元为一长方形。举例而言,影像传感器700的每一感测单元的宽度与高度皆等于WPIX,而影像传感器1100的每一感测单元的宽度为WPIX,高度则设计为(WPIX×K/Q),其中Q<K,也就是说,影像传感器1100的每一感测单元的短边位于水平方向(X轴方向)上,长边位于垂直方向上。换句话说,影像传感器1100的每一行感测单元具有与影像传感器700的每一感测单元相同的宽度,且影像传感器1100的每一行感测单元的数目Q虽然少于影像传感器700的每一行感测单元的数目K,但是影像传感器1100的每一行感测单元的总面积仍维持与影像传感器700相同。类似于影像传感器700,影像传感器1100提供M个感测单元所产生的M个感测信号给距离计算电路,以使距离计算电路计算出累计光感测信号SALS1~SALSN。举例而言,根据第1行感测单元CS11~CS1Q的光感测信号相加而产生的累计光感测信号为SALS1;根据第2行感测单元CS21~CS2Q的光感测信号相加而产生的累计光感测信号为SALS2;根据第N行感测单元CSN1~CSNQ的光感测信号相加而产生的累计光感测信号为SALSN,其它可依此类推,故不再赘述。如此一来,距离计算电路可利用图8所述的方法,以根据累计光感测信号SALS1~SALSN来得到反射光LRD的成像位置,并进而计算出待测距离DM
相较于影像传感器700,由于在影像传感器1100中,每一感测单元的短边位于水平方向上而使得每一行感测单元的数目较少(意即Q<K),因此可减少距离计算电路于产生累计光感测信号SALS1~SALSN时所需累加的次数。由于影像传感器1100的每一行感测单元的总面积仍维持与影像传感器700相同,因此每一行感测单元所接收到的镜头LEN所汇聚的光的能量维持不变。换句话说,当利用影像传感器1100时,可减少距离计算电路于产生累计光感测信号SALS1~SALSN时所需处理的运算量,且同时维持累计光感测信号SALS1~SALSN的信噪比。此外,在影像传感器1100中,每一感测单元的短边位于水平方向上,且其宽度仍维持为WPIX。换句话说,利用影像传感器1100来计算反射光LRD于水平方向上的成像位置时,其分辨率与利用影像传感器700的情况相同。因此,相较于影像传感器700,影像传感器1100可减少距离计算电路所需处理的运算量,并同时维持累计光感测信号的信噪比与成像位置于水平方向(意即短边所位于的方向)上的分辨率。
综上所述,本发明所提供的测距装置,借由将测距装置中的影像传感器所感测的光感测信号,移除掉背景光与闪烁光的部分,来降低背景光与闪烁现象的影响。在本发明的影像传感器中,可借由调整每一列感测单元与其相邻的其它列感测单元的水平方向上的位置相隔的位移距离,以提高影像传感器的分辨率。除此之外,本发明另提供一种测距装置的校正方法。借由发光组件发出侦测光至一具有第一已知距离的第一校正物与一具有第二已知距离的第二校正物,以分别得出对应于第一校正物的反射光的第一成像位置与对应于第二校正物的反射光的第二成像位置,并根据第一已知距离、该第一成像位置、该第二已知距离以及该第二成像位置,以计算出可校正该测距装置的内部组件的组装误差角度的校正参数。如此,测距装置可借由校正参数以正确地计算出待测距离,提供给使用者更大的方便。
此外,当测距装置的环境温度改变时,会造成测距装置中的内部组件之间的距离改变,以及内部组件的形变。举例而言,测距装置的镜头因膨胀而导致镜头表面曲率与折射率的改变。如此,反射光通过镜头汇聚于影像传感器上的成像位置改变。换句话说,环境温度的变化成反射光的成像位置改变。因此,当环境温度改变时,测距装置会受到环境温度的影响,而使得测距装置所计算的待测距离产生误差。因此本发明提供一种依据环境温度以校正测距装置所量测的待测物的待测距离的校正方法。以下将作更进一步的说明。
请参考图12。图12为说明本发明的依据环境温度TEMPAMB以校正测距装置DMD所量测的待测物MO的待测距离DM的校正方法1200的流程图。测距装置DMD具有一发光组件LD、镜头LEN1与一影像传感器CS。发光组件LD与影像传感器CS之间的距离为一已知距离L1。发光组件LD发射侦测光LID至待测物MO以产生反射光LRD,反射光LRD通过镜头LEN1汇聚于影像传感器CS,以成像于成像位置DCS1。测距装置DMD依据成像位置DCS1、镜头LEN1的焦距DF、已知距离L1,以计算测距装置DMD与待测物MO之间的待测距离DM,本发明的校正方法1200的步骤说明如下:
步骤1210:提供温度传感器TS以量测测距装置DMD的环境温度TEMPAMB
步骤1220:依据环境温度TEMPAMB与成像位置DCS1,以计算一校正成像位置DCS_CAB
步骤1230:依据校正成像位置DCS_CAB,以计算经校正后的待测距离DM
由于当环境温度TEMPAMB改变时,成像位置DCS1主要是受到镜头LEN的形变的影响而改变,因此校正方法1200于步骤1210中主要量测镜头LEN1附近的温度变化。举例而言,温度传感器TS可设置邻近于镜头LEN1。如此,当测距装置DMD测距时,温度传感器TS可量测镜头LEN1的温度,以得到环境温度TEMPAMB。此外,温度传感器TS也可设置邻近于影像传感器CS。温度传感器TS先量测影像传感器CS的一工作温差ΔTEMPIC。更明确地说,如图13所示,当该影像传感器CS接收到电源以进入工作模式时,温度传感器TS可量测此时影像传感器CS的温度,已得到一启动温度TEMPSTART1。影像传感器CS工作时会发热而使得影像传感器CS的温度随着时间上升。然而,如图13所示,经过一已知时间间隔TSTEADY后,影像传感器CS的温度大约稳定地维持一定值而不再上升。此时,温度传感器TS可量测影像传感器CS的温度,而得到一稳定温度TEMPSTEADY1。因此,依据稳定温度TEMPSTEADY1与启动温度TEMPSTART1即可得到影像传感器CS因工作时发热而产生的工作温差ΔTEMPIC1。更明确地说,将稳定温度TEMPSTEADY1与启动温度TEMPSTART1相减即可得到影像传感器CS因工作时发热而产生的工作温差ΔTEMPIC1。当测距装置DMD测距时,温度传感器TS量测影像传感器CS的温度以得到一芯片工作温度TEMPDETECT。由于影像传感器CS的温度等于环境温度TEMPAMB加上工作温差ΔTEMPIC1,换句话说,将芯片工作温度TEMPDETECT与工作温差ΔTEMPIC1相减,即可得到环境温度TEMPAMB。此外,如图14所示,若影像传感器CS进入一省电模式,则当影像传感器CS从省电模式切换进入工作模式时,于经过已知时间间隔TSTEADY后量测影像传感器CS的温度,而得到稳定温度TEMPSTEADY2。因此,依据稳定温度TEMPSTEADY2与启动温度TEMPSTART1可得到此时影像传感器CS因工作时发热而产生的工作温差ΔTEMPIC2。如此,即使影像传感器CS有进入过省电模式,温度传感器TS仍可量测到正确的工作温差ΔTEMPIC2。因此温度传感器TS于测距装置DMD测距时,可依据芯片工作温度TEMPDETECT与工作温差ΔTEMPIC2,而得到正确的环境温度TEMPAMB。相较于设置温度传感器TS邻近于镜头LEN1以直接量测镜头LEN1的温度,来得到环境温度TEMPAMB,设置温度传感器TS邻近于影像传感器CS,仍可以上述的方式(量测影像传感器CS的工作温差ΔTEMPIC)以量测环境温度TEMPAMB,且此时可将温度传感器TS与影像传感器CS整合为一芯片,因此可节省测距装置DMD的成本。
在步骤1220中,于一校正阶段PHCAB内,测距装置DMD分别于已知环境温度TEMPPRE1与TEMPPRE2(举例而言,如30℃与50℃)的条件下,量测具有已知距离DC3的校正物CO3,以得到成像位置DCS3与成像位置成像位置DCS4。也就是说,由于测距装置的内部组件(如镜头LEN1)受到环境温度的变化的影响,因此当测距装置DMD于已知环境温度TEMPPRE1的条件下量测校正物CO3时所得到的成像位置为DCS3,而于已知环境温度TEMPPRE2的条件下量测校正物CO3时所得到的成像位置为DCS4。依据已知环境温度TEMPPRE1与TEMPPRE1、成像位置DCS3与DCS4,可计算一校正斜率SLCAB与基准环境温度TEMPSTD。更明确地说,依据已知距离DC3,可计算测距装置DMD于一基准环境温度TEMPSTD下,量测具有已知距离DC3的校正物CO3时的一基准成像位置DCS_STD。举例而言,设测距装置DMD的工作原理与测距装置100类似,因此,测距装置DMD依据式(3)以计算待测距离DM。此时,将已知距离DC3代入式(3)可得到下式:
DC3=(DF×L1)/DCS_STD…(14);
其中由于DF与L1分别对应于一基准环境温度TEMPSTD(如室温25℃)下镜头LEN1的焦距以及发光组件LD与影像传感器CS之间的距离的已知距离,因此依据式(14)所计算的基准成像位置DCS_STD即为于基准环境温度TEMPSTD下,测距装置DMD量测校正物CO3时的成像位置。由于成像位置的变化量大约正比于环境温度的变化量(如图15所示),因此,成像位置DCS2、DCS3、DCS_STD与环境温度TEMPPRE1、TEMPPRE2、TEMPSTD的关系可以下列方程式表示:
DCS2-DCS_STD=SLCAB×(TEMPPRE1-TEMPSTD)…(15);以及
DCS3-DCS_STD=SLCAB×(TEMPPRE2-TEMPSTD)…(16);
其中SLCAB为校正斜率,用来表示成像位置的变化量与环境温度的变化量之间的比例。由于成像位置DCS2、DCS3、DCS_STD与环境温度TEMPPRE1、TEMPPRE2皆为已知,因此依据式(15)与(16)即可计算出基准环境温度TEMPSTD与校正斜率SLCAB。如此,依据校正斜率SLCAB、基准环境温度TEMPSTD与温度传感器TS所测得的测距装置DMD的环境温度TEMPAMB,即可借由下式以计算出用来补偿测距装置DMD量测待测物MO时的成像位置DCS1的位置补偿量DCDELTA
DCDELTA=SLCAB×(TEMPAMB-TEMPSTD)…(17);
依据式(17)所计算出的位置补偿量DCDELTA与成像位置DCS1,可计算出校正成像位置DCS_CAB。更明确地说,相加成像位置DCS1与位置补偿量DCDELTA,即可计算出校正成像位置DCS_CAB
在步骤1230中,依据校正成像位置DCS_CAB,可计算出经校正后的待测距离DM。举例而言,设测距装置DMD的工作原理与测距装置100类似,因此,测距装置DMD可将校正成像位置DCS_CAB代入式(3)以计算待测距离DM,如下式所示:
DM=(DF×L1)/DCS_CAB…(18);
此外,设测距装置DMD还具有参数计算电路150。由于参数计算电路150可根据式(11)与式(12)计算出可校正感测误差角度θCS1与θCS2的校正参数A,以及可校正发光误差角度θLD的校正参数B,因此,测距装置DMD借由式(13)、与校正参数A、B,以计算校正组装误差后的待测距离DM。因此,当测距装置DMD同时利用校正参数A、B以校正组装误差,且利用校正成像位置DCS_CAB以校正温度变化的影响时,测距装置DMD可利用下式以计算经校正后的待测距离DM
DM=1/[A×DCS_CAB+B]…(19);
其中校正参数A与影像传感器CS的感测误差角度θCS1与θCS2的关系如式(9)所示,校正参数B与发光误差角度θLD的关系如式(5)所示,故不再赘述。
依据本发明的校正方法1200的基本精神,本发明另提供一校正装置。请参考图16。图16为说明本发明的依据环境温度TEMPAMB以校正测距装置DMD所量测的待测物MO的待测距离DM的校正装置1600的示意图。校正装置1600包含一温度传感器1610、一温度感测控制电路1620,以及一温度补偿计算电路1630。
温度传感器1610用来量测测距装置DMD的环境温度TEMPAMB。温度传感器1610的结构与工作原理与前述的温度传感器TS类似。温度传感器1610可设置邻近于测距装置DMD的镜头LEN1。如此,当测距装置DMD测距时,温度传感器1610可量测镜头LEN1的温度,以得到环境温度TEMPAMB。此外,温度传感器1610也可设置邻近于测距装置DMD的影像传感器CS,或是更进一步地将温度传感器1610与影像传感器CS整合为一芯片以节省成本。温度感测控制电路1620用来控制温度传感器1610量测影像传感器CS的工作温差ΔTEMPIC,与控制温度传感器1610于测距装置DMD测距时量测影像传感器CS的温度以得到芯片工作温度TEMPDETECT。如此,温度感测控制电路1620依据芯片工作温度TEMPDETECT与工作温差ΔTEMPIC,以得到环境温度TEMPAMB。更明确地说,温度感测控制电路1620利用图13与图14所说明的方式以控制温度传感器1610量测影像传感器CS的启动温度TEMPSTART与稳定温度TEMPSTEADY,并据以得到影像传感器CS的工作温差ΔTEMPIC。当影像传感器CS接收到电源以进入工作模式时,温度感测控制电路1620控制温度传感器1610量测影像传感器CS的温度以得到启动温度TEMPSTART1。经过已知时间间隔TSTEADY,温度感测控制电路1620控制温度传感器1610量测该影像传感器的温度以得到稳定温度TSTEADY1。如此,温度感测控制电路1620依据稳定温度TSTEADY1与启动温度TSTART1,以得到工作温差ΔTEMPIC1。此外,当影像传感器CS从省电模式进入工作模式时,经过已知时间间隔TSTEADY,温度感测控制电路1620控制温度传感器1610重新量测影像传感器CS的温度以得到稳定温度TSTEADY2。如此,温度感测控制电路1620依据稳定温度TSTEADY2与启动温度TSTART1,可更新工作温差为ΔTEMPIC2。当测距装置DMD测距时,温度感测控制电路1620控制温度传感器1610侦测影像传感器CS的温度以得到芯片工作温度TEMPDETECT,且温度感测控制电路1620依据芯片工作温度TEMPDETECT与工作温差ΔTEMPIC,即可得到环境温度TEMPAMB
TEMPAMB=TEMPDETECT-ΔTEMPIC…(20);
温度补偿计算电路1630用来依据环境温度TEMPAMB与测距装置DMD于量测待测距离DM的成像位置DCS1,以计算校正成像位置DCS_CAB,并提供校正成像位置DCS_CAB给测距装置DMD,以使测距装置DMD可计算经校正后的待测距离DM。更明确地说,于一校正阶段PHCAB内,温度补偿计算电路1630控制测距装置DMD分别于已知环境温度TEMPPRE1与TEMPPRE2(举例而言,如30℃与50℃)的条件下,量测具有已知距离DC3的校正物CO3,以得到成像位置DCS3与成像位置成像位置DCS4。温度补偿计算电路1630依据已知环境温度TEMPPRE1与TEMPPRE1、成像位置DCS3与DCS4,以计算一校正斜率SLCAB与基准环境温度TEMPSTD。更明确地说,温度补偿计算电路1630依据已知距离DC3,可计算测距装置DMD于基准环境温度TEMPSTD下,量测具有已知距离DC3的校正物CO3时的一基准成像位置DCS_STD。举例而言,设测距装置DMD的工作原理与测距装置100类似,测距装置DMD依据式(3)以计算待测距离DM。因此温度补偿计算电路1630依据式(14)可计算于基准环境温度TEMPSTD下,测距装置DMD量测校正物CO3时的基准成像位置DCS_STD,且温度补偿计算电路1630可更进一步地依据式(15)与式(16)以计算出校正斜率SLCAB与基准环境温度TEMPSTD。如此,温度补偿计算电路1630依据校正斜率SLCAB、基准环境温度TEMPSTD与温度传感器1610所测得的测距装置DMD的环境温度TEMPAMB(也就是说,温度感测控制电路1620所提供的环境温度TEMPAMB),即可借由式(17)以计算出用来补偿测距装置DMD量测待测物MO时的成像位置DCS1的位置补偿量DCDELTA。因此,温度补偿计算电路1630相加成像位置DCS1与位置补偿量DCDELTA,即可计算出校正成像位置DCS_CAB
测距装置DMD依据校正成像位置DCS_CAB,可计算出经校正后的待测距离DM。举例而言,设测距装置DMD的工作原理与测距装置100类似,因此,测距装置DMD可将校正成像位置DCS_CAB代入式(18)以计算待测距离DM。此外,若测距装置DMD还具有参数计算电路150,则由于参数计算电路150可根据式(11)与式(12)计算出可校正感测误差角度θCS1与θCS2的校正参数A,以及可校正发光误差角度θLD的校正参数B,因此,测距装置DMD可借由式(13)、与校正参数A、B,以计算校正组装误差后的待测距离DM。如此一来,测距装置DMD可同时利用校正参数A、B以校正组装误差,且利用校正成像位置DCS_CAB以校正温度变化的影响。此时,测距装置DMD利用式(19)以计算经校正后的待测距离DM
综上所述,本发明提供一种依据环境温度以校正测距装置所量测的待测物的待测距离的校正方法及其装置。本发明的校正方法包含提供一温度传感器以量测该测距装置的该环境温度、依据该环境温度与该测距装置测距时的一成像位置,以计算一校正成像位置,以及依据该校正成像位置,以计算经校正后的该待测距离。如此,当测距装置测距时,可依据本发明的校正方法,以避免因环境温度而产生的误差。此外,在本发明的校正方法中,除了可设置温度传感器邻近于测距装置的镜头以直接量测环境温度外,也可设置温度传感器邻近于影像传感器,以间接量测环境温度。如此,可将温度传感器与影像传感器整合成为一芯片,以降低测距装置的成本,带给使用者更大的便利。
以上所述仅为本发明的优选实施例,凡依本发明权利要求所做的均等变化与修饰,皆应属本发明的涵盖范围。

Claims (21)

1.一种依据环境温度以校正测距装置所量测的待测物的待测距离的校正方法,该测距装置具有发光组件、第一镜头、影像传感器,该发光组件发射侦测光至该待测物以产生反射光,该反射光通过该第一镜头汇聚于该影像传感器,以成像于第一成像位置,该测距装置依据该第一成像位置、该第一镜头的焦距、该发光组件与该影像传感器之间的第一已知距离,以计算该测距装置与该待测物之间的该待测距离,该校正方法的特征在于包括:
提供温度传感器以量测该测距装置的该环境温度;
依据该环境温度与该第一成像位置,以计算第一校正成像位置;以及
依据该第一校正成像位置,以计算经校正后的该待测距离。
2.如权利要求1所述的校正方法,其特征在于,提供该温度传感器以量测该测距装置的该环境温度包括:
设置该温度传感器邻近于该第一镜头;以及
于该测距装置测距时,量测该第一镜头的温度,以得到该环境温度。
3.如权利要求1所述的校正方法,其特征在于,提供该温度传感器以量测该测距装置的该环境温度包括:
设置该温度传感器邻近于该影像传感器;
量测该影像传感器的工作温差;
于该测距装置测距时,量测该影像传感器的温度以得到芯片工作温度;
以及
依据该芯片工作温度与该工作温差,以得到该环境温度。
4.如权利要求3所述的校正方法,其特征在于,设置该温度传感器邻近于该影像传感器包括:
整合该温度传感器与该影像传感器于一芯片。
5.如权利要求3所述的校正方法,其特征在于,量测该影像传感器的该工作温差包括:
当该影像传感器接收到电源以进入工作模式时,量测该影像传感器的温度以得到启动温度;
于经过已知时间间隔后,量测该影像传感器的温度以得到稳定温度;以及
依据该稳定温度与该启动温度,以得到该工作温差。
6.如权利要求5所述的校正方法,其特征在于,于经过该已知时间间隔后,量测该影像传感器的温度以得到该稳定温度包括:
当该影像传感器接收到电源以进入该工作模式后,经过该已知时间间隔,量测该影像传感器的温度以得到该稳定温度;以及
当该影像传感器从省电模式进入该工作模式时,经过该已知时间间隔,重新量测该影像传感器的温度以得到该稳定温度。
7.如权利要求1所述的校正方法,其特征在于,依据该环境温度与该第一成像位置,以计算该第一校正成像位置包括:
于校正阶段内,该测距装置分别于第一已知环境温度与第二已知环境温度下,量测具有第二已知距离的校正物,以得到第二成像位置与第三成像位置;
依据该第一已知环境温度、该第二已知环境温度、该第二成像位置、该第三成像位置与该第二已知距离,以计算校正斜率与基准环境温度;
依据该校正斜率、该基准环境温度与该环境温度,以计算位置补偿量;
以及
依据该第一成像位置与该位置补偿量,以计算该第一校正成像位置。
8.如权利要求7所述的校正方法,其特征在于,依据该第一已知环境温度、该第二已知环境温度、该第二成像位置、该第三成像位置与该第二已知距离,以计算该校正斜率与该基准环境温度包括:
依据该第二已知距离,以计算该测距装置于该基准环境温度下,量测具有该第二已知距离的该校正物时的基准成像位置;以及
依据下列方程式以计算该校正斜率与该基准环境温度:
DCS2-DCS_STD=SLCAB×(TEMPPRE1-TEMPSTD);以及
DCS3-DCS_STD=SLCAB×(TEMPPRE2-TEMPSTD);
其中DCS2、DCS3、DCS_STD分别表示该第二成像位置、该第三成像位置与该基准成像位置;SLCAB表示该校正斜率;TEMPPRE1、TEMPPRE2、TEMPSTD分别表示该第一已知环境温度、该第二已知环境温度与该基准环境温度;
其中依据该校正斜率、该基准环境温度与该环境温度,以计算该位置补偿量包括:
依据下式以计算该位置补偿量:
DCDELTA=SLCAB×(TEMPAMB-TEMPSTD);
其中DCDELTA表示该位置补偿量;TEMPAMB表示该环境温度;
其中依据该第一成像位置与该位置补偿量,以计算该第一校正成像位置包括:
相加该第一成像位置与该位置补偿量,以得到该第一校正成像位置。
9.如权利要求1所述的校正方法,其特征在于,依据该第一校正成像位置,以计算经校正后的该待测距离包括:
依据下式以计算该待测距离;
DM=(DF×L)/DCS_CAB
其中DM表示该待测距离;DF表示该第一镜头的该焦距;L表示该发光组件与该影像传感器之间的该第一已知距离;DCS_CAB表示该第一校正成像位置。
10.如权利要求9所述的校正方法,其特征在于,依据该第一校正成像位置,以计算经校正后的该待测距离包括:
依据下式以计算经校正后的该待测距离:
DM=1/(A×DCS_CAB)+B;
其中A、B分别表示第一校正参数与第二校正参数;该第一校正参数用来校正该测距装置的该影像传感器的第一感测误差角度与第二感测误差角度;该第二校正参数用来校正该测距装置的该发光组件的该侦测光所旋转的发光误差角度;
其中该第一校正参数与该影像传感器的该第一感测误差角度与该第二感测误差角度的关系可以下式表示:
A=(cosθCS2×cosθCS1)/(DF×L);
其中θCS1表示该第一感测误差角度、θCS2表示该第二感测误差角度;
其中该第二校正参数与该发光误差角度的关系可以下式表示:
B=tanθLD/L;
其中θLD表示该发光误差角度。
11.一种用来依据环境温度以校正测距装置所量测的待测物的待测距离的校正装置,该测距装置具有发光组件、第一镜头、影像传感器,该发光组件发射侦测光至待测物以产生反射光,该反射光通过该第一镜头汇聚于该影像传感器,以成像于第一成像位置,该测距装置依据该第一成像位置、该第一镜头的焦距、该发光组件与该影像传感器之间的第一已知距离,以计算该测距装置与该待测物之间的该待测距离,该校正装置的特征在于包括:
温度传感器,用来量测该测距装置的该环境温度;以及
温度补偿计算电路,用来依据该环境温度与该第一成像位置,以计算第一校正成像位置,并提供该第一校正成像位置给该测距装置,以使该测距装置计算经校正后的该待测距离。
12.如权利要求11所述的校正装置,其特征在于,该温度传感器设置邻近于该第一镜头,以于该测距装置测距时量测该第一镜头的温度,来得到该环境温度。
13.如权利要求11所述的校正装置,其特征在于,该温度传感器设置邻近于该影像传感器。
14.如权利要求13所述的校正装置,其特征在于,该温度传感器与该影像传感器是整合于一芯片。
15.如权利要求13所述的校正装置,其特征在于,还包括:
温度感测控制电路,用来控制该温度传感器量测该影像传感器的工作温差,与控制该温度传感器于该测距装置测距时量测该影像传感器的温度以得到芯片工作温度,该温度感测控制电路依据该芯片工作温度与该工作温差,以得到该环境温度。
16.如权利要求15所述的校正装置,其特征在于,该温度感测控制电路控制该温度传感器于该影像传感器接收到电源以进入工作模式时,量测该影像传感器的温度以得到启动温度;当该影像传感器进入该工作模式后,经过已知时间间隔,该温度感测控制电路控制该温度传感器量测该影像传感器的温度以得到稳定温度;该温度感测控制电路依据该稳定温度与该启动温度,以得到该工作温差。
17.如权利要求16所述的校正装置,其特征在于,当该影像传感器接收到电源以进入该工作模式后,经过该已知时间间隔,该温度感测控制电路控制该温度传感器量测该影像传感器的温度以得到该稳定温度,且当该影像传感器从省电模式进入该工作模式后,经过该已知时间间隔,该温度感测控制电路控制该温度传感器重新量测该影像传感器的温度以得到该稳定温度。
18.如权利要求11所述的校正装置,其特征在于,于校正阶段内,该测距装置分别于第一已知环境温度与第二已知环境温度下,量测具有第二已知距离的校正物,以得到第二成像位置与第三成像位置;该温度补偿计算电路依据该第已知环境温度、该第二已知环境温度、该第二成像位置、该第三成像位置与该第二已知距离,以计算校正斜率与基准环境温度。
19.如权利要求18所述的校正装置,其特征在于,该温度补偿计算电路依据该第二已知距离,以计算该测距装置于基准环境温度下,量测具有该第二已知距离的该校正物时的基准成像位置;
其中该温度补偿计算电路依据下列方程式以计算该校正斜率与该基准环境温度:
DCS2-DCS_STD=SLCAB×(TEMPPRE1-TEMPSTD);以及
DCS3-DCS_STD=SLCAB×(TEMPPRE2-TEMPSTD);
其中DCS2、DCS3、DCS_STD分别表示该第二成像位置、该第三成像位置与该基准成像位置;SLCAB表示该校正斜率;TEMPPRE1、TEMPPRE2、TEMPSTD分别表示该第一已知环境温度、该第二已知环境温度与该基准环境温度;
其中当该测距装置测距时,该温度补偿计算电路依据该校正斜率、该基准环境温度与该环境温度,以计算位置补偿量,并依据测距装置量测该待测物的该待测距离时的该第一成像位置与该位置补偿量,以计算该第一校正成像位置;
其中该温度补偿计算电路依据下式以计算该位置补偿量:
DCDELTA=SL×(TEMPAMB-TEMPSTD);
其中DCDELTA表示该位置补偿量;TEMPAMB表示该环境温度;
其中该温度补偿计算电路相加该第一成像位置与该位置补偿量,以得到该第一校正成像位置。
20.如权利要求11所述的校正装置,其特征在于,该测距装置还包括距离计算电路,该温度补偿计算电路提供该第一校正成像位置给该距离计算电路,该距离计算电路依据下式以计算经校正后的该待测距离:
DM=(DF×L)/DCS_CAB
其中DM表示该待测距离;DF表示该第一镜头的该焦距;L表示该发光组件与该影像传感器之间的该第一已知距离;DCS_CAB表示该第一校正成像位置。
21.如权利要求20所述的校正装置,其特征在于,该测距装置还包括参数计算电路,该参数计算电路用来提供第一校正参数与第二校正参数给该距离计算电路,该第一校正参数用来校正该测距装置的该影像传感器的第一感测误差角度与第二感测误差角度;该第二校正参数用来校正该测距装置的该发光组件的该侦测光所旋转的发光误差角度,该距离计算电路依据下式以计算经校正后的该待测距离:
DM=1/(A×DCS_CAB)+B;
其中A、B分别表示第一校正参数与第二校正参数;该第校正参数用来校正该测距装置的该影像传感器的第一感测误差角度与第二感测误差角度;该第二校正参数用来校正该测距装置的该发光组件的该侦测光所旋转的发光误差角度;
其中该第一校正参数与该影像传感器的该第一感测误差角度与该第二感测误差角度的关系可以下式表示:
A=(cosθCS2×cosθCS1)/(DF×L);
其中θCS1表示该第一感测误差角度、θCS2表示该第二感测误差角度;
其中该第二校正参数与该发光误差角度的关系可以下式表示:
B=tanθLD/L;
其中θLD表示该发光误差角度。
CN201010245375.6A 2010-07-30 2010-07-30 依据温度校正测距装置量测的待测距离的方法及其装置 Active CN102346030B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201010245375.6A CN102346030B (zh) 2010-07-30 2010-07-30 依据温度校正测距装置量测的待测距离的方法及其装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201010245375.6A CN102346030B (zh) 2010-07-30 2010-07-30 依据温度校正测距装置量测的待测距离的方法及其装置

Publications (2)

Publication Number Publication Date
CN102346030A true CN102346030A (zh) 2012-02-08
CN102346030B CN102346030B (zh) 2016-09-14

Family

ID=45544921

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201010245375.6A Active CN102346030B (zh) 2010-07-30 2010-07-30 依据温度校正测距装置量测的待测距离的方法及其装置

Country Status (1)

Country Link
CN (1) CN102346030B (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105764029A (zh) * 2016-04-19 2016-07-13 福州市佳璞电子商务有限公司 Rfid收发器、基于rfid的视频定位系统和定位方法
CN105783708A (zh) * 2014-11-26 2016-07-20 财团法人工业技术研究院 光学校正装置与光学校正方法
CN107560638A (zh) * 2017-09-05 2018-01-09 上海航天控制技术研究所 一种星敏感器变温标定参数的获取方法
CN107613282A (zh) * 2017-09-29 2018-01-19 无锡昊瑜节能环保设备有限公司 自适应调整的投影仪的投影角度调整方法
CN107613281A (zh) * 2017-09-29 2018-01-19 无锡昊瑜节能环保设备有限公司 一种自适应调整的投影仪
CN107635121A (zh) * 2017-09-29 2018-01-26 无锡昊瑜节能环保设备有限公司 自适应调整的投影仪的投影亮度调节方法
CN108286958A (zh) * 2018-02-06 2018-07-17 北京优尔博特创新科技有限公司 一种测距方法及测距系统
CN110687522A (zh) * 2019-12-10 2020-01-14 广州赛特智能科技有限公司 室内配送车的红外系统校准方法、电子设备及存储介质
CN111473755A (zh) * 2020-04-21 2020-07-31 福建汇川物联网技术科技股份有限公司 一种远程测距方法及装置
CN111824878A (zh) * 2020-07-09 2020-10-27 日立楼宇技术(广州)有限公司 电梯位置检测方法、电梯位置检测系统及电梯
CN111847155A (zh) * 2020-06-04 2020-10-30 日立楼宇技术(广州)有限公司 电梯轿厢位置确定方法、装置、计算机设备和存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1286654A (zh) * 1997-12-26 2001-03-07 三菱电机株式会社 激光加工装置
CN1503047A (zh) * 2002-11-19 2004-06-09 奥林巴斯株式会社 图像摄影装置
CN1734287A (zh) * 2004-07-15 2006-02-15 株式会社三丰 绝对距离测量设备
CN101027574A (zh) * 2004-07-06 2007-08-29 迪米斯戴尔工程有限责任公司 在3d成像系统中测定距离
CN101063799A (zh) * 2006-04-27 2007-10-31 佳能株式会社 图像投影装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1286654A (zh) * 1997-12-26 2001-03-07 三菱电机株式会社 激光加工装置
CN1503047A (zh) * 2002-11-19 2004-06-09 奥林巴斯株式会社 图像摄影装置
CN101027574A (zh) * 2004-07-06 2007-08-29 迪米斯戴尔工程有限责任公司 在3d成像系统中测定距离
CN1734287A (zh) * 2004-07-15 2006-02-15 株式会社三丰 绝对距离测量设备
CN101063799A (zh) * 2006-04-27 2007-10-31 佳能株式会社 图像投影装置

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105783708A (zh) * 2014-11-26 2016-07-20 财团法人工业技术研究院 光学校正装置与光学校正方法
CN105783708B (zh) * 2014-11-26 2019-05-28 财团法人工业技术研究院 光学校正装置与光学校正方法
CN105764029B (zh) * 2016-04-19 2021-11-26 福州佳璞辨溯科技有限公司 基于rfid的视频定位系统和定位方法
CN105764029A (zh) * 2016-04-19 2016-07-13 福州市佳璞电子商务有限公司 Rfid收发器、基于rfid的视频定位系统和定位方法
CN107560638A (zh) * 2017-09-05 2018-01-09 上海航天控制技术研究所 一种星敏感器变温标定参数的获取方法
CN107560638B (zh) * 2017-09-05 2019-09-06 上海航天控制技术研究所 一种星敏感器变温标定参数的获取方法
CN107613282A (zh) * 2017-09-29 2018-01-19 无锡昊瑜节能环保设备有限公司 自适应调整的投影仪的投影角度调整方法
CN107613281A (zh) * 2017-09-29 2018-01-19 无锡昊瑜节能环保设备有限公司 一种自适应调整的投影仪
CN107635121A (zh) * 2017-09-29 2018-01-26 无锡昊瑜节能环保设备有限公司 自适应调整的投影仪的投影亮度调节方法
CN108286958A (zh) * 2018-02-06 2018-07-17 北京优尔博特创新科技有限公司 一种测距方法及测距系统
CN110687522A (zh) * 2019-12-10 2020-01-14 广州赛特智能科技有限公司 室内配送车的红外系统校准方法、电子设备及存储介质
CN111473755A (zh) * 2020-04-21 2020-07-31 福建汇川物联网技术科技股份有限公司 一种远程测距方法及装置
CN111847155A (zh) * 2020-06-04 2020-10-30 日立楼宇技术(广州)有限公司 电梯轿厢位置确定方法、装置、计算机设备和存储介质
CN111824878A (zh) * 2020-07-09 2020-10-27 日立楼宇技术(广州)有限公司 电梯位置检测方法、电梯位置检测系统及电梯

Also Published As

Publication number Publication date
CN102346030B (zh) 2016-09-14

Similar Documents

Publication Publication Date Title
CN102346030A (zh) 依据温度校正测距装置量测的待测距离的方法及其装置
TWI407081B (zh) 利用成像位置差異以測距之測距裝置及其校正方法
CN102650691B (zh) 具校正功能的测距系统与方法
CN102072718B (zh) 利用成像位置差异以测距的测距装置及其校正方法
US10120066B2 (en) Apparatus for making a distance determination
TWI425182B (zh) 距離測量系統及其方法
TWI448666B (zh) 依據環境溫度以校正測距裝置所量測之待測物之待測距離之校正方法與其相關裝置
US20130162835A1 (en) Thermal imaging camera for infrared rephotography
KR102064582B1 (ko) 열화상 카메라를 이용한 온도 측정 장치, 방법 및 컴퓨터로 독출 가능한 기록 매체
TWI476373B (zh) 利用成像位置差異以測距之測距裝置及其校正方法
US10362303B2 (en) Sensor-assisted autofocus calibration
CN109269675A (zh) 测温枪
US8462318B2 (en) Distance-measuring system with correction function and method thereof
CN102401647A (zh) 光学测距系统
CN101806895A (zh) 测距系统及测距方法
CN103558558B (zh) 一种硅太阳能电池转换效率检测装置及检测方法
CN102736795A (zh) 光学触控屏幕系统
JP2011252733A (ja) 物体検知装置
JP5056938B2 (ja) 撮像装置及び画像データ形成方法
JP2012173135A (ja) 携帯機器および温度補正方法
KR20170077472A (ko) 패키지된 광센서 어레이 모듈 보정방법
JP4289382B2 (ja) 監視装置および撮像装置。
CN102680472B (zh) 薄膜检测方法及检测装置
TWI632516B (zh) 日射量比對系統與方法
JP2007036964A (ja) 画像読取装置の調整方法及び調整モジュール

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant