【花雕学编程】Arduino FOC 之二轴绘图机器人添加笔尖控制功能

在这里插入图片描述

Arduino是一个开放源码的电子原型平台,它可以让你用简单的硬件和软件来创建各种互动的项目。Arduino的核心是一个微控制器板,它可以通过一系列的引脚来连接各种传感器、执行器、显示器等外部设备。Arduino的编程是基于C/C++语言的,你可以使用Arduino IDE(集成开发环境)来编写、编译和上传代码到Arduino板上。Arduino还有一个丰富的库和社区,你可以利用它们来扩展Arduino的功能和学习Arduino的知识。

Arduino的特点是:
1、开放源码:Arduino的硬件和软件都是开放源码的,你可以自由地修改、复制和分享它们。
2、易用:Arduino的硬件和软件都是为初学者和非专业人士设计的,你可以轻松地上手和使用它们。
3、便宜:Arduino的硬件和软件都是非常经济的,你可以用很低的成本来实现你的想法。
4、多样:Arduino有多种型号和版本,你可以根据你的需要和喜好来选择合适的Arduino板。
5、创新:Arduino可以让你用电子的方式来表达你的创意和想象,你可以用Arduino来制作各种有趣和有用的项目,如机器人、智能家居、艺术装置等。

在这里插入图片描述
Arduino FOC(Field Oriented Control,场向量控制)是一种先进的电机控制技术,它允许精确控制电机的转矩和速度。这种控制技术特别适用于无刷直流电机(BLDC)和步进电机。在Arduino平台上实现FOC可以提供平滑的运行和高度的扭矩、速度和位置控制,它通过精确控制电机的电流和电压来实现高效率、高精度和低噪声的操作。

主要特点:
1、高性能电机控制:FOC是一种高级的电机控制算法,可以精准控制PMSM(永磁同步电机)和BLDC(无刷直流)电机,实现平滑的转速和扭矩输出。
2、闭环控制架构:FOC采用闭环反馈控制,通过检测电机的位置和速度数据,实时调整输出电压和电流,确保电机动作符合预期。
3、模块化设计:Arduino FOC库采用模块化设计,包含电机建模、速度/位置/电流控制环、PWM生成等子模块,用户可根据需求灵活组合使用。
4、可移植性强:Arduino FOC可移植到多种硬件平台,如Arduino、ESP32、STM32与树莓派等,适用于功率从几十瓦到几千瓦的电机系统。
5、参数自动识别:FOC库具有自动识别电机参数的功能,可以大幅简化电机控制系统的调试过程。

应用场景:
1、工业自动化:在工厂的机器人、传送带、CNC加工设备等领域,Arduino FOC可提供高性能的电机控制解决方案。
2、电动车辆:电动自行车、电动汽车、电动叉车等车载电机驱动系统,可以采用Arduino FOC进行精准控制。
3、家用电器:在电风扇、洗衣机、空调等家用电器中,Arduino FOC可实现细腻的电机速度和扭矩控制。
4、航模和无人机:航模飞机、无人机等对电机控制性能要求很高的领域,Arduino FOC能够提供高精度的电机驱动。
5、机器人:工业机器人、服务机器人、仿生机器人等对电机控制性能有严格要求的领域,Arduino FOC是一个不错的选择。

需要注意的事项:
1、硬件要求:Arduino FOC对控制器的性能(如CPU频率、RAM/ROM容量等)有一定要求,需要选择合适的硬件平台。
2、调试复杂性:FOC算法涉及电机建模、坐标变换、PI调节器等诸多环节,调试和调优过程相对复杂,需要一定的专业知识。
3、噪声抑制:电机驱动电路容易产生噪声干扰,需要采取合理的屏蔽和滤波措施,确保信号质量。
4、安全防护:电机驱动系统可能会产生过电流、过压等故障,需要配备可靠的保护电路,确保人身和设备安全。
5、系统集成:将Arduino FOC集成到完整的电机驱动系统中时,需要考虑机械、电力、控制等各个方面的协调配合。

总的来说,Arduino FOC是一种功能强大、性能优秀的电机控制解决方案,适用于工业自动化、电动车辆、家用电器等众多领域。但在硬件选型、算法调试、噪声抑制和安全防护等方面都需要谨慎考虑,以确保系统稳定可靠地运行。

