RT-Thread Hoist_Motor PID

本节介绍的是一个举升电机，顾名思义，通过转轴控制物体升降，为双通道磁性译码器，利用电调进行操控，具体驱动类似于大学期间最大众的SG180°舵机，在一定的频率下，通过调制脉宽进行控制。
在这里插入图片描述

设备介绍

  • 具体实控
    例如在50Hz情况下，即周期为20ms
    ①驱动信号区间： 区间一(0.5ms-1.5ms )和区间二(1.5ms-2.5ms ) （注意都是开区间且存在死区）
    ②其中区间一和区间二分别表示不同的方向运动，例区间一表示正方向，则区间二表示反方向。
    ③旋转速度呈现为“ V ” 字形，即0.5ms和2.5ms分别表示为正反方向的最快速度，1.5ms左右分别表示正反方向的最慢速度。其中小于等于0.5ms时、1.5ms时和大于等于2.5ms时电机都保持停转状态。

  • 电调引线
    再看电调引线，可注意 分别有7根线，如上图，其中粗线有四根，红黑两根线为电源线，这里接24V，还有两根黄蓝接电机，控制电机不同转向；细线有三根，分别是红黑白，其中红黑为电源线，输出5V，可选择是否需要给MCU供电，黑线接地，白色线为PWM信号输入线，接收MCU发过来的信号进而控制电机转动。

  • 电机引线
    如上图，电机有6根线，跟大众使用的编码器电机无差别，两根电机引线+两根编码器电源线+AB相

  • PID
    由于前几节中已介绍pwm的基本使用，这里就不再介绍，下面我直接介绍我的PID设计
    ①首先在主函数中对PID进行初始化，即设置目标数、比例积分微分常数、输出限幅、积分限幅。
    ②在定时器中断中对旋转产生的脉冲进行采样，然后进行PID运算，将输出信号传入电调。
    ③在P、I、D参数调节中，我习惯先调I，将P和D置0，从小–>大调，观察电机变化，这里我使用的是一个上位机软件VOFA，串口协议，通过上传指定数据，可以很好的观察波形变化，可发现 它呈现出一个缓慢上升的波形，这时可以对I进行放大，加快上升速度，我的调节是：调至I能很好的达到目标点，且在第一次达到目标点时，可以让它超出适量值，再对比左右部分数值，发现这个点的I值达到目标点的速度更快，则这个点就是我要的I值。然后再对P进行调节，也可以选择从小–>大调，P可以很好的反馈出控制器对电机的控制速度，即加大对目标值的反应，具体调节方法同I。最后在对D进行调节（对于一般的控制，PI两个参数足以满足需求，如果最后完美，可再选择D），D表现为误差变化率的变化，可以抑制电机的超调等，对于D，你可以用某物体人为的阻挡电机转动，观察电机变化，例如你提供足够大的阻力，电机肯定会直接拉满，这时观察电机再次回到目标点的时间。

软件设计

  • 1. 设备初始化
