235 lines
6.5 KiB
C
235 lines
6.5 KiB
C
#include "motor.h"
|
||
#include "globalv.h"
|
||
|
||
void PWMtimer_init(void)
|
||
{
|
||
ATIM_InitTypeDef ATIM_InitStruct;
|
||
ATIM_OCInitTypeDef ATIM_OCInitStruct;
|
||
GPIO_InitTypeDef GPIO_InitStruct;
|
||
|
||
__RCC_ATIM_CLK_ENABLE();
|
||
__RCC_GPIOA_CLK_ENABLE();
|
||
__RCC_GPIOB_CLK_ENABLE();
|
||
|
||
PA08_AFx_ATIMCH1A();
|
||
PA09_AFx_ATIMCH2A();
|
||
PA10_AFx_ATIMCH3A();
|
||
|
||
GPIO_InitStruct.IT = GPIO_IT_NONE;
|
||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
||
GPIO_InitStruct.Pins = GPIO_PIN_13|GPIO_PIN_14|GPIO_PIN_15;
|
||
GPIO_InitStruct.Speed = GPIO_SPEED_HIGH;
|
||
GPIO_Init(CW_GPIOB, &GPIO_InitStruct);
|
||
|
||
PWM_AH_OFF;
|
||
PWM_BH_OFF;
|
||
PWM_CH_OFF;
|
||
|
||
GPIO_InitStruct.IT = GPIO_IT_NONE;
|
||
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP;
|
||
GPIO_InitStruct.Pins = GPIO_PIN_8|GPIO_PIN_9|GPIO_PIN_10;
|
||
GPIO_InitStruct.Speed = GPIO_SPEED_HIGH;
|
||
GPIO_Init(CW_GPIOA, &GPIO_InitStruct);
|
||
|
||
PWM_AL_OFF;
|
||
PWM_BL_OFF;
|
||
PWM_CL_OFF;
|
||
|
||
ATIM_InitStruct.BufferState = ENABLE;//;//;
|
||
ATIM_InitStruct.ClockSelect = ATIM_CLOCK_PCLK;
|
||
ATIM_InitStruct.CounterAlignedMode = ATIM_COUNT_MODE_EDGE_ALIGN;
|
||
ATIM_InitStruct.CounterDirection = ATIM_COUNTING_UP;
|
||
ATIM_InitStruct.CounterOPMode = ATIM_OP_MODE_REPETITIVE;
|
||
ATIM_InitStruct.OverFlowMask = ENABLE;
|
||
ATIM_InitStruct.Prescaler = ATIM_Prescaler_DIV1; // ¼ÆËãʱÖÓ1MHz
|
||
ATIM_InitStruct.ReloadValue = PWM_PERIOD; // Òç³öÖÜÆÚ100us
|
||
ATIM_InitStruct.RepetitionCounter = 0;
|
||
ATIM_InitStruct.UnderFlowMask = DISABLE;
|
||
ATIM_Init(&ATIM_InitStruct);
|
||
|
||
ATIM_OCInitStruct.BufferState = DISABLE;
|
||
ATIM_OCInitStruct.OCDMAState = DISABLE;
|
||
ATIM_OCInitStruct.OCInterruptSelect = ATIM_OC_IT_NONE;
|
||
ATIM_OCInitStruct.OCInterruptState = DISABLE;
|
||
ATIM_OCInitStruct.OCMode = ATIM_OCMODE_PWM1;
|
||
ATIM_OCInitStruct.OCPolarity = ATIM_OCPOLARITY_NONINVERT;
|
||
ATIM_OC1AInit(&ATIM_OCInitStruct);
|
||
ATIM_OC2AInit(&ATIM_OCInitStruct);
|
||
ATIM_OC3AInit(&ATIM_OCInitStruct);
|
||
|
||
ATIM_SetCompare1A(0);
|
||
ATIM_SetCompare2A(0);
|
||
ATIM_SetCompare3A(0);
|
||
ATIM_PWMOutputConfig(OCREFA_TYPE_SINGLE, OUTPUT_TYPE_ALONE, -1);
|
||
ATIM_CtrlPWMOutputs(ENABLE);
|
||
ATIM_Cmd(ENABLE);
|
||
|
||
CW_ATIM->MSCR_f.CCDS = 1; // DMA ×Ü¿ª¹Ø
|
||
ATIM_OC4Init(ENABLE, ATIM_OC_IT_UP_COUNTER, ENABLE, DISABLE, DISABLE);
|
||
ATIM_SetCompare4(PWM_PERIOD/2); // ´¥·¢Ê±¿Ì
|
||
ATIM_Cmd(ENABLE);
|
||
}
|
||
|
||
void ATIM_IRQHandler(void)
|
||
{
|
||
if (ATIM_GetITStatus(ATIM_IT_OVF))
|
||
{
|
||
ATIM_ClearITPendingBit(ATIM_IT_OVF);
|
||
}
|
||
}
|
||
|
||
//steP,Ϊµ±Ç°²½£¬PWM_ON_flag=1ʱ´ò¿ªPWMÊä³ö
|
||
void Commutation(unsigned int step,unsigned int PWM_ON_flag)
|
||
{
|
||
if(PWM_ON_flag==0||MOTORSTATE==STATEERROR||MOTORSTATE==STATEERROROVER)
|
||
{
|
||
CW_ATIM->CH1CCRA=0;CW_ATIM->CH2CCRA=0;CW_ATIM->CH3CCRA=0;
|
||
PWM_AL_OFF; PWM_BL_OFF; PWM_CL_OFF;
|
||
return;
|
||
}
|
||
if(step==0||step==5){ PWM_AL_OFF; PWM_CL_OFF;}//AB
|
||
else if(step==1||step==2){ PWM_AL_OFF; PWM_BL_OFF; }//AC
|
||
else if(step==3||step==4){ PWM_BL_OFF; PWM_CL_OFF; }//BA
|
||
|
||
if(step==0||step==1){ CW_ATIM->CH2CCRA=0;CW_ATIM->CH3CCRA=0;CW_ATIM->CH1CCRA=OutPwmValue; }
|
||
if(step==2||step==3){ CW_ATIM->CH1CCRA=0;CW_ATIM->CH3CCRA=0;CW_ATIM->CH2CCRA=OutPwmValue; }
|
||
if(step==4||step==5){ CW_ATIM->CH1CCRA=0;CW_ATIM->CH2CCRA=0;CW_ATIM->CH3CCRA=OutPwmValue; }
|
||
|
||
|
||
if(step==0||step==5){PWM_BL_ON;}//AB
|
||
else if(step==1||step==2){PWM_CL_ON;}//AC
|
||
else if(step==3||step==4){PWM_AL_ON;}//BA
|
||
STEP_last=step;
|
||
}
|
||
|
||
//¸üÐÂÕ¼¿Õ±È
|
||
void UPPWM(void)
|
||
{
|
||
if(STEP_last==0||STEP_last==1){ CW_ATIM->CH2CCRA=0;CW_ATIM->CH3CCRA=0; CW_ATIM->CH1CCRA=OutPwmValue; }
|
||
if(STEP_last==2||STEP_last==3){ CW_ATIM->CH1CCRA=0;CW_ATIM->CH3CCRA=0;CW_ATIM->CH2CCRA=OutPwmValue; }
|
||
if(STEP_last==4||STEP_last==5){ CW_ATIM->CH1CCRA=0;CW_ATIM->CH2CCRA=0;CW_ATIM->CH3CCRA=OutPwmValue; }
|
||
}
|
||
|
||
//»ô¶û¶¨Ê±Æ÷³õʼ»¯
|
||
void Halltimer_init(void)
|
||
{
|
||
GTIM_InitTypeDef GTIM_InitStruct;
|
||
GTIM_ICInitTypeDef GTIM_ICInitStruct;
|
||
GPIO_InitTypeDef GPIO_InitStruct;
|
||
|
||
__RCC_GTIM2_CLK_ENABLE();
|
||
__RCC_GPIOA_CLK_ENABLE();
|
||
__RCC_GPIOB_CLK_ENABLE();
|
||
|
||
GPIO_InitStruct.IT = GPIO_IT_NONE;
|
||
GPIO_InitStruct.Mode =GPIO_MODE_INPUT_PULLUP;// GPIO_MODE_INPUT;
|
||
GPIO_InitStruct.Pins = GPIO_PIN_15 |GPIO_PIN_1;
|
||
GPIO_InitStruct.Speed = GPIO_SPEED_HIGH;
|
||
GPIO_Init(CW_GPIOA, &GPIO_InitStruct);
|
||
|
||
GPIO_InitStruct.IT = GPIO_IT_NONE;
|
||
GPIO_InitStruct.Mode =GPIO_MODE_INPUT_PULLUP;// GPIO_MODE_INPUT;
|
||
GPIO_InitStruct.Pins = GPIO_PIN_10;
|
||
GPIO_InitStruct.Speed = GPIO_SPEED_HIGH;
|
||
GPIO_Init(CW_GPIOB, &GPIO_InitStruct);
|
||
|
||
PA15_AFx_GTIM2CH1();
|
||
PA01_AFx_GTIM2CH2();
|
||
PB10_AFx_GTIM2CH3();
|
||
|
||
__disable_irq();
|
||
NVIC_EnableIRQ(GTIM2_IRQn);
|
||
__enable_irq();
|
||
|
||
GTIM_InitStruct.Mode = GTIM_MODE_TIME;
|
||
GTIM_InitStruct.OneShotMode = GTIM_COUNT_CONTINUE;
|
||
GTIM_InitStruct.Prescaler = GTIM_PRESCALER_DIV1;
|
||
GTIM_InitStruct.ReloadValue = 0xFFFF;
|
||
GTIM_InitStruct.ToggleOutState = DISABLE;
|
||
GTIM_TimeBaseInit(CW_GTIM2, >IM_InitStruct);
|
||
|
||
GTIM_ICInitStruct.CHx = GTIM_CHANNEL1;
|
||
GTIM_ICInitStruct.ICFilter = GTIM_CHx_FILTER_PCLK_N2;
|
||
GTIM_ICInitStruct.ICInvert = GTIM_CHx_INVERT_OFF;
|
||
GTIM_ICInitStruct.ICPolarity = GTIM_ICPolarity_BothEdge;
|
||
GTIM_ICInit(CW_GTIM2, >IM_ICInitStruct);
|
||
|
||
GTIM_ICInitStruct.CHx = GTIM_CHANNEL2;
|
||
GTIM_ICInit(CW_GTIM2, >IM_ICInitStruct);
|
||
|
||
GTIM_ICInitStruct.CHx = GTIM_CHANNEL3;
|
||
GTIM_ICInit(CW_GTIM2, >IM_ICInitStruct);
|
||
|
||
GTIM_ITConfig(CW_GTIM2, GTIM_IT_CC1 | GTIM_IT_CC2 | GTIM_IT_CC3, ENABLE);
|
||
GTIM_Cmd(CW_GTIM2, ENABLE);
|
||
}
|
||
|
||
//»ô¶ûÐźŶÁÈ¡
|
||
unsigned char HALL_Check(void)
|
||
{
|
||
static unsigned char hallerrnum=0;
|
||
unsigned char x=0;
|
||
|
||
if(GPIO_ReadPin(CW_GPIOA,GPIO_PIN_15)!=0)x=1;
|
||
if(GPIO_ReadPin(CW_GPIOA,GPIO_PIN_1)!=0)x|=0x2;
|
||
if(GPIO_ReadPin(CW_GPIOB,GPIO_PIN_10)!=0)x|=0x4;
|
||
// printf("X=%x\n",x);
|
||
if(x==0||x==7)
|
||
{hallerrnum++;if(hallerrnum>=10){hallerrnum=10;ErrorCode=2;}}
|
||
else hallerrnum=0;
|
||
|
||
return x;
|
||
}
|
||
|
||
//»ô¶ûÐźű任£¬»»Ïà
|
||
void GTIM2_IRQHandler(void)
|
||
{
|
||
unsigned char x = 0;
|
||
|
||
/* USER CODE BEGIN */
|
||
if (GTIM_GetITStatus(CW_GTIM2, GTIM_IT_CC1))
|
||
{
|
||
GTIM_ClearITPendingBit(CW_GTIM2, GTIM_IT_CC1);
|
||
}
|
||
|
||
if (GTIM_GetITStatus(CW_GTIM2, GTIM_IT_CC2))
|
||
{
|
||
GTIM_ClearITPendingBit(CW_GTIM2, GTIM_IT_CC2);
|
||
}
|
||
|
||
if (GTIM_GetITStatus(CW_GTIM2, GTIM_IT_CC3))
|
||
{
|
||
GTIM_ClearITPendingBit(CW_GTIM2, GTIM_IT_CC3);
|
||
}
|
||
|
||
x=HALL_Check();
|
||
if(x==0||x==7){return;}
|
||
|
||
HALLcount++;HALLcount1++;
|
||
Cur_step=STEP_TAB[Dir][x-1];
|
||
if(Motor_Start_F==1&&ErrorCode==0)
|
||
Commutation(Cur_step,Motor_Start_F);
|
||
}
|
||
|
||
//µç»úÆô¶¯
|
||
void HALL_MOTOR_START(void)
|
||
{
|
||
unsigned char x=0;
|
||
|
||
x=HALL_Check();
|
||
if(x==0||x==7){return;}
|
||
Cur_step=STEP_TAB[Dir][x-1];
|
||
RealS1=0;
|
||
Motor_Start_F=1;
|
||
Commutation(Cur_step,Motor_Start_F);
|
||
}
|
||
|
||
//µç»úÍ£Ö¹
|
||
void MOTOR_STOP0(void)
|
||
{
|
||
Motor_Start_F=0;
|
||
Commutation(0,0);
|
||
}
|
||
|
||
|