做结构光三维重建的手里基本都攒过一套“投影仪相机”的实验台。这套代码就是把台上最核心的几个环节——条纹编码、图像采集、相位解算、相位展开、三角化重建——全部用Matlab串起来。项目同时实现了互补格雷码加四步相移、多频外差加四步相移两条相位展开路线拿来就能对比着用也能当成算法教材一句句抠原理。这类代码在精密测量、逆向工程、医疗扫描、文物数字化这些场景里都是刚需。单目视觉结构光系统的好处在于只用一个普通工业相机加一台投影仪就能搭建不需要双目相机这种昂贵的同步硬件而且通过相位映射天然解决了左右目匹配问题。如果你正在做结构光相关的毕业设计、课题研究或者想快速验证一个三维重建方案这套代码的参考价值会非常大。1. 单目结构光系统为什么用相位就能算三维坐标1.1 系统构成与“单目”的含义传统双目视觉用两个相机拍摄同一物体通过左右图像的特征匹配计算视差再根据三角关系恢复深度。单目结构光不一样它把投影仪当成“第二只眼”投影仪投出已知频率的条纹相机拍下被物体表面调制后的条纹图片。由于投影仪的条纹图案是我们自己设计的所以每个投影仪像素的相位值是已知的只要能从相机图像里反解出该像素对应的投影仪列坐标就相当于完成了“特征匹配”。这套代码针对的正是竖直条纹投影方案也就是条纹亮度沿水平方向按正弦规律变化沿竖直方向保持不变。竖直条纹对应投影仪列坐标所以打开了一套紧凑的求解链路相机像素坐标加投影仪列坐标给出的是一对“同名点”约束联立相机的内外参和投影仪的内外参就能三角化出三维点。为什么叫单目因为采集端只有一个相机投影仪只是辅助编码光源不需要双相机同步触发硬件成本低、系统标定流程也更简单。1.2 完整处理链路从条纹到点云整套重建流程可以拆成六个环节系统标定标定相机内参和畸变再把投影仪当作反向相机标定它的内参和相对相机的外参。这一步得到后续三角化需要的投影矩阵。编码条纹生成设计正弦条纹频率、相移步数四步并且按照互补格雷码或外差频率组生成投影图案。图像采集投影仪依次投影图案相机同步采集被物体调制的条纹图。包裹相位求解用四步相移公式从相移图里解出每个像素的包裹相位数值范围会被限制在[-π, π)之间。相位展开通过互补格雷码或外差原理给包裹相位补上整数级的2π得到单调连续的绝对相位。这是整套方法最容易出问题的一步也是代码里两种路线的主战场。三维坐标计算将绝对相位换算为投影仪列坐标结合标定得到的三維映射关系逐像素三角化输出点云。我用生活化一点的例子说明包裹相位就像一个被折叠起来的尺子每个2π都是一个折痕。四步相移只告诉你了折痕内部的位置却没说你在第几个折痕里。格雷码或者多频外差干的事情就是给每个折痕编号把折叠的尺子重新展开成完整刻度。2. 互补格雷码加四步相移让相位展开又稳又准2.1 四步相移的数学表达四步相移本质上是利用正弦条纹的亮度随相位线性变化的特性通过多幅图像的亮度方程组解出相位。投影四幅正弦条纹相移量分别是0、π/2、π、3π/2于是每个像素的亮度模型可以表示为I1 I Icos(φ)I2 I Icos(φ π/2)I3 I Icos(φ π)I4 I Icos(φ 3π/2)其中I是背景光强I是调制强度φ是需要求解的相位。把两个正交方向的差分量组合起来就能去掉I和I的影响φ atan2(I4 - I2, I1 - I3)实际用Matlab实现时直接在图像矩阵上做运算即可。这样算出来的相位被atan2限制在[-π, π)里面包含了物体表面的高度信息但这个相位是周期性的每经历一个完整正弦周期就跳变一次。如果不展开三维重建出来的表面会带着密集的锯齿条纹完全没法用。2.2 互补格雷码到底补的是什么格雷码给相位展开提供“级次编号”。假设全场有64个周期的正弦条纹那就需要把相位分成64个级次每个级次对应一个编码区间。用6位二进制就能编码0到63而格雷码的特点是相邻两个编码值只有一位二进制位发生变化。在投影图案里每一位对应一幅黑白条纹图该位为1的区域投影亮条纹为0的区域投影暗条纹。传统格雷码方案有一个严重隐患格雷码的黑白跳变边沿和包裹相位的2π跳变位置重合。这两个地方都是计算不稳定的区域一旦像素落在边界附近离焦、噪声、量化误差会让格雷码误判一级相位展开就整体错一个周期最终在三维表面上形成一条条带状裂缝。互补格雷码的思路是把格雷码的跳变边沿平移半个正弦周期让黑白翻转处正好落在相位值为π的位置。这样包裹相位的2π跳变处格雷码编码是稳定的格雷码翻转处包裹相位又远离跳变位置。两个风险点彻底错开鲁棒性凭空高出一截。代码里生成互补格雷码图案时只需要把每个编码区间的判定边界偏移0.5个区间长度实现成本非常低。2.3 解码级次与绝对相位合成互补格雷码解码完成后每个像素得到一个整数级次k然后绝对相位就等于包裹相位加上2π倍的级次Φ φ 2πk这里要注意解码出的k必须是“逐像素”的不能下采样得到后再插值恢复否则在物体边缘和突变表面会出现级次错位。实战中更稳健的做法是同时投影正码和反码两组格雷码图案判定某一位亮暗时比较正反两幅图哪个更亮再结合互补偏移设计离焦对边沿判断的影响能压到很低。3. 多频外差四步相移没有格雷码也能展开3.1 外差原理两列条纹“拍”出大周期多频外差法不依赖任何额外的编码图案核心思想是用多个不同频率的正弦条纹分别做四步相移再通过频率间的相位差值构造一个等效大周期相位。以双频为例。两个正弦条纹波长分别为λ1和λ2包裹相位分别是φ1和φ2定义两者的等效波长为λ12 λ1·λ2 / |λ1 - λ2|等效相位为φ12 φ1 - φ2并折叠到[-π, π)等效波长比原来的单一波长大了许多倍。也就是说两列原本周期很小的条纹“差频”之后得到了一个周期非常大的合成条纹。如果这个等效周期大于图像宽度那么φ12在整个视场内就是唯一的它可以当作一把覆盖全场的“粗尺子”。在代码里双频展开一个像素的流程是先用φ12和λ12估计出λ1下的绝对相位再计算λ1包裹相位需要加几个2πk round((λ12/λ1·φ12 - φ1) / (2π)) Φ1 φ1 2πk3.2 频率组怎么选精度和鲁棒性的平衡双频外差的比例一旦拉得太大等效波长放大了误差展开就容易出错。实际工程中更常用三频外差甚至四频外差逐级展开先用最大等效波长定全场再用中等等效波长展开中等频率最后用中等绝对相位展开高频相位。我常用的三频设计是波长70、64、59像素。两两外差后得到等效波长746.7和755.2像素再外差一次得到约5.6万像素的等效波长远远大于一般图像宽度全程唯一性没有问题。三个频率都投影四步相移条纹一共12幅图就能完成整个三维表面展开。选频率组时有一条硬约束最低一级等效波长必须大于图像宽度否则相位唯一性直接失效。同时两个频率又不能太接近频率差越小等效波长越大但外差相位对噪声的放大倍数也会跟着增大展开结果容易出现条纹状错误。所以频率差通常选在实际测量精度允许的范围内并通过仿真验证。3.3 格雷码路线和外差路线怎么选两条路线都能做相位展开区别非常明显。格雷码方案投影的图案数量受级次数限制通常需要6到8幅编码图级次边界处对离焦敏感但一旦解码正确每个级次的绝对相位非常精确。外差方案只需要12幅左右条纹图三频乘四步逻辑天然抗边界问题而且频率可以自由设计但是相位噪声会被差频放大对信噪比要求更高。如果物体表面反射率均匀、投影仪离焦不明显互补格雷码的精度上限更高。如果表面复杂、有遮挡边界、或者投影仪景深不够导致条纹模糊多频外差反而更省心。这套代码把两条路都留好了接口做算法选型时可以直接跑同一组采集数据来对比。4. Matlab代码实现工程结构到核心片段4.1 代码结构怎么拆整套代码建议按函数模块拆分而不是把所有逻辑堆在一个脚本里。我的习惯是把工程分为五个模块条纹生成、相位解算、相位展开格雷码路线、相位展开外差路线、三维重建。共享参数放在一个配置文件里方便调整条纹频率、相机分辨率、标定文件路径。% config.m 示例 W 1280; H 800; % 投影分辨率 freqHigh 64; % 高频条纹周期数 grayBits log2(freqHigh); % 互补格雷码位数 lamList [70, 64, 59]; % 多频外差波长组 phaseShiftCount 4; % 四步相移4.2 四步相移包裹相位解算四步相移本身只有几行代码但要注意输入图像已经是浮点型避免uint8溢出问题。相移条纹生成和解码可以共用同一个相位公式。% 生成四步相移条纹 function imgs generatePhaseShiftImages(W, H, freq, shifts) x linspace(0, 2*pi*freq, W); [X, ~] meshgrid(x, 1:H); imgs cell(1, shifts); for k 0:shifts-1 imgs{k1} 127.5 127.5 * cos(X k*2*pi/shifts); end end % 四步相移解包裹相位 function phi decodePhaseShift(I1, I2, I3, I4) phi atan2(I4 - I2, I1 - I3); % 结果范围[-pi, pi) end这里的atan2是相位解算的关键。不要用atan来代替atan的输出范围只有[-π/2, π/2]无法区分四个象限直接用会造成半周期级的错误。4.3 互补格雷码生成与解码互补格雷码的生成需要先把十进制级次转成二进制再转格雷码。投影第b位图案时把每个像素所在的编码区间号算出来查对应格雷码位是0还是1亮暗赋值。互补的关键就在区间号计算时加了0.5偏移。function grayImg generateComplementaryGrayPattern(bitIdx, K, W, H, complementOffset) if nargin 5, complementOffset 0.5; end N ceil(log2(K)); col linspace(0, 1, W); % 归一化列坐标 idx floor(col * K complementOffset); % 偏移半个级次区间 idx min(max(idx, 0), K-1); % 十进制转二进制矩阵 binVec zeros(K, N); for i 1:K s dec2bin(i-1, N); binVec(i,:) s - 0; end % 二进制转格雷码 grayVec binVec; for j 2:N grayVec(:, j) xor(binVec(:, j-1), binVec(:, j)); end bit grayVec(idx1, bitIdx1); grayImg repmat(bit * 255, H, 1); end解码时对每一位比较正码和反码的亮度取更亮的那一个作为该位判定结果然后把格雷码逐位异或转回二进制再转十进制得到级次k。组合相位时绝对相位就是包裹相位加上2π倍级次。4.4 多频外差展开外差展开建议写成两个通用函数一个做差频合成一个做参考相位展开。三频展开就是反复调用这两个函数。% 双频合成返回等效波长和等效包裹相位 function [lamAB, phiAB] heterodynePair(phiA, phiB, lamA, lamB) lamAB lamA * lamB / abs(lamA - lamB); phiAB mod(phiA - phiB pi, 2*pi) - pi; % 折叠到[-pi, pi) end % 用参考绝对相位展开目标相位 function absPhase unwrapWithRef(phiTarget, refAbsPhase, lamTarget, lamRef) k round((lamRef / lamTarget * refAbsPhase - phiTarget) / (2*pi)); absPhase phiTarget 2*pi*k; end % 三频外差流水线 function absPhase unwrapThreeFreq(phi1, phi2, phi3, lam1, lam2, lam3) [lam12, phi12] heterodynePair(phi1, phi2, lam1, lam2); [lam23, phi23] heterodynePair(phi2, phi3, lam2, lam3); [lam123, phi123] heterodynePair(phi12, phi23, lam12, lam23); absPhase12 unwrapWithRef(phi12, phi123, lam12, lam123); absPhase1 unwrapWithRef(phi1, absPhase12, lam1, lam12); end这个外差流程是“逐级由粗到细”的低一级的参考相位精度直接影响高一级的展开结果。如果物体表面有大深度突变中间某级展开跳了一个条纹最后一级会成片出错。工程上常在中频展开后加一次中值滤波把零星跳变先抹掉再继续高频展开。4.5 相位到三维坐标的映射完成绝对相位后用投影仪列坐标和相机像素坐标联合三角化。投影仪列坐标的计算方式取决于投影条纹定义如果用正弦频率是freq投影仪宽度Wproj则一个周期的行像素数λproj Wproj / freq列坐标xp Φ · λproj / (2π)。三角化时我习惯直接用投影矩阵构造线性方程组因为不管标定用的是张氏标定还是其他工具最终都能得到相机的3×4投影矩阵Pc和投影仪的3×4投影矩阵Pp。对每个像素(u, v, xp)建立方程后用最小二乘解三维坐标function XYZ triangulatePixel(u, v, xp, Pc, Pp) % 相机约束u和v A [Pc(1,1:3) - u*Pc(3,1:3); Pc(2,1:3) - v*Pc(3,1:3);]; b -[Pc(1,4) - u*Pc(3,4); Pc(2,4) - v*Pc(3,4);]; % 投影仪约束投影仪x列坐标 A(3,:) Pp(1,1:3) - xp*Pp(3,1:3); b(3) -(Pp(1,4) - xp*Pp(3,4)); XYZ A \ b; end如果投影的是水平条纹就用yp代替xp对应Pp的第二行和第三行构造方程。竖直条纹时只用了投影仪行方向自由度的约束所以重建精度主要取决于相位质量。5. 实际踩过的坑排查顺序和避坑指南5.1 格雷码跳变与相位跳变错位互补格雷码虽然把边沿错开了但投影仪离焦严重时黑白边沿会扩散好几个像素。解码时如果只用正码判断靠近边沿的像素很容易被分到错误的级次展开后出现整条横向裂纹。排查手段是显示“级次图”叠加在包裹相位图上看级次的跳变位置是否正好落在相位连续区域中央。如果发现错位可以考虑在解码前先对格雷码图案做高斯模糊或形态学开闭运算抑制孤立噪点。更省事的做法是直接转到多频外差路线外差法天生不需要处理二值化边沿。5.2 投影仪gamma非线性投影仪的输入灰度和输出亮度不是严格线性关系四步相移公式里假设条纹是理想正弦实际投影出的余弦被gamma扭曲后解出来的包裹相位会带上二倍频误差。表现是三维表面出现波浪状条纹频率正好是正弦频率的两倍。解决思路是做一个灰阶响应标定投影一系列已知灰阶图相机采集后拟合出输入输出映射生成查找表。生成正弦条纹时先用查找表反向映射每个像素的灰度值把输出端的非线性预补偿掉。没有时间做完整标定时至少可以把投影仪的对比度调低、亮度调中让响应尽量落在线性区间。5.3 高反光和暗区高反光物体的镜面区域拍出来一片白相位在这个区域会丢失。暗区则是相机信噪比不够相位噪声放大。两种问题都会让三维点云出现大范围空洞。我处理高反光的经验是分组曝光对同一个条纹图案分别用低、中、高三档曝光采集然后对每个像素挑选灰度值接近但未饱和的那幅图参与相位解算。也可以用偏振片削弱镜面反射但会增加硬件成本。暗区一般靠提高投影亮度或者降低环境光解决实在不行就在重建后对空洞区域做点云插补。5.4 常见问题排查速查表现象可能原因优先级检查展开后出现贯穿性条纹裂缝格雷码级次跳变错位或外差逐级跳变查看级次图与包裹相位叠加图表面有波浪状起伏投影仪gamma非线性灰阶响应标定与预补偿点云里很多孤立飞点环境光变化或高反光饱和多曝光融合或环境光抑制目标边缘锯齿严重离焦、投影仪低频响应不足调节投影仪景深、改用互补偏移展开相位在某个区域整体偏移标定的投影仪外参有偏差用平面靶标验证重投影误差物体前后移动但相位没变化采集时序错位检查相机与投影仪的触发同步排查时先不要急着调算法顺序应该是先确认包裹相位图本身平滑无突变再确认级次图或低频参考相位全场唯一最后才去调三角化。很多时候问题并不在算法而在采集环境的光线扰动。我在实际使用这套代码时最大的体会是先用Matlab把算法链路跑通比什么都重要。采集时难免遇到各种脏数据但在代码层面先把每一级的中间结果可视化出来问题基本能定位到具体环节。等算法验证稳定了再往C或者GPU上移植会省很多力气。最后分享一个小技巧正式采集前先投影一张纯白和一张纯黑图案估算每个像素的信号幅值和背景光强如果某个区域幅值低于阈值直接生成掩膜后续重建跳过这些像素能省掉很多无效计算。
做结构光三维重建的手里基本都攒过一套“投影仪相机”的实验台。这套代码就是把台上最核心的几个环节——条纹编码、图像采集、相位解算、相位展开、三角化重建——全部用Matlab串起来。项目同时实现了互补格雷码加四步相移、多频外差加四步相移两条相位展开路线拿来就能对比着用也能当成算法教材一句句抠原理。这类代码在精密测量、逆向工程、医疗扫描、文物数字化这些场景里都是刚需。单目视觉结构光系统的好处在于只用一个普通工业相机加一台投影仪就能搭建不需要双目相机这种昂贵的同步硬件而且通过相位映射天然解决了左右目匹配问题。如果你正在做结构光相关的毕业设计、课题研究或者想快速验证一个三维重建方案这套代码的参考价值会非常大。1. 单目结构光系统为什么用相位就能算三维坐标1.1 系统构成与“单目”的含义传统双目视觉用两个相机拍摄同一物体通过左右图像的特征匹配计算视差再根据三角关系恢复深度。单目结构光不一样它把投影仪当成“第二只眼”投影仪投出已知频率的条纹相机拍下被物体表面调制后的条纹图片。由于投影仪的条纹图案是我们自己设计的所以每个投影仪像素的相位值是已知的只要能从相机图像里反解出该像素对应的投影仪列坐标就相当于完成了“特征匹配”。这套代码针对的正是竖直条纹投影方案也就是条纹亮度沿水平方向按正弦规律变化沿竖直方向保持不变。竖直条纹对应投影仪列坐标所以打开了一套紧凑的求解链路相机像素坐标加投影仪列坐标给出的是一对“同名点”约束联立相机的内外参和投影仪的内外参就能三角化出三维点。为什么叫单目因为采集端只有一个相机投影仪只是辅助编码光源不需要双相机同步触发硬件成本低、系统标定流程也更简单。1.2 完整处理链路从条纹到点云整套重建流程可以拆成六个环节系统标定标定相机内参和畸变再把投影仪当作反向相机标定它的内参和相对相机的外参。这一步得到后续三角化需要的投影矩阵。编码条纹生成设计正弦条纹频率、相移步数四步并且按照互补格雷码或外差频率组生成投影图案。图像采集投影仪依次投影图案相机同步采集被物体调制的条纹图。包裹相位求解用四步相移公式从相移图里解出每个像素的包裹相位数值范围会被限制在[-π, π)之间。相位展开通过互补格雷码或外差原理给包裹相位补上整数级的2π得到单调连续的绝对相位。这是整套方法最容易出问题的一步也是代码里两种路线的主战场。三维坐标计算将绝对相位换算为投影仪列坐标结合标定得到的三維映射关系逐像素三角化输出点云。我用生活化一点的例子说明包裹相位就像一个被折叠起来的尺子每个2π都是一个折痕。四步相移只告诉你了折痕内部的位置却没说你在第几个折痕里。格雷码或者多频外差干的事情就是给每个折痕编号把折叠的尺子重新展开成完整刻度。2. 互补格雷码加四步相移让相位展开又稳又准2.1 四步相移的数学表达四步相移本质上是利用正弦条纹的亮度随相位线性变化的特性通过多幅图像的亮度方程组解出相位。投影四幅正弦条纹相移量分别是0、π/2、π、3π/2于是每个像素的亮度模型可以表示为I1 I Icos(φ)I2 I Icos(φ π/2)I3 I Icos(φ π)I4 I Icos(φ 3π/2)其中I是背景光强I是调制强度φ是需要求解的相位。把两个正交方向的差分量组合起来就能去掉I和I的影响φ atan2(I4 - I2, I1 - I3)实际用Matlab实现时直接在图像矩阵上做运算即可。这样算出来的相位被atan2限制在[-π, π)里面包含了物体表面的高度信息但这个相位是周期性的每经历一个完整正弦周期就跳变一次。如果不展开三维重建出来的表面会带着密集的锯齿条纹完全没法用。2.2 互补格雷码到底补的是什么格雷码给相位展开提供“级次编号”。假设全场有64个周期的正弦条纹那就需要把相位分成64个级次每个级次对应一个编码区间。用6位二进制就能编码0到63而格雷码的特点是相邻两个编码值只有一位二进制位发生变化。在投影图案里每一位对应一幅黑白条纹图该位为1的区域投影亮条纹为0的区域投影暗条纹。传统格雷码方案有一个严重隐患格雷码的黑白跳变边沿和包裹相位的2π跳变位置重合。这两个地方都是计算不稳定的区域一旦像素落在边界附近离焦、噪声、量化误差会让格雷码误判一级相位展开就整体错一个周期最终在三维表面上形成一条条带状裂缝。互补格雷码的思路是把格雷码的跳变边沿平移半个正弦周期让黑白翻转处正好落在相位值为π的位置。这样包裹相位的2π跳变处格雷码编码是稳定的格雷码翻转处包裹相位又远离跳变位置。两个风险点彻底错开鲁棒性凭空高出一截。代码里生成互补格雷码图案时只需要把每个编码区间的判定边界偏移0.5个区间长度实现成本非常低。2.3 解码级次与绝对相位合成互补格雷码解码完成后每个像素得到一个整数级次k然后绝对相位就等于包裹相位加上2π倍的级次Φ φ 2πk这里要注意解码出的k必须是“逐像素”的不能下采样得到后再插值恢复否则在物体边缘和突变表面会出现级次错位。实战中更稳健的做法是同时投影正码和反码两组格雷码图案判定某一位亮暗时比较正反两幅图哪个更亮再结合互补偏移设计离焦对边沿判断的影响能压到很低。3. 多频外差四步相移没有格雷码也能展开3.1 外差原理两列条纹“拍”出大周期多频外差法不依赖任何额外的编码图案核心思想是用多个不同频率的正弦条纹分别做四步相移再通过频率间的相位差值构造一个等效大周期相位。以双频为例。两个正弦条纹波长分别为λ1和λ2包裹相位分别是φ1和φ2定义两者的等效波长为λ12 λ1·λ2 / |λ1 - λ2|等效相位为φ12 φ1 - φ2并折叠到[-π, π)等效波长比原来的单一波长大了许多倍。也就是说两列原本周期很小的条纹“差频”之后得到了一个周期非常大的合成条纹。如果这个等效周期大于图像宽度那么φ12在整个视场内就是唯一的它可以当作一把覆盖全场的“粗尺子”。在代码里双频展开一个像素的流程是先用φ12和λ12估计出λ1下的绝对相位再计算λ1包裹相位需要加几个2πk round((λ12/λ1·φ12 - φ1) / (2π)) Φ1 φ1 2πk3.2 频率组怎么选精度和鲁棒性的平衡双频外差的比例一旦拉得太大等效波长放大了误差展开就容易出错。实际工程中更常用三频外差甚至四频外差逐级展开先用最大等效波长定全场再用中等等效波长展开中等频率最后用中等绝对相位展开高频相位。我常用的三频设计是波长70、64、59像素。两两外差后得到等效波长746.7和755.2像素再外差一次得到约5.6万像素的等效波长远远大于一般图像宽度全程唯一性没有问题。三个频率都投影四步相移条纹一共12幅图就能完成整个三维表面展开。选频率组时有一条硬约束最低一级等效波长必须大于图像宽度否则相位唯一性直接失效。同时两个频率又不能太接近频率差越小等效波长越大但外差相位对噪声的放大倍数也会跟着增大展开结果容易出现条纹状错误。所以频率差通常选在实际测量精度允许的范围内并通过仿真验证。3.3 格雷码路线和外差路线怎么选两条路线都能做相位展开区别非常明显。格雷码方案投影的图案数量受级次数限制通常需要6到8幅编码图级次边界处对离焦敏感但一旦解码正确每个级次的绝对相位非常精确。外差方案只需要12幅左右条纹图三频乘四步逻辑天然抗边界问题而且频率可以自由设计但是相位噪声会被差频放大对信噪比要求更高。如果物体表面反射率均匀、投影仪离焦不明显互补格雷码的精度上限更高。如果表面复杂、有遮挡边界、或者投影仪景深不够导致条纹模糊多频外差反而更省心。这套代码把两条路都留好了接口做算法选型时可以直接跑同一组采集数据来对比。4. Matlab代码实现工程结构到核心片段4.1 代码结构怎么拆整套代码建议按函数模块拆分而不是把所有逻辑堆在一个脚本里。我的习惯是把工程分为五个模块条纹生成、相位解算、相位展开格雷码路线、相位展开外差路线、三维重建。共享参数放在一个配置文件里方便调整条纹频率、相机分辨率、标定文件路径。% config.m 示例 W 1280; H 800; % 投影分辨率 freqHigh 64; % 高频条纹周期数 grayBits log2(freqHigh); % 互补格雷码位数 lamList [70, 64, 59]; % 多频外差波长组 phaseShiftCount 4; % 四步相移4.2 四步相移包裹相位解算四步相移本身只有几行代码但要注意输入图像已经是浮点型避免uint8溢出问题。相移条纹生成和解码可以共用同一个相位公式。% 生成四步相移条纹 function imgs generatePhaseShiftImages(W, H, freq, shifts) x linspace(0, 2*pi*freq, W); [X, ~] meshgrid(x, 1:H); imgs cell(1, shifts); for k 0:shifts-1 imgs{k1} 127.5 127.5 * cos(X k*2*pi/shifts); end end % 四步相移解包裹相位 function phi decodePhaseShift(I1, I2, I3, I4) phi atan2(I4 - I2, I1 - I3); % 结果范围[-pi, pi) end这里的atan2是相位解算的关键。不要用atan来代替atan的输出范围只有[-π/2, π/2]无法区分四个象限直接用会造成半周期级的错误。4.3 互补格雷码生成与解码互补格雷码的生成需要先把十进制级次转成二进制再转格雷码。投影第b位图案时把每个像素所在的编码区间号算出来查对应格雷码位是0还是1亮暗赋值。互补的关键就在区间号计算时加了0.5偏移。function grayImg generateComplementaryGrayPattern(bitIdx, K, W, H, complementOffset) if nargin 5, complementOffset 0.5; end N ceil(log2(K)); col linspace(0, 1, W); % 归一化列坐标 idx floor(col * K complementOffset); % 偏移半个级次区间 idx min(max(idx, 0), K-1); % 十进制转二进制矩阵 binVec zeros(K, N); for i 1:K s dec2bin(i-1, N); binVec(i,:) s - 0; end % 二进制转格雷码 grayVec binVec; for j 2:N grayVec(:, j) xor(binVec(:, j-1), binVec(:, j)); end bit grayVec(idx1, bitIdx1); grayImg repmat(bit * 255, H, 1); end解码时对每一位比较正码和反码的亮度取更亮的那一个作为该位判定结果然后把格雷码逐位异或转回二进制再转十进制得到级次k。组合相位时绝对相位就是包裹相位加上2π倍级次。4.4 多频外差展开外差展开建议写成两个通用函数一个做差频合成一个做参考相位展开。三频展开就是反复调用这两个函数。% 双频合成返回等效波长和等效包裹相位 function [lamAB, phiAB] heterodynePair(phiA, phiB, lamA, lamB) lamAB lamA * lamB / abs(lamA - lamB); phiAB mod(phiA - phiB pi, 2*pi) - pi; % 折叠到[-pi, pi) end % 用参考绝对相位展开目标相位 function absPhase unwrapWithRef(phiTarget, refAbsPhase, lamTarget, lamRef) k round((lamRef / lamTarget * refAbsPhase - phiTarget) / (2*pi)); absPhase phiTarget 2*pi*k; end % 三频外差流水线 function absPhase unwrapThreeFreq(phi1, phi2, phi3, lam1, lam2, lam3) [lam12, phi12] heterodynePair(phi1, phi2, lam1, lam2); [lam23, phi23] heterodynePair(phi2, phi3, lam2, lam3); [lam123, phi123] heterodynePair(phi12, phi23, lam12, lam23); absPhase12 unwrapWithRef(phi12, phi123, lam12, lam123); absPhase1 unwrapWithRef(phi1, absPhase12, lam1, lam12); end这个外差流程是“逐级由粗到细”的低一级的参考相位精度直接影响高一级的展开结果。如果物体表面有大深度突变中间某级展开跳了一个条纹最后一级会成片出错。工程上常在中频展开后加一次中值滤波把零星跳变先抹掉再继续高频展开。4.5 相位到三维坐标的映射完成绝对相位后用投影仪列坐标和相机像素坐标联合三角化。投影仪列坐标的计算方式取决于投影条纹定义如果用正弦频率是freq投影仪宽度Wproj则一个周期的行像素数λproj Wproj / freq列坐标xp Φ · λproj / (2π)。三角化时我习惯直接用投影矩阵构造线性方程组因为不管标定用的是张氏标定还是其他工具最终都能得到相机的3×4投影矩阵Pc和投影仪的3×4投影矩阵Pp。对每个像素(u, v, xp)建立方程后用最小二乘解三维坐标function XYZ triangulatePixel(u, v, xp, Pc, Pp) % 相机约束u和v A [Pc(1,1:3) - u*Pc(3,1:3); Pc(2,1:3) - v*Pc(3,1:3);]; b -[Pc(1,4) - u*Pc(3,4); Pc(2,4) - v*Pc(3,4);]; % 投影仪约束投影仪x列坐标 A(3,:) Pp(1,1:3) - xp*Pp(3,1:3); b(3) -(Pp(1,4) - xp*Pp(3,4)); XYZ A \ b; end如果投影的是水平条纹就用yp代替xp对应Pp的第二行和第三行构造方程。竖直条纹时只用了投影仪行方向自由度的约束所以重建精度主要取决于相位质量。5. 实际踩过的坑排查顺序和避坑指南5.1 格雷码跳变与相位跳变错位互补格雷码虽然把边沿错开了但投影仪离焦严重时黑白边沿会扩散好几个像素。解码时如果只用正码判断靠近边沿的像素很容易被分到错误的级次展开后出现整条横向裂纹。排查手段是显示“级次图”叠加在包裹相位图上看级次的跳变位置是否正好落在相位连续区域中央。如果发现错位可以考虑在解码前先对格雷码图案做高斯模糊或形态学开闭运算抑制孤立噪点。更省事的做法是直接转到多频外差路线外差法天生不需要处理二值化边沿。5.2 投影仪gamma非线性投影仪的输入灰度和输出亮度不是严格线性关系四步相移公式里假设条纹是理想正弦实际投影出的余弦被gamma扭曲后解出来的包裹相位会带上二倍频误差。表现是三维表面出现波浪状条纹频率正好是正弦频率的两倍。解决思路是做一个灰阶响应标定投影一系列已知灰阶图相机采集后拟合出输入输出映射生成查找表。生成正弦条纹时先用查找表反向映射每个像素的灰度值把输出端的非线性预补偿掉。没有时间做完整标定时至少可以把投影仪的对比度调低、亮度调中让响应尽量落在线性区间。5.3 高反光和暗区高反光物体的镜面区域拍出来一片白相位在这个区域会丢失。暗区则是相机信噪比不够相位噪声放大。两种问题都会让三维点云出现大范围空洞。我处理高反光的经验是分组曝光对同一个条纹图案分别用低、中、高三档曝光采集然后对每个像素挑选灰度值接近但未饱和的那幅图参与相位解算。也可以用偏振片削弱镜面反射但会增加硬件成本。暗区一般靠提高投影亮度或者降低环境光解决实在不行就在重建后对空洞区域做点云插补。5.4 常见问题排查速查表现象可能原因优先级检查展开后出现贯穿性条纹裂缝格雷码级次跳变错位或外差逐级跳变查看级次图与包裹相位叠加图表面有波浪状起伏投影仪gamma非线性灰阶响应标定与预补偿点云里很多孤立飞点环境光变化或高反光饱和多曝光融合或环境光抑制目标边缘锯齿严重离焦、投影仪低频响应不足调节投影仪景深、改用互补偏移展开相位在某个区域整体偏移标定的投影仪外参有偏差用平面靶标验证重投影误差物体前后移动但相位没变化采集时序错位检查相机与投影仪的触发同步排查时先不要急着调算法顺序应该是先确认包裹相位图本身平滑无突变再确认级次图或低频参考相位全场唯一最后才去调三角化。很多时候问题并不在算法而在采集环境的光线扰动。我在实际使用这套代码时最大的体会是先用Matlab把算法链路跑通比什么都重要。采集时难免遇到各种脏数据但在代码层面先把每一级的中间结果可视化出来问题基本能定位到具体环节。等算法验证稳定了再往C或者GPU上移植会省很多力气。最后分享一个小技巧正式采集前先投影一张纯白和一张纯黑图案估算每个像素的信号幅值和背景光强如果某个区域幅值低于阈值直接生成掩膜后续重建跳过这些像素能省掉很多无效计算。
平方复杂度无法被常规优化消除｜TaoToken 统一 Key 通道实测)
