slam无人驾驶传感器

SimultaneousLocalizationAndSimultaneousLocalizationAnd相机：单目、双目激光:超声波:相机：单目、双目激光:超声波:[1]Chong,T.J.,Tang,X.J.,Leng,C.H.,Yogeswaran,M.,Ng,O.E.,&Chong,Y.Z.(2015).Sensortechnologiesandsimultaneouslocalizationandmapping(SLAM).ProcediaComputerScience,76,MonoInfraredMonoInfrared（通常方便人或者设备读取或者处理（单一通道），（通常方便人或者设备读取或者处理（单一通道），CCDArLight 11 Cones:sensitive Cones:sensitivetored,green,andbluelightare63,31,and6percent,respectivelyRods:areexquisitelysensitiveandonlyinlow-lightCIE1931colorImageOpticalPinhole相机成像（小孔成像模型ImageinvertedSizereducedImageisdimNodirectdepthImageOpticalPinhole相机成像（小孔成像模型ImageinvertedSizereducedImageisdimNodirectdepthf这就是：perspective假设给定了世界坐标系下的点P,影p(x,Z=Z假设给定了世界坐标系下的点P,影p(x,Z=Z轴平行x//XxfyfPose//Pose//Framecoordinates(xim,yim)pixelsImagecoordinates(x,y)inmmCameracoordinates(X,Y,Z)Worldcoordinates内参IntrinsicParameters(ofthecameraandtheframegrabber):linktheframecoordinatesofanimagepointwithitscorrespondingcamera外参Extrinsicparameters:definethelocationandorientationofcameracoordinatesystemwithrespecttotheworldcoordinatepImagecenterDirectionsofaxesPixelsize从3D到PerspectivepImagecenterDirectionsofaxesPixelsize从3D到Perspective(ox,oy):imagecenter(in(sx,sy):effectivesizeofthepixel(inmm)f:focallengthxfyfx(ximox)sxy(yimoy)syPRPwPRPw旋转PRPwPRPwr rYr RT T x xP Tr rYr T RT yr rYr T RT T z z RT 1R RT 3世界坐标系到相机坐标系（要在自己的坐标系下看RT rYr xP世界坐标系到相机坐标系（要在自己的坐标系下看RT rYr xPT rYr RTy rYr R z ximoxfxr11Xwr12Yw13Zwr31Xwr32Ywr33Zw o f r21Xwr22Ywr23ZwTy yr31Xwr32Ywr33Zw(x,y)(fX fY x(ximox)sxy(yimoy)sy3D->2D 3D->2D TxMext Ty x1 Xw x2MintMextYwx3 Zw 1 oxMint f oy 1ximoxfxr11Xwr12Yw13Zwr31Xwr32Ywr33Zw o f r21Xwr22Ywr23ZwTy yr31Xwr32Ywr33ZwXwx'Xwx'r32Ywr33Zwr22Ywr23ZwXwXwy' r 32 =xiXir21xiYir22xiZir23xiTyyiXi(r11)yiYi(r12)yiZi(r13)yi(Tx)xiXiv1xiYiv2xiZiv3xiv4yiXiv5yiYiv6yiZiv7yiv8x'(r21Xwr22Ywr23ZwTy)y'(r11Xwr12Ywr13ZwTxx'fy(r21Xwr22Ywr23ZwTy)y'fx(r11Xwr12Ywr13ZwTx帧平面（图像平面帧平面（图像平面d=xr-ffd=xr-ffp(x,y OpticalCenterBOpticalCenterZDf2D2D3D表面法向量（SurfaceNormal表面法向量（SurfaceNormal点特征直方图（PointFeature旋转图片特征（Spin-迭代最近邻点（IterativeClosest p+ p+ C1PPPP Cvjjvj,j{0,1,2}0012xp1 12u12unsptpsvu pt wudd pt 2vntuptpsarctanwnt,unt Np Np ER,t xiRpiNp SVD求解矩阵RUVtSVD求解矩阵RUVtER,tx2y22 Npi 0=U 0VT U,VR3x3 Nx Np xi,p Np ER,t xiRpiNp Rusu,RaduBogdan."Semantic3dobjectmapsforeverydaymanipulationinhumanlivingenvironments."KI-KnstlRusu,RaduBogdan."Semantic3dobjectmapsforeverydaymanipulationinhumanlivingenvironments."KI-KnstlicheIntelligenz24.4(2010):345-Johnson,AndrewE.,andMartialHebert."Usingspinimagesforefficientobjectrecognitionincluttered3Dscenes."IEEETransactionsonpatternanalysisandmachineintelligence21.5(1999):433-449.Besl,PaulJ.,andNeilD.McKay."Amethodforregistrationof3-shapes."IEEETransactionsonpatternanalysisandmachineintelligence14.2(1992):239-256.Rusu,RaduBogdan,NicoBlodow,andMichaelBeetz.