附录:系列目录
1、Arduino FOC的特点、场景和使用事项
http://t.csdnimg.cn/WZhYL
2、Arduino FOC 之简单FOC库 - 跨平台的无刷直流和步进电机FOC实现
http://t.csdnimg.cn/p9ADE
3、Arduino FOC 之无刷直流电机速度控制
http://t.csdnimg.cn/gZ7CY
4、Arduino FOC 之步进电机位置控制
http://t.csdnimg.cn/VYbIb
5、Arduino FOC 之无刷直流电机电流控制
http://t.csdnimg.cn/wWGVu
6、Arduino FOC 之 SimpleFOC 库的主要函数
http://t.csdnimg.cn/S26MC
7、Arduino FOC 之 ArduinoFOC库的核心函数
http://t.csdnimg.cn/3VLzF
8、Arduino FOC 之传感器校准
http://t.csdnimg.cn/NS3TR
9、Arduino FOC 之SimpleFOCShield v2.0.4无刷电机驱动板
http://t.csdnimg.cn/g9mP7
10、Arduino FOC 之 AS5600角度读取
http://t.csdnimg.cn/dmI6F
11、Arduino FOC 之 FOC算法
http://t.csdnimg.cn/ENxc0
12、Arduino FOC 之 SimpleFOC库的适配电机方案
http://t.csdnimg.cn/QdH6k

在这里插入图片描述
1、主要特点:
二轴机械结构: 该方案针对具有两个旋转关节的二轴绘图机器人进行设计,可实现平面内的绘图功能。
Arduino FOC集成: Arduino FOC库为二轴绘图机器人提供了全面的电机驱动和运动控制支持。
笔尖控制功能: 该方案添加了对笔尖升降的控制功能,能实现在绘图过程中精准地落笔和抬笔。
实时轨迹规划: 算法采用数学建模和坐标变换的方式,生成平滑、连续的绘图轨迹。
可视化界面: 该方案包含了基于Arduino的二维可视化界面,能够实时显示绘图机器人的运动状态和绘图轨迹。

2、应用场景:
自动绘图: 该方案可应用于各类自动绘图机器人,如广告制作、工艺品制作、教育培训等领域。
艺术创作: 该方案还可应用于一些艺术创作机器人,如机器人绘画、雕刻等。
教学实验: 该方案可用于工程教育和机器人实验中,作为二轴绘图机器人的教学演示。
产品展示: 可以将该绘图机器人应用于产品展示、场景布置等场合,提高展示效果。

3、需要注意的事项:
正逆运动学: 该方案需要建立二轴绘图机器人的正逆运动学模型,确保绘图轨迹的精确性。
电机参数标定: 两个旋转关节电机的电气参数和机械参数需要精确标定,以优化FOC控制效果。
笔尖控制设计: 笔尖升降机构的动力学特性、响应速度等需要仔细设计和优化。
轨迹规划算法: 绘图轨迹规划算法需要考虑绘图速度、加速度等因素,生成平滑连续的轨迹。
实时性能: 该方案需要具备高速的数据采集、运动规划和驱动响应能力,才能实现真正的实时控制。
安全防护: 算法还需要具备可靠的过载、碰撞等安全保护机制,杜绝意外事故发生。
界面交互: 二维可视化界面的设计需要考虑人机交互的友好性和直观性,满足不同使用场景的需求。

总的来说,基于Arduino FOC的二轴绘图机器人添加笔尖控制功能,在自动绘图、艺术创作、教学实验、产品展示等领域都有广泛应用前景。但在正逆运动学建模、电机参数标定、笔尖控制设计、轨迹规划算法、实时性能、安全防护、界面交互等方面,仍需要格外重视和谨慎处理。

在这里插入图片描述
1、基本笔尖控制

#include <SimpleFOC.h>
#include <Servo.h>

// 定义电机和编码器
BLDCMotor motorX = BLDCMotor(7);
BLDCMotor motorY = BLDCMotor(7);
BLDCDriver3PWM driverX = BLDCDriver3PWM(9, 10, 11);
BLDCDriver3PWM driverY = BLDCDriver3PWM(3, 5, 6);
Encoder encoderX = Encoder(2, 3, 500);
Encoder encoderY = Encoder(18, 19, 500);

// 定义笔尖控制伺服
Servo penServo;

void setup() {
  // 初始化电机
  motorX.linkDriver(&driverX);
  motorY.linkDriver(&driverY);
  motorX.linkSensor(&encoderX);
  motorY.linkSensor(&encoderY);
  motorX.controller = MotionControlType::angle;
  motorY.controller = MotionControlType::angle;
  motorX.init();
  motorY.init();

  // 初始化伺服
  penServo.attach(6); // 连接伺服到数字引脚6
}

