程序员经验分享-hwhale

【基于51】红外寻迹智能小车 - 代码篇

2023-05-16

文章目录

  • 前言
  • 一、准备工作
  • 二、使用步骤
    • 1.模块化编程
    • 2.电机模块
    • 3.小车动作模块
    • 4**.PWM**和定时器、中断系统
    • 5.寻迹逻辑
  • 总结

前言

关于硬件部分可以看我上次写的帖子https://blog.csdn.net/ZER00000001/article/details/124378788
#新人报道我是普通本科大一新生，因为兴趣爱好加入学校机器人协会，计划本学期挑战电赛|ू･ω･` )没想到疫情突发，只能匆匆用了一个星期入门51，做阶段性小项目，基于51智能红外寻迹小车，虽然论坛教程很多，但还是发此贴记录分享撸车的时光，也顺便做个引子给刚入门的同好们…

一、准备工作

1.安装keil 5
2.有一定的c语言基础
3.明白各模块工作原理，才能写逻辑

二、使用步骤

1.模块化编程

【视频教程：b站江科大自化协】我跟着这位老师入门的51，他讲的很好，其中教会了我模块化编程（可以有效降低代码耦合性，并且写下来思路非常清晰！！！），所以在接下的说明中我会按照这种方式来讲解代码(￣▽￣)~*
（代码不成熟，仅供参考）

2.电机模块

这是电机模块，也就是控制轮子怎么转的。（如果你的电机反向，就把1和0交换位置）

#include <REGX52.H>

sbit IN1 = P1^0;//左轮
sbit IN2 = P1^1;//左轮
sbit IN3 = P1^2;//右轮
sbit IN4 = P1^3;//右轮

void Left_Motor_Forward()//左轮前进
{
	IN1 = 1;
	IN2 = 0;
}

void Right_Motor_Forward()//右轮前进
{
	IN3 = 1;
	IN4 = 0;
}
//
void Left_Motor_Back()//左轮后退
{
	IN1 = 0;
	IN2 = 1;
}

void Right_Motor_Back()//右轮后退
{
	IN3 = 0;
	IN4 = 1;
}
//
void Left_Motor_Stop()//左轮停
{
	IN1 = 0;
	IN2 = 0;
}

void Right_Motor_Stop()//右轮停
{
	IN3 = 0;
	IN4 = 0;
}

这是函数封装

#ifndef __MOTORSET_H__
#define __MOTORSET_H__


void Left_Motor_Forward();
void Right_Motor_Forward();
void Left_Motor_Back();
void Right_Motor_Back();
void Left_Motor_Stop();
void Right_Motor_Stop();

#endif

3.小车动作模块

利用封装好的电机模块对小车整体控制

#include <REGX52.H>
#include "MotorSet.h"

void Car_Go()
{Left_Motor_Forward();Right_Motor_Forward();}

void Car_Left()
{Left_Motor_Stop();Right_Motor_Forward();}

void Car_Right()
{Right_Motor_Stop();Left_Motor_Forward();}

void Car_Stop()
{Left_Motor_Stop();Right_Motor_Stop();}

void Car_Back()
{Left_Motor_Back();Right_Motor_Back();}

封装

#ifndef __MOTORSET_H__
#define __MOTORSET_H__


void Left_Motor_Forward();
void Right_Motor_Forward();
void Left_Motor_Back();
void Right_Motor_Back();
void Left_Motor_Stop();
void Right_Motor_Stop();

#endif

4**.PWM**和定时器、中断系统

关于PWM

在这里插入图片描述
在这里插入图片描述

CSDN上也有足够详细的讲解：
pwm的频率：
是指1秒钟内信号从高电平到低电平再回到高电平的次数(一个周期)；
也就是说一秒钟PWM有多少个周期
单位： Hz
表示方式： 50Hz 100Hz
pwm的周期：
T=1/f
周期=1/频率
50Hz = 20ms 一个周期
如果频率为50Hz ，也就是说一个周期是20ms 那么一秒钟就有 50次PWM周期
占空比：
是一个脉冲周期内，高电平的时间与整个周期时间的比例
单位： % (0%-100%)
表示方式：20%

