Arduino BLDC之抗辐射环境自主导航与辐射监测机器人是一套融合无刷电机高可靠驱动、多模态辐射感知与分层自主导航的特种机器人系统，其核心优势在于以BLDC的低电磁噪声与长寿命特性保障极端环境下的持续作业，并通过辐射成本地图实现“避障+避辐”双安全路径规划，主要适用于核事故应急、设施退役及口岸安检等场景，但落地时必须重点攻克辐射加固、电源隔离与通信冗余三大工程难题。

1、系统架构与技术原理
该系统采用"感知-决策-执行"三层解耦架构，将辐射探测、自主导航与电机驱动彻底分离，确保在极端环境下的可靠性与可维护性：
感知层：构建"辐射+环境"双模态感知网络。辐射探测方面，搭载GM计数管（高灵敏度剂量率监测）或CsI(Tl)闪烁体探测器（能谱分析与核素识别），通过Arduino中断脉冲计数+死时间校正+滑动平均滤波抑制统计涨落；环境感知方面，融合2D LiDAR/超声波/ToF+IMU+编码器，实现SLAM建图与实时定位。
决策层：采用"全局规划+局部避障"的分层导航架构。全局规划器（A*/Dijkstra）基于先验地图生成宏观路径；局部规划器（DWA/VFH）在滚动窗口内进行高频动态重规划，实时规避突发障碍。核心创新在于辐射成本地图（Radiation Costmap）——将实时辐射剂量数据与空间坐标绑定，与传统地形障碍物地图融合为综合"风险地形图"，路径规划算法据此计算辐射暴露风险最低的安全路径，实现"既避障又避辐"。
执行层：基于Arduino生态（如SimpleFOC库），通过FOC（磁场定向控制）驱动BLDC无刷电机，实现位置/速度/力矩三环闭环控制。BLDC的无刷结构避免了电刷磨损故障，低电磁噪声特性有助于减少对辐射探测传感器的信号干扰。

2、主要特点
BLDC驱动的高可靠性底盘
长寿命与低维护：电子换向无电刷磨损，寿命远超有刷直流电机，适合无人干预的长时任务。效率>85%，高扭矩密度配合FOC驱动器可实现低速大扭矩爬坡越障。
低电磁噪声：FOC正弦波驱动消除了方波驱动的高频谐波，显著降低电磁干扰（EMI），避免对GM管、闪烁体等敏感辐射探测器的信号造成污染。
全地形适应性：可搭配履带式或四足（机器狗）构型，适应核设施内可能存在的废墟、台阶、狭窄夹层等复杂地形。
多模态辐射感知与数据融合
异构传感器网络：GM计数管负责高灵敏度剂量率监测（量程可达0.1μSv/h_{10Sv/h，自动切换高低量程），CsI(Tl)闪烁体负责能谱分析和核素识别（10keV}3MeV能量范围）。Arduino通过中断脉冲计数采集原始数据，经死时间校正和滑动平均滤波后输出稳定剂量率。
辐射场三维可视化：将采集到的辐射剂量数据与机器人实时位姿（通过SLAM/编码器推算）绑定，生成带色阶的辐射场热力图（Radiation Field Mapping），直观显示放射源方位与强度分布。
阵列式定向探测（进阶）：前沿方案采用多块闪烁晶体组成的阵列式探测器，具备空间半球定向能力，可实时判断放射源方向，显著提高搜寻效率。
辐射感知的自主导航
辐射成本地图融合：核心创新在于将辐射信息转化为导航系统能理解的"风险地图"。实时辐射测量数据经算法生成辐射成本地图，与传统地形障碍物地图融合为综合"风险地形图"，路径规划算法据此计算辐射暴露风险最低的安全路径。
分层式导航架构：全局规划器（A*/Dijkstra）基于先验地图生成宏观路径；局部规划器（DWA/VFH）在滚动窗口内进行高频动态重规划，实时规避突发障碍。滚动窗口机制仅以机器人为中心维护局部代价地图，大幅降低MCU内存占用与计算负荷。
断连自主作业：采用分层控制架构，Arduino/底层MCU负责电机PID闭环与紧急避障，上位机负责路径规划。通信中断时底层仍可独立避障巡航，确保任务不中断。
抗干扰与冗余设计
EMC电磁兼容：BLDC驱动电源与Arduino/传感器电源物理隔离；信号线加RC低通滤波、磁珠、屏蔽双绞线；软件数字滤波剔除电机换相毛刺。
通信冗余：支持Wi-Fi/ZigBee/LoRa/4G多模通信，重要指令加CRC-16校验与ACK确认重发机制。当无线信号受屏蔽或干扰时，可切换至有线模式（光纤/网线），确保控制指令和探测数据的可靠传输。
辐射超阈值自动报警/回撤：检测到辐射超过预设阈值时自动触发报警并执行回撤逻辑，硬件急停、限位开关作为最后防线。

