PID算法控制5840-31ZY编码器直流减速电机旋转特定角度(一)

模块分析

在本工程中,使用stm32做主控芯片输出PWM波,TB6112做电源驱动带动5840-31ZY编码器直流减速电机旋转特定角度

有如下模块

TB6112驱动模块

TB6112是性能优于常见L298N的一款电机驱动芯片,体积更小效率更高发热少

其接线如图,其中通过BIN2,BIN1分别输入高低电平,可以控制BO2,BO1对应输出高低电平,从而实现对直流电机旋转方向的设定

#include "stm32f10x.h"                  // Device headervoid tb6612_init(){RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);//使能电机正反转控制RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE);//使能时钟RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);//使能pwm输出口GPIO_InitTypeDef gpiob12;gpiob12.GPIO_Mode=GPIO_Mode_Out_PP;gpiob12.GPIO_Pin=GPIO_Pin_1 | GPIO_Pin_2;gpiob12.GPIO_Speed=GPIO_Speed_50MHz;GPIO_Init(GPIOB,&gpiob12);//电机正反转引脚TIM_InternalClockConfig(TIM3);//内部时钟选择GPIO_InitTypeDef gpioa6;gpioa6.GPIO_Mode=GPIO_Mode_AF_PP;gpioa6.GPIO_Pin=GPIO_Pin_6;gpioa6.GPIO_Speed=GPIO_Speed_50MHz;GPIO_Init(GPIOA,&gpioa6);//使用TIM3,CH1通道——对应输出引脚为PA6TIM_TimeBaseInitTypeDef tim3_1;tim3_1.TIM_ClockDivision=TIM_CKD_DIV1;tim3_1.TIM_CounterMode=TIM_CounterMode_Down;tim3_1.TIM_Period=1000-1;tim3_1.TIM_Prescaler=720-1;tim3_1.TIM_RepetitionCounter=0;TIM_TimeBaseInit(TIM3,&tim3_1);//使能时钟,时基单元初始化TIM_OCInitTypeDef tim_ocinitstructure;TIM_OCStructInit(&tim_ocinitstructure);tim_ocinitstructure.TIM_OCMode=TIM_OCMode_PWM1;tim_ocinitstructure.TIM_OCPolarity=TIM_OCPolarity_High;tim_ocinitstructure.TIM_OutputState=TIM_OutputState_Enable;tim_ocinitstructure.TIM_Pulse=1000;TIM_OC1Init(TIM3,&tim_ocinitstructure);//捕获比较模式选择TIM_Cmd(TIM3,ENABLE);//}void z_revolve(){GPIO_SetBits(GPIOB,GPIO_Pin_1);GPIO_ResetBits(GPIOB,GPIO_Pin_2);//电机正转
}void f_revolve(){GPIO_SetBits(GPIOB,GPIO_Pin_2);GPIO_ResetBits(GPIOB,GPIO_Pin_1);//电机反转
}void pwm_duty(int duty){TIM_SetCompare1(TIM3,duty*10);//设定PWM占空比
}

这里提供了对应IO口的使能与输入,并通过电平设定,可以控制电机旋转方向,并且对应PWM占空比也提供了接口进行调节(BIN1接PB1口,BIN2接PB2口,PWM接PA6口)

霍尔编码器模块

对于该款——5840-31ZY编码器,其与电机集成在一起,6个接口,两个连接电机电源(TB6112模块引出),两个连接传感器电源地线,两个连接AB信号(与stm32对应引脚连接,从而利用stm32根据读取AB相值执行相应功能)

 

这里我们只关注其AB相对应关系

