機械臂共有六個舵機斥季， 舵機通過PWM輸出波形控制训桶，波形的高電平持續(xù)時間對應(yīng)旋轉(zhuǎn)的角度， 實現(xiàn)0~180°的旋轉(zhuǎn)角度酣倾，疑問:能否實現(xiàn)舵機旋轉(zhuǎn)角度的平滑輸出舵揭？
由于控制的舵機較多，所以用了TIM2躁锡、TIM3兩個定時器輸出六路PWM午绳，注意調(diào)用GPIO_PinRemapConfig函數(shù)，用來開啟GPIO管腳部分映射功能.配置1~4輸出通道映之。
硬件連接： 舵機用外置直流電源供電拦焚，注意直流電源和開發(fā)板GND要相連
TIM1的初始化配置
void Tim1_PWM_Init(void)
{
TIM_TimeBaseInitTypeDef TIM_TimeBaseStruct;
TIM_OCInitTypeDef TIM_OCInitStructure;
GPIO_PinRemapConfig(GPIO_PartialRemap_TIM3,ENABLE);
//定時器初始化
TIM_TimeBaseStruct.TIM_Period=20000;//初值
TIM_TimeBaseStruct.TIM_Prescaler=72;//預(yù)分頻
TIM_TimeBaseStruct.TIM_ClockDivision=0;
TIM_TimeBaseStruct.TIM_CounterMode=TIM_CounterMode_Up;//向上
TIM_TimeBaseInit(TIM3,&TIM_TimeBaseStruct);
//pwm 初始化
TIM_OCInitStructure.TIM_OCMode=TIM_OCMode_PWM2;
TIM_OCInitStructure.TIM_OutputState=TIM_OutputState_Enable;
TIM_OCInitStructure.TIM_OCPolarity=TIM_OCPolarity_Low;
TIM_OC1Init(TIM3,&TIM_OCInitStructure);
TIM_OC1PreloadConfig(TIM3,TIM_OCPreload_Enable);
TIM_OC2Init(TIM3,&TIM_OCInitStructure);
TIM_OC2PreloadConfig(TIM3,TIM_OCPreload_Enable);
TIM_OC3Init(TIM3,&TIM_OCInitStructure);
TIM_OC3PreloadConfig(TIM3,TIM_OCPreload_Enable);
TIM_OC4Init(TIM3,&TIM_OCInitStructure);
TIM_OC4PreloadConfig(TIM3,TIM_OCPreload_Enable);
TIM_Cmd(TIM3,ENABLE);
TIM_SetCompare1(TIM3,djsd);
TIM_SetCompare2(TIM3,djsd);
TIM_SetCompare3(TIM3,djsd);
TIM_SetCompare4(TIM3,djsd);
}
PWM輸出管腳初始化
void DJ_Init(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_4;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_AF_PP;
GPIO_Init(PWM_GPIO_Port,&GPIO_InitStructure);
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_5;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_AF_PP;
GPIO_Init(PWM_GPIO_Port,&GPIO_InitStructure);
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_0;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_AF_PP;
GPIO_Init(PWM_GPIO_Port,&GPIO_InitStructure);
GPIO_InitStructure.GPIO_Pin=GPIO_Pin_1;
GPIO_InitStructure.GPIO_Mode=GPIO_Mode_AF_PP;
GPIO_Init(PWM_GPIO_Port,&GPIO_InitStructure);
}
通過鍵盤控制舵機旋轉(zhuǎn)
void DJ4_KZ_Key(void)
{
if(GPIO_ReadInputDataBit(KEY4_PORT,KEY4_PIN)==Bit_RESET)
{
djsd=1500;
TIM_SetCompare4(TIM3,djsd); //1.5ms 0 度
printf_bz=1;
while(!GPIO_ReadInputDataBit(KEY1_PORT,KEY1_PIN));
}
if(GPIO_ReadInputDataBit(KEY2_PORT,KEY2_PIN)==Bit_RESET) //右 熄滅
{
if(djfx==0) //左 反轉(zhuǎn)
{
djsd=500;
djfx=1;
TIM_SetCompare4(TIM3,djsd); //0.5ms -90 度
printf_bz=1;
}
else //右 正轉(zhuǎn)
{
djsd=2500;
djfx=0;
TIM_SetCompare4(TIM3,djsd); //2.5ms 90 度
printf_bz=1;
}
while(!GPIO_ReadInputDataBit(KEY2_PORT,KEY2_PIN));
}
//上 加速
if(GPIO_ReadInputDataBit(KEY3_PORT,KEY3_PIN)==Bit_RESET) //上 增加
{
if(djsd>500) djsd=djsd-500;
TIM_SetCompare4(TIM3,djsd);
printf_bz=1;
while(!GPIO_ReadInputDataBit(KEY3_PORT,KEY3_PIN));
}
//下 減速
if(GPIO_ReadInputDataBit(KEY4_PORT,KEY4_PIN)==Bit_RESET) //下 減少
{
if(djsd<2500) djsd=djsd+500;
TIM_SetCompare4(TIM3,djsd);
printf_bz=1;
while(!GPIO_ReadInputDataBit(KEY4_PORT,KEY4_PIN));
}
}
通過PAJ7620手勢識別控制舵機旋轉(zhuǎn)
未完待續(xù)...