void loop() {
  // 设置电机目标位置
  motorX.move(45);
  motorY.move(30);

  // 控制笔尖
  penServo.write(90); // 笔尖放下
  delay(1000);
  penServo.write(0);  // 笔尖抬起
  delay(1000);
}

2、绘图路径控制

#include <SimpleFOC.h>
#include <Servo.h>

// 定义电机和编码器
BLDCMotor motorX = BLDCMotor(7);
BLDCMotor motorY = BLDCMotor(7);
BLDCDriver3PWM driverX = BLDCDriver3PWM(9, 10, 11);
BLDCDriver3PWM driverY = BLDCDriver3PWM(3, 5, 6);
Encoder encoderX = Encoder(2, 3, 500);
Encoder encoderY = Encoder(18, 19, 500);

// 定义笔尖控制伺服
Servo penServo;

void setup() {
  // 初始化电机
  motorX.linkDriver(&driverX);
  motorY.linkDriver(&driverY);
  motorX.linkSensor(&encoderX);
  motorY.linkSensor(&encoderY);
  motorX.controller = MotionControlType::angle;
  motorY.controller = MotionControlType::angle;
  motorX.init();
  motorY.init();

  // 初始化伺服
  penServo.attach(6); // 连接伺服到数字引脚6
}

void loop() {
  // 绘制路径
  for (int i = 0; i <= 100; i++) {
    motorX.move(i * 0.5);
    motorY.move(i * 0.3);
    penServo.write(90); // 笔尖放下
    delay(10);
  }
  penServo.write(0); // 笔尖抬起
  delay(1000);
}

3、复杂图形绘制

#include <SimpleFOC.h>
#include <Servo.h>

// 定义电机和编码器
BLDCMotor motorX = BLDCMotor(7);
BLDCMotor motorY = BLDCMotor(7);
BLDCDriver3PWM driverX = BLDCDriver3PWM(9, 10, 11);
BLDCDriver3PWM driverY = BLDCDriver3PWM(3, 5, 6);
Encoder encoderX = Encoder(2, 3, 500);
Encoder encoderY = Encoder(18, 19, 500);

// 定义笔尖控制伺服
Servo penServo;

void setup() {
  // 初始化电机
  motorX.linkDriver(&driverX);
  motorY.linkDriver(&driverY);
  motorX.linkSensor(&encoderX);
  motorY.linkSensor(&encoderY);
  motorX.controller = MotionControlType::angle;
  motorY.controller = MotionControlType::angle;
  motorX.init();
  motorY.init();

  // 初始化伺服
  penServo.attach(6); // 连接伺服到数字引脚6
}

void loop() {
  // 绘制复杂图形
  drawLine(0, 0, 50, 50);
  drawLine(50, 50, 100, 0);
  drawLine(100, 0, 0, 0);
}

void drawLine(float x0, float y0, float x1, float y1) {
  int steps = 100;
  for (int i = 0; i <= steps; i++) {
    float x = x0 + (x1 - x0) * i / steps;
    float y = y0 + (y1 - y0) * i / steps;
    motorX.move(x);
    motorY.move(y);
    penServo.write(90); // 笔尖放下
    delay(10);
  }
  penServo.write(0); // 笔尖抬起
}

要点解读
电机和伺服初始化:每个案例都展示了如何初始化电机、驱动器、编码器和伺服电机。这是实现FOC控制和笔尖控制的基础步骤。
目标位置设置:通过设置电机的目标位置,机器人可以按照预定的路径进行运动。案例一展示了简单的目标位置设置,案例二展示了路径控制,案例三展示了复杂图形的绘制。
笔尖控制:每个案例都展示了如何通过伺服电机控制笔尖的上下移动。笔尖的控制对于绘图机器人的精确绘制非常重要。
路径规划:案例二和案例三展示了如何通过循环逐步调整电机的位置,实现路径规划和复杂图形的绘制。这种方法确保了绘图的平滑性和连续性。
延时控制:在每个案例中,延时函数(delay())用于控制电机和伺服的动作节奏,确保每一步的执行时间一致。这对于实现平滑的绘图轨迹非常重要。

在这里插入图片描述
4、使用伺服电机控制笔尖

#include <SimpleFOC.h>
#include <Servo.h>

// 电机定义
BLDCMotor motor1(14);
BLDCMotor motor2(15);

// 笔尖伺服电机定义
Servo penServo;
int penPos = 0;    // 笔尖位置

