【Arduino】麦克纳姆轮原理及驱动程序

Zhao-Jichao

分类：硬件电路

发布时间 2022.11.16阅读数 3595 评论数 0

Arduino 麦克纳姆轮

麦克纳姆轮全向移动原理【已整理】

在这里插入图片描述

麦轮测试程序 Arduino UNO+L298N

/_**_/
/_**_硬件：Arduino UNO + L298N电机驱动两个_**_/
/_**_/

int L1_IN1 = 7;int L1_IN2 = 5;int L1_ENA = 6;//左前轮
int R1_IN1 = 4;int R1_IN2 = 2;int R1_ENA = 3;//右前轮
int L2_IN1 = 12;int L2_IN2 = 13;int L2_ENA = 11;//左后轮
int R2_IN1 = 8;int R2_IN2 = 9;int R2_ENA = 10;//右后轮

void setup() {
  // put your setup code here, to run once:
  pinMode(L1_IN1, OUTPUT);pinMode(L1_IN2, OUTPUT);pinMode(L1_ENA, OUTPUT);
  pinMode(R1_IN1, OUTPUT);pinMode(R1_IN2, OUTPUT);pinMode(R1_ENA, OUTPUT);
  pinMode(L2_IN1, OUTPUT);pinMode(L2_IN2, OUTPUT);pinMode(L2_ENA, OUTPUT);
  pinMode(R2_IN1, OUTPUT);pinMode(R2_IN2, OUTPUT);pinMode(R2_ENA, OUTPUT);
}

void L1_forward(int sp)//左前轮前进
{
  digitalWrite(L1_IN1,LOW);
  digitalWrite(L1_IN2,HIGH);
  analogWrite(L1_ENA,sp);
}
void R1_forward(int sp)//右前轮前进
{
  digitalWrite(R1_IN1,HIGH);
  digitalWrite(R1_IN2,LOW);
  analogWrite(R1_ENA,sp);
}
void L2_forward(int sp)//左后轮前进
{
  digitalWrite(L2_IN1,HIGH);
  digitalWrite(L2_IN2,LOW);
  analogWrite(L2_ENA,sp);
}
void R2_forward(int sp)//右后轮前进
{
  digitalWrite(R2_IN1,HIGH);
  digitalWrite(R2_IN2,LOW);
  analogWrite(R2_ENA,sp);
}
void allstop()
{
  digitalWrite(L1_IN1,LOW);
  digitalWrite(L1_IN2,LOW);
  digitalWrite(R1_IN1,LOW);
  digitalWrite(R1_IN2,LOW);
  digitalWrite(L2_IN1,LOW);
  digitalWrite(L2_IN2,LOW);
  digitalWrite(R2_IN1,LOW);
  digitalWrite(R2_IN2,LOW);
}
void L1_backward(int sp)//左前轮后退
{
  digitalWrite(L1_IN1,HIGH);
  digitalWrite(L1_IN2,LOW);
  analogWrite(L1_ENA,sp);
}
void R1_backward(int sp)//右前轮后退
{
  digitalWrite(R1_IN1,LOW);
  digitalWrite(R1_IN2,HIGH);
  analogWrite(R1_ENA,sp);
}
void L2_backward(int sp)//左后轮后退
{
  digitalWrite(L2_IN1,LOW);
  digitalWrite(L2_IN2,HIGH);
  analogWrite(L2_ENA,sp);
}
void R2_backward(int sp)//右后轮后退
{
  digitalWrite(R2_IN1,LOW);
  digitalWrite(R2_IN2,HIGH);
  analogWrite(R2_ENA,sp);
}