3、典型应用场景
核事故应急响应与评估
在核泄漏或核事故（如福岛核事故）后，现场辐射水平极高且结构复杂。机器人深入反应堆厂房、废墟内部或地下廊道，自主规划路径避开障碍物，同时实时绘制辐射剂量率分布图，寻找放射源位置，并通过视频回传现场状况，为指挥员制定处置方案提供关键数据支撑。
核设施日常巡检与退役
在核电站、乏燃料储存池或核废料处理厂等场所，机器人定期在高辐射区域（如反应堆水池边缘、热室内部）进行自主巡检，检测辐射水平变化、设备腐蚀情况。在核设施退役阶段，机器人可进入密闭容器或狭窄空间进行辐射测绘和去污作业，大幅降低人员受照剂量（ALARA原则）。
海关与边境安全检查
在口岸、海关或边境检查站，部署轮式或履带式机器人对集装箱堆场、车辆底部或可疑包裹进行快速扫描。利用自主避障能力，机器人可在密集的集装箱阵列中穿梭，自动定位并识别非法走私的放射性物质，防止核材料非法流通。广州海关已部署全国首个辐射探测"机器狗"，集成辐射、气体、温湿度等传感器，用于集装箱放射性检测。
核废料处理与污染区监测
在放射性废物管理领域，机器人用于自动分拣、封装、转运高放废物，或在污染区域进行辐射水平监测与环境评估，确保作业人员零暴露。
医疗放射性物资管理
在医院核医学科或放射性药物生产车间，机器人用于放射性药品的自动搬运、存储与分发，减少医护人员长期低剂量辐射暴露风险。

4、注意事项与关键技术挑战
电子元器件的辐射加固
单粒子效应（SEU）与总剂量损伤（TID）：高能粒子可能导致Arduino微控制器发生单粒子翻转（SEU），导致程序跑飞或数据错误；长期累积辐射剂量（TID）会造成半导体器件性能退化甚至永久损坏。
对策：关键芯片局部铅/钨屏蔽；启用看门狗定时器（WDT）防止程序跑飞；数据CRC校验；双MCU热备或定期状态自检；关键数据实时存储防止掉电丢失。在原型/教学层面，这些措施可显著提升生存能力；在工业级应用中，则需采用专门的辐射硬化芯片。
电源系统的稳定性与隔离
大电流干扰：BLDC电机启动和负载突变时会产生大的电流冲击，可能导致Arduino因电压跌落而复位，造成机器人失控。
对策：电机驱动电源与逻辑控制电源（Arduino及传感器）必须物理隔离，使用独立的高性能LDO或DC-DC模块为逻辑电路供电；电源入口加入大容量低ESR电解电容（≥470μF）吸收电流尖峰；电机相线套屏蔽网。
辐射探测器的信号抗干扰
电磁干扰：BLDC电机换相产生的高频噪声可能耦合到辐射探测器的微弱信号中，导致剂量率读数失真。
对策：辐射探测器与电机驱动保持物理距离；信号线使用屏蔽双绞线；硬件RC低通滤波+软件中值滤波/滑动平均滤波双重处理；GM管死时间校正消除计数饱和。
通信可靠性与离线容错
信号遮挡：核设施内厚重的混凝土墙和金属结构会严重衰减无线信号，通信中断时机器人可能丢失任务或停在危险区域。
对策：采用有线（光纤/网线）与无线（Wi-Fi/LoRa）双模通信机制；MCU端本地缓存任务与地图数据，通信恢复后自动续传；部署中继节点构建Mesh网络扩展覆盖范围。
导航算法的辐射感知融合
辐射成本地图的实时性：辐射数据具有统计涨落特性（泊松分布），直接用于路径规划可能导致路径频繁抖动。
对策：对辐射数据进行时间窗口平滑处理后再注入代价地图；设置合理的辐射梯度阈值，避免对微小波动过度响应；全局路径与局部避障的切换需设置滞回区间，防止状态振荡。
安全合规与应急机制
辐射锁死：检测到超阈值辐射时必须立即断电停机，防止机器人深入更高辐射区域导致电子设备彻底损毁。
硬件急停：急停按钮必须为硬件中断直接切断电机使能，绕过软件调度层，确保在任何软件故障下都能可靠停车。
累积剂量监控：持续记录机器人本体的累积辐射剂量，当接近电子元件耐受极限时自动触发撤离，避免设备在高辐射区"殉职"。

1、基础辐射监测 + 避障导航（FSM驱动）
场景：低本底辐射区域（如核设施外围、实验室）的日常巡检与测绘，机器人需沿预设路线采集辐射数据并避开障碍物。

核心逻辑：采用有限状态机管理机器人行为，在巡航与避障状态间切换。使用辐射传感器（如GM管/盖革计数器）中断脉冲计数，结合滑动平均滤波和死时间校正处理数据；超声波测距驱动避障逻辑，实现基础自主导航。

#include <SimpleFOC.h>   // BLDC电机库
#include <NewPing.h>     // 超声波库

// ===== BLDC差速电机 =====
BLDCMotor motorL(7), motorR(8);

// ===== 辐射传感器（GM管，脉冲计数）=====
#define RADIATION_INT_PIN 2  // 接GM管输出
const float CALIB_FACTOR = 0.0087; // 对Cs-137校准因子 [citation:9]
volatile unsigned long pulseCount = 0;
float doseRate = 0;  // μSv/h

// ===== 超声波避障 =====
NewPing sonarF(TRIG_F, ECHO_F, 200);

// ===== FSM状态枚举 =====
enum RobotState { CRUISING, AVOIDING };
RobotState currentState = CRUISING;

// ===== 避障与辐射报警阈值 =====
const int OBSTACLE_THRESHOLD_CM = 30;
const float RADIATION_ALARM_THRESHOLD = 5.0;  // μSv/h

void setup() {
    Serial.begin(115200);
    // 辐射传感器中断：每个脉冲触发计数
    pinMode(RADIATION_INT_PIN, INPUT_PULLUP);
    attachInterrupt(digitalPinToInterrupt(RADIATION_INT_PIN), countPulse, FALLING);
    // BLDC电机初始化...
}