void setup() {
  // 电机初始化
  motor1.init();
  motor2.init();
  
  // 笔尖伺服初始化
  penServo.attach(9);
  penServo.write(penPos);
}

void loop() {
  // 电机控制
  motor1.move(x);
  motor2.move(y);
  
  // 笔尖控制
  if (penPos < 180) {
    penPos += 1;
  } else {
    penPos = 0;
  }
  penServo.write(penPos);
  delay(50);
}

要点解释:
使用SimpleFOC库控制无刷直流电机,实现二轴绘图机器人的运动。
通过Servo库控制一个伺服电机,用于上下移动绘图笔尖。
在loop()函数中,先控制电机运动,再控制笔尖伺服电机的角度,实现绘图过程中笔尖的升降。
通过设置penPos变量,让笔尖在0到180度之间循环升降。
适当的delay()函数可以控制笔尖升降的速度,从而实现平滑的绘图效果。

5、使用数字IO控制笔尖

#include <SimpleFOC.h>

// 电机定义
BLDCMotor motor1(14);
BLDCMotor motor2(15);

// 笔尖控制IO引脚
int penPin = 9;
bool penState = false;

void setup() {
  // 电机初始化
  motor1.init();
  motor2.init();
  
  // 笔尖控制IO初始化
  pinMode(penPin, OUTPUT);
  digitalWrite(penPin, penState);
}

void loop() {
  // 电机控制
  motor1.move(x);
  motor2.move(y);
  
  // 笔尖控制
  if (penState == false) {
    digitalWrite(penPin, HIGH);
    penState = true;
  } else {
    digitalWrite(penPin, LOW);
    penState = false;
  }
  delay(500);
}

要点解释:
与案例一类似,使用SimpleFOC库控制二轴电机实现绘图机器人的运动。
通过一个数字IO引脚控制笔尖的升降,不需要额外的伺服电机。
在loop()函数中,先控制电机运动,再切换笔尖IO引脚的状态,实现绘图过程中笔尖的升降。
通过不断切换penState变量的值,让笔尖在抬起和落下之间切换。
适当的delay()函数可以控制笔尖升降的频率,从而实现平滑的绘图效果。

6、:使用模拟IO控制笔尖压力

#include <SimpleFOC.h>
#include <Adafruit_ADS1X15.h>

// 电机定义
BLDCMotor motor1(14);
BLDCMotor motor2(15);

// 笔尖压力传感器
Adafruit_ADS1115 ads;
int16_t adc0, adc1, adc2, adc3;
int penPressure = 0;

void setup() {
  // 电机初始化
  motor1.init();
  motor2.init();
  
  // 压力传感器初始化
  ads.begin();
}

void loop() {
  // 电机控制
  motor1.move(x);
  motor2.move(y);
  
  // 读取压力传感器值
  adc0 = ads.readADC_SingleEnded(0);
  adc1 = ads.readADC_SingleEnded(1);
  adc2 = ads.readADC_SingleEnded(2);
  adc3 = ads.readADC_SingleEnded(3);
  penPressure = (adc0 + adc1 + adc2 + adc3) / 4;
  
  // 根据压力值调整笔尖压力
  if (penPressure > 2000) {
    // 增加笔尖压力
  } else if (penPressure < 1000) {
    // 减小笔尖压力
  }
}

要点解释:
与前两个案例类似,使用SimpleFOC库控制二轴电机实现绘图机器人的运动。
通过Adafruit_ADS1X15库读取一个4通道的模拟压力传感器,用于检测笔尖压力。
在loop()函数中,先控制电机运动,然后读取压力传感器的值并计算平均值。
根据压力传感器的值,可以调整笔尖的压力,例如增加或减小压力。
可以通过调整压力阈值,实现不同的绘图效果,如浓淡线条变化等。

注意,以上案例只是为了拓展思路,仅供参考。它们可能有错误、不适用或者无法编译。您的硬件平台、使用场景和Arduino版本可能影响使用方法的选择。实际编程时,您要根据自己的硬件配置、使用场景和具体需求进行调整,并多次实际测试。您还要正确连接硬件,了解所用传感器和设备的规范和特性。涉及硬件操作的代码,您要在使用前确认引脚和电平等参数的正确性和安全性。

在这里插入图片描述

  • 18
    点赞
  • 10
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

驴友花雕

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付:¥1
获取中
扫码支付

您的余额不足,请更换扫码支付或充值

打赏作者

实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值