#include "stm32f10x.h"                  // Device header
extern int encoder_num;
void encoder_init(void){RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE);//使能时钟GPIO_InitTypeDef gpiob3;gpiob3.GPIO_Mode=GPIO_Mode_IPU;gpiob3.GPIO_Pin=GPIO_Pin_3;gpiob3.GPIO_Speed=GPIO_Speed_50MHz;GPIO_Init(GPIOB,&gpiob3);//初始化A相接口GPIO_InitTypeDef gpiob4;gpiob4.GPIO_Mode=GPIO_Mode_IPU;gpiob4.GPIO_Pin=GPIO_Pin_4;gpiob4.GPIO_Speed=GPIO_Speed_50MHz;GPIO_Init(GPIOB,&gpiob4);//初始化B相接口GPIO_EXTILineConfig(GPIO_PortSourceGPIOB,GPIO_PinSource3);EXTI_InitTypeDef EXTI_INSTRUCTURE;EXTI_INSTRUCTURE.EXTI_Line=EXTI_Line3;EXTI_INSTRUCTURE.EXTI_LineCmd=ENABLE;EXTI_INSTRUCTURE.EXTI_Mode=EXTI_Mode_Interrupt;EXTI_INSTRUCTURE.EXTI_Trigger=EXTI_Trigger_Falling;EXTI_Init(&EXTI_INSTRUCTURE);//中断模式选择,默认高电平,下降沿触发NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);NVIC_InitTypeDef NVIC_INITSTRUCTURE;NVIC_INITSTRUCTURE.NVIC_IRQChannel=EXTI3_IRQn;NVIC_INITSTRUCTURE.NVIC_IRQChannelCmd=ENABLE;NVIC_INITSTRUCTURE.NVIC_IRQChannelPreemptionPriority=1;NVIC_INITSTRUCTURE.NVIC_IRQChannelSubPriority=1;NVIC_Init(&NVIC_INITSTRUCTURE);//中断优先级分组
}void EXTI3_IRQHandler(){
if(EXTI_GetITStatus(EXTI_Line3)==SET){encoder_num++;EXTI_ClearITPendingBit(EXTI_Line3);
}
}//中断处理函数,每当发生中断,即发生脉冲变化,encoder_num加1int get_encodernum(){return encoder_num;//返回encoder_num值}

在这里,我们读取A相电平变化,并且在A相电平由高到低——下降沿触发时,进入中断,执行中断函数,encoder_num加1,我们读取的值即为当前脉冲发生次数,再与电机旋转一周脉冲次数相比较,即可得到当前旋转角度

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.mzph.cn/news/781864.shtml

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈email:809451989@qq.com,一经查实,立即删除!

相关文章

HarmonyOs开发:轮播图Banner组件封装与使用