void loop() {
    // 1. 辐射剂量率计算（滑动平均滤波，抑制统计涨落）[citation:1][citation:2]
    static unsigned long lastCalc = 0;
    static float doseBuffer[10];
    static int bufIdx = 0;
    if (millis() - lastCalc > 1000) {
        float cps = pulseCount;           // 每秒计数率
        pulseCount = 0;
        doseBuffer[bufIdx] = cps * CALIB_FACTOR;  // 转换为剂量率
        bufIdx = (bufIdx + 1) % 10;
        // 滑动平均滤波（剔除极端值）
        float sum = 0, cnt = 0;
        for (int i = 0; i < 10; i++) {
            if (doseBuffer[i] > 0 && doseBuffer[i] < 100) { sum += doseBuffer[i]; cnt++; }
        }
        doseRate = (cnt > 0) ? sum / cnt : 0;
        lastCalc = millis();

        // 辐射超阈值报警（案例三可扩展为自动回撤）
        if (doseRate > RADIATION_ALARM_THRESHOLD) {
            Serial.printf("辐射报警: %.2f μSv/h\n", doseRate);
            // 可触发蜂鸣器或回传告警
        }
    }

    // 2. FSM状态机：巡航 ↔ 避障
    int frontDist = sonarF.ping_cm();
    switch(currentState) {
        case CRUISING:
            if (frontDist > 0 && frontDist < OBSTACLE_THRESHOLD_CM) {
                currentState = AVOIDING;
                motorL.move(0); motorR.move(0);  // 急停
                Serial.println("障碍物，进入避障模式");
            } else {
                // 直线巡航
                motorL.move(100);
                motorR.move(100);
            }
            break;

        case AVOIDING:
            // 简单随机转向避障（可扩展为沿墙或VFH）
            if (frontDist > OBSTACLE_THRESHOLD_CM + 10) {
                currentState = CRUISING;
                Serial.println("避障完成，恢复巡航");
            } else {
                // 原地右转（差速）
                motorL.move(50);
                motorR.move(-50);
            }
            break;
    }

    // 3. 回传状态（串口/无线，此处仅串口打印）
    Serial.printf("剂量率: %.2f μSv/h, 距离: %d cm, 状态: %d\n", doseRate, frontDist, currentState);

    delay(30);
}

// 脉冲计数中断服务程序
void countPulse() {
    pulseCount++;
}

2、辐射场测绘 + A*全局规划 + DWA局部避障
场景：需在较大区域（如核设施厂房、废物储存区）进行系统性辐射场测绘，生成带剂量率热力图，并自主规划路径。

核心逻辑：采用分层架构——Arduino/底层MCU负责BLDC电机闭环、传感器采集和紧急避障；上位机（ESP32/树莓派） 负责A*全局路径规划与DWA动态窗口局部避障。辐射剂量率数据与机器人位姿（来自IMU+编码器里程计）绑定，生成辐射场热力图。

#include <SimpleFOC.h>
#include <NewPing.h>
#include <Wire.h>
#include <MPU6050.h>

// ===== BLDC差速电机 =====
BLDCMotor motorL(7), motorR(8);
MPU6050 imu;

// ===== 辐射传感器（GM管） =====
#define RADIATION_INT_PIN 2
volatile unsigned long pulseCount = 0;
float doseRate = 0;
float posX = 0, posY = 0, theta = 0;  // 机器人位姿（里程计推算）

// ===== 超声波避障（多传感器） =====
NewPing sonarF(TRIG_F, ECHO_F);
NewPing sonarL(TRIG_L, ECHO_L);
NewPing sonarR(TRIG_R, ECHO_R);

// ===== 串口通信（与上位机/树莓派）=====
#define SERIAL_BAUD 115200

// ===== 避障与辐射报警阈值 =====
const int OBSTACLE_THRESHOLD_CM = 25;
const float RADIATION_ALARM_THRESHOLD = 2.0;  // μSv/h
bool radiationEmergency = false;

void setup() {
    Serial.begin(SERIAL_BAUD);
    // 辐射传感器中断
    attachInterrupt(digitalPinToInterrupt(RADIATION_INT_PIN), countPulse, FALLING);
    // IMU与电机初始化...
}

void loop() {
    // 1. 辐射剂量率计算（同案例一）
    static unsigned long lastCalc = 0;
    if (millis() - lastCalc > 1000) {
        doseRate = pulseCount * CALIB_FACTOR;
        pulseCount = 0;
        lastCalc = millis();
        
        // 超阈值触发紧急回撤
        if (doseRate > RADIATION_ALARM_THRESHOLD) {
            radiationEmergency = true;
            Serial.println("辐射超阈值，触发紧急回撤");
        }
    }

    // 2. 位姿更新（编码器里程计+IMU修正）
    updatePosition();

    // 3. 接收上位机指令（格式：vx,vy,omega）
    if (Serial.available()) {
        String cmd = Serial.readStringUntil('\n');
        // 解析并更新目标速度...
    }

    // 4. 局部避障（DWA由上位机执行，此处仅为"硬中断级"避障）[citation:1][citation:2]
    int dF = sonarF.ping_cm(), dL = sonarL.ping_cm(), dR = sonarR.ping_cm();
    if ((dF > 0 && dF < OBSTACLE_THRESHOLD_CM) || 
        (dL > 0 && dL < 20) || (dR > 0 && dR < 20)) {
        // 紧急停车，覆盖上位机指令
        motorL.move(0); motorR.move(0);
        Serial.println("硬中断级避障触发");
        delay(100);
        // 可选：发送"避障暂停"消息给上位机
        Serial.println("AVOID_PAUSE");
        return;
    }

    // 5. 电机驱动（若辐射紧急则降速回撤）
    if (radiationEmergency) {
        motorL.move(-80); motorR.move(-80);  // 低速返回
    } else {
        motorL.move(targetSpeedL);
        motorR.move(targetSpeedR);
    }

    // 6. 辐射场数据回传：位姿+剂量率
    Serial.printf("POS,%.2f,%.2f,%.2f,RAD,%.2f\n", posX, posY, theta, doseRate);

    delay(30);
}

