[STM32+HAL]DengFOC移植之闭环位置控制

一、源码来源

DengFOC官方文档

二、HAL库配置

1、开启硬件IIC低速模式

低速更稳定

2、PWM波开启

三、keil填写代码

1、AS5600读取编码器数值
#include "AS5600.h"
#include "math.h"float angle_prev=0;
int full_rotations=0; 		// full rotation tracking;
float angle_d;				//GetAngle_Without_Track()的返回值
float angle_cd;				//GetAngle()的返回值//IIC读多字节
void AS5600_Read_Reg(uint16_t reg, uint8_t* buf, uint8_t len)
{HAL_I2C_Mem_Read(&hi2c1, AS5600_ADDRESS, reg, I2C_MEMADD_SIZE_8BIT, buf, len, 100);
}//得到弧度制的角度,范围在0-6.28
float GetAngle_Without_Track(void)
{int16_t in_angle;uint8_t temp[DATA_SIZE]={0};AS5600_Read_Reg( Angle_Hight_Register_Addr, temp, DATA_SIZE);in_angle = ((int16_t)temp[0] <<8) | (temp[1]);angle_d = (float)in_angle * (2.0f*PI) / 4096;
//angle_d为弧度制,范围在0-6.28return angle_d;
}//得到弧度制的带圈数角度
float GetAngle(void)
{float val = angle_d;float d_angle = val - angle_prev;//计算旋转的总圈数//通过判断角度变化是否大于80%的一圈(0.8f*6.28318530718f)来判断是否发生了溢出,如果发生了,则将full_rotations增加1(如果d_angle小于0)或减少1(如果d_angle大于0)。if(fabs(d_angle) > (0.8f*2.0f*PI) ) full_rotations += ( d_angle > 0 ) ? -1 : 1;angle_prev = val;angle_cd = full_rotations * (2.0f*PI) + angle_prev;return angle_cd;
}void Track(void)
{GetAngle_Without_Track();GetAngle();
}

2、闭环FOC控制
#include "AS5600.h"
#include "FOC1.h"
#include <math.h>#define PWMA TIM1 -> CCR1
#define PWMB TIM1 -> CCR2
#define PWMC TIM1 -> CCR3
#define CNT  TIM1 -> ARR-1float voltage_limit=12.6;
float voltage_power_supply=12.6;
float shaft_angle=0,open_loop_timestamp=0;
float zero_electric_angle=0,Ualpha,Ubeta=0,Ua=0,Ub=0,Uc=0,dc_a=0,dc_b=0,dc_c=0;
int PP=7,DIR=-1;float _electricalAngle(void){return  _normalizeAngle((float)(DIR *  PP) * GetAngle_Without_Track()-zero_electric_angle);
}// 归一化角度到 [0,2PI]
float _normalizeAngle(float angle){float a = fmod(angle, 2*PI);   //取余运算可以用于归一化,列出特殊值例子算便知return a >= 0 ? a : (a + 2*PI);
}// 设置PWM到控制器输出
void setPwm(float Ua, float Ub, float Uc) {// 限制上限Ua = _constrain(Ua, 0.0f, voltage_limit);Ub = _constrain(Ub, 0.0f, voltage_limit);Uc = _constrain(Uc, 0.0f, voltage_limit);// 计算占空比// 限制占空比从0到1dc_a = _constrain(Ua / voltage_power_supply, 0.0f , 1.0f );dc_b = _constrain(Ub / voltage_power_supply, 0.0f , 1.0f );dc_c = _constrain(Uc / voltage_power_supply, 0.0f , 1.0f );//写入PWM到PWM 0 1 2 通道PWMA = dc_a*5599;PWMB = dc_b*5599;PWMC = dc_c*5599;
}void setPhaseVoltage(float Uq,float Ud, float angle_el) {angle_el = _normalizeAngle(angle_el);// 帕克逆变换Ualpha =  -Uq*sin(angle_el);Ubeta =   Uq*cos(angle_el);// 克拉克逆变换Ua = Ualpha + voltage_power_supply/2;Ub = (sqrt(3)*Ubeta-Ualpha)/2 + voltage_power_supply/2;Uc = (-Ualpha-sqrt(3)*Ubeta)/2 + voltage_power_supply/2;setPwm(Ua,Ub,Uc);
}//初始化FOC,校准零点
void FOC_Init(void)
{setPhaseVoltage(3, 0,_3PI_2);HAL_Delay(1000);zero_electric_angle=_electricalAngle();setPhaseVoltage(0, 0,_3PI_2);
}