前言 轮播图在每个项目中都很常见,鸿蒙中在容器组件中也提供了Swiper组件,用于子组件滑动轮播显示,和前端的使用起来也是异曲同工,我们先看下基本的用法。 Swiper() {ForEach(["1", "2", "3", &quo…

每日一题(反转链表)

给你单链表的头节点 head ,请你反转链表,并返回反转后的链表。 206. 反转链表 - 力扣(LeetCode) 示例 1: 输入:head [1,2,3,4,5] 输出:[5,4,3,2,1] 思路一 运用迭代的算法,把头指针…

【智能算法】晶体结构算法(CryStAl)原理及实现

目录 1.背景2.算法原理2.1算法思想2.2算法过程 3.结果展示4.参考文献 1.背景 2021年,S Talatahari等人受到晶体自然结构启发,提出了晶体构造算法(Crystal Structure Algorithm , CryStAl)。 2.算法原理 2.1算法思想 CryStAl受…

Unity Mobile Notifications推送问题

1.在部分机型点击通知弹窗进不去游戏 把这里改成自己的Activity 2.推送的时候没有横幅跟icon红点 主要是第一句话 注册的时候选项可以选择 defaultNotificationChannel new AndroidNotificationChannel(“default_channel”, “Default Channel”, “For Generic notifica…

一文教你如何轻松领取阿里云优惠券

随着云计算技术的飞速发展,越来越多的企业和个人选择使用阿里云作为他们的云服务提供商。为了吸引更多的用户上云,阿里云推出了各种优惠券和促销活动。本文将教大家如何轻松领取阿里云优惠券,以便在购买阿里云产品和服务时享受更多优惠。 一、…

WinServer启用Hyper-V新建虚拟机没有网络、无法开启增强模式、开启远程连接功能

没有网络问题如下: 原因:没有在Hyper-V中新增交换机 操作—虚拟交换机管理器—新建虚拟网络交换机-外部-允许管理员操作系统共享此网络适配器 无法开启增强模式: 开启远程连接功能 或者:

C++:你真的了解匿名对象的生命周期吗?

初步了解匿名对象生命周期 1. 提出问题2. 模拟验证3. 得出结论 不知道有没有人和我一样&#xff0c;在vector的模拟实现部分对于resize接口的实现有一些疑问。 void resize(size_t n , const T& val T()) {if (n > size()){reserve(n);for (size_t i size(); i <…

Kafka开发实录

前言 最近我总是在做大胆的事情&#xff0c;莫不是少年也需要冲冲冲&#xff0c;明明我不是这样的人啊&#xff0c;难不成这就是命运&#xff0c;来自命运石之门的选择&#xff01;废话不多说&#xff0c;本次是Kafka的实战篇&#xff0c;为什么这篇这么快呢&#xff1f;看了开…

golang 在多线程中避免 CPU 指令重排

发布日期&#xff1a;2024-03-26 16:29:39 起因 golang 的发明初衷便是多线程&#xff0c;是一门专门用于多线程高并发的编程语言。其独创的 GMP 模型在多线程的开发上提供了很大的便利。 现代计算机基本上都是多核 CPU 的结构。CPU 在进行指令运行的时候&#xff0c;为了提高…

基于Python的Selenium详细教程

一、PyCharm安装配置Selenium 本文使用环境&#xff1a;windows11、Python 3.10.5、PyCharm 2022.1.3、Selenium 4.3.0 需要你懂的技术&#xff1a;Python、HTML、CSS、JavaScript 1.Seleium安装&#xff1a; 在PyCharm终端或window命令窗口输入以下命令 #查看已安装的Pytho…

EMD关于信号的重建,心率提取

关于EMD的俩个假设&#xff1a; IMF 有两个假设条件&#xff1a; 在整个数据段内&#xff0c;极值点的个数和过零点的个数必须相等或相差最多不能超过一 个&#xff1b;在任意时刻&#xff0c;由局部极大值点形成的上包络线和由局部极小值点形成的下包络线 的平均值为零&#x…

大话设计模式之工厂模式

工厂模式&#xff08;Factory Pattern&#xff09;是一种创建型设计模式&#xff0c;它提供了一种创建对象的最佳方式&#xff0c;而无需指定将要创建的对象的确切类。通过使用工厂模式&#xff0c;我们可以将对象的创建和使用分离&#xff0c;从而使代码更具灵活性和可维护性。…

酒店能源监测管理系统:实现节能减排与提升管理效率的利器

随着全球能源问题的日益突出和可持续发展理念的深入人心&#xff0c;酒店业也在积极探索节能减排的途径。在这一背景下&#xff0c;酒店能源监测管理系统应运而生&#xff0c;成为了酒店行业提升管理效率、降低能源消耗的重要工具。本文将从多个角度介绍酒店能源监测管理系统的…

第十五届蓝桥杯模拟考试II_物联网设计

反思&#xff1a; 本次模拟让我惊醒&#xff0c;写这个作品如同搭积木&#xff0c;在拼接的时候都要仔细检查这个积木是否出bug,确保没有问题再将其拼接到之前搭好的大模块之中&#xff0c;因为就是这样的题目我在处理过程中就遇到了BUG&#xff0c;原因竟出在输入模式要上拉&…

Android 自定义坐标曲线图(二)

Android 自定义坐标曲线图_android 自定义曲线图-CSDN博客 继上一篇文章&#xff0c;点击折线图上的点&#xff0c;显示提示信息进行修改&#xff0c;之前通过回调&#xff0c;调用外部方法&#xff0c;使用popupwindow或dialog来显示&#xff0c;但是这种方法对于弹框显示的位…

电子产品说明书是什么?要怎么才能制作?

电子产品令人着迷&#xff0c;尤其是最新的技术&#xff0c;这就是为什么市场上充斥着各式各样的电子产品。然而&#xff0c;随着电子产品变得越来越复杂&#xff0c;如何正确、安全地使用它们变得越来越重要。这就涉及到了电子产品说明书的具体内容和如何制作。 电子产品说明书…

Thread常用的方法及线程状态原因解析

温馨提示&#xff1a;PC端观看&#xff0c;效果更佳&#xff01; 本文两大部分&#xff1a;介绍一些Thread线程常用的方法&#xff0c;和解析线程的六大状态&#xff01; 目录 一、线程常用的方法 介绍Thread类 1.开启线程 2.获取线程引用 3.休眠线程 4.中断线程 3.等待…

【ERP原理与应用】用友U8实验

实验一、系统管理与基础设置 实验内容&#xff1a; 一、核算体系的建立 好友软件公司是一家软件制造和系统集成企业&#xff0c;其产品面向国内外市场&#xff0c;自 2019 年 3 月公司开始使用 ERP 软件管理业务。软件操作员有三位&#xff0c;黄红是账套 主管&#xff0c;张…

mysql进阶知识总结

1.存储引擎 1.1MySQL体系结构 1).连接层 最上层是一些客户端和链接服务&#xff0c;包含本地sock通信和大多数基于客户端/服务端工具实现的类似于TCP/IP的通信。主要完成一些类似于连接处理、授权认证、及相关的安全方案。在该层上引入了线程池的概念&#xff0c;为通过认证…

机器学习基础——模型评估与选择(部分)

目录 一、前言&#xff1a;误差与拟合 &#xff08;一&#xff09;经验误差 &#xff08;二&#xff09;过拟合、欠拟合 二、评估方法 &#xff08;一&#xff09;评估总体的思路 &#xff08;二&#xff09;如何划分训练集和测试集 1.留出法 2.k折交叉验证 3.自助法 …