void countPulse() { pulseCount++; }

3、抗辐射加固 + 双机热备 + 通信冗余
场景：应急响应场景，需进入中高剂量辐射区（>100 μSv/h），对系统可靠性和生存能力有更高要求。

核心逻辑：在案例一/二基础上增加辐射加固措施——启用硬件看门狗防死机；关键数据ECC校验并定时存储；双MCU热备仲裁；通信采用WiFi/ZigBee/LoRa多模冗余。

#include <SimpleFOC.h>
#include <avr/wdt.h>   // 硬件看门狗

// ===== 硬件看门狗配置 =====
const byte WDT_TIMEOUT = WDTO_4S;

// ===== 双MCU热备（此处模拟） =====
bool mcuPrimaryHealthy = true;
bool mcuBackupHealthy = false;

// ===== 通信冗余 =====
enum CommMode { WIFI_MODE, LORA_MODE };
CommMode activeComm = WIFI_MODE;
unsigned long lastCommTime = 0;
const unsigned long COMM_TIMEOUT = 3000;  // 3秒无通信则切换

void setup() {
    Serial.begin(4800);  // 抗干扰低波特率 [citation:10]
    // 1. 硬件看门狗初始化
    wdt_enable(WDT_TIMEOUT);
    wdt_reset();
    // 2. 关键数据CRC校验（模拟）
    if (!validateCriticalData()) {
        // 从备份区恢复
        restoreFromBackup();
    }
    // 3. 其他硬件初始化...
}

void loop() {
    // 1. 【抗辐射加固】定期喂狗 + 内存扫描 [citation:10]
    static unsigned long lastWDT = 0;
    if (millis() - lastWDT > 2000) {
        wdt_reset();  // 喂狗，防止系统复位
        lastWDT = millis();
        // 内存扫描与修复（模拟）
        scanAndRepairMemory();
    }

    // 2. 【双机热备】主MCU状态监测
    if (!mcuPrimaryHealthy) {
        activateBackupMCU();  // 切换至备用
    }

    // 3. 【通信冗余】检测通信状态
    if (millis() - lastCommTime > COMM_TIMEOUT) {
        // 切换至备用通信通道
        if (activeComm == WIFI_MODE) {
            activeComm = LORA_MODE;
            Serial.println("📡 切换至LoRa通道");
        } else {
            // 进入"存储转发"模式 [citation:2]
            storeDataForLater();
        }
        lastCommTime = millis();
    }

    // 4. 辐射监测与报警（同案例一/二）
    if (doseRate > EMERGENCY_THRESHOLD) {
        // 触发自动回撤
        executeEmergencyRetreat();
        // 通过所有可用通道发送警报
        sendAlertAllChannels("RADIATION_ALERT", doseRate);
    }

    // 5. 执行安全控制（电机驱动等）
    // ...
    delay(50);
}

// 关键数据校验函数
bool validateCriticalData() {
    // 实现CRC或校验和检查
    return true;
}

要点解读
辐射加固的本质是"生存能力设计"：在核辐射环境中，商用Arduino面临总剂量效应（TID，导致芯片性能退化） 和单粒子翻转（SEU，导致程序跑飞）。软件策略包括硬件看门狗（防死机）、CRC校验（防数据损坏）、关键数据定时存储EEPROM/FRAM（防掉电丢失）。硬件策略包括局部铅/钨屏蔽。

分级控制架构解决Arduino算力瓶颈：SLAM建图、A*全局规划和DWA动态避障等算法对算力要求高，超出8位Arduino能力。典型做法是分层控制——Arduino只负责BLDC电机闭环、传感器中断采集和紧急避障（"硬中断级"安全兜底）；上位机（树莓派/ESP32/Teensy）负责建图、路径规划和辐射场可视化。

辐射数据处理的三大关键技术：中断脉冲计数（GM管输出脉冲，需死时间校正）；滑动平均滤波（抑制辐射统计涨落，窗口通常取10~30秒）；位姿绑定（将剂量率与机器人位置关联，是生成辐射场热力图的基础）。

电源隔离是抗干扰的第一道防线：BLDC电机启动/堵转时大电流冲击会导致Arduino因电压跌落而复位。必须电机驱动电源与逻辑电源物理隔离；逻辑侧使用独立LDO/隔离DC-DC；电源入口并联大容量电解电容+陶瓷电容吸收尖峰。

EMI（电磁干扰）抑制：BLDC换相电磁噪声可能干扰辐射探测器敏感电路。措施包括：硬件滤波（RC低通、磁珠、屏蔽双绞线）；软件数字滤波（中值滤波/滑动平均剔除换相毛刺）；BLDC驱动与传感器电路物理分区布局。在强辐射环境中，建议优先使用LoRa或有线拖缆（RS485/CAN） 应对无线通信衰减问题。

