当前位置：首页 > news >正文

SimpleFOC实战：双电机协同控制从硬件搭建到模式切换

news 2026/5/27 20:26:50

1. 硬件搭建：从零组装双电机系统

第一次接触双电机控制时，最让我头疼的就是硬件连接。各种跳线、编码器接口看得眼花缭乱，接错一根线就可能让整个系统瘫痪。下面我就用最直白的语言，带你一步步完成硬件搭建。

核心硬件清单就像做菜的食材，缺一不可：

Arduino UNO主板（1块）：相当于系统的大脑
SimpleFOCShield驱动板（2块V2.0.3版本）：电机专用"肌肉"
带磁编码器的云台电机（2个）：我用的JGA25-370系列
12V电源（1个）：建议选择带过流保护的
USB数据线（1条）：普通手机线就能用

特别注意：驱动板版本必须匹配，我曾在V2.2.2版本上浪费三天时间，后来才发现双电机控制必须用V2.1.1版本。

跳线设置是第一个关键点。两个驱动板的背面跳线需要错开配置：

第一个驱动板接9、5、6、8引脚
第二个驱动板接3、10、11、7引脚这相当于给两个电机分配不同的"身份证号"，避免信号冲突。记得用万用表检查跳线是否导通，我有次因为虚焊导致电机时转时不转。

编码器接线要注意两个细节：

电源可以从Arduino UNO的两组5V接口分别取电
信号线对应关系要记牢：
- 跳线9/5/6/8的驱动板接A0模拟口
- 跳线3/10/11/7的驱动板接A2模拟口

完整接线就像搭积木：

把两个驱动板像三明治一样叠在Arduino上
USB线连接电脑和主板（同时供电）
12V电源正负极并联到两个驱动板的TB_PWR接口
电机三相线无顺序接入驱动板（运行时可以调换）
编码器接口注意电源正负极不要接反

2. 软件配置：双电机实例化实战

硬件组装好比盖好了房子，现在要通电装修。SimpleFOC库的配置就像智能家居控制系统，能让两个电机和谐共处。

开发环境准备有三步：

安装Arduino IDE（建议1.8.x稳定版）
添加SimpleFOC库：在库管理器搜索安装v2.1.1
选择开发板类型：Tools > Board > Arduino AVR Boards > Arduino Uno

打开示例文件时有个坑要注意：

// 错误做法：直接使用ABZ编码器示例 // 正确做法：使用custom_encoder示例修改 #include <SimpleFOC.h>

电机参数配置就像给双胞胎办户口：

// 电机1配置 BLDCMotor motor1 = BLDCMotor(7); // 极对数7 MagneticSensorAnalog encoder1 = MagneticSensorAnalog(A0); // 电机2配置 BLDCMotor motor2 = BLDCMotor(7); MagneticSensorAnalog encoder2 = MagneticSensorAnalog(A2); void setup() { // 初始化编码器 encoder1.init(); encoder2.init(); // 关联电机与编码器 motor1.linkSensor(&encoder1); motor2.linkSensor(&encoder2); }

PID参数调节是让电机听话的关键。新手可以先用默认值，遇到震动再调整：

// 速度环PID motor1.PID_velocity.P = 0.2; motor1.PID_velocity.I = 20; // 角度环PID motor1.P_angle.P = 20; // 电机2参数同理

实测发现，云台电机I值设为20-30时最稳定，P值太大会导致"抽风式"抖动。

3. 基础控制模式实现

让电机转起来只是开始，不同模式就像汽车的变速箱，适用于不同场景。我们先从最基础的力矩模式入手。

力矩模式相当于手动挡：

在setup()中添加初始化：

motor1.torque_controller = TorqueControlType::voltage; motor1.init(); motor2.torque_controller = TorqueControlType::voltage; motor2.init();

在loop()中持续运行：

motor1.loopFOC(); motor2.loopFOC(); motor1.move(target1); motor2.move(target2);

串口调试时我发现个实用技巧：

发送"A1.5"设置电机1电压为1.5V
发送"B2.0"设置电机2电压为2.0V 电压值建议从0.5V开始逐步增加，突然给高电压可能导致电机飞转。

异常处理经验：

电机发出"滋滋"声不转：检查编码器接线
一个电机转另一个不转：交换驱动板测试是否硬件故障
电机发烫：立即断电检查PID参数

4. 高级模式切换技巧

真正实用的系统往往需要多种模式组合使用。就像开车时要随时切换倒车、巡航等模式。

速度模式配置三步走：

修改初始化代码：

motor1.controller = MotionControlType::velocity; motor2.controller = MotionControlType::velocity;

设置目标速度（单位rad/s）：

motor1.move(3.14); // 约1转/秒 motor2.move(6.28); // 约2转/秒

调节速度PID：

motor1.PID_velocity.P = 0.1; motor1.PID_velocity.I = 20;

混合模式最体现双电机协同价值。比如让电机1保持匀速同时电机2输出恒定力矩：

// 电机1速度模式 motor1.controller = MotionControlType::velocity; // 电机2力矩模式 motor2.controller = MotionControlType::torque; void loop() { motor1.move(3.14); // 恒定速度 motor2.move(1.0); // 恒定力矩 }

模式切换时有个隐藏bug要注意：每次修改controller类型后，必须重新执行init()函数：

// 错误示例：直接修改controller不生效 motor1.controller = MotionControlType::velocity; // 正确做法： motor1.controller = MotionControlType::velocity; motor1.init(); // 关键步骤！

实际项目中，我常用串口指令触发模式切换：

if(Serial.available()){ char cmd = Serial.read(); if(cmd == 'V'){ motor1.controller = MotionControlType::velocity; motor1.init(); } else if(cmd == 'T'){ motor1.controller = MotionControlType::torque; motor1.init(); } }

调试混合模式时，建议先用手机慢动作拍摄电机运转，观察速度突变时的同步性能。我在四轴飞行器项目中发现，两个电机的响应延迟差异超过50ms就会导致机体震荡。

查看全文

http://www.zskr.cn/news/1406804.html