Arduino三轮全向小车（二）：编码马达的使用

最新推荐文章于 2024-06-02 16:27:25 发布
最新推荐文章于 2024-06-02 16:27:25 发布
阅读量4k 收藏 77
点赞数 19
分类专栏： Arduino 笔记 文章标签： arduino
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/weixin_44845947/article/details/108089245
版权

上一篇文章介绍了编码马达的原理以及特性，本篇话不多说，直接开始实用。

马达控制

观察以下编码马达的接口图片：（原谅我这样拍照，实在懒得把马达拆下来了）

总共六根线，其中两根是控制马达转速以及转向的，也就是说和普通马达完全相同，你需要找到这两根线，应该会有注明，例如我的马达上标注为：马达线1和马达线2。将这两根线接入马达驱动板，这里我推荐TB6612模块，小巧又强大，也不算很贵，但是使用时一定要小心，我买回来的第一个，刚一接线就烧了（不怪人家，是我把12v接上了5v的口）。

关于TB6612的使用，这里简单介绍一下，马达的两根线应该接入AO1和AO2（或BO1和BO2），PWMA（或PWMB）接入Arduino的某一个PWM端口，这个是管马达速度的。UNO的PWM口其实蛮少的，做三轮车很吃紧，我直接用了Mega。AIN1和AIN2（或BIN1和BIN2）分别接入Arduino的非PWM的数字口，这两个是管马达转向的。剩下的口一定要注意，千万别接错，否则就像我一样，VM和随便一个GND分别接大电源的正负极，大电源电压尽量不要高于12V，不要低于8V，最好用个稳压模块。VCC和另外一个GND口分别接入Arduino的+5v和GND口。STBY可以直接接一个+5V口，也可以接入数字口然后给高电平，这是使能端。

ok，终于把这个复杂的接口讲完了，其实这一部分普通马达和编码马达都是一样的，代码也都一样，下面是我的习惯写法：

void MotorControl(float sp){
	if (sp > 0) {
    	digitalWrite(MOTOR_PIN1, HIGH);
    	digitalWrite(MOTOR_PIN2, LOW);
    	analogWrite(MOTOR_SP, sp);
  	} else if (sp < 0) {
    	digitalWrite(MOTOR_PIN1, LOW);
    	digitalWrite(MOTOR_PIN2, HIGH);
    	analogWrite(MOTOR_SP, -1 * sp);
  	} else {
    	digitalWrite(MOTOR_PIN1, LOW);
    	digitalWrite(MOTOR_PIN2, LOW);
  	}
}

其中MOTOR_SP是PWM口，而其他两个则为控制转向的接口。这些都和普通马达一样，也很好理解，这里不再详细解释。
推荐你把它写成个头文件放库里，反正只要是做小车，都会用到它。

读取码盘数据

接下来这部分才是使用编码马达的“重头戏”：读取码盘的数据。根据之前我们理解的码盘的原理，我们只需要测量A相和B相的频率以及相位差，即可测算出马达的转速和转向。马达的另外四根线，一根是A相，一根是B相，分别接入Arduino的中断端口（Mega的中断口有2, 3, 18, 19, 20, 21；UNO只有2，3，如果是三轮车，看上去只能用Mega了）和其他数字口，另外两根则是编码器的5V和GND，接Arduino的5V和GND即可。

实际上码盘返回的是计数，频率需要自己测算，这就涉及到Arduino的一个功能：中断。就好比你正在你家看电影，做着自己的事情，突然你朋友敲门来找你玩，于是你暂停电影，去给朋友开门并把他打发走，又回来继续看电影。这就是中断。Arduino可以运行中，因为某些触发时间而暂停，然后去执行其他任务，执行结束后在回来继续当前的程序。

Arduino中有一个函数是

attachInterrupt(digitalPinToInterrupt(pin),ISR,mode);

