CN113776528B - 一种物流机器人及其定位方法 - Google Patents
一种物流机器人及其定位方法 Download PDFInfo
- Publication number
- CN113776528B CN113776528B CN202111069248.XA CN202111069248A CN113776528B CN 113776528 B CN113776528 B CN 113776528B CN 202111069248 A CN202111069248 A CN 202111069248A CN 113776528 B CN113776528 B CN 113776528B
- Authority
- CN
- China
- Prior art keywords
- speed
- moving mechanism
- driving motor
- plate
- gear
- 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 36
- 230000007246 mechanism Effects 0.000 claims abstract description 52
- 230000033001 locomotion Effects 0.000 claims abstract description 17
- 238000006073 displacement reaction Methods 0.000 claims abstract description 10
- 238000012937 correction Methods 0.000 claims abstract description 9
- 230000005540 biological transmission Effects 0.000 claims description 42
- 230000001360 synchronised effect Effects 0.000 claims description 31
- 239000011159 matrix material Substances 0.000 claims description 28
- 238000012545 processing Methods 0.000 claims description 13
- 239000000725 suspension Substances 0.000 claims description 13
- 230000001133 acceleration Effects 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 6
- 238000007781 pre-processing Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 230000010354 integration Effects 0.000 claims description 4
- 238000005259 measurement Methods 0.000 claims description 4
- 230000008859 change Effects 0.000 claims description 3
- 238000001914 filtration Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000011156 evaluation Methods 0.000 claims description 2
- 238000003672 processing method Methods 0.000 claims description 2
- 210000000078 claw Anatomy 0.000 abstract description 6
- 230000006870 function Effects 0.000 description 8
- 238000004590 computer program Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 7
- 238000004364 calculation method Methods 0.000 description 3
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 229910000831 Steel Inorganic materials 0.000 description 1
- 230000002411 adverse Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000010959 steel Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
- G01C21/1656—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments with passive imaging devices, e.g. cameras
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G41/00—Supporting frames or bases for conveyors as a whole, e.g. transportable conveyor frames
- B65G41/007—Means for moving conveyor frames and control arrangements therefor
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
- B65G47/74—Feeding, transfer, or discharging devices of particular kinds or types
- B65G47/90—Devices for picking-up and depositing articles or materials
- B65G47/901—Devices for picking-up and depositing articles or materials provided with drive systems with rectilinear movements only
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/80—Technologies aiming to reduce greenhouse gasses emissions common to all road transportation technologies
- Y02T10/86—Optimisation of rolling resistance, e.g. weight reduction
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种物流机器人及其定位方法,其包括底盘,设置在底盘上的横向移动机构、纵向移动机构、前后移动机构和机械爪手;横向移动机构设置在底盘上,纵向移动机构活动设置在横向移动机构上,且前后移动机构设置在纵向移动机构上,机械抓手设置在前后移动机构上。定位方法为:获取车轮驱动电机的当前转速;获取陀螺仪测得的当前速度;对摄像头采集到的图像中相邻两帧图像的特征点进行检测、匹配,得到相邻图像对应特征点在相机坐标系下的位移信息,微分运算得到车体速度;根据三个速度得到相对准确的车体速度得到车体已运动过的距离,将目标位置与当前位置进行比较得出电机应有目标转速,经角度修正后得到电机实际应有转速,完成定位与目标运动。
Description
技术领域
本发明涉及一种机器人技术领域,特别是关于一种物流机器人及其定位方法。
背景技术
随着社会的不断发展,人类生活水平的不断提高,越来越多搬运任务交由一些能自主运行的物流车来完成,如何实现机器人的实时定位的准确性成了一个不可忽视的问题。人们对定位的要求不断提高,使得室内定位的重要性愈发显著,目前已成为了位置服务研究领域的热点。目前主流的室内定位系统有惯性导航、Slam等,但都有着或多或少的问题。INS短时性精度高,但累计误差大、易产生偏移,且成本昂贵。激光Slam可以准确测量障碍点的角度与距离但对环境依赖性强。相机作为无源传感器,使得以其为依靠的视觉Slam可以无需对场景进行布置且图像具有丰富的信息等优势,但也会产生尺度飘逸等现象。上述问题大多可归结为是由于场景因素或传感器本身工艺而带来的,使得单一传感器在使用时时常出现数据偏差、误差增大等现象。其最好的解决办法就是将多传感器的数据进行融合,使得数据源多元化。多传感器数据融合就是要通过相互补偿、互相纠偏等手段将传感器的数据信息进行有效、合理的数据关联来弥补单一传感器的不足。同时鉴于大多搬运任务往往是要往返于固定的两点间,采用上述方法则会极大地增加成本不利于生产经营,所以需要一种低成本同时能完成具有高精度的定位的物流机器人。
发明内容
针对上述问题,本发明的目的是提供一种物流机器人及其定位方法,其定位精度高。
为实现上述目的,本发明采取以下技术方案:一种物流机器人的定位方法,其包括:步骤1、获取机器人的车轮驱动电机的当前转速Vd;步骤2、对机器人上陀螺仪获取的加速度值预处理后,进行复化Simpson积分得到陀螺仪测得的当前速度Va;步骤3、对机器人上摄像头采集到的图像中相邻两帧图像的特征点进行检测、匹配,得到相邻图像对应特征点在相机坐标系下的位移信息,依据世界坐标系与相机坐标系的转化关系得到该特征点在世界坐标系下的位移量Sw,对位移量Sw进行微分运算得到经特征点检测运算得到的车体速度Vv;步骤4、将当前转速Vd、当前速度Va和车体速度Vv进行处理得到相对准确的车体速度V,对该车体速度V进行积分运算得到车体已运动过的距离,将目标位置与当前位置进行比较进行位置闭环运算得出电机速度环的目标转速,经角度环运算修正后输入到内环速度环再利用速度闭环来得到电机应有转速,完成定位。
进一步,所述步骤1中,采用正解算的方法得到电机当前转速Vd。
进一步,所述步骤2中,对加速度值的预处理采用最小二乘法线性拟合。
进一步,所述步骤3中,采用AKAZE方法对相邻两帧图像的特征点进行检测、匹配。
一种用于实现上述定位方法的物流机器人,其包括底盘,以及设置在所述底盘上的横向移动机构、纵向移动机构、前后移动机构和机械爪手;所述横向移动机构设置在所述底盘上,纵向移动机构活动设置在所述横向移动机构上,且所述前后移动机构设置在所述纵向移动机构上,所述机械抓手设置在所述前后移动机构上;
所述横向移动机构包括第一驱动电机、滑轨、第一主动齿轮、第一从动齿轮、第一同步带和丝杠;所述丝杠的两端设置在所述底盘上,所述滑轨与所述丝杠平行设置在所述底盘上;所述第一驱动电机的外壳固定在所述底盘上,所述第一驱动电机的输出端设置有所述第一主动齿轮,所述第一主动齿轮与所述第一从动齿轮通过所述第一同步带进行传动连接,且所述第一同步带的内侧设置有若干锯齿,所述第一同步带位于所述滑轨的上方;所述纵向移动机构与所述第一同步带啮合,并分别与所述滑轨和丝杠连接,由所述第一驱动电机带动所述第一同步带及所述纵向移动机构在横向上左右移动。
进一步,所述纵向移动机构包括连接座、齿条、齿轮和第二驱动电机;所述连接座的底部一端与所述第一同步带的下侧啮合后,与所述滑轨连接,另一端与所述丝杠活动连接,所述齿条的底部固定设置在所述连接座上;所述第二驱动电机设置在所述前后移动机构的底部,且所述第二驱动电机的输出轴与所述齿轮同轴连接,所述齿轮与所述齿条啮合,由所述第二驱动电机带动所述齿轮沿所述齿条进行纵向上下移动。
进一步,所述前后移动机构包括连接板、第三驱动电机、第二同步带、传动齿轮、滑道和传动板;该连接板采用凹槽型结构;所述连接板的底部固定设置有所述第二驱动电机,在所述齿轮和齿条的啮合传动下使所述连接板沿所述齿条进行纵向移动;所述连接板的第一端固定设置有所述第三驱动电机,所述第三驱动电机的输出端通过所述传动齿轮与所述第二同步带传动连接,且所述第二同步带内侧设置有若干锯齿;所述传动板的第一端与所述第二同步一侧啮合,由所述第二同步带带动所述传动板进行前后移动,所述传动板11的第二端与与所述滑道连接,所述滑道嵌设在所述连接板的凹槽内,所述机械抓手设置在所述滑道上,由所述第三驱动电机带动所述滑道和机械抓手进行前后移动。
进一步,所述机械抓手包括安装座,以及设置在所述安装座上的上抓手、下抓手和第四驱动电机;所述上抓手和下抓手之间通过连接轴连接,所述第四驱动电机的输出端同轴连接有第一传动齿轮,所述连接轴的一端固定设置有第二传动齿轮,所述第一传动齿轮与所述第二传动齿轮啮合,由所述第四驱动电机带动所述连接轴转动,实现所述上抓手与所述下抓手闭合或打开。
进一步,所述上抓手和下抓手的一侧设置有摄像头。
进一步,所述底盘包括上底板、下底板前板、下底板后板、侧板、车轮驱动电机、电池、固定件和摆动共轴悬挂结构,所述下底板前板和下底板后板活动连接构成下底板;所述下底板的周边设置有所述侧板,所述下底板前板通过所述摆动共轴悬挂结构与所述上底板连接;所述车轮驱动电机设置为四个,分别用于驱动一个全向轮,所述车轮驱动电机的后侧设置有霍尔传感器;所述下底板的中部通过所述固定件固定设置有所述电池。
本发明由于采取以上技术方案,其具有以下优点:1、本发明采用AKAZE进行特征点检测与匹配的核心算法,具有尺度不变性、旋转不变性、光照不变性与所需算力小等优点。2、本发明采用最小二乘法拟合加速度计的读数,并利用复化Simpson对拟合后的加速度作积分处理,能获取含有较少噪声的数据。3、本发明采用位置环得到动态的目标速度,采用角度环进行目标速度的修正保证机器人姿态的正确性,采用速度环实现机器人的动态自平衡。4、本发明采用摆动共轴悬挂装置能很好地适应崎岖路面,使得机器人不会因路面崎岖而导致一轮悬空的现象。5、本发明采用椭圆爪头增大了抓取时的容错率,同时采用镂空设计减轻爪头的重量。6、本发明在机械臂的移动上采用齿轮传动可以有效防止因堵转带来的不良影响。
附图说明
图1是本发明实施例中机器人的整体结构示意图;
图2是图1的侧视图;
图3是本发明实施例中底盘结构示意图;
图4是本发明实施例中的定位方法流程示意图;
图5是本发明实施例中的车轮驱动电机坐标示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例的附图,对本发明实施例的技术方案进行清楚、完整地描述。显然,所描述的实施例是本发明的一部分实施例,而不是全部的实施例。基于所描述的本发明的实施例,本领域普通技术人员所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要理解的是,术语“上”、“下”“前”、“后”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
如图1、图2所示,本发明提供一种物流机器人,其包括底盘1,以及设置在底盘1上的横向移动机构、纵向移动机构、前后移动机构和机械爪手2。横向移动机构设置在底盘1上,纵向移动机构活动设置在横向移动机构上,且前后移动机构设置在纵向移动机构上,机械爪手2设置在前后移动机构上。
在一个优选的实施例中,横向移动机构包括丝杠3、滑轨4、第一驱动电机5、第一主动齿轮6、第一从动齿轮和第一同步带。丝杠3的两端设置在底盘1上,滑轨4与丝杠3平行设置在底盘1上。第一驱动电机5的外壳固定在底盘1上,第一驱动电机5的输出端设置有第一主动齿轮6,第一主动齿轮6与第一从动齿轮通过第一同步带进行传动连接,且第一同步带的内侧设置有若干锯齿,第一同步带位于滑轨4的上方。纵向移动机构与第一同步带啮合,并分别与滑轨4和丝杠3连接,由滑轨4起到支撑及导向作用;使用时,由第一驱动电机5带动第一同步带及纵向移动机构在横向上左右移动。
在一个优选的实施例中,纵向移动机构包括连接座、齿条7、齿轮8和第二驱动电机22。连接座的底部一端与第一同步带的下侧啮合后,与滑轨4连接,另一端与丝杠3活动连接,进而沿丝杠3随第一同步带在横向左右移动;齿条7的底部固定设置在连接座上。第二驱动电机22设置在前后移动机构的底部,且第二驱动电机22的输出轴与齿轮8同轴连接,齿轮8与齿条7啮合,进而由第二驱动电机22带动齿轮8沿齿条7进行纵向上下移动。
在一个优选的实施例中,前后移动机构包括连接板、第三驱动电机9、第二同步带、传动齿轮、滑道10和传动板11;该连接板采用凹槽型结构。连接板的底部固定设置有第二驱动电机22,在齿轮8和齿条7的啮合传动下使连接板沿齿条7进行纵向移动。连接板的第一端固定设置有第三驱动电机9,第三驱动电机9的输出端通过传动齿轮与第二同步带传动连接,且第二同步带内侧设置有若干锯齿;传动板11的第一端与第二同步一侧啮合,由第二同步带带动传动板11进行前后移动。传动板11的第二端与滑道10连接,滑道10嵌设在连接板的凹槽内,由传动板11带动滑道10在凹槽内前后移动;机械爪手2设置在滑道10上,使用时,由第三驱动电机9带动滑道10进行前后移动,进而带动机械爪手2进行前后移动。
上述实施例中,如图2所示,传动齿轮由第二主动齿轮23和第二从动齿轮24构成,第二主动齿轮23与第三驱动电机9的输出轴同轴连接。第二从动齿轮24设置在连接板的第二端。
在一个优选的实施例中,机械爪手2包括安装座,以及设置在安装座上的上抓手、下抓手和第四驱动电机12。上抓手和下抓手之间通过连接轴连接,第四驱动电机的输出端同轴连接有第一传动齿轮,连接轴的一端固定设置有第二传动齿轮,第一传动齿轮与第二传动齿轮啮合,进而由第四驱动电机12带动连接轴转动,实现上抓手与下抓手闭合或打开。
上述实施例中,位于上抓手和下抓手的一侧设置有摄像头13,用于获取机器人的周边环境信息。
上述实施例中,上抓手和下抓手都采用椭圆型镂空结构,可以有效减轻抓手的重量。
上述各实施例中,第一驱动电机5、第二驱动电机22、第三驱动电机9和第四驱动电机12均优选为12V小电机。
上述各实施例中,在底盘1上设置有四个全向轮14,通过全向轮14实现机器人的全方位移动。
在一个优选的实施例中,如图3所示,底盘1包括上底板、下底板前板15、下底板后板16、侧板17、摆动共轴悬挂结构18、车轮驱动电机19、固定件20和电池21;下底板前板15和下底板后板16活动连接构成下底板。下底板的周边设置有侧板17,且下底板前板15通过摆动共轴悬挂结构18与上底板连接,通过摆动共轴悬挂结构18实现上底板与下底板前板15共轴摆动连接,同时,使机器人在崎岖道路上能摆动保证全向轮14触地。车轮驱动电机19设置为四个,分别用于驱动一个全向轮14;并在车轮驱动电机19的后侧设置有霍尔传感器。下底板的中部通过固定件20固定设置有电池21,用于为各驱动电机供电。
上述实施例中,摆动共轴悬挂结构18包括底座和悬挂件。其中,悬挂件的顶部为安装平面,用于与上底板连接;悬挂件的底部为转轴结构,该转轴与底座之间通过钢棒活动连接,进而使得悬挂件可以在底座上进行左右摆动。
上述实施例中,车轮驱动电机19采用德科电机。
上述各实施例中,位于底盘1中心位置处还设置有陀螺仪。在本实施例中,陀螺仪优选型号为GY-901的九轴陀螺仪。
如图4所示,本发明还提供一种物流机器人的定位方法,其包括:
步骤1、获取机器人的车轮驱动电机19的当前转速Vd;
在本实施例中,采用正解算的方法来处理霍尔传感器采集到的数据,进而得到电机当前转速Vd;
步骤2、对陀螺仪获取的加速度值预处理后,进行复化Simpson积分得到陀螺仪测得的当前速度Va;
在本实施例中,对加速度值的预处理采用最小二乘法线性拟合;
步骤3、对摄像头13采集到的图像中相邻两帧图像的特征点进行检测、匹配,得到相邻图像对应特征点在相机坐标系下的位移信息,依据世界坐标系与相机坐标系的转化关系得到该特征点在世界坐标系下的位移量Sw,对位移量Sw进行微分运算得到经特征点检测运算得到的车体速度Vv;
在本实施例中,采用AKAZE方法对相邻两帧图像的特征点进行检测、匹配;
步骤4、将当前转速Vd、当前速度Va和车体速度Vv进行处理得到相对准确的车体速度V,对该车体速度V进行积分运算得到车体已运动过的距离,将目标位置与当前位置进行比较进行位置闭环运算得出电机速度环的目标转速,经角度修正后输入到内环速度环再利用速度闭环来得到电机应有转速,完成定位;通过速度环可以实现机器人在有外界干扰的状态下实现动态自平衡,保证机器人以应有速度运行;
在本实施例中,为了去除环境噪声,增加数据精准性和稳定性能,对三个速度采用三阶卡尔曼滤波进行数据处理得到相对准确的车体速度V。
上述步骤1中,如图5所示,通过正解算对霍尔编码器信息进行解读,得到车轮驱动电机19在x轴、y轴的速度量Vx、Vy:
式中,V1、V2、V3、V4分别表示四个车轮驱动电机的转速。根据速度量Vx、Vy得到霍尔编码器测得的机器人速度Vd。
上述步骤2中,采用对预先设定的样本数据进行最小二乘法进行线性拟合来得到之后实时测量数据的预先矫正量。采用线性拟合样本数据,令f=min∑(axi-(b0+b1ti))2,得到:
b0=amean-b1tmean
式中,axi表示X轴方向上第i次采样获得的加速度,b0表示待求常亮常数,b1表示待求一阶系数,ti表示第i次采样的时间,n表示采样次数,tmean表示平均时间,amean表示平均加速度;
由此得到拟合的x轴线性加速度计函数axt=b0+b1ti,同理得y轴线性加速度计函数ayt=b2+b3ti,将其与每次所读出的ax、ay进行加权拟合得到较为准确的axt、ayt。采用复化Simpson算法对其进行数值积分,假设目标位置为S,则陀螺仪测得的速度值Va为:
上述步骤3中,采用AKAZE算法来实现相邻帧之间特征点的检测与匹配,从而获得其在相邻两帧图像中的变化量Δxu、Δyv。同时,利用张正友标定法进行相机的标定来获取相机的内参矩阵和外参矩阵进行相机的畸变矫正。根据相机坐标系与世界坐标系、投影关系以及像素与像平面之间的变化关系来得到整体的转换关系:
其中,ZC表示图像中的像素坐标系的位置向量,u表示像素坐标系下的x值,v表示像素坐标系下的y值,Xw、Yw、Zw分别为世界坐标系下的X、Y、Z轴的大小,为相机内参矩阵,fx、fy、cx、cy为摄像头相应的横向畸变与纵向畸变参数,/>为外参矩阵,R表示旋转矩阵,t表示偏移向量,f表示相机焦距;
从而将特征点在相机坐标系中的Δxu、Δyv坐标变化量转化为了其在世界坐标系中的位置差Δxw、Δyw、Δzw。对Δxw、Δyw进行微分处理得到车体速度Vv。
上述步骤4中,三阶卡尔曼滤波处理方法包括:
步骤4.1、预估计:
Vk=Ak-1Vdk-1+Bk-1,kVak-1+Ck-1,kVvk-1;
式中,Vk表示经三阶卡尔曼预测处理后得到的机器人运动速度,Ak-1、Bk-1、Ck-1分别为霍尔编码器得到的速度Vd、加速度计得到的速度Va、视觉检测特征点运算出来的速度Vv的增益矩阵,Vdk-1、Vak-1、Vvk-1分别为三种传感器前次采样得到的速度。
步骤4.2、计算预估计斜方差矩阵Pk:
式中,Pk-1为上次预估计斜方差矩阵,Dk-1,k,为相应变化矩阵及其转置矩阵,Q为过程误差协方差矩阵
步骤4.3、计算卡尔曼增益矩阵Kk:
式中,为相应的概率矩阵,Hk、/>为状态变量到测量(观测)的转换矩阵及其转置矩阵,Rk为测量噪声的协方差。
步骤4.4、更新估计:
Vk=Vk-1+Kk[zk-Hk·Vk]
式中,Vk-1为上一次预估值,Kk为滤波增益矩阵,zk为测量值(观测值)。
步骤4.5、计算更新后估计斜方差矩阵Pk:
Pk=[I-Kk·Hk]Pk
进而对各个时间段采集到的Vk进行积分处理的到机器人已运动的距离S。
上述步骤4中,角度修正是通过读取陀螺仪的数据对车体当前姿态进行解读,将其与设定的目标角度进行角度环的自调节运算,以其运算量来修正位置环输出的速度环目标速度。通过角度修正可以消除因外界环境引起的机器人姿态偏转带来的对里程的影响,且保证机器人的实时姿态。
上述各实施例仅用于说明本发明,各部件的结构、尺寸、设置位置及形状都是可以有所变化的,在本发明技术方案的基础上,凡根据本发明原理对个别部件进行的改进和等同变换,均不应排除在本发明的保护范围之外。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
Claims (10)
1.一种物流机器人的定位方法,其特征在于,包括:
步骤1、获取机器人的车轮驱动电机的当前转速Vd;
步骤2、对机器人上陀螺仪获取的加速度值预处理后,进行复化Simpson积分得到陀螺仪测得的当前速度Va;
步骤3、对机器人上摄像头采集到的图像中相邻两帧图像的特征点进行检测、匹配,得到相邻图像对应特征点在相机坐标系下的位移信息,依据世界坐标系与相机坐标系的转化关系得到该特征点在世界坐标系下的位移量Sw,对位移量Sw进行微分运算得到经特征点检测运算得到的车体速度Vv;
步骤4、将当前转速Vd、当前速度Va和车体速度Vv进行处理得到相对准确的车体速度V,对该车体速度V进行积分运算得到车体已运动过的距离,将目标位置与当前位置进行比较进行位置闭环运算得出电机速度环的目标转速,经角度环运算修正后输入到内环速度环再利用速度闭环来得到电机应有转速,完成定位;
对三个速度采用三阶卡尔曼滤波进行数据处理得到相对准确的车体速度V,三阶卡尔曼滤波处理方法包括:
步骤4.1、预估计:
Vk=Ak-1Vdk-1+Bk-1Vak-1+Ck-1Vvk-1;
式中,Vk表示经三阶卡尔曼预测处理后得到的机器人运动速度,Ak-1、Bk-1、Ck-1分别为霍尔编码器得到的速度Vd、加速度计得到的速度Va、视觉检测特征点运算出来的速度Vv的增益矩阵,Vdk-1、Vak-1、Vvk-1分别为三种传感器前次采样得到的速度;
步骤4.2、计算预估计斜方差矩阵Pk:
式中,Pk-1为上次预估计斜方差矩阵,Dk-1,k,为相应变化矩阵及其转置矩阵,Q为过程误差协方差矩阵;
步骤4.3、计算卡尔曼增益矩阵Kk:
式中,为相应的概率矩阵,Hk、/>为状态变量到测量的转换矩阵及其转置矩阵,Rk为测量噪声的协方差;
步骤4.4、更新估计:
Vk=Vk-1+Kk[zk-Hk·Vk]
式中,Vk-1为上一次预估值,Kk为滤波增益矩阵,zk为测量值;
步骤4.5、计算更新后估计斜方差矩阵Pk+1:
Pk+1=[I-Kk·Hk]Pk
进而对各个时间段采集到的Vk进行积分处理得到机器人已运动的距离S;
角度修正是通过读取陀螺仪的数据对车体当前姿态进行解读,将其与设定的目标角度进行角度环的自调节运算,以其运算量来修正位置环输出的速度环目标速度。
2.如权利要求1所述定位方法,其特征在于,所述步骤1中,采用正解算的方法得到电机当前转速Vd。
3.如权利要求1所述定位方法,其特征在于,所述步骤2中,对加速度值的预处理采用最小二乘法线性拟合。
4.如权利要求1所述定位方法,其特征在于,所述步骤3中,采用AKAZE方法对相邻两帧图像的特征点进行检测、匹配。
5.一种用于实现如权利要求1至4任一项所述定位方法的物流机器人,其特征在于,包括底盘,以及设置在所述底盘上的横向移动机构、纵向移动机构、前后移动机构和机械抓手;所述横向移动机构设置在所述底盘上,纵向移动机构活动设置在所述横向移动机构上,且所述前后移动机构设置在所述纵向移动机构上,所述机械抓手设置在所述前后移动机构上;
所述横向移动机构包括第一驱动电机、滑轨、第一主动齿轮、第一从动齿轮、第一同步带和丝杠;所述丝杠的两端设置在所述底盘上,所述滑轨与所述丝杠平行设置在所述底盘上;所述第一驱动电机的外壳固定在所述底盘上,所述第一驱动电机的输出端设置有所述第一主动齿轮,所述第一主动齿轮与所述第一从动齿轮通过所述第一同步带进行传动连接,且所述第一同步带的内侧设置有若干锯齿,所述第一同步带位于所述滑轨的上方;所述纵向移动机构与所述第一同步带啮合,并分别与所述滑轨和丝杠连接,由所述第一驱动电机带动所述第一同步带及所述纵向移动机构在横向上左右移动。
6.如权利要求5所述物流机器人,其特征在于,所述纵向移动机构包括连接座、齿条、齿轮和第二驱动电机;所述连接座的底部一端与所述第一同步带的下侧啮合后,与所述滑轨连接,另一端与所述丝杠活动连接,所述齿条的底部固定设置在所述连接座上;所述第二驱动电机设置在所述前后移动机构的底部,且所述第二驱动电机的输出轴与所述齿轮同轴连接,所述齿轮与所述齿条啮合,由所述第二驱动电机带动所述齿轮沿所述齿条进行纵向上下移动。
7.如权利要求6所述物流机器人,其特征在于,所述前后移动机构包括连接板、第三驱动电机、第二同步带、传动齿轮、滑道和传动板;该连接板采用凹槽型结构;所述连接板的底部固定设置有所述第二驱动电机,在所述齿轮和齿条的啮合传动下使所述连接板沿所述齿条进行纵向移动;所述连接板的第一端固定设置有所述第三驱动电机,所述第三驱动电机的输出端通过所述传动齿轮与所述第二同步带传动连接,且所述第二同步带内侧设置有若干锯齿;所述传动板的第一端与所述第二同步带一侧啮合,由所述第二同步带带动所述传动板进行前后移动,所述传动板的第二端与所述滑道连接,所述滑道嵌设在所述连接板的凹槽内,所述机械抓手设置在所述滑道上,由所述第三驱动电机带动所述滑道和机械抓手进行前后移动。
8.如权利要求5所述物流机器人,其特征在于,所述机械抓手包括安装座,以及设置在所述安装座上的上抓手、下抓手和第四驱动电机;所述上抓手和下抓手之间通过连接轴连接,所述第四驱动电机的输出端同轴连接有第一传动齿轮,所述连接轴的一端固定设置有第二传动齿轮,所述第一传动齿轮与所述第二传动齿轮啮合,由所述第四驱动电机带动所述连接轴转动,实现所述上抓手与所述下抓手闭合或打开。
9.如权利要求8所述物流机器人,其特征在于,所述上抓手和下抓手的一侧设置有摄像头。
10.如权利要求5所述物流机器人,其特征在于,所述底盘包括上底板、下底板前板、下底板后板、侧板、车轮驱动电机、电池、固定件和摆动共轴悬挂结构,所述下底板前板和下底板后板活动连接构成下底板;所述下底板的周边设置有所述侧板,所述下底板前板通过所述摆动共轴悬挂结构与所述上底板连接;所述车轮驱动电机设置为四个,分别用于驱动一个全向轮,所述车轮驱动电机的后侧设置有霍尔传感器;所述下底板的中部通过所述固定件固定设置有所述电池。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111069248.XA CN113776528B (zh) | 2021-09-13 | 2021-09-13 | 一种物流机器人及其定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111069248.XA CN113776528B (zh) | 2021-09-13 | 2021-09-13 | 一种物流机器人及其定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113776528A CN113776528A (zh) | 2021-12-10 |
CN113776528B true CN113776528B (zh) | 2024-06-11 |
Family
ID=78843099
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111069248.XA Active CN113776528B (zh) | 2021-09-13 | 2021-09-13 | 一种物流机器人及其定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113776528B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN205704181U (zh) * | 2016-06-08 | 2016-11-23 | 佛山市联智新创科技有限公司 | 一种机器人的机械手组件 |
CN107878557A (zh) * | 2016-09-30 | 2018-04-06 | 新乡航空工业(集团)有限公司 | 一种汽车智能电动助力转向系统 |
CN108749819A (zh) * | 2018-04-03 | 2018-11-06 | 吉林大学 | 基于双目视觉的轮胎垂向力估算系统及估算方法 |
CN112326990A (zh) * | 2020-10-22 | 2021-02-05 | 北京农业智能装备技术研究中心 | 一种作业车辆测速方法及系统 |
CN112720432A (zh) * | 2021-01-18 | 2021-04-30 | 石家庄铁道大学 | 一种物流机器人及其抓取方法 |
WO2021147549A1 (zh) * | 2020-01-20 | 2021-07-29 | 深圳市普渡科技有限公司 | 闭环检测方法及系统、多传感器融合slam系统及机器人、介质 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014165031A1 (en) * | 2013-03-13 | 2014-10-09 | Double Robotics, Inc. | Accessory robot for mobile device |
-
2021
- 2021-09-13 CN CN202111069248.XA patent/CN113776528B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN205704181U (zh) * | 2016-06-08 | 2016-11-23 | 佛山市联智新创科技有限公司 | 一种机器人的机械手组件 |
CN107878557A (zh) * | 2016-09-30 | 2018-04-06 | 新乡航空工业(集团)有限公司 | 一种汽车智能电动助力转向系统 |
CN108749819A (zh) * | 2018-04-03 | 2018-11-06 | 吉林大学 | 基于双目视觉的轮胎垂向力估算系统及估算方法 |
WO2021147549A1 (zh) * | 2020-01-20 | 2021-07-29 | 深圳市普渡科技有限公司 | 闭环检测方法及系统、多传感器融合slam系统及机器人、介质 |
CN112326990A (zh) * | 2020-10-22 | 2021-02-05 | 北京农业智能装备技术研究中心 | 一种作业车辆测速方法及系统 |
CN112720432A (zh) * | 2021-01-18 | 2021-04-30 | 石家庄铁道大学 | 一种物流机器人及其抓取方法 |
Non-Patent Citations (2)
Title |
---|
Fusini, L等.Nonlinear Observers for GNSS- and Camera-Aided Inertial Navigation of a Fixed-Wing UAV.《IEEE TRANSACTIONS ON CONTROL SYSTEMS TECHNOLOGY》.2018,全文. * |
王剑 ; 王璋奇 ; .振动加速度数值积分的Lagrange多项式拟合方法.噪声与振动控制.2015,(06),全文. * |
Also Published As
Publication number | Publication date |
---|---|
CN113776528A (zh) | 2021-12-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR100922494B1 (ko) | 이동 로봇의 자세 측정 방법 및 상기 방법을 이용한 위치측정 방법 및 장치 | |
CN108253963B (zh) | 一种基于多传感器融合的机器人自抗扰定位方法以及定位系统 | |
CN107941217B (zh) | 一种机器人定位方法、电子设备、存储介质、装置 | |
CN110146077A (zh) | 移动机器人姿态角解算方法 | |
KR20090009172A (ko) | 이동 로봇의 위치 측정 방법 및 장치 | |
JP6019504B2 (ja) | 移動体の進行方向推定装置及び進行方向推定方法 | |
CN111156997B (zh) | 一种基于相机内参在线标定的视觉/惯性组合导航方法 | |
JP5434608B2 (ja) | 測位装置及び測位方法 | |
CN102914293A (zh) | 信息处理设备和信息处理方法 | |
CN107063305B (zh) | 用惯导、压力传感器修正下坡悬空后轮里程计误差的方法 | |
CN111238535B (zh) | 一种基于因子图的imu误差在线标定方法 | |
JP4171459B2 (ja) | 移動体の回転移動量利用方法とその装置、及びコンピュータプログラムを保存するコンピュータ読取り可能な記録媒体 | |
CN113311411A (zh) | 一种用于移动机器人的激光雷达点云运动畸变校正方法 | |
CN110345936B (zh) | 运动装置的轨迹数据处理方法及其处理系统 | |
JP4578438B2 (ja) | ロボット装置 | |
CN113503873B (zh) | 一种多传感器融合的视觉定位方法 | |
CN111989631A (zh) | 自身位置推定方法 | |
JP5169273B2 (ja) | 移動ロボットの制御装置および移動ロボットシステム | |
EP3227634B1 (en) | Method and system for estimating relative angle between headings | |
CN113776528B (zh) | 一种物流机器人及其定位方法 | |
CN114475581B (zh) | 基于轮速脉冲和imu卡尔曼滤波融合的自动泊车定位方法 | |
CN114543786B (zh) | 一种基于视觉惯性里程计的爬壁机器人定位方法 | |
CN108107882B (zh) | 基于光学运动跟踪的服务机器人自动标定与检测系统 | |
CN111735478B (zh) | 基于lstm的行人实时导航零速检测方法 | |
CN114789439B (zh) | 斜坡定位校正方法、装置、机器人及可读存储介质 |
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 |