[问答]

如何利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制？

问答对人有帮助，内容完整，我也想知道答案 0 如何利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制？ 0
2021-9-27 06:58:37　　评论淘帖0 邀请回答您可以邀请以下用户，快速回答问题 × bertvwang 该类别下有 10 个回答。邀请回答纯纯纯牛奶该类别下有 10 个回答。邀请回答幽默该类别下有 9 个回答。邀请回答王伟01 该类别下有 9 个回答。邀请回答 Ehunt 该类别下有 8 个回答。邀请回答 tutu304725938 该类别下有 8 个回答。邀请回答笔画张该类别下有 8 个回答。邀请回答偶是糕富帅该类别下有 8 个回答。邀请回答凌晨3点睡该类别下有 8 个回答。邀请回答 dahairenlyy 该类别下有 8 个回答。邀请回答 hzp_bbs1 该类别下有 8 个回答。邀请回答 fhbding 该类别下有 8 个回答。邀请回答温暖镜头该类别下有 7 个回答。邀请回答 djelje 该类别下有 7 个回答。邀请回答 jenny042 该类别下有 7 个回答。邀请回答雅博电子科技该类别下有 7 个回答。邀请回答回头太晚该类别下有 7 个回答。邀请回答技术牛人小渣子该类别下有 7 个回答。邀请回答王萍该类别下有 7 个回答。邀请回答 ldd1211_ 该类别下有 7 个回答。邀请回答举报李丽华相关推荐 • 如何去实现步进电机的XY精确位置控制 1592 • 步进电机可以实现电机转速和位置的精确控制吗 1285 • 如何利用DSP与FPGA设计运动控制器？ 2285 • PLC步进电机指令可以控制伺服电机吗？ 3545 • 求助伺服电机的控制，速度可调又能精确定位 10246 • 如何选择伺服电机的控制方式 958 • 无刷电机做位置伺服控制的精度问题 9145 • 求大神分享伺服电机的几种常用模式及控制模式的设置 1509 • 如何确定选择伺服电机控制方式 1537 • 求助毕业设计基于Labview语言的《交流伺服电机 PID 控制... 3571 1个回答