以单片机为例，我们知道，单片机的IO口输出的是数字信号，IO口只能输出高电平和低电平
假设高电平为5V 低电平则为0V 那么我们要输出不同的模拟电压，就要用到PWM，通过改变IO口输出的方波的占空比从而获得使用数字信号模拟成的模拟电压信号
我们知道，电压是以一种连接1或断开0的重复脉冲序列被夹到模拟负载上去的（例如LED灯，直流电机等），连接即是直流供电输出，断开即是直流供电断开。通过对连接和断开时间的控制，理论上来讲，可以输出任意不大于最大电压值（即0~5V之间任意大小）的模拟电压
比方说 占空比为50% 那就是高电平时间一半，低电平时间一半，在一定的频率下，就可以得到模拟的2.5V输出电压 那么75%的占空比 得到的电压就是3.75V
在这里插入图片描述

图 14.1.1 就是一个简单的 PWM 原理示意图。图中，我们假定定时器工作在向上计数 PWM模式，且当 CNT<CCRx 时，输出 0，当 CNT>=CCRx 时输出 1。那么就可以得到如上的 PWM示意图：当 CNT 值小于 CCRx 的时候， IO 输出低电平(0)，当 CNT 值大于等于 CCRx 的时候，IO 输出高电平(1)， 当 CNT 达到 ARR 值的时候，重新归零，然后重新向上计数，依次循环。改变 CCRx 的值，就可以改变 PWM 输出的占空比，改变 ARR 的值，就可以改变 PWM 输出的频率，这就是 PWM 输出的原理。

关于定时器的配置，这里我们使用的是计时器0模式1
在这里插入图片描述（图片为定时器和中断系统的原理图）

定时器0的初始化

#include <REGX52.H>

sbit ENA_1 = P3^0;
sbit ENA_2 = P3^1;
sbit ENB_1 = P3^2;
sbit ENB_2 = P3^3;

/**
  * @brief  定时器0初始化，100us@12.000MHz
  * @param  无
  * @retval 无
  */
void Timer0_Init(void)		//100微秒@11.0592MHz
{

	TMOD &= 0xF0;		//设置定时器模式
	TMOD |= 0x01;		//设置定时器模式
	TL0 = (65536-100)%256;		//设置定时初始值
	TH0 = (65536-100)/256;		//设置定时初始值
	TF0 = 0;		//清除TF0标志
	TR0 = 1;		//定时器0开始计时
	ET0 = 1;
	EA = 1;
	PT0 = 0;
}

利用中断函数实现PWM


unsigned int pwml,pwmr,t;//左右占空比，比较值
void Timer0_Routine() interrupt 1
{
	TL0 = (65536-100)%256;		//设置定时初始值
	TH0 = (65536-100)/256;		//设置定时初始值
	t++;
	if(t<pwml)
	{
		ENA_1 = 1;
		ENA_2 = 1;
	}
	else
	{
		ENA_1 = 0;
		ENA_2 = 0;
	}
//左pwm
	if(t<pwmr)
	{
		ENB_1 = 1;
		ENB_2 = 1;
	}
	else
	{
		ENB_1 = 0;
		ENB_2 = 0;
	}
//右pwm
	if(t>=100){t = 0;}
}

定时器模块的封装

#ifndef __TIMER0_H__
#define __TIMER0_H__


extern pwml;
extern pwmr;
extern t; 
void Timer0_Init(void);

#endif

整个撸车过程中耗时最长的就属调车的参数了，需要根据现场情况，一点点找到合适的占空比，来实现两轮转速的相对平衡（高级多的可以用一些带编码器的电机或物理仿真来找到合适的参数）；

5.寻迹逻辑

我们使用的是红外避障模块（和寻迹原理一样，详细见我另一篇文章【基于51】红外寻迹智能小车 - 硬件篇）
但模块接收回红外信号时，OUT端返回低电平;但在黑线上时，黑线吸收红外，模块没有信号返回，OUT端返回高电平。
根据以上原理，我们可以写出寻迹逻辑