/************************** Uart ************************************/
void Uart_Init(void)
{char str[] = "hello RT-Thread!\r\n";/* step1：查找串口设备 */serial = rt_device_find(SAMPLE_UART_NAME);/* step2：修改串口配置参数 */config.baud_rate = BAUD_RATE_115200;        //修改波特率为 115200config.data_bits = DATA_BITS_8;           //数据位 8config.stop_bits = STOP_BITS_1;           //停止位 1config.bufsz     = 128;                   //修改缓冲区 buff size 为 128config.parity    = PARITY_NONE;           //无奇偶校验位/* step3：控制串口设备。通过控制接口传入命令控制字，与控制参数 */rt_device_control(serial, RT_DEVICE_CTRL_CONFIG, &config);/* step4：打开串口设备。以中断接收及轮询发送模式打开串口设备 */rt_device_open(serial, RT_DEVICE_FLAG_INT_RX);
}/************************** Timer ************************************/
void Timer_Init(void)
{rt_hwtimer_mode_t mode;            /* 定时器模式  */rt_hwtimerval_t timeout_s;         /* 定时器超时值  */rt_uint32_t freq = 1000000;       /* 计数频率  */// 使用前必须先手动打开时钟__HAL_RCC_TIM3_CLK_ENABLE();/* 查找定时器设备 */hw_dev = rt_device_find(HWTIMER_DEV_NAME);if (hw_dev == RT_NULL){rt_kprintf("hwtimer sample run failed! can't find %s device!\n", HWTIMER_DEV_NAME);}/* 以读写方式打开设备 */rt_err_t ret = rt_device_open(hw_dev, RT_DEVICE_OFLAG_RDWR);if (ret != RT_EOK){rt_kprintf("open %s device failed!\n", HWTIMER_DEV_NAME);}/* 设置超时回调函数 */rt_device_set_rx_indicate(hw_dev, Timer3_Out);/* 设置计数频率(若未设置该项，默认为1Mhz 或 支持的最小计数频率) */rt_device_control(hw_dev, HWTIMER_CTRL_FREQ_SET, &freq);/* 设置模式为周期性定时器（若未设置，默认是HWTIMER_MODE_ONESHOT）*/mode = HWTIMER_MODE_PERIOD;ret = rt_device_control(hw_dev, HWTIMER_CTRL_MODE_SET, &mode);if (ret != RT_EOK){rt_kprintf("set mode failed! ret is :%d\n", ret);}/* 设置定时器超时值为2s并启动定时器 */timeout_s.sec = 0;      /* 秒 */timeout_s.usec = 40000;     /* 微秒 */if (rt_device_write(hw_dev, 0, &timeout_s, sizeof(timeout_s)) != sizeof(timeout_s)){rt_kprintf("set timeout value failed\n");}
}/************************** PWM ************************************/
void PWM_Init(void)
{/* 查找设备 */pwm_dev = (struct rt_device_pwm *)rt_device_find(PWM_DEV_NAME);if (pwm_dev == RT_NULL){rt_kprintf("pwm sample run failed! can't find %s device!\n", PWM_DEV_NAME);}/* 使能设备 */rt_pwm_enable(pwm_dev, PWM_DEV_CHANNEL1);/* 设置PWM周期和脉冲宽度 */rt_pwm_set(pwm_dev, PWM_DEV_CHANNEL1, period, pulse);
}/************************** Encoder ************************************/
void Encoder_Init(void)
{/* 查找脉冲编码器设备 */pulse_encoder_dev = rt_device_find(PULSE_ENCODER_DEV_NAME);if (pulse_encoder_dev == RT_NULL){rt_kprintf("pulse encoder sample run failed! can't find %s device!\n", PULSE_ENCODER_DEV_NAME);}/* 以只读方式打开设备 */rt_err_t ret = rt_device_open(pulse_encoder_dev, RT_DEVICE_OFLAG_RDONLY);if (ret != RT_EOK){rt_kprintf("open %s device failed!\n", PULSE_ENCODER_DEV_NAME);}
}
  • 2. 以下为位置式PID计算，可供参考
PID_VAR_TYPE Position_PID_Cal(PID * s_PID,PID_VAR_TYPE now_point)
{s_PID->LastResult = s_PID->Result;                 // 简单赋值运算//误差计算s_PID->Error = s_PID->SetPoint - now_point;s_PID->SumError += s_PID->Error;                            //积分误差累加//积分限幅PID_VAR_TYPE IOutValue = s_PID->SumError * s_PID->Integral;if(IOutValue > s_PID->IntegralMax)IOutValue = s_PID->IntegralMax;else if(IOutValue < s_PID->IntegralMin)IOutValue = s_PID->IntegralMin;//PID计算s_PID->Result =  s_PID->Proportion  *  s_PID->Error                          // 比例项+ IOutValue                                                     // 积分项+ s_PID->Derivative  * (s_PID->Error - s_PID->LastError);     // 微分项s_PID->PrevError = s_PID->LastError;                               // 简单赋值运算s_PID->LastError = s_PID->Error;                       // 简单赋值运算//输出限幅if(s_PID->Result > s_PID->OutMax)s_PID->Result = s_PID->OutMax;else if(s_PID->Result < s_PID->OutMin)s_PID->Result = s_PID->OutMin;return s_PID->Result;
}
  • 3. VOFA
    正如上面所介绍的一个上位机软件，可观察PID波形变化，协助开发，具体协议如下所示：
void SendDatatoVoFA(rt_uint8_t byte[],float v_real)
{rt_uint8_t t_test=0;//四位发送rt_uint8_t send_date[4]={0};//发送数据Float_to_Byte(v_real,byte);  //类型转换for(t_test=0;t_test<4;t_test++){rt_device_write(serial, 0, &byte[t_test], 1);}send_date[0]=0X00;send_date[1]=0X00;send_date[2]=0X80;send_date[3]=0X7f;for(t_test=0;t_test<4;t_test++){rt_device_write(serial, 0, &send_date[t_test], 1);}
}
  • 4. 在定时器中断不断进行PID计算，并输出PWM信号
static rt_err_t Timer3_Out(rt_device_t dev, rt_size_t size)
{    rt_device_read(pulse_encoder_dev, 0, &count, 1);  /* 读取脉冲编码器计数值 */rt_int32_t out=Position_PID_Cal(&pid1,count);rt_pwm_set(pwm_dev, PWM_DEV_CHANNEL1, period, out);rt_kprintf("%d - %d\n",count,out);SendDatatoVoFA(byte,count);   //发送到vofa上位机，查看波形rt_device_control(pulse_encoder_dev, PULSE_ENCODER_CMD_CLEAR_COUNT, RT_NULL);/* 清空脉冲编码器计数值 */return 0;
}

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

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