4、超声波避障+盖革计数器复合检测系统——基础场景下的避障与辐射监测
适用场景：核设施日常巡检（如低辐射区域的通道巡检），要求机器人在避开障碍物的同时，实时监测辐射剂量率，当超标时触发报警并撤离，适合对算力要求低、环境相对规整的场景。

核心设计：
传感器融合：超声波传感器实现障碍物检测，盖革计数器监测辐射剂量率，两者互补覆盖“物理避障+辐射监测”核心需求；
逻辑决策：优先响应辐射超标（撤离优先级高于避障），避障时采用PID控制电机转向，确保路径稳定；
状态反馈：通过LCD实时显示辐射值和距离，直观反馈机器人状态。

/* 超声波避障+盖革计数器复合检测系统
   核心逻辑：避障与辐射监测融合，辐射超标优先撤离，PID控制电机稳定转向
   硬件：Arduino Mega + BLDC电机 + 超声波传感器 + 盖革计数器 + LCD显示屏
   参数：避障安全距离30cm，辐射报警阈值100μSv/h
*/

// --- 硬件引脚定义 ---
#define MOTOR_PWM 3
#define MOTOR_DIR 4
#define ENCODER_A 2
#define TRIG_PIN 7
#define ECHO_PIN 8
#define GEIGER_PIN 6
#define LCD_RS 12
#define LCD_EN 11
#define LCD_D4 10
#define LCD_D5 9
#define LCD_D6 8
#define LCD_D7 7

// --- 核心变量 ---
const float SAFE_DISTANCE = 30; // 避障安全距离（cm）
const float RADIATION_THRESHOLD = 100; // 辐射报警阈值（μSv/h）
float currentRadiation = 0;
long distance = 0;

// --- 初始化函数 ---
void setup() {
  pinMode(MOTOR_PWM, OUTPUT);
  pinMode(MOTOR_DIR, OUTPUT);
  pinMode(GEIGER_PIN, INPUT);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  
  // 初始化LCD
  LiquidCrystal lcd(LCD_RS, LCD_EN, LCD_D4, LCD_D5, LCD_D6, LCD_D7);
  lcd.begin(16, 2);
  
  Serial.begin(9600);
  lcd.print("System Ready");
  delay(1000);
}

// --- 主循环：避障+辐射监测 ---
void loop() {
  // 1. 超声波测距
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  distance = pulseIn(ECHO_PIN, HIGH) * 0.034 / 2;

  // 2. 盖革计数器读数（脉冲计数转换为剂量率，简化处理）
  int pulseCount = pulseIn(GEIGER_PIN, HIGH);
  currentRadiation = map(pulseCount, 0, 500, 0, 200); // 简化映射，实际需校准

  // 3. 决策逻辑：辐射超标优先撤离
  if (currentRadiation > RADIATION_THRESHOLD) {
    // 辐射超标：停止前进，倒车撤离
    lcd.clear();
    lcd.print("RAD ALERT! Exit");
    digitalWrite(MOTOR_DIR, LOW);
    analogWrite(MOTOR_PWM, 0);
    delay(500);
    digitalWrite(MOTOR_DIR, HIGH); // 倒车
    analogWrite(MOTOR_PWM, 150);
    delay(1000);
    analogWrite(MOTOR_PWM, 0);
    return;
  }

  // 4. 避障逻辑
  if (distance < SAFE_DISTANCE && distance > 0) {
    // 障碍物在安全距离内：转向避障
    lcd.clear();
    lcd.print("Obstacle! Turn");
    digitalWrite(MOTOR_DIR, LOW);
    analogWrite(MOTOR_PWM, 0);
    delay(500);
    // 左转（简化转向逻辑）
    digitalWrite(MOTOR_DIR, HIGH);
    analogWrite(MOTOR_PWM, 100);
    delay(800);
    analogWrite(MOTOR_PWM, 0);
  } else {
    // 无障碍物：正常前进
    lcd.clear();
    lcd.setCursor(0, 0);
    lcd.print("RAD:");
    lcd.print(currentRadiation);
    lcd.setCursor(0, 1);
    lcd.print("DIST:");
    lcd.print(distance);
    digitalWrite(MOTOR_DIR, HIGH);
    analogWrite(MOTOR_PWM, 150);
  }

  delay(100); // 控制循环频率
}

5、激光雷达SLAM建图与路径规划系统——复杂场景下的自主导航与辐射标注
适用场景：核事故应急响应（如废墟环境测绘），要求机器人在未知环境中自主构建地图，同时将辐射剂量率与空间坐标关联，生成辐射热力图，避开高辐射区域，适合对导航精度要求高、环境复杂的场景。

核心设计：
SLAM建图：激光雷达采集环境点云，结合里程计实现位姿估计，构建二维占据栅格地图；
路径规划：A*算法生成全局最优路径，避开高辐射区域和障碍物；
辐射融合：将辐射数据与地图坐标绑定，实现辐射热点标注，为后续处置提供依据。

/* 激光雷达SLAM建图与路径规划系统
   核心逻辑：SLAM构建环境地图，融合辐射数据标注热点，A*算法规划避障路径
   硬件：ESP32 + BLDC电机 + 激光雷达 + 盖革计数器 + IMU
   说明：代码简化SLAM核心算法，保留框架，实际需补充点云匹配、因子图优化等细节
*/

#include <RPLIDAR.h>
#include <KalmanFilter.h>
#include <AStarPlanner.h>

