麦轮控制32f4

2023-10-29 14:40
文章标签 控制 麦轮 32f4

本文主要是介绍麦轮控制32f4，希望对大家解决编程问题提供一定的参考价值，需要的开发者们随着小编来一起学习吧！

在这里插入图片描述

#include "motor.h"
double CNT_10ms[4]={0};//每5ms脉冲数
double CNT_10ms_old[4]={0};
static void Dis_Gpio_Init(void)
{GPIO_InitTypeDef  GPIO_InitStructure;RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOE, ENABLE);GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7|GPIO_Pin_8|GPIO_Pin_10|GPIO_Pin_12;GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;//普通输出模式GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;//推挽输出GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;//100MHzGPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;//上拉GPIO_Init(GPIOE, &GPIO_InitStructure);//初始化GPIOGPIO_SetBits(GPIOE,GPIO_Pin_7|GPIO_Pin_8|GPIO_Pin_10|GPIO_Pin_12);
}
static void pwm_init(void)//GPIO_AF_TIM1,,pwm初始化 pe
{GPIO_InitTypeDef GPIO_InitStructure;TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;TIM_OCInitTypeDef  TIM_OCInitStructure;RCC_AHB1PeriphClockCmd (RCC_AHB1Periph_GPIOE, ENABLE); //开启引脚时钟GPIO_PinAFConfig(GPIOE,GPIO_PinSource9,GPIO_AF_TIM1); GPIO_PinAFConfig(GPIOE,GPIO_PinSource11,GPIO_AF_TIM1);GPIO_PinAFConfig(GPIOE,GPIO_PinSource13,GPIO_AF_TIM1);GPIO_PinAFConfig(GPIOE,GPIO_PinSource14,GPIO_AF_TIM1);//复用引脚														   GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9|GPIO_Pin_11|GPIO_Pin_13|GPIO_Pin_14;	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;    GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz; GPIO_Init(GPIOE, &GPIO_InitStructure);//初始化引脚RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE); //开启定时器时钟TIM_TimeBaseStructure.TIM_Period = 1200-1;       TIM_TimeBaseStructure.TIM_Prescaler = 14-1;	TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;TIM_TimeBaseStructure.TIM_CounterMode=TIM_CounterMode_Up;TIM_TimeBaseStructure.TIM_RepetitionCounter=0;TIM_TimeBaseInit(TIM1, &TIM_TimeBaseStructure);//初始化定时器 TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;	   TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;	TIM_OCInitStructure.TIM_Pulse = 600-1;TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;  	 TIM_OC1Init(TIM1, &TIM_OCInitStructure);	TIM_OC2Init(TIM1, &TIM_OCInitStructure);	TIM_OC3Init(TIM1, &TIM_OCInitStructure);	TIM_OC4Init(TIM1, &TIM_OCInitStructure);//配置pwmTIM_OC1PreloadConfig(TIM1, TIM_OCPreload_Enable);TIM_OC2PreloadConfig(TIM1, TIM_OCPreload_Enable);TIM_OC3PreloadConfig(TIM1, TIM_OCPreload_Enable);TIM_OC4PreloadConfig(TIM1, TIM_OCPreload_Enable);//使能通道重载TIM_Cmd(TIM1, ENABLE);	//开启定时器TIM_CtrlPWMOutputs(TIM1, ENABLE);
}void Encoder_init(void)//正交解码初始化
{GPIO_InitTypeDef GPIO_InitStructure;TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;TIM_ICInitTypeDef TIM_ICInitStructure;  RCC_AHB1PeriphClockCmd (RCC_AHB1Periph_GPIOA|RCC_AHB1Periph_GPIOB|RCC_AHB1Periph_GPIOC|RCC_AHB1Periph_GPIOD, ENABLE); //开启引脚时钟GPIO_PinAFConfig(GPIOA,GPIO_PinSource15,GPIO_AF_TIM2); GPIO_PinAFConfig(GPIOB,GPIO_PinSource3,GPIO_AF_TIM2);GPIO_PinAFConfig(GPIOC,GPIO_PinSource6,GPIO_AF_TIM8);GPIO_PinAFConfig(GPIOC,GPIO_PinSource7,GPIO_AF_TIM8);GPIO_PinAFConfig(GPIOD,GPIO_PinSource12,GPIO_AF_TIM4);GPIO_PinAFConfig(GPIOD,GPIO_PinSource13,GPIO_AF_TIM4);GPIO_PinAFConfig(GPIOA,GPIO_PinSource0,GPIO_AF_TIM5);GPIO_PinAFConfig(GPIOA,GPIO_PinSource1,GPIO_AF_TIM5);//复用引脚		GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0|GPIO_Pin_1|GPIO_Pin_15;	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;    GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz; GPIO_Init(GPIOA, &GPIO_InitStructure);GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3;	GPIO_Init(GPIOB, &GPIO_InitStructure);GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6|GPIO_Pin_7;GPIO_Init(GPIOC, &GPIO_InitStructure);GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12|GPIO_Pin_13;GPIO_Init(GPIOD, &GPIO_InitStructure);//初始化引脚RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM8, ENABLE); RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2|RCC_APB1Periph_TIM4|RCC_APB1Periph_TIM5, ENABLE); //开启定时器时钟TIM_TimeBaseStructure.TIM_Period = 0xffff;       TIM_TimeBaseStructure.TIM_Prescaler = 1-1;	TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;TIM_TimeBaseStructure.TIM_CounterMode=TIM_CounterMode_Up;TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure);TIM_TimeBaseInit(TIM8, &TIM_TimeBaseStructure);TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure);TIM_TimeBaseInit(TIM5, &TIM_TimeBaseStructure);//初始化定时器TIM_EncoderInterfaceConfig(TIM2, TIM_EncoderMode_TI12, TIM_ICPolarity_BothEdge ,TIM_ICPolarity_BothEdge);TIM_EncoderInterfaceConfig(TIM8, TIM_EncoderMode_TI12, TIM_ICPolarity_BothEdge ,TIM_ICPolarity_BothEdge);TIM_EncoderInterfaceConfig(TIM4, TIM_EncoderMode_TI12, TIM_ICPolarity_BothEdge ,TIM_ICPolarity_BothEdge);TIM_EncoderInterfaceConfig(TIM5, TIM_EncoderMode_TI12, TIM_ICPolarity_BothEdge ,TIM_ICPolarity_BothEdge);TIM_ICStructInit(&TIM_ICInitStructure);TIM_ICInitStructure.TIM_ICFilter = 0;TIM_ICInit(TIM2,&TIM_ICInitStructure);TIM_ICInit(TIM8,&TIM_ICInitStructure);TIM_ICInit(TIM4,&TIM_ICInitStructure);TIM_ICInit(TIM5,&TIM_ICInitStructure);//配置正交解码TIM_Cmd(TIM2, ENABLE);	TIM_Cmd(TIM8, ENABLE); TIM_Cmd(TIM4, ENABLE); TIM_Cmd(TIM5, ENABLE); //开启定时器TIM2->CNT=0;TIM8->CNT=0;TIM4->CNT=0;TIM5->CNT=0;
}void Get_Encoder(void)
{s16 temp;temp=(s16)((u16)(TIM2->CNT));CNT_10ms[0]=(double)temp*0.95+CNT_10ms_old[0]*0.05;CNT_10ms_old[0]=CNT_10ms[0];TIM2->CNT=0;temp=-(s16)((u16)(TIM8->CNT));CNT_10ms[1]=(double)temp*0.95+CNT_10ms_old[1]*0.05;CNT_10ms_old[1]=CNT_10ms[1];TIM8->CNT=0;temp=-(s16)((u16)(TIM4->CNT));CNT_10ms[2]=(double)temp*0.95+CNT_10ms_old[2]*0.05;CNT_10ms_old[2]=CNT_10ms[2];TIM4->CNT=0;temp=(s16)((u16)(TIM5->CNT));CNT_10ms[3]=(double)temp*0.95+CNT_10ms_old[3]*0.05;CNT_10ms_old[3]=CNT_10ms[3];TIM5->CNT=0;
}void motor_control(void)//电机控制
{TIM1->CCR3=motor_1.motor_uk+600;TIM1->CCR4=-motor_2.motor_uk+600;TIM1->CCR2=-motor_3.motor_uk+600;TIM1->CCR1=motor_4.motor_uk+600;
}
void Enable_Motor(void)
{GPIO_ResetBits(GPIOE,GPIO_Pin_7|GPIO_Pin_8|GPIO_Pin_10|GPIO_Pin_12);
}
void Disenable_Motor(void)
{GPIO_SetBits(GPIOE,GPIO_Pin_7|GPIO_Pin_8|GPIO_Pin_10|GPIO_Pin_12);
}
void Motor_Init(void)
{Dis_Gpio_Init();pwm_init();    Encoder_init();
}void Mecanum_Wheel_Motor_Calculate(float front_back,float left_right,float clockwise_anticlockwise)
{float duty[4]={0};duty[0]+=front_back;duty[1]+=front_back;duty[2]+=front_back;duty[3]+=front_back;duty[0]+=left_right;duty[2]+=left_right;duty[1]-=left_right;duty[3]-=left_right;duty[0]+=clockwise_anticlockwise;duty[3]+=clockwise_anticlockwise;duty[1]-=clockwise_anticlockwise;duty[2]-=clockwise_anticlockwise;motor_1.motor_point=duty[0];motor_2.motor_point=duty[1];motor_3.motor_point=duty[2];motor_4.motor_point=duty[3];
}