相关文章

数据结构 图

数据结构 图

树是无环连通图&#xff0c;是一种特殊的图。 分类 图分为有向图[边是有方向的]和无向图[边是无方向的]。 无向图(a—b)&#xff0c;建立两条有向图(a—>b&#xff0c;b—>a)&#xff0c;无向图是一种特殊的有向图。 存储有向图 邻接矩阵 ——用于存储比较稠密的图【…
阅读更多...
MyBatis的xml实现

MyBatis的xml实现

1.下载插件MyBatisX 2.添加依赖 <!--Mybatis 依赖包--><dependency><groupId>org.mybatis.spring.boot</groupId><artifactId>mybatis-spring-boot-starter</artifactId><version>2.3.1</version></dependency><!--…
阅读更多...
Rust错误处理机制：优雅地管理错误

Rust错误处理机制：优雅地管理错误

大家好&#xff01;我是lincyang。 今天&#xff0c;我们要探讨的是Rust语言中的错误处理机制。 Rust作为一种系统编程语言&#xff0c;对错误处理的重视程度是非常高的。它提供了一套既安全又灵活的机制来处理可能出现的错误。 Rust错误处理的两大类别 在Rust中&#xff0…
阅读更多...
vue下载xlsx表格

vue下载xlsx表格

vue下载xlsx表格 // 导入依赖库 import XLSX from xlsx; import FileSaver from file-saver; methods:{btn(){let date new Date()let Y date.getFullYear() -let M (date.getMonth() 1 < 10 ? 0 (date.getMonth() 1) : date.getMonth() 1) -let D (date.getDat…
阅读更多...
【设备树添加节点】

【设备树添加节点】

节点结束位置都需要加分号 of_iomap 完成映射 of_property_read_u32_array of_property_read_string of_fine_node_by_path
阅读更多...
如何优雅的避免空指针异常

如何优雅的避免空指针异常

文章目录 1.数据准备2.实战&#xff1a;获取用户所在的城市2.1.直接获取&#xff1b;容易出现空指针异常。2.2.使用if-else判断&#xff1b;避免了出现空指针的问题&#xff0c;但是代码结构层次嵌套多&#xff0c;不美观2.3.使用工具类美化一下if判断代码2.4.使用Optional解决…
阅读更多...
MySQL数据库：开源且强大的关系型数据库管理系统

MySQL数据库：开源且强大的关系型数据库管理系统

大家好&#xff0c;我是咕噜-凯撒&#xff0c;数据在当今信息化时代的重要性不可忽视。作为企业和组织的重要资产&#xff0c;数据的管理和存储变得至关重要&#xff0c;MySQL作为一种关系型数据库管理系统&#xff0c;具有非常多的优势&#xff0c;下面简单的探讨一下MySQL数据…
阅读更多...
基于卷尾猴算法优化概率神经网络PNN的分类预测 - 附代码

基于卷尾猴算法优化概率神经网络PNN的分类预测 - 附代码

基于卷尾猴算法优化概率神经网络PNN的分类预测 - 附代码 文章目录 基于卷尾猴算法优化概率神经网络PNN的分类预测 - 附代码1.PNN网络概述2.变压器故障诊街系统相关背景2.1 模型建立 3.基于卷尾猴优化的PNN网络5.测试结果6.参考文献7.Matlab代码 摘要&#xff1a;针对PNN神经网络…
阅读更多...
【Java程序员面试专栏 专业技能篇】Java SE核心面试指引（二）：面向对象思想

【Java程序员面试专栏 专业技能篇】Java SE核心面试指引（二）：面向对象思想

关于Java SE部分的核心知识进行一网打尽，包括四部分：基础知识考察、面向对象思想、核心机制策略、Java新特性，通过一篇文章串联面试重点，并且帮助加强日常基础知识的理解，全局思维导图如下所示 本篇Blog为第二部分：面向对象思想，子节点表示追问或同级提问 面向对象基…
阅读更多...
按照指定条件对数据进行分组并对每个分组内的全部数据应用自定义函数进行聚合计算groupby().apply()

按照指定条件对数据进行分组并对每个分组内的全部数据应用自定义函数进行聚合计算groupby().apply()

【小白从小学Python、C、Java】 【计算机等考500强证书考研】 【Python-数据分析】 按照指定条件对数据进行分组 并对每个分组内的全部数据 应用自定义函数进行聚合计算 groupby().apply() [太阳]选择题 下列输出正确的是&#xff1a; import pandas as pd data {Name: [A, B,…
阅读更多...
多线程的概念