3、main.c
/* USER CODE BEGIN PV */
extern float voltage_limit;
extern float voltage_power_supply;
extern float shaft_angle,open_loop_timestamp;
extern float zero_electric_angle,Ualpha,Ubeta,Ua,Ub,Uc,dc_a,dc_b,dc_c;
extern int PP,DIR;float motor_target = 4;
/* USER CODE END PV */  /* USER CODE BEGIN 2 */printf("Hello World\r\n");HAL_Delay(500);HAL_TIM_PWM_Start(&htim1,TIM_CHANNEL_1);HAL_TIM_PWM_Start(&htim1,TIM_CHANNEL_2);HAL_TIM_PWM_Start(&htim1,TIM_CHANNEL_3);FOC_Init();HAL_TIM_Base_Start_IT(&htim2);/* USER CODE END 2 *//* Infinite loop *//* USER CODE BEGIN WHILE */while (1){float Sensor_Angle=GetAngle();float Kp=0.133;setPhaseVoltage(_constrain(Kp*(motor_target-DIR*Sensor_Angle)*180/PI,-6,6),0,_electricalAngle());/* USER CODE END WHILE *//* USER CODE BEGIN 3 */}/* USER CODE END 3 */

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

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

相关文章

hive窗口函数数据范围

window的内包括&#xff1a; (ROWS | RANGE) BETWEEN (UNBOUNDED | [num]) PRECEDING AND ([num] PRECEDING | CURRENT ROW | (UNBOUNDED | [num]) FOLLOWING) (ROWS | RANGE) BETWEEN CURRENT ROW AND (CURRENT ROW | (UNBOUNDED | [num]) FOLLOWING) (ROWS | RANGE) BETWEEN…

前端面试题(小整理)

vue中的生命周期钩子有哪些 beforeCreate&#xff1a; 在实例初始化之后&#xff0c;数据观测 (data observer) 和事件配置 (event/watcher setup) 之前被调用。 在此阶段&#xff0c;实例的属性和方法还未初始化。 created&#xff1a; 在实例创建完成后被立即调用。 可以访问…

文心一言VSchatGPT4

文心一言和GPT-4各有优势&#xff0c;具体表现在不同的测试场景下。 在某些测试场景中心一言的表现优于GPT-4&#xff0c;例如在故事的完整度和情节吸引力方面&#xff0c;文心一言表现得更加符合指令&#xff0c;情节更吸引人。这可能得益于其模型在训练时对中文语境的深入理…

选择电源自动化测试系统,要考虑哪些因素?

随着科技的发展以及市场需求的变化&#xff0c;手动测试以及传统自动化测试不足日益明显&#xff0c;已无法满足当前的电源测试需求&#xff0c;因此&#xff0c;选择全新的自动化测试系统成为必然趋势。那么&#xff0c;要如何选择可靠、高效的电源自动化测试系统呢&#xff1…

计算机网络——网络地址转换(NAT)技术

目录 前言 前篇 引言 SNAT&#xff08;Source Network Address Translation&#xff09;源网络地址转换 SNAT流程 确定性标记 DNAT&#xff08;Destination Network Address Translation&#xff0c;目标网络地址转换&#xff09; NAT技术重要性 前言 本博客是博主用于…

15 Python进阶: random和pyecharts

Python random 模块主要用于生成随机数。 random 模块实现了各种分布的伪随机数生成器。 要使用 random 函数必须先导入&#xff1a; import randompython random 模块的一般用法 Python中的random模块提供了生成伪随机数的功能&#xff0c;可以用于模拟、游戏开发、密码学…

【Spring Boot 源码学习】SpringApplication 的 run 方法核心流程介绍

《Spring Boot 源码学习系列》 SpringApplication 的 run 方法核心流程介绍 一、引言二、往期内容三、主要内容3.1 run 方法源码初识3.2 引导上下文 BootstrapContext3.3 系统属性【java.awt.headless】3.4 早期启动阶段3.5 准备和配置应用环境3.6 打印 Banner 信息3.7 新建应用…

TCP 粘包

从应用层到 TCP 传输层的多个数 据包是一连串的字节流是没有边界的&#xff0c;而且 TCP 首部并没有记录数据包的长度&#xff0c;所以 TCP 传输数据的时候可能会发送粘包和拆包的问题&#xff1b;而 UDP 是基于数据报传输数据的&#xff0c;UDP 首部也记录了数据报的长度&…