#include <REGX52.H>
#include "CarGo.h"
#include "Timer0.h"
#include "Delay.h"

sbit OUT1 = P2^5;//左大调
sbit OUT2 = P2^4;//左微调
sbit OUT4 = P2^2;//右大调
sbit OUT3 = P2^1;//右微调

sbit IN1 = P1^0;//左轮
sbit IN2 = P1^1;//左轮
sbit IN3 = P1^2;//右轮
sbit IN4 = P1^3;//右轮

extern pwml;
extern pwmr;

void Chack()
{
	if(OUT1 == 1 && OUT2 == 1 && OUT3 == 1 && OUT4 == 1)//全黑线（或空中）停车
	{
		pwml = 0;
		pwmr = 0;
		Car_Stop();
	}

	if(OUT1 == 0 && OUT2 == 0 && OUT3 == 1 && OUT4 == 0)//偏左，右移
	{
		pwml = 20;
		pwmr = 16;
		Car_Go();
	}

	if(OUT1 == 0 && OUT2 == 1 && OUT3 == 0 && OUT4 == 0)//偏右，左移
	{
	    pwml = 16;
		pwmr = 20;
		Car_Go();
	}
///
	if(OUT1 == 1 && OUT2 == 1 && OUT3 == 0 && OUT4 == 0)//左大转
	{
//		Car_Stop();
//		Delay(20);
//		pwml = 5;
//		pwmr = 30;
//		Delay(20);
//		Car_Go();
		
		while(1)
		{
				IN1 = 0;
				IN2 = 1;
				if(OUT3 == 1) {
				IN1 = 1;
				IN2 = 0;
				break;}
				pwml = 18;
				pwmr = 18;
				Car_Go();
				
		}
	}
//	if(OUT1 == 0 && OUT2 == 0 && OUT3 == 0 && OUT4 == 1)//右大转
//	{
		Car_Stop();
		Delay(20);
		pwml = 5;
		pwmr = 30;
		Delay(20);
		Car_Go();
//		
//		while(1)
//		{
//			IN3 = 0;
//				IN4 = 1;
//				if(OUT2 == 1) {
//				IN3 = 1;
//				IN4 = 0;
//				break;}
//				pwml = 25;
//				pwmr = 25;
//				Car_Go();
//				
//		}
//	}
///
	if(OUT1 == 1 && OUT2 == 0 && OUT3 == 0 && OUT4 == 1)
	{
		pwml = 16;
		pwmr = 16;
		Car_Go();
	}
}

在上篇我说过，我们使用的是4个红外模块平行放置来检测黑线，在调整好红外灵敏度和模块间距离（当中间两个正好能检测黑线时），靠外侧的模块用来判断转弯（这里我们考虑了用while实现的直角转弯）；

函数封装

#ifndef __CHACK_H__
#define __CHACK_H__
#inlcude "MotorSet.h"
void Chack();
#endif

最后把函数全部调用进main函数就ok了ヾ(✿ﾟ▽ﾟ)ノ

总结

这次的小车虽然只是个阶段性小项目，但是收获颇多！下次准备挑战21电赛f组试题。希望大家都能享受亲自把小车跑起来时的快乐！

本文内容由网友自发贡献，版权归原作者所有，本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容，请联系:hwhale#tublm.com(使用前将#替换为@)

