Makerbase SimpleFOC MINI 基本测试

Makerbase_mks

已于 2023-12-26 10:39:45 修改

阅读量1.9k

点赞数 3

分类专栏： Simple FOC 文章标签：经验分享

于 2023-09-24 11:47:23 首次发布

本文链接：https://blog.csdn.net/gjy_skyblue/article/details/133234738

版权

Simple FOC 专栏收录该内容

18 篇文章

订阅专栏

第1部分硬件介绍

1.1 硬件清单

序号	品名	数量
1	SimpleFOC MINI V1.0 主板	1
2	ARDUINO UNO主板	1
3	MKS SF2804电机	1
4	杜邦线	4
5	DC12V电源	1
6	USB 线	1

1.2 硬件连接

1.SimpleFOC MINI V1.0 主板主板与Arduino UNO主板叠接。如下图所示：
在这里插入图片描述
2.USB 线一端连接 Arduino UNO 主板，另一端连接 PC；
3.DC12V 电源连接主板 DC 接口，上电后 PWR 指示灯亮。
4.电机三根相线连接至 SimpleFOC MINI主板 TB_M1 的 3 个接口。
AS5600 传感器 Analog 接口：

序号	Arduino UNO 主板	Arduino UNO 主板
1	A1	OUT
2	5V	5V
3	GND	GND

Analog 接口硬件连接如下图所示：
在这里插入图片描述
5.AS5600 传感器 I2C 接口：

序号	Arduino UNO 主板	Arduino UNO 主板
1	SCL	SCL
2	SDA	SDA
3	5V	5V
3	GND	GND
I2C 接口硬件连接如下图所示：

在这里插入图片描述

第2部分 AS5600 传感器测试

2.1 Analog接口测试

打开Aruino IDE。打开示例，文件 -> 示例-> Simple FOC -> utils -> sensor_test -> magnetic_sensors -> magnetic_sensor_analog_example, 如下图1,2,3,4,5,6,7所示。
analog示例程序如下图所示。
连接开发板后，点击上传，并等待上传完成，如下图1，2所示。
打开串口监视器，可以监测电机的位置以及转速，如下图1，2所示。
转动电机，可以发现电机位置与转速发生改变，如下图3所示。
正转一圈约数值增加6.28（2π），反转一圈数值减少6.28（2π）。

2.2 I2C接口测试

打开示例：文件->示例-> Simple FOC -> utils -> sensor_test -> magnetic_sensors -> magnetic_sensor_i2c_example，如下图1，2，3，4，5，6，7所示。
I2C示例程序如下图所示。
连接开发板后，点击上传，并等待上传完成。
打开串口监视器，可以监测电机的位置以及转速，如下图1，2所示。
转动电机，可以发现电机位置与转速发生改变，如下图3所示。
正转一圈约数值增加6.28（2π），反转一圈数值减少6.28（2π）。

第3部分闭环控制测试

3.1 闭环位置测试

打开示例：文件 -> 示例 -> Simple FOC -> motion_control -> position_motion_control -> magnetic_sensor -> angle_control，如下图1，2，3，4，5，6，7所示。
修改文件，如下图所示。
第 13 行，用“//”屏蔽，如下图 1 所示。
如果用 I2C 接口则需要：第 15 行，删除“//”，取消屏蔽，如下图 1 所示。如果用 Analog 接口则需要：第 17 行，删除“//”，取消屏蔽。
第 20 行，BLDCMotor motor = BLDCMotor(7);如下图 2 所示。第 21 行，BLDCDriver3PWM driver = BLDCDriver3PWM(11,10,9,8);如下图 3 所示。
第 56 行，motor.PID_velocity.P = 0.1;如下图 4 所示。
第 57 行，motor.PID_velocity.I = 1;如下图 5 所示。
第 60 行，motor.voltage_limit = 1; 如下图 6 所示。。
连接开发板后，上传代码，并等待上传完成。
打开串口监视器，等待完成初始化，如下图1所示。
输入位置信息 T62.8，并点击发送，如下图1，2所示。
正转一圈约数值增加6.28（2π），反转一圈数值减少6.28（2π）。
可观察到电机转动约10圈，并返回位置信息，如下图3所示。
输入不同位置信息，可观察电机转动，并停在不同位置。
用手拨动电机会发现有阻力，松手后电机会返回原先的位置。

3.2 闭环速度测试

打开示例：文件 -> 示例 -> Simple FOC -> motion_control -> velocity_motion_control -> magnetic_sensor -> velocity_control，如下图1，2，3，4，5，6，7所示。
修改文件，如下图所示。
第 13 行，用“//”屏蔽，如下图 1 所示。
如果用 I2C 接口则需要：第 15 行，删除“//”，取消屏蔽，如下图 1 所示。如果用 Analog 接口则需要：第 17 行，删除“//”，取消屏蔽。
第 20 行，BLDCMotor motor = BLDCMotor(7);如下图 2 所示。第 21 行，BLDCDriver3PWM driver = BLDCDriver3PWM(11,10,9,8);如下图 3 所示。
第 56 行，motor.PID_velocity.P = 0.1;如下图 4 所示。
第 57 行，motor.PID_velocity.I = 1;如下图 5 所示。
第 60 行，motor.voltage_limit = 1; 如下图 6 所示。
连接开发板后，上传代码，并等待上传完成。
打开串口监视器，等待完成初始化，如下图1所示。
输入速度信息 T2，并点击发送，如下图1，2所示。
可观察到电机会以2圈/秒的转速转动，并返回转速信息，如下图3所示。
输入不同转速信息，可观察电机以不同转速转动。