单片机伺服电机加减速控制子程序

该代码实现了一个电机自动加减速控制程序。通过设置加减速标志MtAdDc_FLAG,程序分为加速和减速两个阶段:加速时根据运行距离分三个阶段调整速度(3mm内3倍延时、3-20mm内2倍延时、20mm以上正常速度);减速时根据剩余距离分三个阶段(30-20mm内2倍延时、20-10mm内3倍延时、10mm以下4倍延时)。通过调整脉冲间隔时间实现速度控制,最终输出高低电平脉冲驱动电机运行。程序包含距离判断、速度调节和脉冲输出等功能模块,实现了电机的平滑启停控制。

/***电机运行子程序运动值valmt运动值缓冲器val10*/

/******自动加减速 ------------*****/

/******进入子程序加减速标志MtAdDc_FLAG置1******/

/*---电机起始加速-----------------------------*/

/***电机起始3mm脉冲延时*3,3-20mm脉冲延时*2. ***/

/***大于200mm脉冲延时等于设置值 ***/

/*--------------------------------------------*/

/*---电机停止减速-----------------------------*/

/***小于30mm大于20mm开始减速(val_mtspeed*2) ***/

/***小于20mm大于10mm减速延时(val_mtspeed*3) ***/

/***缓冲器值小余10mm减速延时(val_mtspeed*4) ***/

/*--------------------------------------------*/

void Motor_Run1() /**/

{

MtAdDc_FLAG=1; //加减速标志置1,加速延时判断。加速结束置0,减速脉冲延时判断

for(val10>0;val10--;) //实际值与自动设定值之差

{

/////

if(MtAdDc_FLAG==1) //起步电机慢速 中速 全速三个阶段

{

if(valmt-val10<30) //电机运行总值减缓冲器值 3mm

MtAdDc_mtspeed=val_mtspeed*3; //3倍定时设定值 慢速启动

else if(valmt-val10<200&valmt-val10>30) //20mm---3mm

MtAdDc_mtspeed=val_mtspeed*2; //2倍定时设定值

else if(valmt-val10<300&valmt-val10>200) //30mm---20mm

{ //定时设定值

MtAdDc_mtspeed=val_mtspeed;

// P0=MtAdDc_mtspeed; //??? P0

MtAdDc_FLAG=0; //加减速标志置零,判断结束

}

}

/////

/////

else if(MtAdDc_FLAG==0) //电机减速判断

{

if(val10<300&val10>200) //小于30mm大于20mm开始减速(val_mtspeed*2)

{

MtAdDc_mtspeed=val_mtspeed*2;

}

else if(val10<200&val10>100) //小于20mm大于10mm减速延时(val_mtspeed*3)

{

MtAdDc_mtspeed=val_mtspeed*3;

}

else if(val10<100) //缓冲器值小余10mm减速延时(val_mtspeed*4)

{

MtAdDc_mtspeed=val_mtspeed*4;

}

}

/////

/////

for(k=0;k<coefficient;k++) //电机比例因子,K循环等于coefficient发一次脉冲

{

MTORCP=0; /*子函数开始*/

delay1ms(MtAdDc_mtspeed); //

MTORCP=1;

delay1ms(MtAdDc_mtspeed);

}

/////

}

}

相关推荐
冻柠檬飞冰走茶1 小时前
PTA基础编程题目集 7-17 爬动的蠕虫(C语言实现)
c语言·开发语言·数据结构·算法
崇山峻岭之间1 小时前
小华芯片HC32F460之TMR6输出互补PWM
单片机·嵌入式硬件
麻瓜老宋13 小时前
AI开发C语言应用按步走,表达式计算器calc的第二十二步,分号赋值链式修复、TOKEN_ASSIGN
c语言·开发语言·atomcode
Freak嵌入式15 小时前
MCU 低功耗模式解析:时钟门控、电源门控、深度休眠
人工智能·python·单片机·嵌入式硬件·开源·依赖倒置原则·micropython
国科安芯16 小时前
FreeRTOS RISC-V 浮点上下文切换移植:在 IAR 工程中完整保存 FPU 寄存器
java·开发语言·单片机·嵌入式硬件·算法·系统架构·risc-v
躺不平的理查德16 小时前
STM32时钟树(Clock Tree)
stm32·单片机·嵌入式硬件
Javenwww17 小时前
STM32中DMA的使用——串口数据的DMA传输
单片机
qq_4017004117 小时前
经典的电压基准源电路
单片机·嵌入式硬件
SilentSlot18 小时前
【C/C++】手写 DPDK 协议栈(十一):基于 PPS、SYN 比例和源 IP 熵的 DDoS 检测
c语言·c++·tcp/ip
西安景驰电子19 小时前
PCIe 授时卡原理及应用
运维·服务器·windows·单片机·嵌入式硬件·fpga开发