STMF030 电机驱动

bfbm

#include "MOTOR.h"

void MOTOR_GPIO_Init(void)
{
    GPIO_InitTypeDef  GPIO_InitStructure;
  
    /* 使能时钟 */
    RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOB, ENABLE);
    RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOC, ENABLE);
    RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOD, ENABLE);   

    /* 配置列相应引脚PB14 PB13 PB12 PF4 */
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3|GPIO_Pin_4|GPIO_Pin_5|GPIO_Pin_6|GPIO_Pin_7|GPIO_Pin_8;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
    GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
    GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(GPIOB, &GPIO_InitStructure);
   
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
    GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
    GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(GPIOD, &GPIO_InitStructure);
   
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
    GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
    GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(GPIOC, &GPIO_InitStructure);
   
    GPIO_ResetBits(GPIOC, GPIO_Pin_12);
    GPIO_ResetBits(GPIOD, GPIO_Pin_2);
    GPIO_ResetBits(GPIOB, GPIO_Pin_3);
    GPIO_ResetBits(GPIOB, GPIO_Pin_4);
    GPIO_ResetBits(GPIOB, GPIO_Pin_5);
    GPIO_ResetBits(GPIOB, GPIO_Pin_6);
    GPIO_ResetBits(GPIOB, GPIO_Pin_7);
    GPIO_ResetBits(GPIOB, GPIO_Pin_8);
        
    /*PWM*/
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6|GPIO_Pin_7|GPIO_Pin_8|GPIO_Pin_9;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
    GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
    GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    GPIO_Init(GPIOC, &GPIO_InitStructure);
   
    GPIO_SetBits(GPIOC, GPIO_Pin_6);
    GPIO_SetBits(GPIOC, GPIO_Pin_7);
    GPIO_SetBits(GPIOC, GPIO_Pin_8);
    GPIO_SetBits(GPIOC, GPIO_Pin_9);
}

void Motor_forward( unsigned char motor )    //向下
{
    switch( motor )
    {
        case 1:
            GPIO_SetBits(GPIOB, GPIO_Pin_3);
            GPIO_ResetBits(GPIOB, GPIO_Pin_4);
            break;
        case 2:   
            GPIO_SetBits(GPIOC, GPIO_Pin_12);
            GPIO_ResetBits(GPIOD, GPIO_Pin_2);
            break;
        case 3:
            GPIO_SetBits(GPIOB, GPIO_Pin_7);
            GPIO_ResetBits(GPIOB, GPIO_Pin_8);
            break;   
        case 4:
            GPIO_SetBits(GPIOB, GPIO_Pin_5);
            GPIO_ResetBits(GPIOB, GPIO_Pin_6);
            break;
    }
}

void Motor_reversal( unsigned char motor ) //向上
{
    switch( motor )
    {
        case 1:
            GPIO_ResetBits(GPIOB, GPIO_Pin_3);
            GPIO_SetBits(GPIOB, GPIO_Pin_4);
            break;
        case 2:   
            GPIO_ResetBits(GPIOC, GPIO_Pin_12);
            GPIO_SetBits(GPIOD, GPIO_Pin_2);
            break;
        case 3:
            GPIO_ResetBits(GPIOB, GPIO_Pin_7);
            GPIO_SetBits(GPIOB, GPIO_Pin_8);
            break;   
        case 4:
            GPIO_ResetBits(GPIOB, GPIO_Pin_5);
            GPIO_SetBits(GPIOB, GPIO_Pin_6);
            break;
    }
}

void Motor_stop( unsigned char motor )    //停止
{
    switch( motor )
    {
        case 1:
            GPIO_ResetBits(GPIOB, GPIO_Pin_3);
            GPIO_ResetBits(GPIOB, GPIO_Pin_4);
            break;
        case 2:   
            GPIO_ResetBits(GPIOC, GPIO_Pin_12);
            GPIO_ResetBits(GPIOD, GPIO_Pin_2);
            break;
        case 3:
            GPIO_ResetBits(GPIOB, GPIO_Pin_7);
            GPIO_ResetBits(GPIOB, GPIO_Pin_8);
            break;   
        case 4:
            GPIO_ResetBits(GPIOB, GPIO_Pin_5);
            GPIO_ResetBits(GPIOB, GPIO_Pin_6);
            break;
    }
}

yangxf0120

谢谢分享STMF030 电机驱动