设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 电子技术分类讨论区 › 资料共享 › 基于STC12C5A60S2的电磁循迹小车源码
返回列表 发新帖
查看: 5706|回复: 4
收起左侧

基于STC12C5A60S2的电磁循迹小车源码

[复制链接]
ID:254433 发表于 2018-6-16 17:57 | 显示全部楼层 |阅读模式
采用STC12C5A60S2采集AD信号小车循迹

单片机源程序如下:
  1. #include <STC12C5A60S2.H>
  2. #include "intrins.h"
  3. #include "Common.h"         //通用宏定义
  4. #include "delay.h"         //通用延时程序
  5. #include "PWM_TIME.h" //模拟PWM
  6. #include "ADC.H"

  8. #define k1 0.1
  9. #define k2 0.1

  11. void AD_send();

  13. fp32 AD_chuli(uchar *s1, uchar *s2);

  15. fp32 Engine_PWM = Engine_Left;
  16. uchar a1 = 100, a2 = 100;
  17. int error;
  18. uchar flag;
  19. uchar flag1 = 0;
  20. uchar flag2;
  21. extern INT32 kk;

  23. void Init0_Init()
  24. {
  25.         
  26.     IT0 = 1;                        //set INT0 int type (1:Falling 0:Low level)
  27.     EX0 = 1;                        //enable INT0 interrupt
  28.     EA = 1;                         //open global interrupt switch
  29. }
  30. void main(void)
  31. {
  32.         InitADC();
  33.         InitUart();
  34.         Init_PWM_TIME();
  35.         Init0_Init();
  36.         while(1)
  37.         {
  38.                
  39.                
  40.                         if(flag == 1)
  41.                         {
  42.                                 a1 = 0, a2 = 0;
  43.                                 Engine_PWM = Engine_Mid;
  44.                                 error = -150;
  45.                         }
  46.                
  47.                 Engine_PWM = AD_chuli(&a1, &a2);
  48.                 //AD_send();
  49.             change_Motor(a1,a2);
  50.             change_Engine(Engine_PWM);

  52.         }
  53. }

  55. void AD_send()
  56. {
  57.         ShowResult(1); //show ChabneP10
  58.         ShowResult(2); //P11
  59.         ShowResult(3); //P12
  60.         //ShowResult(4);
  61.         //ShowResult(7);
  62.         //ShowResult(6);
  63.         Delay(30);
  64.         
  65. }

  67. fp32 AD_chuli(uchar *s1, uchar *s2)
  68. {
  69.         fp32 temp;
  70.         error = GetADCResult(2) - GetADCResult(1);
  71.         if(flag != 1)
  72.         {
  73.                 if(GetADCResult(1) > GetADCResult(2))
  74.                 {
  75.                         

  77.                                 Engine_PWM = k2 * error + Engine_Mid;
  78.                                 *s1 = 100, *s2 = 100;
  79.                                 flag2 = 1;
  80.                         if(error < -60)
  81.                         {
  82.                                 //Engine_PWM = k2 * error + Engine_Mid;
  83.                                 flag1 = 1;
  84.                                 temp = Engine_PWM;
  85.                                 *s1 = 100, *s2 = 100;
  86.                         }
  87.                         
  88.                         
  89.                 }
  90.                
  91.                 else if(GetADCResult(2) > GetADCResult(1))
  92.                 {
  93.                         
  94.                                 
  95.                                 Engine_PWM = k2 * error + Engine_Mid;
  96.                                 *s1 = 100, *s2 = 100;
  97.                                 flag2 = 2;
  98.                         if(error > 60)
  99.                         {
  100.                                 //Engine_PWM = k2 * error + Engine_Mid;
  101.                                 flag1 = 2;
  102.                                 temp = Engine_PWM;
  103.                                 *s1 = 100, *s2 = 100;
  104.                         }

  106.                 }
  107.         }
  108.         if(GetADCResult(2) == 0  && GetADCResult(1) == 0 && GetADCResult(3) == 0)
  109.         {
  110.                 if(flag != 1)
  111.                 {
  112.                         
  113.                         if(flag2 != 2)
  114.                         {
  115.                                 if(flag1 == 1)
  116.                                 {
  117.                                                 Engine_PWM = temp;*s1 = 100, *s2 = 100;
  118.                                 }
  119.                                 else
  120.                                 {
  121.                                                 Engine_PWM = Engine_Left;
  122.                                 }
  123.                         }
  124.                         else if(flag2 != 1)
  125.                         {
  126.                                 if(flag1 == 2)
  127.                                 {
  128.                                                 Engine_PWM = temp;*s1 = 100, *s2 = 100;
  129.                                 }
  130.                                 else
  131.                                 {
  132.                                         Engine_PWM = Engine_Right;
  133.                                 }
  134.                         }
  135.                         
  136.                 }
  137.         }
  138.         
  139.         
  140.         
  141.         if(Engine_PWM <= Engine_Left)
  142.         {
  143.                         Engine_PWM = Engine_Left;
  144.         }
  145.         else if(Engine_PWM >= Engine_Right)
  146.         {
  147.                         Engine_PWM = Engine_Right;
  148.         }
  149.         
  150.         
  151.         return Engine_PWM;
  152.         
  153. }

  155. void Int0_Routine(void) interrupt 0
  156. {
  157.         
  158.         if(kk >= 100000)
  159.         {
  160.                 flag = 1;
  161.         }
  162.         else
  163.         {
  164.                 flag = 2;
  165.         }
  166.                
  167.         
  168. }

  170. /* 中断服务程序的编号
  171. void Int0_Routine(void) interrupt 0;                 外部中断0(INT0)
  172. void Timer0_Rountine(void) interrupt 1;          定时器0中断
  173. void Int1_Routine(void) interrupt 2;                  外部中断1(INT1)
  174. void Timer1_Rountine(void) interrupt 3;                   定时器1中断
  175. void UART_Routine(void) interrupt 4;                   串口1(UART1)中断
  176. void ADC_Routine(void) interrupt 5;                          A/D转换中断
  177. void LVD_Routine(void) interrupt 6;                        低压检测(LVD)中断
  178. void PCA_Routine(void) interrupt 7;                        PCA中断
  179. void UART2_Routine(void) interrupt 8;                串口2中断
  180. void SPI_Routine(void) interrupt 9                         SPI中断
  181. */
复制代码

所有资料51hei提供下载:
小车控制.zip (119.94 KB, 下载次数: 96)
回复

使用道具 举报

ID:257207 发表于 2019-4-3 23:31 | 显示全部楼层
嘿嘿 学习学习
回复

使用道具 举报

ID:511145 发表于 2019-4-13 14:12 | 显示全部楼层
借鉴一下
回复

使用道具 举报

ID:780742 发表于 2021-3-18 23:38 | 显示全部楼层
问下楼主电磁传感器使用的是什么传感器呢？有没有芯片的中文资料呀？
回复

使用道具 举报

ID:377166 发表于 2022-8-17 11:43 | 显示全部楼层
求分享电路图
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

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

Powered by 单片机教程网

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