其中各参数分别为：

  • digitalPinToInterrupt(pin)：中断端口号（并不是真正的端口号）
  • ISR：中断时要执行的程序
  • mode：有以下三种值：
    • LOW：在引脚为低电平时触发
    • HIGH：在引脚为高电平时触发
    • CHANGE：在引脚电平状态改变时触发

如果学过数电，可以结合触发器触发条件的知识理解一下上面的触发是怎么个原理。

这里有个很狗的一点是，中断端口号并不是真正的引脚编号，也就是你插了Mega的19引脚，实际上你应该写4号，对应关系如下：
引脚对应
或者也可以直接写digitalPinToInterrupt(19)，但无形中多写了好多哇…（狗头）

我们的思路是，当A相的引脚发生变化时（CHANGE），中断主程序，根据我们上一篇文章所说的原理：

当A相上行时可以看到B相是高电平，我们定义这时电机为正转，反转时，它们的相位差是原来的相反数，也就是负九十度。这时，A相上行时B相为低电平，这样即可简单地判断出电机转动方向。

也就是说，要判断此时电机的转向，我们需要先判断A相是上行还是下行，之后在判断此时B相是高电平还是低电平，这个其实很好判断，几个if完事。当我们判断出电机是正转时，我们就让计数变量加1，证明码盘扫过一格，否则减1，即反转扫过一格。代码如下：

void Count() {
  if (digitalRead(pinA) == LOW) {
    if (digitalRead(pinB) == HIGH) pps++;
    else if (digitalRead(pinB) == LOW) pps--;
  } else {
    if (digitalRead(pinB) == HIGH) pps--;
    else if (digitalRead(pinB) == LOW) pps++;
  }
}

其中pps即为计数变量，它的含义其实就是码盘转过的格数，如果你知道码盘一圈有几格（比如我的电机是390，一般这个参数会被称为精度），那你就可以算出目前电机转过的角度。

注意把attachInterrupt()放在setup里，比如我的A相接了19，对应的中断口号为4，则我就在setup里这么写：

attachInterrupt(4, Count1, CHANGE);

好了，至此你就已经可以顺利读出码盘数据了，不过不知道你有没有发现这个问题，有了码盘转动的数据，我们也只能算出位移，如何计算速度？

在这里，我们使用另外一种中断：定时中断，也就是每隔一段时间，我就中断主函数，去算一下速度和位移，这会用到一个库：MsTimer（这个库可能需要在网上下载导入，直接百度一波，找不到可以给我留言，留下qq号我发你）。该库中有一个函数是这样的：

MsTimer2::set(t, SpeedDetection);

其中，t为时间间隔，也就是每隔这么多时间中断一次，第二个参数为中断函数名，也就是中断后去执行该函数的内容。看名字我已经取好了：SpeedDetection，速度检测，顾名思义这个函数就是测速度的。

测速度的方法也很简单，我们先用两次间隔的pss之差计算出电机转角，再用该转角除以时间间隔t，即可求出角速度。

float SpeedDetection() {
  detachInterrupt(4);	//先停止另一种中断，以免中断套中断（禁止套娃）
  velocity = (float)pps * (1000 / t) / 780.0;	//测量速度
  m += pps * (1000 / t) * 360 / 780;			//测量转角
    //    Serial.print("Omega：");
    //    Serial.print(velocity);
    //    Serial.print("r/s  Theta:");
    //    Serial.print(m);
    //    Serial.print("°  ");//串口输出调试信息
  }
  pps = 0;		//每次该函数最后将pps清零。
  attachInterrupt(4, Count1, CHANGE);	//不要忘了再打开另一种中断。
}

该函数中的速度和转角计算公式正是考验你数学功底的时候，值得注意的是，虽然我的电机精度为390（也就是码盘一周有390个豁），但是我们在每次A相电平状态改变时，不管上行还是下行都会记一次数，相当于一个豁口我们计两次数，因此真正的精度其实是780。这是在计算时应该注意的。其他没有什么难理解的地方了。

