#include "stm32....h" //頭文件自己寫,按需要弄
//uint16_t phasecw[4] ={0x0200,0x0100,0x0080,0x0040};// D-C-B-A
//uint16_t phaseccw[4]={0x0040,0x0080,0x0100,0x0200};// A-B-C-D
void rightMoto_Init(void)//初始化左輪
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC,ENABLE);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7 | GPIO_Pin_8 | GPIO_Pin_9 ;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOC,&GPIO_InitStructure);
GPIO_ResetBits(GPIOC,GPIO_Pin_6 | GPIO_Pin_7 |GPIO_Pin_8 |GPIO_Pin_9 );
}
void leftMoto_Init(void)//初始化右輪
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10 | GPIO_Pin_11 | GPIO_Pin_12 | GPIO_Pin_13 ;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_Init(GPIOB,&GPIO_InitStructure);
GPIO_ResetBits(GPIOB,GPIO_Pin_10 | GPIO_Pin_11 |GPIO_Pin_12 |GPIO_Pin_13 );
}
//LED¶Ôó|IO3õê¼»ˉ
void Delay_xms(int x)//這里調(diào)節(jié)轉(zhuǎn)速如果太大就不能轉(zhuǎn)了,主要問題就是這里的延時脈沖
{
int i,j;
for(i=0;i<x;i++)
for(j=0;j<112;j++);
}
void Motorcw(void) //ǰ½ø直接按照規(guī)律賦值操作
{
int i= 225;//這里調(diào)節(jié)他以一種模式跑多長時間
GPIO_SetBits(GPIOC,GPIO_Pin_6| GPIO_Pin_9);
GPIO_ResetBits(GPIOC,GPIO_Pin_7|GPIO_Pin_8);
GPIO_SetBits(GPIOB,GPIO_Pin_13| GPIO_Pin_10);
GPIO_ResetBits(GPIOB,GPIO_Pin_11|GPIO_Pin_12);
Delay_xms(i);//×aËùμ÷½ú
GPIO_SetBits(GPIOC,GPIO_Pin_6| GPIO_Pin_7);
GPIO_ResetBits(GPIOC,GPIO_Pin_8|GPIO_Pin_9);
GPIO_SetBits(GPIOB,GPIO_Pin_13| GPIO_Pin_12);
GPIO_ResetBits(GPIOB,GPIO_Pin_11|GPIO_Pin_10);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_7| GPIO_Pin_8);
GPIO_ResetBits(GPIOC,GPIO_Pin_9|GPIO_Pin_6);
GPIO_SetBits(GPIOB,GPIO_Pin_11| GPIO_Pin_12);
GPIO_ResetBits(GPIOB,GPIO_Pin_13|GPIO_Pin_10);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_8| GPIO_Pin_9);
GPIO_ResetBits(GPIOC,GPIO_Pin_6|GPIO_Pin_7);
GPIO_SetBits(GPIOB,GPIO_Pin_10| GPIO_Pin_11);
GPIO_ResetBits(GPIOB,GPIO_Pin_12|GPIO_Pin_13);
Delay_xms(i);
}
void Motorccw(void) //μ1íË
{
int i= 225;
GPIO_SetBits(GPIOC,GPIO_Pin_6| GPIO_Pin_9);
GPIO_ResetBits(GPIOC,GPIO_Pin_7|GPIO_Pin_8);
GPIO_SetBits(GPIOB,GPIO_Pin_13| GPIO_Pin_10);
GPIO_ResetBits(GPIOB,GPIO_Pin_11|GPIO_Pin_12);
Delay_xms(i);//×aËùμ÷½ú
GPIO_SetBits(GPIOC,GPIO_Pin_9| GPIO_Pin_8);
GPIO_ResetBits(GPIOC,GPIO_Pin_7|GPIO_Pin_6);
GPIO_SetBits(GPIOB,GPIO_Pin_10| GPIO_Pin_11);
GPIO_ResetBits(GPIOB,GPIO_Pin_12|GPIO_Pin_13);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_7| GPIO_Pin_8);
GPIO_ResetBits(GPIOC,GPIO_Pin_9|GPIO_Pin_6);
GPIO_SetBits(GPIOB,GPIO_Pin_11| GPIO_Pin_12);
GPIO_ResetBits(GPIOB,GPIO_Pin_13|GPIO_Pin_10);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_7| GPIO_Pin_6);
GPIO_ResetBits(GPIOC,GPIO_Pin_8|GPIO_Pin_9);
GPIO_SetBits(GPIOB,GPIO_Pin_12| GPIO_Pin_13);
GPIO_ResetBits(GPIOB,GPIO_Pin_10|GPIO_Pin_11);
Delay_xms(i);
}
void turn_left(void)
{
int i= 225;
GPIO_SetBits(GPIOC,GPIO_Pin_6| GPIO_Pin_9);
GPIO_ResetBits(GPIOC,GPIO_Pin_7|GPIO_Pin_8);
GPIO_SetBits(GPIOB,GPIO_Pin_13| GPIO_Pin_10);
GPIO_ResetBits(GPIOB,GPIO_Pin_11|GPIO_Pin_12);
Delay_xms(i);//×aËùμ÷½ú
GPIO_SetBits(GPIOC,GPIO_Pin_6| GPIO_Pin_7);
GPIO_ResetBits(GPIOC,GPIO_Pin_8|GPIO_Pin_9);
GPIO_SetBits(GPIOB,GPIO_Pin_10| GPIO_Pin_11);
GPIO_ResetBits(GPIOB,GPIO_Pin_12|GPIO_Pin_13);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_7| GPIO_Pin_8);
GPIO_ResetBits(GPIOC,GPIO_Pin_9|GPIO_Pin_6);
GPIO_SetBits(GPIOB,GPIO_Pin_11| GPIO_Pin_12);
GPIO_ResetBits(GPIOB,GPIO_Pin_13|GPIO_Pin_10);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_8| GPIO_Pin_9);
GPIO_ResetBits(GPIOC,GPIO_Pin_6|GPIO_Pin_7);
GPIO_SetBits(GPIOB,GPIO_Pin_12| GPIO_Pin_13);
GPIO_ResetBits(GPIOB,GPIO_Pin_10|GPIO_Pin_11);
Delay_xms(i);
}
void turn_right(void)
{
int i= 225;
GPIO_SetBits(GPIOC,GPIO_Pin_6| GPIO_Pin_9);
GPIO_ResetBits(GPIOC,GPIO_Pin_7|GPIO_Pin_8);
GPIO_SetBits(GPIOB,GPIO_Pin_13| GPIO_Pin_10);
GPIO_ResetBits(GPIOB,GPIO_Pin_11|GPIO_Pin_12);
Delay_xms(i);//×aËùμ÷½ú
GPIO_SetBits(GPIOC,GPIO_Pin_9| GPIO_Pin_8);
GPIO_ResetBits(GPIOC,GPIO_Pin_7|GPIO_Pin_6);
GPIO_SetBits(GPIOB,GPIO_Pin_13| GPIO_Pin_12);
GPIO_ResetBits(GPIOB,GPIO_Pin_11|GPIO_Pin_10);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_7| GPIO_Pin_8);
GPIO_ResetBits(GPIOC,GPIO_Pin_9|GPIO_Pin_6);
GPIO_SetBits(GPIOB,GPIO_Pin_11| GPIO_Pin_12);
GPIO_ResetBits(GPIOB,GPIO_Pin_13|GPIO_Pin_10);
Delay_xms(i);
GPIO_SetBits(GPIOC,GPIO_Pin_7| GPIO_Pin_6);
GPIO_ResetBits(GPIOC,GPIO_Pin_8|GPIO_Pin_9);
GPIO_SetBits(GPIOB,GPIO_Pin_10| GPIO_Pin_11);
GPIO_ResetBits(GPIOB,GPIO_Pin_12|GPIO_Pin_13);
Delay_xms(i);
}
|