第4章传感器选型（二）

4. 传感器选型（二）：加速度计与倾角传感器

好，咱们接着聊浮体运动监测的传感器选型。上一节讲了风速风向和波浪雷达，这一节我重点说说加速度计和倾角传感器。这两个家伙，说白了就是浮体的「平衡感知器」——浮体怎么晃、怎么倾斜，全靠它们来捕捉。

你想想看，一个几十米直径的浮体，在海浪里上下起伏、左右摇摆。控制系统要是不清楚它当前的状态，那桨距角、扭矩指令全都会乱套。我见过一个项目，浮体倾斜超过15度时，发电机直接报错停机——就是因为倾角传感器没选对，数据滞后了200毫秒。

加速度计负责测量「动态加速度」，说白了就是浮体在三个轴向上有多快地在加速。倾角传感器则告诉你「静态角度」——浮体相对于水平面歪了多少。两者配合，才能还原浮体的真实姿态。

核心逻辑：加速度计看「动」，倾角传感器看「静」。融合之后，才能得到既响应快又稳定的姿态数据。

我个人习惯，选加速度计先看三个参数：量程、带宽、噪声密度。

嗯，这里要注意：加速度计的输出是「比力」，不是纯加速度。它包含重力分量。所以当浮体倾斜时，加速度计会读到一部分重力。这就是为什么不能直接用加速度计算倾角——你得先做滤波。

避坑指南：我曾经选过一款低成本的MEMS加速度计，标称噪声密度150 μg/√Hz。结果在海上实测时，积分出来的位移漂移得离谱——10分钟漂了2米。后来换了ADI的ADXL355，噪声密度降到25 μg/√Hz，问题才解决。所以，噪声密度这个参数，千万别只看数据手册，要实测。

倾角传感器，说白了就是个「电子水平尺」。它内部通常也是MEMS加速度计，但加了算法，直接输出角度值。选型时我主要看三个指标：精度、响应时间、温度漂移。

我建议你选那种带「动态补偿」功能的倾角传感器。它内部会做加速度补偿，在浮体晃动时也能输出相对稳定的角度。我试过一款不带补偿的，浮体一摇，角度输出跟着乱跳，根本没法用。

好，传感器选完了，怎么用？这里就要聊数据融合了。说白了，就是把加速度计的高频响应和倾角传感器的低频稳定性结合起来。

最经典的方法就是互补滤波。公式很简单：

// 互补滤波伪代码
angle = 0.98 * (angle + gyro * dt) + 0.02 * accel_angle;

但注意，这是针对陀螺仪的。咱们这里没有陀螺仪，只有加速度计和倾角传感器。那怎么办？

我的做法是：用加速度计的高频分量（高通滤波）加上倾角传感器的低频分量（低通滤波）。

// 加速度计与倾角传感器融合
float alpha = 0.05;  // 滤波系数，根据带宽调整
float fused_angle = alpha * accel_angle + (1 - alpha) * tilt_angle;

alpha值怎么定？我一般根据浮体的运动频率来调。如果浮体摇摆快，alpha设大一点（比如0.1），让加速度计多贡献一些。如果浮体运动平稳，alpha设小一点（比如0.02），让倾角传感器主导。

警告：互补滤波不是万能的。当浮体做剧烈加速运动时，加速度计的输出会严重偏离真实倾角。这时候融合出来的角度也会失真。我遇到过这种情况——一个大浪打过来，浮体瞬间加速，融合角度直接跳了5度。后来我加了「加速度幅值检测」逻辑，当加速度幅值超过阈值时，暂时降低加速度计的权重，才稳住。

下面这张图，是我自己总结的加速度计与倾角传感器选型与融合的完整逻辑。你照着这个思路走，基本不会踩坑。

最后，我总结几条实战建议，都是真金白银换来的经验：

传感器安装位置要选对。尽量靠近浮体的质心。离质心越远，加速度计读到的角加速度分量越大，融合出来的角度误差也越大。我见过有人把传感器装在塔筒顶部，结果数据完全没法用。
采样率要匹配。加速度计和倾角传感器的采样率最好一致，或者加速度计采样率是倾角传感器的整数倍。不一致的话，融合时要做插值，增加计算量。
别忘了做校准。每次安装后，都要做零偏校准和灵敏度校准。我习惯在浮体静止时采集1000个数据点，取平均作为零偏值。
冗余设计。关键系统建议用双传感器冗余。一个坏了，另一个还能顶上去。我做过一个项目，用了三冗余——两个加速度计加一个倾角传感器，投票输出，可靠性高很多。

小技巧：如果你用的是SPI接口的传感器，注意时钟频率不要太高。我遇到过SPI时钟设到10MHz，结果数据偶尔跳变——后来降到5MHz就稳定了。有时候，慢一点反而更可靠。

好了，这一节就到这里。加速度计和倾角传感器的选型与融合，说白了就是「动」与「静」的平衡。选对了传感器，做对了融合，浮体的姿态数据才能真实可靠。下一节咱们聊聊执行器选型——变桨系统和偏航系统的硬件怎么挑。