void loop() {
  // put your main code here, to run repeatedly:
  /_前进_/
  L1_forward(100);
  R1_forward(100);
  L2_forward(100);
  R2_forward(100);
  delay(1500);
  allstop();
  delay(1500);

  /_后退_/
  L1_backward(100);
  R1_backward(100);
  L2_backward(100);
  R2_backward(100);
  delay(1500);
  allstop();
  delay(1500);

  /_顺时针原地旋转_/
  L1_forward(200);
  R1_backward(200);
  L2_forward(200);
  R2_backward(200);
  delay(1500);
  allstop();
  delay(1500);

  /_逆时针原地旋转_/
  L1_backward(200);
  R1_forward(200);
  L2_backward(200);
  R2_forward(200);
  delay(1500);
  allstop();
  delay(1500);

  /_左边平移_/
  L1_backward(150);
  R1_forward(150);
  L2_forward(150);
  R2_backward(150);
  delay(1500);
  allstop();
  delay(1500);

  /_右边平移_/
  L1_forward(150);
  R1_backward(150);
  L2_backward(150);
  R2_forward(150);
  delay(1500);
  allstop();
  delay(1500);

  /_斜向左上方_/
  R1_forward(150);
  L2_forward(150);
  delay(1500);
  allstop();
  delay(1500);

  /_斜向右上方_/
  L1_forward(150);
  R2_forward(150);
  delay(1500);
  allstop();
  delay(1500);

  /_斜向左下方_/
  L1_backward(150);
  R2_backward(150);
  delay(1500);
  allstop();
  delay(1500);

  /_斜向右下方_/
  R1_backward(150);
  L2_backward(150);
  delay(1500);
  allstop();
  delay(1500);
}

带红外控制程序 Arduino UNO+L298N+红外

#include <IRremote.h>
/_定义红外接收管接线引脚_/
int RECV_PIN = 11;//定义红外接收引脚号
IRrecv irrecv(RECV_PIN);
decode_results results;//解码结果放在decode results结构的result中

/_定义电机驱动接线引脚_/
int L1_IN1 = 44; int L1_IN2 = 42; int L1_ENA = 7;//左前轮
int R1_IN1 = 40; int R1_IN2 = 38; int R1_ENA = 6;//右前轮
int L2_IN1 = 52; int L2_IN2 = 50; int L2_ENA = 5;//左后轮
int R2_IN1 = 48; int R2_IN2 = 46; int R2_ENA = 4;//右后轮

void setup()
{
  // put your setup code here, to run once:
  pinMode(L1_IN1, OUTPUT);pinMode(L1_IN2, OUTPUT);pinMode(L1_ENA, OUTPUT);
  pinMode(R1_IN1, OUTPUT);pinMode(R1_IN2, OUTPUT);pinMode(R1_ENA, OUTPUT);
  pinMode(L2_IN1, OUTPUT);pinMode(L2_IN2, OUTPUT);pinMode(L2_ENA, OUTPUT);
  pinMode(R2_IN1, OUTPUT);pinMode(R2_IN2, OUTPUT);pinMode(R2_ENA, OUTPUT);

  Serial.begin(9600);
  // In case the interrupt driver crashes on setup, give a clue
  // to the user what’s going on.
  Serial.println(“Enabling IRin”);
  irrecv.enableIRIn(); // 启动接收器
  Serial.println(“Enabled IRin”);
}

