发明内容
为解决上述问题,本发明提供了一种机器人获取深度图像数据的方法及其控制系统,大大提高了机器人获取深度图像数据的工作效率,保证机器人获取深度图像数据的质量。本发明的具体技术方案如下:
一种机器人获取深度图像数据的方法,其特征在于,机器人获取深度图像数据的方法具体步骤包括如下:机器人基于预先设置的校准信息获取当前工作环境的曝光信息;机器人基于预先设置的校准信息和当前工作环境曝光信息进行积分时间自适应调节;机器人基于调节后的积分时间获取深度图像数据;其中,所述预先设置的校准信息是机器人被设置于标准测试环境时,基于预先选择的采样区域进行校准获取的信息;所述预先选择的采样区域是预先从机器人红外光强度图像中选择的限定区域。本方法能够使得机器人在不同工作环境下通过自适应调节积分时间快速获取高质量、曝光效果最佳的深度图像数据。
进一步地,所述校准信息的获取具体包括如下步骤:机器人被设置于标准测试环境中;依次调节机器人积分时间,机器人采集并储存积分时间和其对应的红外光强度图;基于采集的红外光强度图和预先选择的采样区域,机器人计算红外光强度图中采样区域内红外光强度中值IR_mid;基于积分时间和其对应的红外光强度图中采样区域内红外光强度中值IR_mid进行曲线拟合,机器人获取积分时间和红外光强度中值的标准曲线关系式;基于红外光强度图比较得出曝光效果最佳时的图像,机器人获取并储存曝光效果最佳时的红外光强度中值IR_mid。本发明将机器人设置于标准测试环境中获取校准信息,校准信息可用于校准机器人在不同工作环境下的曝光效果最佳时的积分时间,以此达到机器人在不同工作环境获取高质量的深度图像数据的目的。
进一步地,所述预先选择的采样区域是基于机器人的不同功能对深度数据有不同的需求,从红外光强度图中选择出符合深度数据需求的区域。本发明可根据机器人的不同功能目的,对所述红外光强度图像中的采样区域进行定制化限定,具有高度灵活性。
进一步地,所述机器人获取积分时间和红外光强度中值的标准曲线关系式的具体步骤包括:机器人选择适当的曲线关系式来拟合反映积分时间Integration_time和其对应的红外光强度图中采样区域内红外光强度中值IR_time两变量间的关系,获得积分时间Integration_time和强度中值IR_mid的标准曲线关系式。
进一步地,所述机器人获取当前工作环境曝光信息的具体步骤包括如下:机器人采集当前工作环境实时红外光强度图,计算实时红外光强度图中采样区域内红外光强度中值IR_real;机器人根据当前工作环境实时红外光强度图中采样区域内红外光强度中值IR_real和当前积分时间在校准信息中的标准曲线关系式中对应的标准强度中值IR_standard,计算当前工作环境缩放系数Scale_factor;机器人根据校准信息中曝光效果最佳时的红外光强度中值IR_best、积分时间与红外光强度中值的标准曲线关系式和缩放系数Scale_factor,计算当前工作环境中曝光效果最佳时的积分时间Integration_time_best;其中,所述当前工作环境中曝光效果最佳时的积分时间是机器人当前工作环境的曝光信息。本发明使得机器人准确获取当前工作环境的曝光信息,基于获取的当前工作环境的曝光信息可以帮助机器人获取更精准的深度图像数据。
进一步地,所述当前工作环境缩放系数Scale_factor是机器人当前积分时间在标准曲线关系式中对应的标准强度中值IR_standard和当前工作环境实时红外光强度图中采样区域内红外光强度中值IR_real的比值的n次幂。
进一步地,所述曝光效果最佳时的积分时间通过将校准信息中的曝光效果最佳时的强度中值IR_best和当前缩放系数Scale_factor的乘积作为IR_mid代入标准曲线关系式中获得。本发明利用缩放系数使得校准信息中的标准曲线关系式能够在不同工作环境下作为机器人获取深度图像数据的参考关系式。
进一步地,所述机器人基于调节后的积分时间获取深度图像数据具体包括如下步骤:机器人根据计算获得的当前工作环境曝光效果最佳时的积分时间调节自身积分时间;机器人获取当前工作环境曝光效果最佳时的深度图像数据。本发明机器人可基于当前工作环境曝光效果最佳时的积分时间获取曝光效果最佳时的深度图像数据,无需耗费大量人力和时间,机器人可自适应调节至获取高质量深度图像数据。
本发明还公开一种自适应获取深度图像数据的机器人控制系统,所述机器人控制系统包括:控制单元,用于获取和储存预先设置的校准信息,接收TOF传感器采集的实时红外光强度图像,计算当前工作环境红外光强度图像中预先选择的采样区域内强度中值IR_MID,获取当前工作环境曝光效果最佳时的积分时间并传输至TOF传感器;TOF传感器,用于采集实时红外光强度图像并传输至控制单元,接收控制单元获取的当前工作环境曝光效果最佳时的积分时间并基于当前工作环境曝光效果最佳时的积分时间调节积分时间,采集当前工作环境曝光效果最佳时的深度图像数据。所述控制系统能够在不同工作环境下控制机器人快速获取高质量、曝光效果最佳时的深度图像数据,不受环境光强度影响,避免出现过曝光或欠曝光的情况。
进一步地,所述校准信息通过如下步骤获取:机器人控制系统被设置于标准测试环境下;基于TOF传感器的积分时间范围内,依次调节积分时间,TOF传感器采集随积分时间改变而变换的红外光强度图像,控制单元接收计算并储存积分时间和其对应的红外光强度中采样区域内的红外光强度中值IR_MID;基于积分时间和其对应的红外光强度中值IR_MID进行曲线拟合,控制单元获取并储存积分时间与红外光强度中值的标准曲线关系式。所述校准信息可用于机器人控制系统在不同工作环境下校准环境获取曝光效果最佳时的深度图像数据,具有灵活校准的优势。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行详细描述。应当理解,下面所描述的具体实施例仅用于解释本发明,并不用于限定本发明。
本发明公开一种机器人获取深度图像数据的方法,用于机器人在不同工作环境下自适应调节参数获取深度图像数据,结合附图1,所述方法具体步骤包括:机器人基于预先设置的校准信息获取当前工作环境的曝光信息;机器人基于预先设置的校准信息和当前工作环境曝光信息进行积分时间自适应调节;机器人基于调节后的积分时间获取深度图像数据。
具体地,所述预先设置的校准信息是机器人被设置于标准测试环境时,基于预先选择的采样区域进行校准所获取的信息;所述采样区域是根据产品功能对深度数据的需求,通过预先选择红外光强度图像中的限定像素点作为采样区域,可以是但不限于红外光强度图像中的下方四十行像素点、红外光强度图像中的上方二十行像素点、红外光强图像右侧十列像素点或全幅红外光强度图像,具体限定像素点作为采样区域可根据产品功能对深度图像数据的需求改变;所述机器人获取深度图像数据可以是但不限于机器人利用TOF传感器获取;所述积分时间为TOF模块发射光波脉冲和接收反射光波脉冲的时间。
本发明的一种实施例中,所述校准信息的获取具体包括如下步骤:机器人被设置于标准测试环境中;依次调节机器人积分时间,机器人采集并储存积分时间和其对应的红外光强度图;基于采集的红外光强度图和预先选择的采样区域,机器人计算红外光强度图中采样区域内红外光强度中值IR_mid;基于积分时间和其对应的红外光强度图中采样区域内红外光强度中值IR_mid进行曲线拟合,机器人获取积分时间和红外光强度中值的标准曲线关系式;基于红外光强度图比较得出曝光效果最佳时的图像,机器人获取并储存曝光效果最佳时的红外光强度中值IR_mid。
具体地,所述标准测试环境是指环境中空间空旷且不存在障碍物;所述红外光强度图是指所拍摄图像中每个像素点代表红外光强度;所述红外光强度中值是指红外光强度图像中采样区域内所有像素点的像素值中值。
本发明的一种实施例中,所述预先选择的采样区域是基于机器人的不同功能对深度数据有不同的需求,从红外光强度图中选择出符合深度数据需求的区域。
具体地,所述采样区域是基于机器人不同功能对深度数据的需求,选择红外光强度图像中的行数据作为限定采样区域范围,可以是但不限于是红外光强度图像下方四十行数据、红外光强图像上方二十行数据或全幅红外光强度图像,具体采样区域的限定可根据机器人功能对深度数据的需求而改变,如果机器人是扫地机器人,需要测量扫地区域的深度数据,则可以根据传感器位置选择红外光强度图中下方一定行数的像素点作为机器人采样区域。
本发明的一种实施例中,所述机器人获取积分时间和红外光强度中值的标准曲线关系式的具体步骤包括:机器人选择适当的曲线关系式来拟合反映积分时间Integration_time和其对应的红外光强度图中采样区域内红外光强度中值IR_time两变量间的关系,获得积分时间Integration_time和强度中值IR_mid的标准曲线关系式。具体地,标准曲线关系式可用作机器人在不同工作环境下的校准公式,利用标准曲线关系式获取当前工作环境的标准强度中值。
本发明的一种实施例中,所述机器人获取当前工作环境曝光信息的具体步骤包括如下:机器人采集当前工作环境实时红外光强度图,计算实时红外光强度图中采样区域内红外光强度中值IR_real;机器人根据当前工作环境实时红外光强度图中采样区域内红外光强度中值IR_real和当前积分时间在校准信息中的标准曲线关系式中对应的标准强度中值IR_standard,计算当前工作环境缩放系数Scale_factor;机器人根据校准信息中曝光效果最佳时的红外光强度中值IR_best、积分时间与红外光强度中值的标准曲线关系式和缩放系数Scale_factor,计算当前工作环境中曝光效果最佳时的积分时间Integration_time_best;具体地,所述机器人当前工作环境曝光信息为当前工作环境中曝光效果最佳时的积分时间。
本发明的一种实施例中,所述当前工作环境缩放系数Scale_factor是机器人当前积分时间在标准曲线关系式中对应的标准强度中值IR_standard和当前工作环境实时红外光强度图中采样区域内红外光强度中值IR_real的比值的n次幂。具体地,所述n次幂根据标准曲线关系式决定,可以是但不限于是1次幂或2次幂;由于机器人当前工作环境与标准测试环境有所差异,可以通过缩放系数进行校准使得标准曲线关系式可应用于不同工作环境中。
本发明的一种实施例中,所述曝光效果最佳时的积分时间通过将校准信息中的曝光效果最佳时的强度中值IR_best和当前缩放系数Scale_factor的乘积作为IR_mid代入标准曲线关系式中获得。具体地,所述预先选择的曝光效果最佳时的强度中值和当前缩放系数的乘积代表机器人当前工作环境曝光效果最佳时的强度中值;;所述标准曲线关系式根据校准信息中标准测试环境下积分时间Integration_time和强度中值IR_mid拟合获得。
本发明的一种实施例中,所述机器人基于调节后的积分时间获取深度图像数据具体包括如下步骤:机器人根据计算获得的当前工作环境曝光效果最佳时的积分时间调节自身积分时间;机器人获取当前工作环境曝光效果最佳时的深度图像数据。具体地,机器人基于TOF飞行时间测距法获取深度图像数据,通过调节积分时间可以获得当前工作环境下曝光效果最佳时的深度图像数据。
本发明还公开了一种自适应获取深度图像数据的机器人控制系统,如图2所示,所述机器人控制系统包括:控制单元,用于获取和储存预先设置的校准信息,接收TOF传感器采集的实时红外光强度图像,计算当前工作环境红外光强度图像中预先选择的采样区域内强度中值IR_mid,获取当前工作环境曝光效果最佳时的积分时间并传输至TOF传感器;TOF传感器,用于采集实时红外光强度图像并传输至控制单元,接收控制单元获取的当前工作环境曝光效果最佳时的积分时间并基于当前工作环境曝光效果最佳时的积分时间调节积分时间,采集当前工作环境曝光效果最佳时的深度图像数据。具体地,所述控制系统能够在不同工作环境下控制机器人快速获取高质量、曝光效果最佳时的深度图像数据,不受环境光强度影响,避免出现过曝光或欠曝光的情况。
本发明的一种实施例中,所述校准信息通过如下步骤获取:机器人控制系统被设置于标准测试环境下;基于TOF传感器的积分时间范围内,依次调节积分时间,TOF传感器采集随积分时间改变而变换的红外光强度图像,控制单元接收计算并储存积分时间和其对应的红外光强度中采样区域内的红外光强度中值IR_mid;基于积分时间和其对应的红外光强度中值IR_mid进行曲线拟合,控制单元获取并储存积分时间与红外光强度中值的标准曲线关系式。具体地,所述校准信息可用于机器人控制系统在不同工作环境下校准环境获取曝光效果最佳的深度图像数据,具有灵活校准的优势
以上实施例仅用于说明本发明的技术方案,而非对其限制。在本发明的上述实施例中,对各个实施例的描述都各有侧重,某各实施例中没有详述的部分,可以参见其他实施例的相关描述。
在本发明所提供的实施例中,应该理解到,所揭露的方法和控制系统,可以通过其他的方式实现。例如,以上所描述实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略或不执行。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同限定以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。