当然之后还需要在setup里写：

MsTimer2::set(t, SpeedDetection);
MsTimer2::start();		//计时开始的意思

OK，大功告成，接下来我们就可以利用起这些数据做些闭环控制算法了，当然最常见的就是PID，这个我留到下一篇文章讲（有可能又会鸽好久，很尴尬，太忙了）。

下面附上整个源码（三轮版本）

#include <motor.h>		//这是我自己写的，在github上https://github.com/mond538/motor
#include <PinChangeInt.h>	//引脚中断库
#include <MsTimer2.h>
//-------------端口定义---------------
#define pinA_1 19			//A相
#define pinB_1 29			//B相
#define MOTOR1_SP 13		//PWM端口
#define MOTOR1_PIN1 27		//IN1
#define MOTOR1_PIN2 28		//IN2

#define pinA_2 2
#define pinB_2 23
#define MOTOR2_SP 11
#define MOTOR2_PIN1 24
#define MOTOR2_PIN2 25

#define pinA_3 3
#define pinB_3 26
#define MOTOR3_SP 12
#define MOTOR3_PIN1 30
#define MOTOR3_PIN2 31
//------------------------------------

motor Motor1(pinA_1, pinB_1, MOTOR1_SP, MOTOR1_PIN1, MOTOR1_PIN2);
motor Motor2(pinA_2, pinB_2, MOTOR2_SP, MOTOR2_PIN1, MOTOR2_PIN2);
motor Motor3(pinA_3, pinB_3, MOTOR3_SP, MOTOR3_PIN1, MOTOR3_PIN2);
//motor类是我自己在motor.h中定义的类，参数均为端口。
volatile long m[3] = {0, 0, 0};
int pps[3] = {0, 0, 0};
float velocity[3] = {0, 0, 0};
int t = 50;

int adjust(int sp) {
	//限制马达最大和最小速度。
  int max_sp = 150;
  if (sp >= max_sp) sp = max_sp;
  else if (sp <= -1 * max_sp) sp = -1 * max_sp;
  if (sp >= -10 && sp <= 10) sp = 0;
  return sp;
}

float SpeedDetection() {
  detachInterrupt(4);
  detachInterrupt(0);
  detachInterrupt(1);
  for (int i = 0; i < 3; i++) {
    velocity[i] = (float)pps[i] * (1000 / t) / 780.0;
    m[i] += pps[i] * (1000 / t) * 360 / 780;
    //    Serial.print("M");
    //    Serial.print(i + 1);
    //    Serial.print(": ");
    //    Serial.print(velocity[i]);
    //    Serial.print("r/s ");
    //    Serial.print(m[i]);
    //    Serial.print("°  ");
  }
  for (int i = 0; i < 3; i++)  pps[i] = 0;
  attachInterrupt(4, Count1, CHANGE);
  attachInterrupt(0, Count2, CHANGE);
  attachInterrupt(1, Count3, CHANGE);
}

void setup() {
  pinMode(pinA_1, INPUT);
  pinMode(pinB_1, INPUT);
  pinMode(MOTOR1_SP, OUTPUT);
  pinMode(MOTOR1_PIN1, OUTPUT);
  pinMode(MOTOR1_PIN2, OUTPUT);

  pinMode(pinA_2, INPUT);
  pinMode(pinB_2, INPUT);
  pinMode(MOTOR2_SP, OUTPUT);
  pinMode(MOTOR2_PIN1, OUTPUT);
  pinMode(MOTOR2_PIN2, OUTPUT);

  pinMode(pinA_3, INPUT);
  pinMode(pinB_3, INPUT);
  pinMode(MOTOR3_SP, OUTPUT);
  pinMode(MOTOR3_PIN1, OUTPUT);
  pinMode(MOTOR3_PIN2, OUTPUT);

  Serial.begin(9600);

  attachInterrupt(4, Count1, CHANGE);
  attachInterrupt(0, Count2, CHANGE);
  attachInterrupt(1, Count3, CHANGE);
  
  MsTimer2::set(t, SpeedDetection);
  MsTimer2::start();
}

