前言&&准备材料

我这里用的控制器是esp32，它的adc采集器分辨率是12位，工作电压是3.3V。因此我们读取到的模拟数值0~4096就是对应的0~3.3V。

这里我的ina240型号是I240A2。也就是说ina240的增益是50V/V。

我的驱动器型号是simplefoc v0.2。采用内置电流采样，具体电流采样电路如下图：

双向

arduino程序

/**使用电压控制回路的扭矩控制示例。大多数低端无刷电机驱动器没有电流测量功能，因此SimpleFOC为您提供了一种通过设置电机电压而不是电流来控制电机扭矩的方法。这使无刷直流电机有效地成为直流电机，您可以以相同的方式使用它。
*/
// IN1     pwm1    9  27
// IN2     pwm2    6  26
// IN3     pwm3    5  25
// INH1   enable1  8  12
// INH2   enable2  7  13
// INH3   enable3  4  14
//in-line current sense - phase 1/A 35
//in-line current sense - phase 1/C 34#include <SimpleFOC.h>class LowPassFilte {public:LowPassFilte(float Tf);//低通滤波器时间常量~LowPassFilte() = default;float operator() (float x);float Tf; //!< 低通滤波器时间常量protected:unsigned long timestamp_prev;  //!< 上次执行时间戳float y_prev; //!< 经过上次执行后过滤到的值
};LowPassFilte::LowPassFilte(float time_constant): Tf(time_constant), y_prev(0.0f)
{timestamp_prev = micros();
}float LowPassFilte::operator() (float x)
{unsigned long timestamp = micros();float dt = (timestamp - timestamp_prev) * 1e-6f;if (dt < 0.0f || dt > 0.5f)dt = 1e-3f;float alpha = Tf / (Tf + dt);float y = alpha * y_prev + (1.0f - alpha) * x;y_prev = y;timestamp_prev = timestamp;return y;
}LowPassFilte LF_a(0.01);//原始数据滤波器
LowPassFilte LF_b(0.01);//A相电流滤波器
LowPassFilte LF_c(0.01);//C相电流滤波器//AS5600编码器支持spi，iic和模拟量三种数据传输方式，这里用iic（同时也是最常用的方式）
// magnetic sensor instance - I2C
MagneticSensorI2C sensor = MagneticSensorI2C(AS5600_I2C);
TwoWire I2Cone = TwoWire(0);// BLDC motor & driver instance
BLDCMotor motor = BLDCMotor(11);
BLDCDriver3PWM driver = BLDCDriver3PWM(27, 26, 25, 12, 13, 14);InlineCurrentSense Cs_motor(0.001, 50.0, 35, 36, 34);// voltage set point variable
float target_voltage = 5.0;
// instantiate the commander
Commander command = Commander(Serial);
void doTarget(char* cmd) {command.scalar(&target_voltage, cmd);
}void setup() {// initialise magnetic sensor hardwareI2Cone.begin(18, 5, 400000);sensor.init(&I2Cone);// link the motor to the sensormotor.linkSensor(&sensor);// power supply voltagedriver.voltage_power_supply = 12;driver.init();motor.linkDriver(&driver);// aligning voltagemotor.voltage_sensor_align = 5;// choose FOC modulation (optional)motor.foc_modulation = FOCModulationType::SpaceVectorPWM;// set motion control loop to be usedmotor.controller = MotionControlType::torque;// use monitoring with serialSerial.begin(115200);// comment out if not neededmotor.useMonitoring(Serial);// initialize motormotor.init();// align sensor and start FOCmotor.initFOC();// add target command Tcommand.add('T', doTarget, "target voltage");Serial.println(F("Motor ready."));Serial.println(F("Set the target voltage using serial terminal:"));_delay(1000);Cs_motor.init();
}void loop() {// main FOC algorithm function// the faster you run this function the better// Arduino UNO loop  ~1kHz// Bluepill loop ~10kHzmotor.loopFOC();// Motion control function// velocity, position or voltage (defined in motor.controller)// this function can be run at much lower frequency than loopFOC() function// You can also use motor.move() and set the motor.target in the codemotor.move(target_voltage);// Cs_motor.getPhaseCurrents();Serial.print(LF_b((Cs_motor.getPhaseCurrents()).a));Serial.print(",");Serial.println(LF_c((Cs_motor.getPhaseCurrents()).c));//  Serial.print(LF_a(analogRead(35)));
//  Serial.print(",");
//  Serial.print(LF_b((3.3 * ((float)analogRead(35) - 1930) / 4096.0) * 20.0));
//  Serial.print(",");
//  Serial.println(LF_c((-3.3 * ((float)analogRead(34) - 1930) / 4096.0) * 20.0));// user communicationcommand.run();
}