void loop()
{
  if (irrecv.decode(&results))
  {
    Serial.print(“HEX格式 》》 “);
    Serial.println(results.value,HEX);//以16进制换行输出接收代码
    Serial.print(“默认格式 》》 “);
    Serial.println(results.value);

    if (results.value == 0xFF30CF)  //1键为前进键
    {
      L1_forward(100);
      R1_forward(100);
      L2_forward(100);
      R2_forward(100);
    }
    else if (results.value == 0xFF18E7)  //2键为后退键
    {
      L1_backward(100);
      R1_backward(100);
      L2_backward(100);
      R2_backward(100);
    }
    else if (results.value == 0xFF7A85)  //3键为左边平移键
    {
      L1_forward(150);R1_backward(150);
      L2_forward(150);R2_backward(150);
    }
    else if (results.value == 0xFF10EF)  //4键为右边平移键
    {
      L1_backward(150);R1_forward(150);
      L2_backward(150);R2_forward(150);
    }
    else if (results.value == 0xFF38C7)  //5键为顺时针原地旋转键
    {
      L1_backward(150);R1_forward(150);
      L2_forward(150); R2_backward(150);

    }
    else if (results.value == 0xFF5AA5)  //6键为逆时针原地旋转键
    {
      L1_forward(150); R1_backward(150);
      L2_backward(150);R2_forward(150);

    }
    else if (results.value == 0xFF4AB5)  //8键为原地画数字8键
    {
      //前
      L1_forward(100); R1_forward(100);
      L2_forward(100); R2_forward(100);
      delay(500);
      allstop();
      delay(500);

      //右
      L1_backward(150);R1_forward(150);
      L2_backward(150);R2_forward(150);
      delay(800);
      allstop();
      delay(500);

      //前
      L1_forward(100); R1_forward(100);
      L2_forward(100); R2_forward(100);
      delay(500);
      allstop();
      delay(500);

      //左
      L1_forward(150); R1_backward(150);
      L2_forward(150); R2_backward(150);
      delay(800);
      allstop();
      delay(500);

      //后
      L1_backward(100);R1_backward(100);
      L2_backward(100);R2_backward(100);
      delay(500);
      allstop();
      delay(500);

      //右
      L1_backward(150);R1_forward(150);
      L2_backward(150);R2_forward(150);
      delay(800);
      allstop();
      delay(500);

      //后
      L1_backward(100);R1_backward(100);
      L2_backward(100);R2_backward(100);
      delay(500);
      allstop();
      delay(500);

      //左
      L1_forward(150); R1_backward(150);
      L2_forward(150); R2_backward(150);
      delay(800);
      allstop();
      delay(500);

    }
    else if (results.value == 0xFF6897)  //0键为停止键
    {
      allstop();Serial.println(“allstop”);
    }

    irrecv.resume(); // Receive the next value
    Serial.println(“———-“);
  }
  delay(100);
}

void L1_forward(int sp)//左前轮前进
{
  digitalWrite(L1_IN1,LOW);
  digitalWrite(L1_IN2,HIGH);
  analogWrite(L1_ENA,sp);
}
void R1_forward(int sp)//右前轮前进
{
  digitalWrite(R1_IN1,HIGH);
  digitalWrite(R1_IN2,LOW);
  analogWrite(R1_ENA,sp);
}
void L2_forward(int sp)//左后轮前进
{
  digitalWrite(L2_IN1,HIGH);
  digitalWrite(L2_IN2,LOW);
  analogWrite(L2_ENA,sp);
}
void R2_forward(int sp)//右后轮前进
{
  digitalWrite(R2_IN1,HIGH);
  digitalWrite(R2_IN2,LOW);
  analogWrite(R2_ENA,sp);
}
void allstop()
{
  digitalWrite(L1_IN1,LOW);
  digitalWrite(L1_IN2,LOW);
  digitalWrite(R1_IN1,LOW);
  digitalWrite(R1_IN2,LOW);
  digitalWrite(L2_IN1,LOW);
  digitalWrite(L2_IN2,LOW);
  digitalWrite(R2_IN1,LOW);
  digitalWrite(R2_IN2,LOW);
}
void L1_backward(int sp)//左前轮后退
{
  digitalWrite(L1_IN1,HIGH);
  digitalWrite(L1_IN2,LOW);
  analogWrite(L1_ENA,sp);
}
void R1_backward(int sp)//右前轮后退
{
  digitalWrite(R1_IN1,LOW);
  digitalWrite(R1_IN2,HIGH);
  analogWrite(R1_ENA,sp);
}
void L2_backward(int sp)//左后轮后退
{
  digitalWrite(L2_IN1,LOW);
  digitalWrite(L2_IN2,HIGH);
  analogWrite(L2_ENA,sp);
}
void R2_backward(int sp)//右后轮后退
{
  digitalWrite(R2_IN1,LOW);
  digitalWrite(R2_IN2,HIGH);
  analogWrite(R2_ENA,sp);
}

