stm32最小系统板hal库实现蓝牙遥控循迹避障小车(1)

         驱动四个轮子用的TB6612,黑色的和红色最大输电压好像不一样(12v和10v的区别,建议还是5v就够了)

一、cubemx

sys

RCC 

 

 

gpio 

 TIM3-PWM

         最后生成文件记得要勾选生成独立的.c.h文件

二、连线

TB6612STM32
       PWMA        PA7
PWMBPA6
AIN1PB12
AIN2

PB13

BIN1PB14
BIN2PB15

三、代码

        写一个Motor文件,里面包含一些函数,配置引脚高低电平以及通过设置比较寄存器来调控车速

Motor.C

#include "stm32f1xx_hal.h"             
#include "tim.h"
void Motor_LeftSetSpeed(int8_t speed)
{
	if(speed>0)		
	{
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_12,GPIO_PIN_SET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_13,GPIO_PIN_RESET);
		__HAL_TIM_SET_COMPARE(&htim3,TIM_CHANNEL_1,speed);

	}else if(speed<0)
	{
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_13,GPIO_PIN_SET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_12,GPIO_PIN_RESET);
		__HAL_TIM_SET_COMPARE(&htim3,TIM_CHANNEL_1,-speed);	
	}else
	{	
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_12,GPIO_PIN_SET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_13,GPIO_PIN_SET);
		__HAL_TIM_SET_COMPARE(&htim3,TIM_CHANNEL_1,speed);
	}
}

void Motor_RightSetSpeed(int8_t speed)
{
	if(speed>0)		
	{
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_14,GPIO_PIN_SET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_15,GPIO_PIN_RESET);
		__HAL_TIM_SET_COMPARE(&htim3   ,TIM_CHANNEL_2,speed);
	}else if(speed<0)
	{
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_15,GPIO_PIN_SET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_14,GPIO_PIN_RESET);
		__HAL_TIM_SET_COMPARE(&htim3,TIM_CHANNEL_2,-speed);	
	}else
	{	
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_14,GPIO_PIN_SET);
		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_15,GPIO_PIN_SET);
		__HAL_TIM_SET_COMPARE(&htim3,TIM_CHANNEL_2,speed);
	}
}


void Go_Ahead()
{
	Motor_LeftSetSpeed(70);
	Motor_RightSetSpeed(70);
}
void Go_Back()
{
	Motor_LeftSetSpeed(-70);
	Motor_RightSetSpeed(-70);
}
void Turn_Left()
{
	Motor_LeftSetSpeed(0);
	Motor_RightSetSpeed(70);
}
void Turn_Right()
{
	Motor_LeftSetSpeed(70);
	Motor_RightSetSpeed(0);
}

void Self_Left()
{
	Motor_LeftSetSpeed(-70);
	Motor_RightSetSpeed(70);
}

void Self_Right()
{
	Motor_LeftSetSpeed(70);
	Motor_RightSetSpeed(-70);
}

void Car_Stop()
{
	Motor_LeftSetSpeed(0);
	Motor_RightSetSpeed(0);
}

Motor.h

#ifndef __MOTOR_H__
#define __MOTOR_H__
#include "stm32f1xx_hal.h"             
#include "tim.h"
void Motor_LeftSetSpeed(int8_t speed);
void Motor_RightSetSpeed(int8_t speed);
void Go_Ahead();
void Go_Back();
void Turn_Left();
void Turn_Right();
void Self_Left();
void Self_Right();
void Car_Stop();

#endif

        在main.c里加入头文件

/* USER CODE BEGIN Includes */
#include "Motor.h"
/* USER CODE END Includes */

        开启PWM的两个通道,在while循环里调用Go_Ahead();即可驱动小车

int main(void)
{

  /* USER CODE BEGIN 1 */

  /* USER CODE END 1 */

  /* MCU Configuration--------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* USER CODE BEGIN Init */

  /* USER CODE END Init */

  /* Configure the system clock */
  SystemClock_Config();

  /* USER CODE BEGIN SysInit */

  /* USER CODE END SysInit */

  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_TIM3_Init();
  /* USER CODE BEGIN 2 */
	HAL_TIM_PWM_Start(&htim3,TIM_CHANNEL_1);
	HAL_TIM_PWM_Start(&htim3,TIM_CHANNEL_2);
//	__HAL_TIM_SET_COUNTER(&htim3, 100);
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
//		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_14,GPIO_PIN_SET);
//		HAL_GPIO_WritePin(GPIOB,GPIO_PIN_15,GPIO_PIN_RESET);
	Go_Ahead();
	HAL_Delay(20);
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
  }
  /* USER CODE END 3 */
}

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值