// --- 硬件与参数定义 ---
#define LIDAR_SERIAL Serial1
#define LIDAR_BAUD 500000
#define MAP_SIZE 100 // 地图尺寸（栅格数）
#define RESOLUTION 1 // 栅格分辨率（cm）
#define RADIATION_THRESHOLD 150 // 高辐射区域阈值

// --- SLAM核心组件 ---
RPLIDAR lidar(LIDAR_SERIAL, LIDAR_BAUD);
KalmanFilter poseKF; // 位姿估计滤波器
OccupancyGrid map(MAP_SIZE, RESOLUTION); // 占据栅格地图
AStarPlanner planner;

// --- 状态变量 ---
float currentX = 0, currentY = 0, currentTheta = 0;
float radiationValue = 0;

// --- 初始化函数 ---
void setup() {
  Serial.begin(115200);
  lidar.begin();
  poseKF.init(0, 0, 0); // 初始位姿（x,y,theta）
  map.clear(); // 清空地图
  planner.init(&map); // 初始化路径规划器
  Serial.println("SLAM System Ready");
}

// --- 主循环：建图+路径规划+辐射标注 ---
void loop() {
  // 1. 获取激光雷达点云数据
  LaserScan scan = lidar.getLatestScan();
  if (scan.size() == 0) {
    Serial.println("No LIDAR data");
    return;
  }

  // 2. 前端里程计更新（基于点云匹配估计位姿变化）
  PoseUpdate odom = computeOdometry(scan);
  poseKF.predict(odom.deltaX, odom.deltaY, odom.deltaTheta);
  currentX += odom.deltaX;
  currentY += odom.deltaY;
  currentTheta += odom.deltaTheta;

  // 3. 后端优化：闭环检测（简化：定期检测回环）
  if (detectLoopClosure(scan)) {
    optimizePoseGraph(); // 因子图优化，减少累积误差
  }

  // 4. 更新占据栅格地图
  updateMap(scan);

  // 5. 辐射监测与热点标注
  radiationValue = readRadiationSensor(); // 读取辐射传感器数据
  if (radiationValue > RADIATION_THRESHOLD) {
    // 标注高辐射区域
    markContaminatedArea(currentX, currentY, radiationValue);
  }

  // 6. 路径规划：避开高辐射区域和障碍物
  if (needReplan()) {
    plannedPath = planner.findPath(currentX, currentY, targetX, targetY);
    if (plannedPath.isEmpty()) {
      Serial.println("No path found, emergency stop");
      stopMotors();
      return;
    }
  }

  // 7. 执行路径规划的速度指令
  executeMotionCommands(plannedPath);

  delay(100);
}

// --- 辅助函数（简化实现） ---
PoseUpdate computeOdometry(LaserScan scan) {
  // 基于点云匹配估计位姿变化，实际需实现ICP算法
  PoseUpdate odom;
  odom.deltaX = 1.0; // 示例值，实际需根据点云计算
  odom.deltaY = 0.0;
  odom.deltaTheta = 0.01;
  return odom;
}

bool detectLoopClosure(LaserScan scan) {
  // 闭环检测，简化为定期触发
  static int counter = 0;
  counter++;
  return counter % 100 == 0;
}

void updateMap(LaserScan scan) {
  // 将点云数据映射到占据栅格地图，更新障碍物信息
  for (int i = 0; i < scan.size(); i++) {
    Point point = scan[i];
    int gridX = (currentX + point.x) / RESOLUTION;
    int gridY = (currentY + point.y) / RESOLUTION;
    if (gridX >= 0 && gridX < MAP_SIZE && gridY >= 0 && gridY < MAP_SIZE) {
      map.setOccupied(gridX, gridY);
    }
  }
}

float readRadiationSensor() {
  // 读取辐射传感器数据，示例返回随机值，实际需对接硬件
  return random(0, 200);
}

void markContaminatedArea(float x, float y, float rad) {
  // 在地图中标注高辐射区域
  int gridX = x / RESOLUTION;
  int gridY = y / RESOLUTION;
  if (gridX >= 0 && gridX < MAP_SIZE && gridY >= 0 && gridY < MAP_SIZE) {
    map.setContaminated(gridX, gridY, rad);
  }
}

void executeMotionCommands(Path path) {
  // 根据路径生成电机速度指令，驱动BLDC电机
  if (path.size() > 0) {
    Point target = path[0];
    float dx = target.x - currentX;
    float dy = target.y - currentY;
    float targetTheta = atan2(dy, dx);
    float angleError = targetTheta - currentTheta;
    // PID控制电机转向和速度
    setMotorSpeed(angleError);
  }
}

6、抗辐射强化型应急越障机器人——极端环境下的生存与作业
适用场景：核事故核心区应急作业（如废墟越障、放射源定位），要求机器人具备抗辐射加固能力，能在通信中断、强干扰环境下自主执行任务，支持故障自检和应急处理，适合极端辐射、复杂地形的高危场景。

核心设计：
抗辐射加固：硬件看门狗、CRC校验、双CPU冗余，缓解单粒子翻转；关键芯片局部屏蔽，提升抗辐射能力；
应急机制：电源监测、故障自检，低电压时启动保护，系统故障时触发应急流程；
越障与作业：BLDC电机提供大扭矩越障，步进电机带动探头扫描，AI识别放射性尘埃，支持自主避障和应急撤离。

/* 抗辐射强化型应急越障机器人
   核心逻辑：抗辐射加固设计，故障自检与应急处理，越障与辐射扫描作业
   硬件：Arduino Mega + 抗辐射加固模块 + BLDC越障电机 + 步进扫描探头 + 双CPU冗余
   说明：代码聚焦抗辐射逻辑，硬件抽象层需对接实际加固模块
*/