串口打印效果：

用Baize_Foc的测试代码

/**使用电压控制回路的扭矩控制示例。大多数低端无刷电机驱动器没有电流测量功能，因此SimpleFOC为您提供了一种通过设置电机电压而不是电流来控制电机扭矩的方法。这使无刷直流电机有效地成为直流电机，您可以以相同的方式使用它。
*/
// IN1     pwm1    9  27
// IN2     pwm2    6  26
// IN3     pwm3    5  25
// INH1   enable1  8  12
// INH2   enable2  7  13
// INH3   enable3  4  14
//in-line current sense - phase 1/A 35
//in-line current sense - phase 1/C 34#include <SimpleFOC.h>class LowPassFilte {public:LowPassFilte(float Tf);//低通滤波器时间常量~LowPassFilte() = default;float operator() (float x);float Tf; //!< 低通滤波器时间常量protected:unsigned long timestamp_prev;  //!< 上次执行时间戳float y_prev; //!< 经过上次执行后过滤到的值
};LowPassFilte::LowPassFilte(float time_constant): Tf(time_constant), y_prev(0.0f)
{timestamp_prev = micros();
}float LowPassFilte::operator() (float x)
{unsigned long timestamp = micros();float dt = (timestamp - timestamp_prev) * 1e-6f;if (dt < 0.0f || dt > 0.5f)dt = 1e-3f;float alpha = Tf / (Tf + dt);float y = alpha * y_prev + (1.0f - alpha) * x;y_prev = y;timestamp_prev = timestamp;return y;
}LowPassFilte LF_a(0.01);//原始数据滤波器
LowPassFilte LF_b(0.01);//A相电流滤波器
LowPassFilte LF_c(0.01);//C相电流滤波器//AS5600编码器支持spi，iic和模拟量三种数据传输方式，这里用iic（同时也是最常用的方式）
// magnetic sensor instance - I2C
MagneticSensorI2C sensor = MagneticSensorI2C(AS5600_I2C);
TwoWire I2Cone = TwoWire(0);// BLDC motor & driver instance
BLDCMotor motor = BLDCMotor(11);
BLDCDriver3PWM driver = BLDCDriver3PWM(17, 18, 19, 21, 22, 23);InlineCurrentSense Cs_motor(0.001, 50.0, 34, 35);// voltage set point variable
float target_voltage = 5.0;
// instantiate the commander
Commander command = Commander(Serial);
void doTarget(char* cmd) {command.scalar(&target_voltage, cmd);
}void setup() {// initialise magnetic sensor hardwareI2Cone.begin(26, 25, 400000);sensor.init(&I2Cone);// link the motor to the sensormotor.linkSensor(&sensor);// power supply voltagedriver.voltage_power_supply = 12;driver.init();motor.linkDriver(&driver);// aligning voltagemotor.voltage_sensor_align = 5;// choose FOC modulation (optional)motor.foc_modulation = FOCModulationType::SpaceVectorPWM;// set motion control loop to be usedmotor.controller = MotionControlType::torque;// use monitoring with serialSerial.begin(115200);// comment out if not neededmotor.useMonitoring(Serial);// initialize motormotor.init();// align sensor and start FOCmotor.initFOC();// add target command Tcommand.add('T', doTarget, "target voltage");Serial.println(F("Motor ready."));Serial.println(F("Set the target voltage using serial terminal:"));_delay(1000);Cs_motor.init();
}void loop() {// main FOC algorithm function// the faster you run this function the better// Arduino UNO loop  ~1kHz// Bluepill loop ~10kHzmotor.loopFOC();// Motion control function// velocity, position or voltage (defined in motor.controller)// this function can be run at much lower frequency than loopFOC() function// You can also use motor.move() and set the motor.target in the codemotor.move(target_voltage);// Cs_motor.getPhaseCurrents();
//  Serial.print(LF_b((Cs_motor.getPhaseCurrents()).a));
//  Serial.print(",");
//  Serial.println(LF_c((Cs_motor.getPhaseCurrents()).c));//  Serial.print(LF_a(analogRead(35)));
//  Serial.print(",");Serial.print(LF_b((3.3 * ((float)analogRead(35) - 1930) / 4096.0) * 20.0));Serial.print(",");Serial.println(LF_c((-3.3 * ((float)analogRead(34) - 1930) / 4096.0) * 20.0));// user communicationcommand.run();
}