【基于51】红外寻迹智能小车 - 代码篇 的相关文章

  • AirSim中获取视觉、惯性数据方法研究

    AirSim中获取视觉 惯性数据方法研究 文章目录 AirSim中获取视觉 惯性数据方法研究1 获取ROS bag格式数据2 获取文件形式 EuRoc数据集格式 3 其他方案 最近在做AirSim中部署V SLAM xff0c 抽空将之前尝

  • 如何引用开源库(BibTex转为endnote)方法

    前言 xff1a 我们在写论文时 xff0c 论文的工作有时可能会用到别人的开源算法库 xff0c 那么我们如何在参考文献中引用呢 以Ceres库为例 xff0c 该库是谷歌开发的一款求解非线性优化问题的库 xff0c 相信做SLAM相关的

  • 关于MAC 安装 laravel4 的一些经验 二

    unix 和windows 完全不同 xff0c 只好恶补了一些UNIX的知识 xff0c 找到了 profie 这个是隐藏文件 xff0c 在find里面找不到的 接下来只能自己配置PHP环境或者下载其他软件 我下载了XAMPP xff0

  • AirSim相机、IMU内外参分析(VIO、vSLAM)

    作者 朱贞欣 xff0c 公ZH xff1a SLAM学习er 文章目录 0 引入1 世界坐标系2 IMU2 1 IMU数据生成2 2 关于IMU噪声 3 相机3 1 相机外参3 2 内参 0 引入 假设你想通过AirSim获取仿真数据运行

  • C++ cout输出小数位数

    方法一 xff1a 使用setiosflags span class token macro property span class token directive hash span span class token directive

  • kubeadm init 运行时kebelet启动失败问题

    最近在部署kebeedge xff0c 需要先在云服上部署k8s xff0c 期间通过kubeadm init config的方式进行master的部署 xff0c 记录一下遇到的kubelet相关的错误 在通过kubeadm init c

  • 2288hv5超融合服务器 数码管报888

    问题现象 2288hv5超融合服务器 xff0c 前面板数码管报888 xff0c 电源灯黄灯闪烁 xff0c 开不了机 xff0c ibmc网络是通的 xff0c 但是web网页打不开 问题原因 iBMC的版本过低 xff0c iBMC在

  • 跟我一起写操作系统(二)——史上最简单的内核

    跟我一起写操作系统 二 史上最简单的内核 转载注明出处 xff1a http www cnblogs com lucasysfeng p 4847662 html 上一讲地址 xff1a http www cnblogs com lucas

  • k8s中文文档

    http www cnblogs com huangzhenyou p 8066145 html k8s概念比较多 xff0c 有什么概念的疑惑的推荐看k8s中文文档 me的环境 操作系统 xff1a centos7 docker xff1

  • 阿里云 CentOS7 安装图形化界面 。安装图形化界面看这一篇就够了。

    阿里云centos7 下执行eclipse 响应学校老师的要求安装eclipse用于与hadoop的操作 在这之前想过两种方法来解决服务器无图形化界面 xff0c 来操作eclipse 1 在主机上下载eclipse把需要编译的代码编译成j

  • 把ESXi中的虚拟机通过OVA/OVF导出的方式迁移到Proxmox 5

    一 前言 之前发现ESXi是免费的时候 xff0c 非常兴奋地把几台服务器都装上了 xff0c 用着确实还行 xff0c 但是用久了之后就发现 xff0c 很多高端功能需要进一步付费才能使用 xff0c 比如HA等 另外就是它还有很多局限性

  • PX4 ThoneFlow光流使用

    PX4官方光流介绍 xff1a PMW3901 Based Flow Sensors PX4 User Guide 与飞控连接 接线 xff1a G接GND xff1b V接3 3V xff1b T是TX接飞控的RX口 xff1b Y接地开

  • Ubuntu PX4无人机仿真环境配置

    目录 一 VM虚拟机安装ubuntu18 04 1 VMware安装 2 新建虚拟机 二 Ubuntu系统配置 1 更改软件安装源 2 安装中文输入法 三 PX4环境搭建 1 安装git 2 下载px4源码 3 安装ROS 4 安装MAVR

  • larave5安装过程分享－MAX OSX版本

    MAC上的平台是XAMPP xff0c 自带的版本低 我用的是XAMPP MAC版本 一 本地php环境配置 which php php xff0d v xff5c php xampp php PASH 61 34 xff0f applic

  • PX4二次开发 创建进程

    目录 一 创建进程 二 仿真测试 PX4官方手册 xff1a Module Template for Full Applications PX4 User Guide 编写参照PX4源码 src templates xff1a PX4 Au

  • 【Matlab】Matlab基础绘图整理

    Matlab基础绘图整理 一张图绘制多个子图在图片文本中添加希腊字母和特殊字符其他常用函数限制坐标轴范围添加坐标轴说明添加图例修改线条类型 标记修改线条粗细 一张图绘制多个子图 主要命令 xff1a figure 第几张图 subplot

  • PX4 磁罗盘干扰分析

    磁罗盘干扰分析 推力与磁场关系正常情况干扰情况与推力相关解决方法 与推力不相关 罗盘补偿操作流程获取用于分析的日志分析日志调整罗盘补偿参数 推力与磁场关系 无人机上的电机电流会干扰无人机上搭载的磁罗盘 xff0c PX4官方提供了一些方式

  • 【C++】进制

    目录 一 进制转换1 十进制转二进制2 十进制转八进制 xff08 同上 xff09 3 二进制转八进制4 二进制转十六进制5 八进制转二进制6 十六进制转二进制 二 位运算1 原码 反码 补码2 位运算符3 变换操作 一 进制转换 1 十

  • Ubuntu20.04安装ROS2+ROS2-PX4框架搭建

    目录 Ubuntu20 04安装ROS2Set localeSetup SourcesInstall ROS2 packageEnvironment setup测试 ROS2 PX4框架搭建Install PX4Install ROS2Se

  • Jetson Nano利用ROS2通过MicroDDS与PX4通讯

    目录 Jetson Nano安装Ubuntu20 04Ubuntu20 04 配置ROS2环境Pixhawk配置Jetson Nano上MicroDDS Agent配置及和pixhawk通讯 PX4在V1 14及后续版本中 xff0c 将原