多线程的概念

点击链接返回标题-> 什么是进程&#xff1f; 进程&#xff08;Process&#xff09;&#xff0c;是程序的基本执行实体。 在早期面向进程设计的计算机结构中&#xff0c;进程是程序的基本执行实体&#xff1b; 在当代面向线程设计的计算机结构中&#xff0c;进程是线程的容器…
阅读更多...
求二叉树中指定节点所在的层数（可运行）

求二叉树中指定节点所在的层数（可运行）

运行环境.cpp 我这里设置的是查字符e的层数&#xff0c;大家可以在main函数里改成自己想查的字符。&#xff08;输入的字符一定是自己树里有的&#xff09;。 如果没有输出结果&#xff0c;一定是建树错误&#xff01;&#xff01;&#xff01;&#xff01;&#xff01;&…
阅读更多...
Maven环境配置

Maven环境配置

Maven环境配置 下载Maven 网址&#xff1a;https://maven.apache.org/download.cgi 如果你的系统是Windows的直接按照箭头指示下载即可 环境变量配置 配置环境变量&#xff1a;将 Maven 的安装目录添加到您的系统环境变量中。 右键点击“我的电脑”&#xff08;或“此电脑…
阅读更多...
Startdrive中上传参数设置的具体方法和注意事项

Startdrive中上传参数设置的具体方法和注意事项

Startdrive中上传参数设置的具体方法和注意事项 适用于配 SINAMICS S120、G130、G150、S150和MV（基于CU3x0-2的驱动器）和所有启动驱动器版本INAMICS G115D/G120/G120D/G120C/G120P/G110M（基于CU2x0-2的驱动器） 根据SINAMICS类型的不同，Startdrive中的Upload参数有所不同。…
阅读更多...
leetcode刷题详解——粉刷房子

leetcode刷题详解——粉刷房子

1. 题目链接&#xff1a;LCR 091. 粉刷房子 2. 题目描述&#xff1a; 假如有一排房子&#xff0c;共 n 个&#xff0c;每个房子可以被粉刷成红色、蓝色或者绿色这三种颜色中的一种&#xff0c;你需要粉刷所有的房子并且使其相邻的两个房子颜色不能相同。 当然&#xff0c;因为…
阅读更多...
Ubuntu20上离线安装samba

Ubuntu20上离线安装samba

如果联网&#xff0c;一条 sudo apt-get install samba就可能解决问题&#xff0c;但是没有网&#xff0c;那么只能一个一个的解决问题&#xff1a; 我以为装了samba-common就可以了&#xff0c;发现smbd.serverice not found,于是开始了漫长的下载依赖包&#xff0c;安装&…
阅读更多...
Linux中Team链路聚合配置

Linux中Team链路聚合配置

目录 一、Team介绍 二、网卡的bonding和Teaming技术 三、Teaming常用工作模式 四、实验环境 五、添加物理网卡 1、给虚拟机新增四张物理网卡 2、查看网卡信息 六、Team链路聚合配置 1、创建team0的网络接口 2、为team0设置静态IP,掩码位&#xff0c;网关&#xff0c;dns…
阅读更多...
Java并发编程第12讲——cancelAcquire()流程详解及acquire方法总结

Java并发编程第12讲——cancelAcquire()流程详解及acquire方法总结

上篇文章介绍了AQS的设计思想以及独占式获取和释放同步状态的源码分析&#xff0c;但是还不够&#xff0c;一是感觉有点零零散散&#xff0c;二是里面还有很多细节没介绍到——比如cancelAcquire()方法&#xff08;重点&#xff09;&#xff0c;迫于篇幅原因&#xff0c;今天就…
阅读更多...
Spring Cloud实战 |分布式系统的流量控制、熔断降级组件Sentinel如何使用

Spring Cloud实战 |分布式系统的流量控制、熔断降级组件Sentinel如何使用

专栏集锦&#xff0c;大佬们可以收藏以备不时之需 Spring Cloud实战专栏&#xff1a;https://blog.csdn.net/superdangbo/category_9270827.html Python 实战专栏&#xff1a;https://blog.csdn.net/superdangbo/category_9271194.html Logback 详解专栏&#xff1a;https:/…
阅读更多...
求二叉树的最大密度（可运行）

求二叉树的最大密度（可运行）

最大密度&#xff1a;二叉树节点数值的最大值 如果没有输出结果&#xff0c;一定是建树错误&#xff01;&#xff01;&#xff01;&#xff01;&#xff01;&#xff01;&#xff01; 我设置输入的是字符型数据&#xff0c;比较的ASCII值。 输入&#xff1a;FBE###CE### 输…
阅读更多...
推荐文章
最新文章

Copyright @ 2022~2023