void loop() {
  MotorControlTri(1, 1, 1);
  delay(t);
  //随便跑一跑做调试
}

void MotorControlTri(float sp1, float sp2, float sp3) {
  sp1 = adjust(sp1);
  sp2 = adjust(sp2);
  sp3 = adjust(sp3);
  Motor1.MotorControl(sp1);
  Motor2.MotorControl(sp2);
  Motor3.MotorControl(sp3);
  //该MotorControl方法也是在我自己写的库函数中，参数为速度，正负代表方向
}

void Count1() {
  if (digitalRead(pinA_1) == LOW) {
    if (digitalRead(pinB_1) == HIGH) pps[0]++;
    else if (digitalRead(pinB_1) == LOW) pps[0]--;
  } else {
    if (digitalRead(pinB_1) == HIGH) pps[0]--;
    else if (digitalRead(pinB_1) == LOW) pps[0]++;
  }
}
void Count2() {
  if (digitalRead(pinA_2) == LOW) {
    if (digitalRead(pinB_2) == HIGH) pps[1]++;
    else if (digitalRead(pinB_2) == LOW) pps[1]--;
  } else {
    if (digitalRead(pinB_2) == HIGH) pps[1]--;
    else if (digitalRead(pinB_2) == LOW) pps[1]++;
  }
}
void Count3() {
  if (digitalRead(pinA_3) == LOW) {
    if (digitalRead(pinB_3) == HIGH) pps[2]++;
    else if (digitalRead(pinB_3) == LOW) pps[2]--;
  } else {
    if (digitalRead(pinB_3) == HIGH) pps[2]--;
    else if (digitalRead(pinB_3) == LOW) pps[2]++;
  }
}

下一篇：PID算法简介

Mond
关注
  • 19
    点赞
  • 踩
  • 77
    收藏
    觉得还不错? 一键收藏
  • 22
    评论