参考链接：

1.【INA240】产品参数介绍、INA240数据手册、中英文PDF资料下载-TI资料-电子发烧友

INA240三相无刷电机电流采样实例（arduino）相关推荐

SimpleFOC移植STM32（五）—— 电流采样及其变换
目录一.原理说明 1.1.电流采样 1.1.1.为什么要采样电流 1.1.2.电流采样方式 1.1.2.1.低侧电流采样 1.1.2.2.高侧电流采样 1.1.2.3.内置电流采样 1.2.电流变换 ...
FOC 电流采样为什么不准？你忽略了这个细节
文章目录 1 引言 2 延迟类型及典型时间 3 延迟源详细分析 3.1PWM死区时间插入 3.2 光耦延迟和预驱动器延迟 3.3晶体管开关延迟 3.4其他延迟 4 结语在电机驱动的FOC控制开发过程 ...
基于PSoC4的矢量控制方案：电流采样
Cypress在2013年3月推出PSoC4可编程片上系统架构, 它将赛普拉斯一流的PSoC模拟和数字架构以及业界领先的CapSense电容式触摸技术同ARM的低功耗Cortex-M0内核完美相结合. ...
FOC——13.电流采样与运放电路
文章目录 1.电流采样方案 1.1.不同数量的采样电阻方案 1.2.采样电阻的位置 1.3.采样窗口问题 2.运放电路 2.1.运放和比较器 2.2.差分放大 2.3.偏置电压 2.4.运放放大倍数的 ...
FOC 电流采样方案对比（单电阻/双电阻/三电阻）
原文:https://www.cnblogs.com/unclemac/p/12783352.html 文章目录 1 电流采样的作用 2 硬件架构 3 采样关键 4 采样方案 5 三电阻采样 5.1 ...
双电阻差分电流采样_矢量控制中的常见电流检测方式
矢量控制技术中,一个关键的技术环节是相电流的采集和重构.电流采集方式有多种,但是鉴于成本和易用性的考虑,目前应用较多的电流采集方式只有三种.单电阻法.双电阻法以及三电阻法. 1 单电阻采集方案,成本低 ...
永磁同步电机控制系统——电流采样
文章目录前言一.电流采样注意事项二.电流采样时刻 1. 规则通道 2. 注入通道总结前言在电机控制中,电流环是最重要的环节,是整个控制系统的核心.电流环涉及一个最基础的问题,那就是电流采样 ...
基于FPGA的FOC电流采样Bug调试记录
#基于FPGA的FOC电流采样Bug调试记录博主在调试FOC闭环控制中遇到了一个bug,冥思苦想两三天,最终一步步地调试时序,最终找到了bug,在调试过程中学会了debug的思想,也明白了调试过程中 ...
三相无刷电机驱动STC
三相无刷电机驱动-STC8H1K28 /**********************************************/ void main(void) {u8 i;u16 j;P2n_ ...

INA240三相无刷电机电流采样实例（arduino）

前言&&准备材料

arduino程序

用Baize_Foc的测试代码

参考链接：

INA240三相无刷电机电流采样实例（arduino）相关推荐

最新文章

热门文章