#include <HardenedElectronics.h>
#include <WatchdogTimer.h>
#include <StepperMotor.h>

// --- 硬件抽象与参数 ---
HardenedDigitalIO shieldPins[8]; // 防浪涌IO扩展
WatchdogTimer wdt; // 硬件看门狗
StepperMotor scanMotor(3, 4, 5, 6); // 扫描步进电机（探头驱动）

// --- 状态变量 ---
bool systemOK = true;
float supplyVoltage = 0;
float radiationLevel = 0;

// --- 初始化函数 ---
void setup() {
  wdt.enable(WDTO_8S); // 启用8秒看门狗超时复位
  for (int i = 0; i < 8; i++) {
    shieldPins[i].begin();
    shieldPins[i].setInterrupt(RISING); // 上升沿触发中断
  }
  scanMotor.begin();
  scanMotor.setSpeed(10); // 扫描速度
  Serial.begin(115200);
  Serial.println("Hardened System Initializing...");
  performBIT(); // 上电执行BIT自检
}

// --- 主循环：抗辐射生存+应急作业 ---
void loop() {
  wdt.reset(); // 定期喂狗，防止程序跑飞

  // 1. 电源监测：低电压应急处理
  supplyVoltage = getSupplyVoltage();
  if (supplyVoltage < 6.5V) {
    Serial.println("Low voltage! Enter safe mode");
    enterLowPowerMode(); // 切断非核心负载
    deployParachute(); // 启动降落伞（高空场景）或制动装置
    systemOK = false;
    while(true); // 停机等待人工干预
  }

  // 2. 系统自检：确保核心模块正常
  if (!systemOK) {
    flashEmergencyLights(); // 闪烁应急灯
    broadcastDistressSignal(); // 广播求救信号
    while(true); // 死机冻结，防止失控
  }

  // 3. 辐射扫描作业：步进电机带动探头扫描
  performRadiationScan();

  // 4. 放射性尘埃识别：AI模型分析（简化为数据模拟）
  analyzeContamination();

  // 5. 越障控制：BLDC电机驱动底盘越障
  obstacleCrossing();

  // 6. 通信监测：通信中断应急处理
  if (!checkCommunication()) {
    Serial.println("Communication lost! Emergency return");
    emergencyReturn();
  }

  delay(100);
}

// --- 辅助函数：抗辐射核心逻辑 ---
void performBIT() {
  // BIT（Built-In Test）自检：检测CPU、传感器、电机等核心模块
  bool cpuOK = checkCPUIntegrity();
  bool sensorOK = checkSensors();
  bool motorOK = checkMotors();
  systemOK = cpuOK && sensorOK && motorOK;
  if (!systemOK) {
    Serial.println("BIT failed! System will halt");
    flashEmergencyLights();
    while(true);
  }
  Serial.println("BIT passed");
}

void performRadiationScan() {
  // 步进电机带动探头旋转扫描，采集辐射数据
  for (int i = 0; i < 360; i += 10) {
    scanMotor.step(10); // 步进旋转
    radiationLevel = readRadiationSensor(); // 读取探头数据
    storeRadiationData(i, radiationLevel); // 存储扫描数据
    if (radiationLevel > 200) {
      markRadiationHotspot(i, radiationLevel); // 标记辐射热点
    }
  }
}

void analyzeContamination() {
  // AI模型识别放射性尘埃类型（简化为模拟）
  String contaminationType = "Unknown";
  if (radiationLevel > 300) {
    contaminationType = "High-level Waste";
  } else if (radiationLevel > 150) {
    contaminationType = "Intermediate Waste";
  } else if (radiationLevel > 50) {
    contaminationType = "Low-level Waste";
  }
  Serial.printf("Contamination type: %s, Level: %.2f\n", contaminationType.c_str(), radiationLevel);
}

void obstacleCrossing() {
  // BLDC电机驱动底盘越障，基于传感器反馈调整扭矩
  bool obstacleDetected = checkObstacle();
  if (obstacleDetected) {
    Serial.println("Obstacle detected, increasing torque");
    setMotorTorque(1.5); // 提升电机扭矩
    delay(2000); // 越障动作持续
    setMotorTorque(1.0); // 恢复正常扭矩
  } else {
    setMotorTorque(1.0); // 正常行驶
  }
}

void emergencyReturn() {
  // 通信中断后，启动预设避难路径，返回安全区域
  stopAllMotors();
  setReturnPath(); // 加载预设返航路径
  while (!isAtSafeZone()) {
    executeReturnStep(); // 执行返航步骤
    wdt.reset();
  }
  stopAllMotors();
  Serial.println("Reached safe zone");
}

// --- 硬件抽象函数（简化实现） ---
float getSupplyVoltage() {
  // 读取电源电压，示例返回模拟值
  return analogRead(A0) * 0.01;
}

bool checkCommunication() {
  // 检测通信链路，简化为返回true
  return true;
}

bool checkObstacle() {
  // 检测障碍物，简化为返回随机值
  return random(0, 2) > 1;
}

void setMotorTorque(float torque) {
  // 设置BLDC电机扭矩，简化实现
  analogWrite(9, torque * 255);
}

要点解读