麦克纳姆轮 Arduino 经验分享嵌入式系统

打赏 0

上一篇：Ardino基础教程 14_倾斜开关

下一篇：Ardino基础教程 11_PWM调控灯光亮度

【Arduino】麦克纳姆轮原理及驱动程序

Zhao-Jichao

Arduino 麦克纳姆轮

麦克纳姆轮全向移动原理【已整理】

麦轮测试程序 Arduino UNO+L298N

带红外控制程序 Arduino UNO+L298N+红外

为你推荐

PMAC应用三-运动程序

STM32精英版（正点原子STM32F103ZET6开发板）学习篇7——Systick定时器

AMBA总线协议（4）——AHB（二）：基本传输

PCB相关知识-封装+元件属性+印制电路板PCB

MOS的功耗计算-半桥的功耗

魔方机器人之下位机编程-----两种串口通信方式的比较

关于作者

Zhao-Jichao

35

0

200

2

【STM32】FreeRTOS 调度器开启和任务相关函数详解

【Arduino】库分析及如何编写自己的Arduino库

【Matlab 图像】LAB 色彩空间分析

相关推荐

永磁直流无刷电机设计之路（四）——仿真计算分析

STM32CubeMX+Keil实现 STM32F4 SDcard+SPI Flash读卡器

【STM32】处理字符串时 \r\n、\r、\n 的区别

Stm32-使用TB6612驱动电机及编码器测速

GPIO复用功能1——定时器输入捕获

魔方机器人之下位机编程----串口接收数据并解析

热门泡泡

30积分失眠，聊聊自己搞ROS的心得体会吧

ros学习路线

30积分 TF_REPEATED_DATA ignoring data错误

各位大佬，有什么ROS定位算法推荐吗

5积分想买能用ROS2的开发套件。或者开发板

5积分 ros中启动gazebo时报错

给作者打赏

【Arduino】麦克纳姆轮原理及驱动程序

Zhao-Jichao

Arduino 麦克纳姆轮

麦克纳姆轮全向移动原理【已整理】

麦轮测试程序 Arduino UNO+L298N

带红外控制程序 Arduino UNO+L298N+红外

为你推荐

PMAC应用三-运动程序

STM32精英版（正点原子STM32F103ZET6开发板）学习篇7——Systick定时器

AMBA总线协议（4）——AHB（二）：基本传输

PCB相关知识-封装+元件属性+印制电路板PCB

MOS的功耗计算-半桥的功耗

魔方机器人之下位机编程-----两种串口通信方式的比较

评论（0）

关于作者

Zhao-Jichao

35

0

200

2

【STM32】FreeRTOS 调度器开启和任务相关函数详解

【Arduino】库分析及如何编写自己的Arduino库

【Matlab 图像】LAB 色彩空间分析

相关推荐

永磁直流无刷电机设计之路（四）——仿真计算分析

STM32CubeMX+Keil实现 STM32F4 SDcard+SPI Flash读卡器

【STM32】处理字符串时 \r\n、\r、\n 的区别

Stm32-使用TB6612驱动电机及编码器测速

GPIO复用功能1——定时器输入捕获

魔方机器人之下位机编程----串口接收数据并解析

热门泡泡

30积分 失眠，聊聊自己搞ROS的心得体会吧

ros学习路线

30积分 TF_REPEATED_DATA ignoring data错误

各位大佬，有什么ROS定位算法推荐吗

5积分 想买能用ROS2的开发套件。或者开发板

5积分 ros中启动gazebo时报错

给作者打赏

忘记密码

修改头像

添加你感兴趣的标签

举报类型（必选）

举报详情（选填）

30积分失眠，聊聊自己搞ROS的心得体会吧

5积分想买能用ROS2的开发套件。或者开发板