随机推荐

  • 用速腾RS16跑LeGO-LOAM

    版权声明 xff1a 本文为博主原创文章 xff0c 遵循 CC 4 0 BY SA 版权协议 xff0c 转载请附上原文出处链接和本声明 本文链接 xff1a https blog csdn net Zed Of Zoe article

  • Visual Studio 2017环境配置MPI v9.0 并行编程环境

    目录 第一步 xff1a 下载安装mpi 官网 xff1a http www mpich org windows版官网 xff1a https msdn microsoft com en us library bb524831 v 61 v

  • 学习java基础的心得感悟

    学完java基础 xff0c 对java面向对象的思想有更加深刻的认识了 xff0c 从学习java语言概述到最后网络编程IDE的使用 xff0c 时间用了1个月零9天 xff0c 上课时间28天 xff0c 回首感觉快又感觉漫长 xff0

  • 如何使用SQL批量替换数据库特定字段中部分特定数据

    1 替换数据库特定字段中部分特定数据的SQL语句 SQL语句 xff1a update 表名 set 字段名 61 replace 字段名 原字符串 需要替换成的字符串 以将表exam major中的字段pos2019中的数据 50 替换成

  • 阿里云ubuntu16.04 server 配置方案 1 配置桌面环境

    首先为服务器配置一个桌面系统 升级一下哦 xff01 span class hljs built in sudo span apt get update span class hljs built in sudo span apt get

  • Xshell远程连接华为云服务器

    Xshell远程连接华为云服务器 一 关于华为云1 什么是云服务器2 为什么使用华为云3 我的华为云体验 二 控制台操作 1 设置密码 2 开放端口 3 切换系统 三 Xshell操作 1 下载Xshell和Xftp2 连接云服务器 一 关

  • 校园网网络连接反复断开又连接是什么原因？

    网络连接反复断开又连接是什么原因 xff1f 原因可能跟ARP攻击或擅自使用P2P终结者等攻击软件有关 因为校园内多个楼宇已部署防ARP攻击网络设备 xff0c 只要判断用户计算机感染ARP或使用P2P终结者 网络执法官 聚生网管等软件攻击

  • xuperchain源码分析-启动过程

    xuperchain的启动分为两个比较大的过程 xff0c 一个是节点的初始化 xff0c 另一个是挖坑的初始化

  • 通过Excel学习PID算法（一步步理解它的KP,KI,KD）

    PID原理 PID控制算是应用非常广泛的经典控制算法 但是怎么理解PID这三个参数呢 xff1f 在参考了别人的文章之后 xff0c 我还是有点一知半解 xff0c 这时候发现不自己动手算一算是很难理解PID了 xff0c 但是我又不想做这

  • 通过Excel学习PID算法（连续系统的PID）

    总结上一节 在之前 xff0c 我们用倒水的例子通俗易懂的解释了什么是PID算法 在这里先回顾一下之前的学习的内容 P表示对误差的比例系数 与目标值差多少 xff0c 就在下一次修正中加上这个误差与P的乘积 xff0c 同时会导致系统有一个

  • 原来学习是如此地苦涩

    原文链接 xff1a http blog csdn net tangl 99 article details 2047657 最近一直在忙第一篇Paper xff0c 虽然想法大致的框架成熟了 xff0c 但是还有一些细节需要完善 这几天在

  • 互联网+时代的7个引爆点（读书笔记）

    百货商场里的销售人员一直抱怨 xff0c 大家只是到自己这里来看看 xff0c 之后转身就在网上下单 从旧视角瞎看这固然是一种文体 xff0c 显示着揭示了一种新的机会 以线下体验为入口的机会 小团队精益式的迭代 xff0c 几个周期后就可

  • maperuce运算框架

    1 xff0c 概念 mapreduce 运算框架主要实现hadoop 的数据处理 xff0c 数据处理中 流经过5个节点 数据流 xff1a input gt spilt gt map gt shuffle gt reduce xff08

  • 在Python中使用print输出时，出现UnicodeEncodeError错误，错误提示为“‘gbk‘ codec can‘t encode character ‘\u2022‘ in posit

    利用chatgpt一步步解决了这个问题 xff0c 感觉ChatGPT还是太强大了 问题描述 xff1a 在Python中使用print输出时 xff0c 出现UnicodeEncodeError错误 xff0c 错误提示为 39 gbk

  • openstack一些特性资料

    Keystone RBAC nova compute Cells Bare Metal Compute 是什么东西 xff1f http wiki openstack org blueprint nova compute cells htt

  • 【神经网络和深度学习-开发案例】 第二章 神经网络结构

    神经网络和深度学习 第二章 神经网络结构 案例 xff1a 使用神经网络识别手写数字 我将介绍一个神经网络 xff0c 它可以很好地对手写的数字进行分类 为了准备这一点 xff0c 它有助于解释一些术语 xff0c 让我们可以命名一个网络的

  • 2000页kubernetes操作手册，内容详细代码清晰，小白也能看懂

    现如今 xff0c Kubernetes业务已成长为新时代的IT基础设施 xff0c 并成为高级运维工程师 架构师 后端开发工程师的必修技术栈 毫无疑问 xff0c Kubernetes是云计算发展演进的一次彻底革命性的突破 xff0c 只

  • FreeRTOS代码阅读笔记：heap_4.c

    FreeRTOS中对于内存的管理当前一共有5种实现方式 xff08 作者当前的版本是10 1 1 xff09 xff0c 均在 Source portable MemMang 下面 xff0c 这里笔记下 heap 4 c和第二种方式比较相

  • （1）touchgfx 添加时钟控件

    第一步 xff1a 新建空白模版 添加图片 xff1a 放入 链接 xff1a https pan baidu com s 1NI6LUYrTUs64Z2jZE6AAQQ 提取码 xff1a 2odw 添加控件 xff1a 位置部件属性1T

  • 【基于51】红外寻迹智能小车 - 代码篇

    文章目录 前言一 准备工作二 使用步骤1 模块化编程2 电机模块3 小车动作模块4 PWM 和定时器 中断系统5 寻迹逻辑 总结 前言 关于硬件部分可以看我上次写的帖子https blog csdn net ZER00000001 arti

热门标签