专栏目录
arduino 1 读取电机编码器值
Steve_Kung的博客
09-07 9109
#define BAUDRATE 115200 #define LEFT 0 //左轮 #define RIGHT 1 //右轮 #define FORWARDS true #define BACKWARDS false //如果一个变量所在的代码段可能会意外地导致变量值改变那此变量应声明为volatile， //比如并行多线程等。在ardui...
1.三轮全向移动底盘运动学解析
热门推荐
ycy_dy的博客
10-26 2万+
三轮图片示意图 2.三轮理解 三轮全向移动底盘因其良好的运动性并且结构简单，近年来备受欢迎。三个轮子互相间隔120°，每个全向轮由若干个小滚轮组成，各个滚轮的母线组成一个完整的圆。机器人既可以沿轮面的切线方向移动，也可以沿轮子的轴线方向移动，这两种运动的组合即可以实现平面内任意方向的运动。 3.运动学分析 为便于运动学分析，我们以理想情况为基础，三个轮子相对于车体的
编码电机的使用方法（ESP32--Arduino）
最新发布
2302_81176524的博客
06-02 825
编码器主要分为光电编码器和磁编码器(霍尔编码器)。
Arduino三轮全向小车（一）：编码马达
Mond的博客
03-14 4249
Arduino三轮全向小车（一）：编码马达 ​  近期准备做一个三轮全向平台，用来搞各种事情。于是先用Solidworks建了一个模型，运动算例搞了一番，还是不知所以然，干脆直接开始动手，变搞边学习。然而查阅网上各种资料高深莫测，看得我云里雾里，初学很是艰辛。所以就写几篇博客记录一下自己的学习过程。作为菜鸡，第一次发博，还请各位大佬多指正。 马达的选用 ​  如果是要做小车的，选用什么样的马达是很...
Arduino三轮全向小车（一）：编码马达的使用
huashuideyu的博客
03-25 1500
Arduino三轮全向小车（一）：编码马达的使用## 标题 近期准备做一个arduino作为下位机的底盘，看了很多，还是不知所以然，干脆直接开始动手，变搞边学习。然而查阅网上各种资料高深莫测，看得我云里雾里，初学很是艰辛。所以就写几篇博客记录一下自己的学习过程。作为菜鸡，欢迎大家指正。 马达的选用 ​  如果是要做小车的，选用什么样的马达是很重要的，需要考虑的一个方面。之前用Arduino做小车一般直接用减速直流电机，就是那种小黄马达。说实在的效果不是很好，所谓便宜没好货，拿去比赛各种问题接踵而至，但若不考
全向轮三轮小车的搭建（一）
HYXWZ的博客
08-20 2830
正值暑假有很多的空余时间，所以打算用自己大一大二所学的知识和一些准备比赛的经验来从零开始搭建一个基于arduino的ros全向轮小车，之前准备比赛做的是差分机器人所以这次想尝试挑战一下全向移动机器人。和其他机器人一样在搭建机器人之前首先得设计好自己机器人的底盘，包括底盘的运动模型，后续都会根据模型去调整小车的一些参数，要想做好一个机器人，搭好底盘是非常重要的一步。 1.全向轮机构设计 全向轮的底盘可以是等边三角形也可以是圆形（可根据自己实际情况来定），三个轮子两两必须相差120°，一般常用的安装方式为三个轮
全向轮三轮小车的搭建（二）
HYXWZ的博客
08-23 1204
这次是第一次搭建全向轮小车，所以选择的是比较简单的树莓派和arduino，一是因为整体上比较简单，二是因为相对于TX2和32来说在价格上要比较经济实惠，特别是对于我这种学生党来说，下面我将我这次搭建用到的硬件整理了一下列了出来。 小车用到的硬件列表 型号 数量 Raspberry Pi 树莓派4B 一块 Arduino Mege2560控制器 一块 MEGA传感器扩展板V2.3 一块 IO传感器扩展板 V7.1 一块 双路15A大功率电机驱动板 两块 4S锂电池 两块
Arduino三轮小车
06-20
学生期末作业，红外循迹和蓝牙控制两种模式，用了LCD1602 i2c显示屏，LED灯和蜂鸣器报警，红外和超声波避障，感兴趣就看看用吧
基于Arduino设计的麦轮小车，三轮全向小车.zip（毕设/课设/竞赛/实训/项目开发）
03-29
本人单片机开发经验充足，深耕嵌入式领域，有任何使用问题欢迎随时与我联系，我会及时为你解惑，提供帮助。 【资源内容】：包含完整源码+工程文件+说明，项目具体内容可查看下方的资源详情。 【附带帮助】： 若还...
Arduino蓝牙控制小车
07-20
在Arduino蓝牙控制小车中，我们通常使用HC-05或HC-06等蓝牙串口模块，它们可以与手机、电脑等设备配对，实现无线通信。用户可以通过编写特定的APP或者使用现成的蓝牙控制软件向Arduino发送指令，如前进、后退、左转...
Arduino-Garden-Watering:使用Arduino的自动花园浇水系统
05-15
使用arduino的花园给水系统 这是一个使用Arduino为花园浇水的项目。 为此，我使用了一个电动阀来控制浇水，使用了一个传感器来测量温度和湿度，使用了LCD显示屏为用户编写信息，使用了两个按钮来修改浇水时间并打开...
三轮全向轮机器人底盘控制与分析（论文）
06-04
在机器人技术迅速发展的今天,机器人的移动技术也是不断发展的。现有的仿生机器人有波士顿动力公司设计研发的人形机器人Atlas,仿生狗机器人Spot等;普通轮式机器人有家用的扫地机器人,双轮平衡车等[1]。但这些机器人的移动方式都有一定的局限性,不具备全姿态的移动能力,移动不灵活。而全向移动平台则克服了这些缺点,在灵活性方面远胜于普通轮式移动平台。对于全向移动平台,四轮解决方案有麦克纳姆轮移动平台,三轮解决方案有全向轮移动平台等。本文就针对三轮全向轮移动平台进行分析。
Arduino 步进电机接线方法（含有代码）
05-25
上面介绍了关于步进电机的接线问题，及提供了代码
arduino_hssp:使用 Arduino 进行 PSoC:registered: 1 设备编程
06-08
使用 Arduino 进行 PSoC:registered: 1 设备编程 这是在 ，修订版 2.30）上找到的代码到 Arduino 平台的端口。 它将向连接到运行此代码的 Arduino 的 PSoC:registered: 1 设备写入和验证升序十六进制值。 下一步...
Arduino开发之如何连接步进电机？
【cacrle】的博客
03-28 1276
某项目需要一个小电机转动装置进行测量，该装置本身可以测量角度（姿态），对不需要电机的精确角度，但需要对速度要有控制，需要调速达到测量最佳结果。本文通过实测研究步进电机的转速规律，以通过调节参数达到调速目的。
Arduino通过继电器控制电机（5V小马达）ESP8266-12F同理（小白初学）
qq_46158783的博客
06-17 1万+
用Arduino/ESP8266-12F控制电机 一、实验环境 IDE：Arduino 材料：Arduino UNO、4.5V电池盒子、继电器（6脚）、5V电机一个（5V小马达），面包板、杜邦线若干。 二、接法 参照37款传感器套件资料中的Arduino继电器的接法： （某宝卖家给的） 说明： 6脚继电器：COM（公共端）连接电池盒子的正极，NO（常开端）连接电机的正极、电池盒子的负极连接电机的负极。 实体图： 三、代码 #define FAN 2 //用的是UNO上的2引脚 void set
旋转编码器的工作原理以及如何同Arduino开发板使用
佐佐沐
04-13 1301
在本篇文章中，您将了解如何使用旋转编码器。首先，您将看到有关旋转编码器的一些信息，然后您将学习如何使用旋转编码器。 什么是旋转编码器？ 旋转编码器是一种机电设备，可将轴角度的位置转换为数字数据。旋转编码器具有带有一些孔的圆形板和两个通道A和B。通过旋转圆形板，当A和B通道通过孔时，在该通道和公共端之间建立连接。这些中断在输出通道中产生方波。通过计算这些脉冲，我们可以找到旋转量。另一方面，通道A和B...
使用Arduino和TB6612驱动编码电机实现测速功能
m0_63715549的博客
07-03 4549
使用Arduino和TB6612驱动编码电机实现测速功能
Arduino 电机测速
qq_42731062的博客
08-04 6175
电机测速
三轮全向轮小车运动学模型
10-10
三轮全向轮小车运动学模型是基于小车运动学理论的研究，通过对小车的运动特性进行建模分析，可以对其运动状态和运动轨迹进行预测和控制。对于三轮全向轮小车，其运动学模型可以分解为平移运动和旋转运动两个部分，平移运动部分是小车在直线上的运动，旋转运动部分是小车绕中心点的旋转运动。 具体来说，三轮全向轮小车的平移运动可以用以下公式描述： v = (vr + vl + vθ)/3 其中v表示小车的前进速度，vr、vl、vθ分别表示三个轮子的线速度。而小车的旋转运动可以用以下公式描述： w = (vr - vl)/L 其中w表示小车的角速度，L为小车轴距。 综合平移和旋转运动，可以得到三轮全向轮小车的运动学模型： v = (vr + vl + vθ)/3 w = (vr - vl)/L

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 22
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

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

余额充值