Blender表面细分的操作

在使用Blender的过程中,刚开始创建的模型,都会比较少面,这样操作起来比较流畅,减少电脑的计算量,当设计快要完成时,就会增加表面细分,这样更加圆滑,看起来更加顺眼。 比如创建一个猴头,它会默认显示如下: 从上图可以看到,有一些表面会比较大,棱角很多。 这时候你…

java声明一个日期类MyDate

声明一个日期类MyDate&#xff0c;包含如下方法&#xff1a; * - boolean isLeapYear()&#xff1a;判断是否是闰年 * - String monthName()&#xff1a;根据月份值&#xff0c;返回对应的英语单词 * - int totalDaysOfMonth()&#xff1a;返回这个月的总天数 * - int totalDay…

win11如何重新安装应用商店,怎么重装应用商店

win11系统内置了应用商店&#xff0c;相当于手机的应用商城&#xff0c;用户们想要下载软件时&#xff0c;就会前往应用商店搜索下载。如果我们因为误操作&#xff0c;删除了win11应用商店&#xff0c;或者是应用商店出现闪退、卡顿等问题&#xff0c;这个时候&#xff0c;最好…

插值算法-代码实现

1、 import java.util.HashMap; import java.util.Map;public class Interpolation {public static void main(String[] args) {// 定义给定的 XML 字段值Map<String, double[]> xmlValues new HashMap<>();xmlValues.put("faceSize", new double[]{10…

MyBatis-Spring整合

引入Spring之前需要了解mybatis-spring包中的一些重要类&#xff1b; http://www.mybatis.org/spring/zh/index.html 什么是 MyBatis-Spring&#xff1f; MyBatis-Spring 会帮助你将 MyBatis 代码无缝地整合到 Spring 中。 知识基础 在开始使用 MyBatis-Spring 之前&#x…

Python学习笔记23 - 目录操作

os模块操作目录相关函数 os.path模块操作目录相关函数 案例1 —— 列出指定目录下的所有.py文件 案例2 —— walk()

掌握ChatGPT:高效撰写科研论文的必备利器

ChatGPT无限次数:点击直达 掌握ChatGPT&#xff1a;高效撰写科研论文的必备利器 在当今科研领域&#xff0c;撰写高质量的论文是每位研究者不可或缺的任务。然而&#xff0c;研究者常常在文稿撰写过程中遇到写作思路不清晰、表达不够准确甚至同义词重复等问题。针对这些挑战&a…

MySQL 8.0 字符集问题导致报错

报错&#xff1a; ### Error querying database. Cause: java.sql.SQLException: Illegal mix of collations (utf8_general_ci,IMPLICIT) and (utf8mb4_0900_ai_ci,COERCIBLE) MySQL 8.0引入了一些新的字符集和排序规则&#xff0c;并对现有的进行了改进。在MySQL 8.0中&#…

vue大屏

使用viewport方案和postcss-px-to-viewport插件来实现屏幕适配&#xff0c;主要是为了让你的Vue大屏应用在不同尺寸和分辨率的屏幕上都能良好地显示。以下是一个简单的实现步骤&#xff1a; 1.安装 npm install postcss-px-to-viewport --save-dev # 或者 yarn add postcs…

内网渗透-红队内网渗透工具(Viper)

红队内网渗透工具(Viper) 最近发现一款很强大的内网渗透工具Viper 接下来我给大家介绍一下具体的安装过程&#xff0c;这里我在kali上进行安装 &#xff08;1&#xff09;首先打开kali终端&#xff0c;切换到root用户,确认以下操作都在root用户下操作&#xff0c;sudo -s 安装…

Leetcode 3112. Minimum Time to Visit Disappearing Nodes

Leetcode 3112. Minimum Time to Visit Disappearing Nodes 1. 解题思路2. 代码实现 题目链接&#xff1a;3112. Minimum Time to Visit Disappearing Nodes 1. 解题思路 这一题的话思路上来说就是一个最优路径的问题&#xff0c;我们通过一个遍历&#xff0c;即可获得从0节…

【MATLAB源码-第16期】基于matlab的MSK定是同步仿真,采用gardner算法和锁相环

1、算法描述 **锁相环&#xff08;PLL&#xff09;** 是一种控制系统&#xff0c;用于将一个参考信号的相位与一个输入信号的相位同步。它在许多领域中都有应用&#xff0c;如通信、无线电、音频、视频和计算机系统。锁相环通常由以下几个关键组件组成&#xff1a; 1. **相位…