找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 2479|回复: 1
打印 上一主题 下一主题
收起左侧

STM32 PWM驱动寻迹小车程序

[复制链接]
跳转到指定楼层
楼主
ID:517850 发表于 2019-10-15 11:17 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
本实验是用PWM驱动寻迹小车,代码已经测试过了,写了好久,现在分享给大家。

单片机源程序如下:

  1. #include "stm32f10x.h"         //官方库

  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "motor.h"

  5. #include "led.h"
  6. #include "stdio.h"
  7. #include "hw.h"
  8. #include "key.h"
  9. #include "timer.h"


  10. int main(void)  
  11. {
  12.         u8 key;

  13.           delay_init(72);
  14.           LED_config();
  15.          KEY_Init();
  16.           hw_init();
  17.         Motor_Init();
  18. //        TIM4_Int_Init(4999,7199);
  19.         PWM_Init(899,0);
  20.        
  21.        
  22.           while(1)
  23.           {
  24.                           key=KEY_Scan(0);                //得到键值
  25.                                         if(key==KEY1_PRES){
  26.                                                 LED0=0;               
  27.                                         xunji();
  28.                                         }
  29.                                        
  30. //                carStraight(400,400);
  31.           }
  32.           
  33. }
复制代码

  1. #include "motor.h"
  2. #include "hw.h"
  3. #include "delay.h"
  4. #include "timer.h"
  5. void Motor_Init(void)
  6. {
  7.         RCC->APB2ENR|=1<<2;       //PORTA时钟使能   
  8.         GPIOA->CRH&=0XFFF00FFF;   //PORTA11 12 4 5推挽输出
  9.         GPIOA->CRH|=0X00033000;  //PORTA11 12 4 5推挽输出
  10.         GPIOA->ODR |= 1<<11;
  11.         GPIOA->ODR |= 1<<12;
  12.         GPIOA->CRL&=0XFF00FFFF;   //PORTA11 12 4 5推挽输出
  13.         GPIOA->CRL|=0X00330000;     //PORTA11 12 4 5推挽输出
  14.         GPIOA->ODR |= 1<<4;
  15.         GPIOA->ODR |= 1<<5;
  16. }





  17. void carStraight(u16 leftPWM, u16 rightPWM)
  18.         {
  19.         setPWM(leftPWM,rightPWM);
  20.         LEFT_1 = 1;
  21.         LEFT_2 = 0;
  22.         RIGHT_1 = 1;
  23.         RIGHT_2 = 0;

  24. }
  25. void carLeft(u16 leftPWM, u16 rightPWM){
  26.         setPWM(leftPWM,rightPWM);
  27.         LEFT_1 = 0;
  28.         LEFT_2 = 1;
  29.        
  30.         RIGHT_1 = 1;
  31.         RIGHT_2 = 0;
  32. }
  33. void carRight(u16 leftPWM, u16 rightPWM){
  34.         setPWM(leftPWM,rightPWM);
  35.         LEFT_1 = 1;
  36.         LEFT_2 = 0;
  37.        
  38.         RIGHT_1 = 0;
  39.         RIGHT_2 = 1;
  40. }
  41. void carBack(u16 leftPWM, u16 rightPWM){
  42.         setPWM(leftPWM,rightPWM);
  43.        
  44.         LEFT_1 = 0;
  45.         LEFT_2 = 1;
  46.         RIGHT_1 = 0;
  47.         RIGHT_2 = 1;
  48. }
  49. void carStop(){

  50.         LEFT_1 = 1;
  51.         LEFT_2 = 1;
  52.         RIGHT_1 = 1;
  53.         RIGHT_2 = 1;
  54. }


  55. void zuoxuan (u16 leftPWM, u16 rightPWM)

  56. {setPWM(leftPWM,rightPWM);
  57.        
  58.         LEFT_1 = 1;
  59.         LEFT_2 = 0;
  60.         RIGHT_1 = 1;
  61.         RIGHT_2 = 1;
  62.        
  63.         delay_ms(80);
  64.         carStop();
  65. }




  66. void xunji()
  67. {

  68.         while(1){
  69.                  
  70.                 if(LEFT_FIND == 0)
  71.                         {
  72.                         carStraight(0,0);
  73.                         }
  74.                         else
  75.                         {
  76.                         zuoxuan(0,899); }
  77.                        
  78.         }
  79.        
  80. }





  81. //||(RIGHT_FIND == 1 &&MIDDLE_FIND==1  &&LEFT_FIND == 1)
复制代码

所有资料51hei提供下载:
小车 - PWM -2.7z (177.86 KB, 下载次数: 34)


分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶 踩
回复

使用道具 举报

沙发
ID:1 发表于 2019-10-15 15:55 | 只看该作者
本帖需要重新编辑补全电路原理图,源码,详细说明与图片即可获得100+黑币(帖子下方有编辑按钮)
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表