这篇关于麦轮控制32f4的文章就介绍到这儿，希望我们推荐的文章对编程师们有所帮助！


http://www.chinasem.cn/article/301328。

相关文章

SpringBoot请求参数接收控制指南分享

SpringBoot请求参数接收控制指南分享

《SpringBoot请求参数接收控制指南分享》：本文主要介绍SpringBoot请求参数接收控制指南,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录Spring Boot 请求参数接收控制指南1. 概述2. 有注解时参数接收方式对比3. 无注解时接收参数默认位置
阅读更多...
Spring Security+JWT如何实现前后端分离权限控制

Spring Security+JWT如何实现前后端分离权限控制

《SpringSecurity+JWT如何实现前后端分离权限控制》本篇将手把手教你用SpringSecurity+JWT搭建一套完整的登录认证与权限控制体系,具有很好的参考价值,希望对大家... 目录Spring Security+JWT实现前后端分离权限控制实战一、为什么要用 JWT？二、JWT 基本结构
阅读更多...
Android实现两台手机屏幕共享和远程控制功能

Android实现两台手机屏幕共享和远程控制功能

《Android实现两台手机屏幕共享和远程控制功能》在远程协助、在线教学、技术支持等多种场景下,实时获得另一部移动设备的屏幕画面,并对其进行操作,具有极高的应用价值,本项目旨在实现两台Android手... 目录一、项目概述二、相关知识2.1 MediaProjection API2.2 Socket 网络
阅读更多...
用js控制视频播放进度基本示例代码

