标题: STM32循迹小车源程序 [打印本页]

作者: 1345000698    时间: 2018-7-15 09:23
标题: STM32循迹小车源程序
#include "motor.h"
#include "interface.h"
#include "stm32f10x.h"
#include "delay.h"

//GPIOéèÖÃ
void MotorGPIO_Configuration(void)
{        
        GPIO_InitTypeDef GPIO_InitStructure;
        
        RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA , ENABLE);
        RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB , ENABLE);
        RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC , ENABLE);

        RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOF , ENABLE);
        
        GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1  | GPIO_Pin_6 | GPIO_Pin_7;
        GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
        GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;         
        GPIO_Init(GPIOA, &GPIO_InitStructure);   
        
        GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0 | GPIO_Pin_1 | GPIO_Pin_7| GPIO_Pin_8;
        GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
        GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;         
        GPIO_Init(GPIOB, &GPIO_InitStructure);   
         
        GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7| GPIO_Pin_6|GPIO_Pin_8| GPIO_Pin_9;
        GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
        GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;         
        GPIO_Init(GPIOC, &GPIO_InitStructure);  
        

}

//Ïòǰ
void CarGo(void)
{
        TIM_SetCompare1(TIM3 , 430);
  TIM_SetCompare2(TIM3 , 430);
        TIM_SetCompare3(TIM3 , 430);
        TIM_SetCompare4(TIM3 , 430);
        
        FRONT_LEFT_F = 1;
        FRONT_LEFT_B = 0;
        BEHIND_LEFT_F =1;
        BEHIND_LEFT_B = 0;
        
        FRONT_RIGHT_F = 1;
        FRONT_RIGHT_B = 0;
        BEHIND_RIGHT_F = 0;
        BEHIND_RIGHT_B = 1;
        
        delay_ms(100);
}

//Ïòoó
void CarBack(void)
{
        TIM_SetCompare1(TIM3 , 400);
        TIM_SetCompare2(TIM3 , 400);
        TIM_SetCompare3(TIM3 , 400);
        TIM_SetCompare4(TIM3 , 400);

        FRONT_LEFT_F  = 0;
        FRONT_LEFT_B  = 1;
        BEHIND_LEFT_F = 0;
        BEHIND_LEFT_B = 1;
        
        FRONT_RIGHT_F  = 0;
        FRONT_RIGHT_B  = 1;
        BEHIND_RIGHT_F = 1;
        BEHIND_RIGHT_B = 0;
        
        delay_ms(100);

}

//Ïòóò
void CarLeft(void)
{
        TIM_SetCompare1(TIM3 , 300);
        TIM_SetCompare2(TIM3 , 300);
        TIM_SetCompare4(TIM3 , 350);
        TIM_SetCompare3(TIM3 ,350);
        
        FRONT_LEFT_F  = 1;
        FRONT_LEFT_B  = 0;
        BEHIND_LEFT_F = 1;
        BEHIND_LEFT_B = 0;
        
        FRONT_RIGHT_F  = 0;
        FRONT_RIGHT_B  = 1;
        BEHIND_RIGHT_F = 1;
        BEHIND_RIGHT_B = 0;

        delay_ms(100);

}
//′óóò
void CarBigLeft(void)
{
        TIM_SetCompare1(TIM3 , 400);
        TIM_SetCompare2(TIM3 , 400);
        
        FRONT_LEFT_F  = 1;
        FRONT_LEFT_B  = 0;
        BEHIND_LEFT_F = 1;
        BEHIND_LEFT_B = 0;
        
        FRONT_RIGHT_F  = 0;
        FRONT_RIGHT_B  = 0;
        BEHIND_RIGHT_F = 0;
        BEHIND_RIGHT_B = 0;

        delay_ms(100);

}

//Ïò×ó
void CarRight(void)
{
        TIM_SetCompare1(TIM3 , 350);
        TIM_SetCompare2(TIM3 , 350);
        TIM_SetCompare4(TIM3 , 300);
        TIM_SetCompare3(TIM3 ,300);

        FRONT_LEFT_F  = 0;
        FRONT_LEFT_B  = 1;
        BEHIND_LEFT_F = 0;
        BEHIND_LEFT_B = 1;
        
        FRONT_RIGHT_F  = 1;
        FRONT_RIGHT_B  = 0;
        BEHIND_RIGHT_F = 0;
        BEHIND_RIGHT_B = 1;
        

}

//′ó×ó
void CarBigRight(void)
{
        TIM_SetCompare4(TIM3 , 400);
        TIM_SetCompare3(TIM3 , 400);

        FRONT_LEFT_F  = 0;
        FRONT_LEFT_B  = 0;
        BEHIND_LEFT_F = 0;
        BEHIND_LEFT_B = 0;
        
        FRONT_RIGHT_F  = 1;
        FRONT_RIGHT_B  = 0;
        BEHIND_RIGHT_F = 1;
        BEHIND_RIGHT_B = 0;
        

}

//í£Ö1
void CarStop(void)
{
        TIM_SetCompare1(TIM3 , 900);
        TIM_SetCompare2(TIM3 , 900);
        TIM_SetCompare3(TIM3 , 900);
        TIM_SetCompare4(TIM3 , 900);
        
}

void MotorInit(void)
{
        MotorGPIO_Configuration();
        CarStop();
}

循迹小车.rar

278.84 KB, 下载次数: 156, 下载积分: 黑币 -5


作者: augestclown    时间: 2018-7-19 10:50
请问有实物接线图吗
作者: 余生喜喜    时间: 2018-8-7 21:46
这个使用STM32循迹嘛

作者: 余生喜喜    时间: 2018-8-7 21:46
这个是不是使用STM32J加上摄像头循迹呀

作者: tanman8886    时间: 2018-8-8 22:43
已经下载,谢谢楼主!准备学习
作者: 不屈的意志55    时间: 2018-9-18 18:36
谢谢分享
作者: 啊杰啊啊啊    时间: 2018-11-8 21:00
不错的资料




欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1