1. 抗辐射硬件适配：从源头保障系统在极端环境下的生存能力
   抗辐射环境的核心挑战是高能粒子导致的电子元器件损伤，硬件适配需聚焦隔离、加固、冗余三大方向：
   电源隔离：BLDC电机启动/堵转时的大电流冲击会导致电压跌落，需采用电机驱动电源与逻辑控制电源物理隔离，并搭配LDO/DC-DC模块供电，电源入口加大容量电容吸收尖峰，避免Arduino复位，案例3通过电源监测模块实现低电压应急，本质是对电源稳定性的保障；
   元器件加固：商用Arduino抗辐射能力弱，需选用工业级耐辐射器件，关键芯片局部加铅/钨屏蔽，案例3的硬件抽象层（HardenedElectronics.h）即针对防浪涌、抗辐射设计；
   冗余设计：通过双CPU热备、硬件看门狗、CRC校验缓解单粒子翻转（SEU），案例3启用8秒看门狗，程序跑飞时自动复位，同时系统自检（BIT）确保核心模块正常，从硬件层面提升系统生存能力。
2. 多传感器融合：实现“环境感知+辐射监测”的双维度精准决策
   抗辐射机器人需同时应对物理障碍和辐射风险，单一传感器无法满足需求，多传感器融合是核心：
   感知维度互补：案例4用超声波避障、盖革计数器监测辐射，案例2用激光雷达建图、辐射传感器标注热点，案例6用越障传感器+扫描探头，覆盖“避障-导航-监测-作业”全流程，避免单一传感器失效导致系统瘫痪；
   数据融合逻辑：优先响应高优先级风险（辐射超标优先于避障），案例4中辐射超标时立即撤离，而非单纯避障，体现任务优先级的融合逻辑；案例5将辐射数据与地图坐标绑定，实现“环境地图+辐射场”的可视化，为后续处置提供决策依据；
   抗干扰处理：BLDC电机的电磁干扰会影响传感器精度，需通过硬件滤波（RC低通、磁珠）和软件滤波（滑动平均、中值滤波）抑制干扰，案例1的PID控制和案例2的卡尔曼滤波，本质是对传感器数据的抗干扰处理，确保数据可靠。
3. 自主导航算法：适配抗辐射环境的动态路径规划与定位
   抗辐射环境多为未知、复杂场景（如废墟、核设施内部），自主导航需解决定位漂移、路径动态调整问题：
   定位技术适配：核设施内部GPS拒止，需依赖SLAM技术，案例5通过激光雷达+里程计+IMU实现位姿估计，同时引入闭环检测和因子图优化减少累积误差，避免地图扭曲；
   路径规划策略：采用“全局规划+局部避障”的分层架构，全局用A*算法规划避开高辐射区域的最优路径，局部用动态避障算法应对突发障碍，案例5的路径规划器即遵循这一逻辑，确保机器人在复杂环境中灵活调整路径；
   应急导航机制：通信中断或系统故障时，需具备自主避险能力，案例3的应急返航功能，通信中断后自动执行预设避难路径，避免机器人失控撞击设备，体现导航的可靠性设计。
4. 状态监测与应急机制：构建“感知-决策-执行”的安全闭环
   抗辐射环境作业风险极高，状态监测与应急机制是保障机器人安全和任务执行的核心：
   全维度状态监测：实时监测电源电压、辐射剂量、障碍物、通信状态等关键参数，案例1通过LCD显示状态，案例3通过系统自检（BIT）和电源监测实现全方位状态感知，确保及时识别异常；
   分级应急响应：根据风险等级触发不同应急流程，辐射超标时撤离（案例1）、低电压时停机保护（案例3）、通信中断时返航（案例3）、系统故障时冻结等待人工干预，形成分级响应机制，避免风险扩大；
   失效保护设计：设置硬线急停、看门狗复位、电机过流保护等多重安全防线，案例6的应急灯闪烁、求救信号广播，本质是失效后的告警机制，确保机器人失控时能被及时定位和处置。
5. 工程落地优化：平衡算力、功耗与抗辐射能力的工程适配
   Arduino平台算力有限，抗辐射环境对功耗和可靠性要求高，工程落地需在算力分配、功耗管理、可维护性之间平衡：
   算力分层架构：将复杂算法（如SLAM建图、AI识别）放在上位机（ESP32、树莓派），Arduino仅负责底层电机控制、传感器采集和紧急避障，案例2采用ESP32作为主控，Arduino作为辅助，既解决算力瓶颈，又保证实时性；
   功耗动态管理：根据任务优先级调整功耗，空闲时关闭非核心传感器，案例4的循环延时、案例3的低功耗模式，本质是功耗优化，延长机器人续航，适配长时作业需求；
   可维护性设计：代码模块化封装（如传感器驱动、电机控制、应急逻辑独立成模块），便于调试和升级；内置串口调试信息，记录状态切换、数据变化，案例中通过Serial打印关键信息，便于快速定位问题，同时硬件接口预留，支持后续功能扩展（如新增辐射传感器、通信模块）。

请注意：以上案例仅作为思路拓展的参考示例，不保证完全正确、适配所有场景或可直接编译运行。由于硬件平台、实际使用场景、Arduino 版本的差异，均可能影响代码的适配性与使用方法的选择。在实际编程开发时，请务必根据自身硬件配置、使用场景及具体功能需求进行针对性调整，并通过多次实测验证效果；同时需确保硬件接线正确，充分了解所用传感器、执行器等设备的技术规范与核心特性。对于涉及硬件操作的代码，使用前务必核对引脚定义、电平参数等关键信息的准确性与安全性，避免因参数错误导致硬件损坏或运行异常。