用js控制视频播放进度基本示例代码

《用js控制视频播放进度基本示例代码》写前端的时候,很多的时候是需要支持要网页视频播放的功能,下面这篇文章主要给大家介绍了关于用js控制视频播放进度的相关资料,文中通过代码介绍的非常详细,需要的朋友可... 目录前言html部分:JavaScript部分:注意：总结前言在javascript中控制视频播放
阅读更多...
Python异步编程中asyncio.gather的并发控制详解

Python异步编程中asyncio.gather的并发控制详解

《Python异步编程中asyncio.gather的并发控制详解》在Python异步编程生态中,asyncio.gather是并发任务调度的核心工具,本文将通过实际场景和代码示例,展示如何结合信号量... 目录一、asyncio.gather的原始行为解析二、信号量控制法：给并发装上"节流阀"三、进阶控制
阅读更多...
使用DrissionPage控制360浏览器的完美解决方案

使用DrissionPage控制360浏览器的完美解决方案

《使用DrissionPage控制360浏览器的完美解决方案》在网页自动化领域,经常遇到需要保持登录状态、保留Cookie等场景,今天要分享的方案可以完美解决这个问题：使用DrissionPage直接... 目录完整代码引言为什么要使用已有用户数据？核心代码实现1. 导入必要模块2. 关键配置（重点！）3.
阅读更多...
SpringSecurity 认证、注销、权限控制功能(注销、记住密码、自定义登入页)

SpringSecurity 认证、注销、权限控制功能(注销、记住密码、自定义登入页)

《SpringSecurity认证、注销、权限控制功能(注销、记住密码、自定义登入页)》SpringSecurity是一个强大的Java框架,用于保护应用程序的安全性,它提供了一套全面的安全解决方案... 目录简介认识Spring Security“认证”（Authentication）“授权” （Auth
阅读更多...
python之流程控制语句match-case详解

python之流程控制语句match-case详解

《python之流程控制语句match-case详解》：本文主要介绍python之流程控制语句match-case使用,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录match-case 语法详解与实战一、基础值匹配（类似 switch-case）二、数据结构解构匹
阅读更多...
Spring Security注解方式权限控制过程

Spring Security注解方式权限控制过程

《SpringSecurity注解方式权限控制过程》：本文主要介绍SpringSecurity注解方式权限控制过程,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、摘要二、实现步骤2.1 在配置类中添加权限注解的支持2.2 创建Controller类2.3 Us
阅读更多...
Python中如何控制小数点精度与对齐方式

Python中如何控制小数点精度与对齐方式

《Python中如何控制小数点精度与对齐方式》在Python编程中,数据输出格式化是一个常见的需求,尤其是在涉及到小数点精度和对齐方式时,下面小编就来为大家介绍一下如何在Python中实现这些功能吧... 目录一、控制小数点精度1. 使用 round() 函数2. 使用字符串格式化二、控制对齐方式1. 使用
阅读更多...

Copyright China编程 23002807@qq.com

沪ICP备2023033072号-2