答案对人有帮助，有参考价值 0 实验室有个项目涉及到多个步进电机以及伺服电机的控制，需要电机得到一个触发信号后精确移动一段距离。下面以单个伺服电机控制为例，利用伺服电机的指令脉冲加方向位置控制模式实现精确位置控制。关于伺服电机所谓指令脉冲+方向控制模式就是由一路PWM波控制电机转动，一个IO控制电机方向。PWM的占空比控制电机转速，PWM的脉冲数控制电机的转动距离。计算方法如下： *电机转动一圈所需脉冲数=电机驱动内置编码器线数4/电子齿轮数 4为编码器对AB相计数模式若仅对AB相上升沿或者下降沿计数则取2 若对AB相上升沿和下降沿都计数则取4 电子齿轮*即为电机驱动对脉冲的细分数，使控制更加精确。例: 伺服电机编码器为2500线驱动细分为4：1 则一圈脉冲数=25004/4=2500 指令脉冲频率=（需要电机运行的转速 r/min/60）一圈的脉冲数此次操作不涉及到电机速度控制不做介绍一圈所需脉冲数为2500 则一个脉冲转动1/2500圈设电机转动一圈移动距离为C，则一个脉冲移动C/2500 所以通过对脉冲计数可以实现非常精确的位置控制。* 关于PWM脉冲数精确控制 PWM脉冲数精确控制有以下三种方案：利用延时在开始发出脉冲的同时开始延时时长=PWM周期PWM脉冲数这是非常土的方法且弊端显而易见一是延时使系统的实时性降低二是精确度不高两个定时器同步，一个发PWM波另外一个计数* 即将两个定时器时基参数配置相同且同时开启定时器在1个period中产生一个PWM脉冲定时器2在一个period更新时产生一个中断，通过中断使计数变量加一，至设定脉冲数后关闭定时器1。这个方法可以实现精确的脉冲数量控制，但是需要系统频繁的进入中断，如果需要20个PWM脉冲就要触发20次中断进行计数，如果需要20000个PWM脉冲则要触发20000次中断，太浪费系统资源，并且过于频繁的中断会让系统出现跑飞或者其他一些莫名其妙的错误，只有在数量比较小时才适合这种方法。利用STM32自带的定时器主从模式进行计数将主定时器的PWM输出脉冲作为从定时器的时钟，同时将从定时器的period设置为所需脉冲数，当从定时器产生溢出中断时则表示到达了所需脉冲数，即可在中断中关闭主定时器的PWM输出，达到精确的位移控制的目的。这种方法只需要触发一次中断，并且计数非常精确。权衡利弊，本次使用了方法三，需要两个定时器资源，主控为STM32F103ZET6，选用TIM3的CH2作为PWM输出通道即主定时器为TIM3，从定时器选用TIM4。关于STM32主从定时器在stm32中文参考手册”定时器同步“那一小节中有详细介绍选择使用模式1 使用一个定时器（主）作为另一个定时器（从）的预分频器其实就是将stm32的72MHz的时钟由主定时器分为一个周期为主定时器period的新脉冲（可理解为从定时器的新时钟），在主定时器的每个period溢出的那一刻会产生更新事件，由更新事件作为从定时器的时钟。由下表可以看到STM32 TIMX的内部连接，在程序中通过选择ITRX将主从定时器联系起来，如本程序从定时器为TIM4，主定时器选择TIM3，则应选择ITR2. 下面直接上代码：下为伺服电机控制头文件代码下为伺服电机控制头文件代码 #ifndef ms_counter_h #define ms_counter_h #include "sys.h" #define PWM_CLK RCC_APB2Periph_GPIOC //定义PWM输出时钟 #define Motor_CCW GPIO_ResetBits(GPIOE,GPIO_Pin_5) //电机逆时针旋转 #define Motor_CW GPIO_SetBits(GPIOE,GPIO_Pin_5) //电机顺时针旋转 void Master_TIM(u16 period,u16 prescaler,u16 pulse); //主定时器配置函数 void Slave_TIM(u16 period); //从定时器配置函数 void DIR_Crl(void); //方向控制IO配置函数 #endif 下为主/从定时器配置函数代码： #include"stm32f10x.h" #include "MS_Counter.h" /************* 主定时器配置函数 period:PWM周期 prescaler:预分频系数 pulse:占空比控制变量也就是PWM有效电平的宽度 PWM输出IO为GPIOC_7 完全重映射至 TIM3_CH2 ***********/ void Master_TIM(u16 period,u16 prescaler,u16 pulse) { TIM_OCInitTypeDef TIM_OCInitStructure; //OC2初始化结构体 TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; //TIM3时基初始化结构体 GPIO_InitTypeDef GPIO_InitTypeStructure; //GPIO初始化结构体 RCC_APB2PeriphClockCmd(PWM_CLK\|RCC_APB2Periph_GPIOB\|RCC_APB2Periph_AFIO,ENABLE); //使能PWM输出的时钟和复用IO时钟 RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE); //使能主定时器时钟 GPIO_InitTypeStructure.GPIO_Mode=GPIO_Mode_Out_PP; //沙雕核心板默认蜂鸣器开启状态，每次还要专门写代码关蜂鸣器... GPIO_InitTypeStructure.GPIO_Pin=GPIO_Pin_8; GPIO_InitTypeStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOB,&GPIO_InitTypeStructure); GPIO_ResetBits(GPIOB,GPIO_Pin_8); GPIO_InitTypeStructure.GPIO_Mode=GPIO_Mode_AF_PP; //PWM输出IO设为复用推挽 GPIO_InitTypeStructure.GPIO_Pin=GPIO_Pin_7; GPIO_InitTypeStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOC,&GPIO_InitTypeStructure); GPIO_PinRemapConfig(GPIO_FullRemap_TIM3,ENABLE); //完全重映射至TIM3_CH2 /***** 初始化TIM3的时基设定PWM周期和预分频系数 *****/ TIM_TimeBaseInitStructure.TIM_ClockDivision=1; //时钟分频为1即为72MHz TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up; TIM_TimeBaseInitStructure.TIM_Period=period; TIM_TimeBaseInitStructure.TIM_Prescaler=prescaler; TIM_TimeBaseInitStructure.TIM_RepetitionCounter=0; TIM_TimeBaseInit(TIM3,&TIM_TimeBaseInitStructure); /******* 初始化PWM输出通道OC2 设定PWM占空比 *******/ TIM_OCInitStructure.TIM_OCIdleState=ENABLE; TIM_OCInitStructure.TIM_OCMode=TIM_OCMode_PWM1; //PWM模式1 TIM_OCInitStructure.TIM_OCPolarity=TIM_OCPolarity_High; //高电平为有效位 TIM_OCInitStructure.TIM_OutputState=ENABLE; TIM_OCInitStructure.TIM_Pulse=pulse; TIM_OC2Init(TIM3,&TIM_OCInitStructure); TIM_OC2PreloadConfig(TIM3,TIM_OCPreload_Enable); //预装载TIM3的pulse值 TIM_Cmd(TIM3,DISABLE); //初始化过程中不开启TIM3 //中断响应后再开启，保证主从定时器同步工作 TIM_SelectMasterSlaveMode(TIM3,TIM_MasterSlaveMode_Enable); //TIM3选择使能主从模式主定时器 TIM_SelectOutputTrigger(TIM3,TIM_TRGOSource_Update); //TIM3选择更新事件作为 trgo触发源 } /******** 从定时器配置函数 period：TIM4的溢出值即设定的PWM脉冲数 *******/ void Slave_TIM(u16 period) { NVIC_InitTypeDef NVIC_InitStructure; //中断初始化结构体 TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure; //TIM4时基初始化结构体 RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4,ENABLE); //使能TIM4时钟 /**** 初始化TIM4时基设定所需PWM脉冲数 ****/ TIM_TimeBaseInitStructure.TIM_ClockDivision=TIM_CKD_DIV1; //时钟不分频即直接使用 //TIM3脉冲 TIM_TimeBaseInitStructure.TIM_CounterMode=TIM_CounterMode_Up; TIM_TimeBaseInitStructure.TIM_Period=period; TIM_TimeBaseInitStructure.TIM_Prescaler=0; //PWM不分频 TIM_TimeBaseInitStructure.TIM_RepetitionCounter=0; TIM_TimeBaseInit(TIM4,&TIM_TimeBaseInitStructure); TIM_SelectSlaveMode(TIM4,TIM_SlaveMode_External1); //TIM4选择从定时器模式 TIM_SelectInputTrigger(TIM4,TIM_TS_ITR2); //TIM4选择内部触发来源为 //TIM3 TIM_Cmd(TIM4,DISABLE); //同样初始化中不使能TIM4 /*********** 配置TIM4的中断利用TIM4计数溢出作为中断事件关闭TIM3 可达到精确计数的目的 ************/ NVIC_InitStructure.NVIC_IRQChannel=TIM4_IRQn; NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE; NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=2; NVIC_InitStructure.NVIC_IRQChannelSubPriority=2; NVIC_Init(&NVIC_InitStructure); TIM_ITConfig(TIM4,TIM_IT_Update,ENABLE); //TIM4中断触发事件为update } /********* 方向控制IO配置函数 GPIOE_5 高电平顺时针低电平逆时针 *********/ void DIR_Crl(void) { GPIO_InitTypeDef GPIO_InitStructure; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE,ENABLE); GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP; GPIO_InitStructure.GPIO_Pin=GPIO_Pin_5; GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOE,&GPIO_InitStructure); } 使用按键信号来模拟外部触发信号，通过外部中断开启TIM3进行PWM输出，开启TIM4进行计数下为按键配置代码： #include"stm32f10x.h" #include "key.h" /****** 按键配置函数通过外部按键触发中断使主定时器发出设定数量的PWM脉冲也可将按键改为其他触发信号接入按键IO为 GPIOE_4 ********/ void KEY_Config(void) { NVIC_InitTypeDef NVIC_InitStructure; //中断初始化结构体 EXTI_InitTypeDef EXTI_InitStructure; //外部中断通道初始化结构体 GPIO_InitTypeDef GPIO_InitStructure; //按键IO初始化结构体 RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOE\|RCC_APB2Periph_AFIO,ENABLE); //使能按键IO时钟和复用时钟 GPIO_InitStructure.GPIO_Mode=GPIO_Mode_IPU; GPIO_InitStructure.GPIO_Pin=GPIO_Pin_4; GPIO_InitStructure.GPIO_Speed=GPIO_Speed_50MHz; GPIO_Init(GPIOE,&GPIO_InitStructure); GPIO_EXTILineConfig(GPIO_PortSourceGPIOE,GPIO_PinSource4); //选择外部中断通道 EXTI_InitStructure.EXTI_Line=EXTI_Line4; EXTI_InitStructure.EXTI_LineCmd=ENABLE; EXTI_InitStructure.EXTI_Mode=EXTI_Mode_Interrupt; EXTI_InitStructure.EXTI_Trigger=EXTI_Trigger_Falling; EXTI_Init(&EXTI_InitStructure); NVIC_InitStructure.NVIC_IRQChannel=EXTI4_IRQn; NVIC_InitStructure.NVIC_IRQChannelCmd=ENABLE; NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=1; NVIC_InitStructure.NVIC_IRQChannelSubPriority=2; NVIC_Init(&NVIC_InitStructure); } 下为中断服务函数：外部按键按下后触发外部中断在外部中断中将主从定时器同时开启主定时器开始发出设定数量的PWM脉冲 void TIM4_IRQHandler (void) //TIM4中断服务函数 { if (TIM_GetITStatus(TIM4,TIM_IT_Update)!=RESET) { TIM_Cmd(TIM3,DISABLE); //TIM4产生中断后关闭TIM3 TIM_ClearITPendingBit(TIM4,TIM_IT_Update); } } void EXTI4_IRQHandler(void) //按键外部中断服务函数 { if (EXTI_GetITStatus(EXTI_Line4)!=RESET) //按键按下后TIM3/4开启，电机动作 { TIM_Cmd(TIM3,ENABLE); TIM_Cmd(TIM4,ENABLE); } EXTI_ClearITPendingBit(EXTI_Line4); } 下为主函数： include "stm32f10x.h" #include "MS_Counter.h" #include "key.h" #include "delay.h" int main() { NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //配置中断优先级 delay_init(); DIR_Crl(); //电机方向接口初始化 Motor_CCW; //控制电机逆时针旋转 Master_TIM(999,719,399); //主定时器预分频为720，周期为1000则PWM频率为100Hz Slave_TIM(20); //设定脉冲数为20，小数量便于验证 KEY_Config(); delay_ms(10); while(1); } 不多不少正好20个脉冲

2021-9-27 10:33:17 评论举报余彦