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

 找回密码
 立即注册

QQ登录

只需一步，快速开始

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

搜索
»论坛 › 嵌入式/单片机论坛 › 单片机DIY制作 › 简易舵机测试仪
返回列表 发新帖
查看: 10552|回复: 3
收起左侧

简易舵机测试仪

[复制链接]
ID:163392 发表于 2017-2-16 23:45 | 显示全部楼层 |阅读模式
在原来电压显示器的基础上稍加修改就成舵机测试仪。对最小时间片和周期有了更深的了解。

IMG_20170216_232825.jpg IMG_20170216_232906.jpg IMG_20170216_232937.jpg IMG_20170216_232950.jpg





  1. //用于测试电压的     用的单片机是 STC15F408AS
  2. #include <reg51.h>
  3. #include<intrins.h>
  4. void Display(unsigned int num);//用于数码管显示具体数字  显示0到9直接用相应的数字做参数，显示1到9 加个点 用1到9乘以10做参数 0加一个点用11做参数
  5. void Display_num(unsigned int num,unsigned char weizhi); // 用于确认那个数码管显示数字。  第一参数num是要显示的数字， 第二个参数weizhi是要在哪个数码管显示（最左边为1，最右边为4）
  6. void Delay10us();                //@12.000MHz
  7. void delay_n_10us(unsigned int n);
  8. unsigned int a; //保存模数转换后的数据

  10. sfr P2M0=0x96;     //声明 P2引脚模式寄存器
  11. sfr P3M0=0xb2;     //声明 P3引脚模式寄存器
  12. sfr P5=0xc8;
  13. sfr P1ASF=0x9D;    //声明 P1口模拟功能寄存器  p1.7开启模拟功能
  14. sfr ADC_RES=0xBD;  //声明 ADC转换结果寄存器
  15. sfr ADC_CONTR=0xBC;//声明 ADC控制寄存器
  16. sbit OUT=P5^5;//定义一个输出引脚
  17. unsigned int L; //用于存储读出的PWM
  18. unsigned char count;//用于存储次数
  19. unsigned char displaytime;
  20. unsigned int data1,data2,data3; //用于存储PWM的个位和十位和百位

  22.                                        
  23. sbit DA=P2^4;                        //数码管每个引脚
  24. sbit DB=P3^2;
  25. sbit DC=P3^6;
  26. sbit DD=P2^0;
  27. sbit DE=P2^1;
  28. sbit DF=P2^3;
  29. sbit DG=P3^5;
  30. sbit DP=P3^7;

  32. sbit B1=P2^5;                        //四个数码管的引脚定义          用于控制哪个数码管亮
  33. sbit B2=P2^2;
  34. sbit B3=P3^3;
  35. sbit B4=P3^4;

  37. void main()
  38. {
  39.    P2M0=0x1B;                //需要高电平大电流的引脚 2.4、2.3、2.1、2.0，填入数值0001 1011
  40.    P3M0=0xE4;                //需要高电平大电流的引脚 3.7、3.6、3.5、3.2，填入数值1110 0100
  41.    //B1=B2=B3=B4=0;

  43.    
  44.        
  45.   while(1)
  46.   {
  47.     delay_n_10us(400);
  48.         count++;
  49.         if(count>4)
  50.         {
  51.             count=0;
  52.                 B1=B2=B3=B4=0;  //暂时关闭数码管 防止闪烁

  54.                 //开始  模--数转换
  55.         P1ASF=0x80;
  56.             ADC_CONTR=0X88+7;
  57.                    delay_n_10us(5);
  58.             a=ADC_RES;
  59.             L=a;//先将读数给PWM                 
  60.              //输出PWM
  61.               if(L>200)         //如果时间大于2ms，从1ms重新开始
  62.              {
  63.                 L=200;
  64.              }
  65.              else if(L<100)         //如果时间小于2ms，从1ms重新开始
  66.                   {
  67.                         L=100;
  68.                       }               
  69.              OUT=1;
  70.              delay_n_10us(L);//输出高电平   
  71.              OUT=0;
  72.                  data3=L/100;
  73.                  data2=L%100/10;
  74.                  data1=L%10;
  75.                  
  76.                
  77.                      
  78.         }
  79.          
  80.        
  81.         displaytime++;
  82.         if(displaytime>2)
  83.           displaytime=0;
  84.         if(displaytime==0)     
  85.           Display_num(data1,4);        //显示个位
  86.         if(displaytime==1)
  87.           Display_num(data2,3);        //显示十位
  88.         if(displaytime==2)
  89.           Display_num(data3*10,2); //显示百位
  90.                        
  91.           
  92.           
  93.        
  94.          
  95.   }
  96.   
  97. }
  98. void Display(unsigned int num) //显示0到9直接用相应的数字做参数，显示1到9 加个点 用1到9乘以10做参数 0加一个点用11做参数
  99. {
  100.    switch(num)
  101.         {
  102.                  case 0:
  103.                      {
  104.                          DA=0;  DB=0;   DC=0;          DD=0;   DE=0; DF=0; DG=1;      DP=1;         //显示0       
  105.                          break;          
  106.                          }
  107.              case 1:
  108.                      {
  109.                          DA=1;  DB=0;   DC=0;          DD=1;  DE=1; DF=1;   DG=1;      DP=1;         //显示1
  110.                          break;                  
  111.                          }
  112.                  case 2:
  113.                      {
  114.                          DA=0;  DB=0;   DC=1;          DD=0;   DE=0;  DF=1;          DG=0;     DP=1;         //显示2                  
  115.                          break;
  116.                          }
  117.                  case 3:
  118.                      {
  119.                          DA=0;  DB=0;    DC=0;          DD=0;    DE=1; DF=1;         DG=0;     DP=1;         //显示3                  
  120.                          break;
  121.                          }
  122.                  case 4:
  123.                      {
  124.                          DA=1;  DB=0;  DC=0;          DD=1;    DE=1;  DF=0;           DG=0;     DP=1;         //显示4                  
  125.                          break;
  126.                          }
  127.                  case 5:
  128.                      {
  129.                          DA=0;  DB=1;     DC=0;          DD=0;   DE=1;   DF=0;           DG=0;   DP=1;         //显示5                  
  130.                          break;
  131.                          }
  132.                  case 6:
  133.                      {
  134.                          DA=0;  DB=1;     DC=0;          DD=0;  DE=0;  DF=0;          DG=0;    DP=1;         //显示6                  
  135.                          break;
  136.                          }
  137.                  case 7:
  138.                      {
  139.                          DA=0;  DB=0;   DC=0;          DD=1;   DE=1;  DF=1;          DG=1;     DP=1;         //显示7                  
  140.                          break;
  141.                          }
  142.                  case 8:
  143.                      {
  144.                          DA=0;  DB=0;    DC=0;          DD=0;  DE=0;  DF=0;          DG=0;     DP=1;         //显示8                  
  145.                          break;
  146.                          }
  147.                  case 9:
  148.                      {
  149.                          DA=0;  DB=0;  DC=0;          DD=0;   DE=1; DF=0;           DG=0;      DP=1;         //显示9                  
  150.                          break;
  151.                          }
  152.                  
  153.              case 10:
  154.                      {
  155.                          DA=1;  DB=0;   DC=0;          DD=1;  DE=1; DF=1;   DG=1;      DP=0;         //显示1加个点
  156.                          break;                  
  157.                          }
  158.                 case 11:
  159.                      {
  160.                          DA=0;  DB=0;   DC=0;          DD=0;   DE=0; DF=0; DG=1;      DP=0;         //显示0        加个点
  161.                          break;          
  162.                          }
  163.                  case 20:
  164.                      {
  165.                          DA=0;  DB=0;   DC=1;          DD=0;   DE=0;  DF=1;          DG=0;     DP=0;         //显示2        加个点          
  166.                          break;
  167.                          }
  168.                  case 30:
  169.                      {
  170.                          DA=0;  DB=0;    DC=0;          DD=0;    DE=1; DF=1;         DG=0;     DP=0;         //显示3        加个点          
  171.                          break;
  172.                          }
  173.                  case 40:
  174.                      {
  175.                          DA=1;  DB=0;  DC=0;          DD=1;    DE=1;  DF=0;           DG=0;     DP=0;         //显示4        加个点          
  176.                          break;
  177.                          }
  178.                  case 50:
  179.                      {
  180.                          DA=0;  DB=1;     DC=0;          DD=0;   DE=1;   DF=0;           DG=0;   DP=0;         //显示5        加个点          
  181.                          break;
  182.                          }
  183.                  case 60:
  184.                      {
  185.                          DA=0;  DB=1;     DC=0;          DD=0;  DE=0;  DF=0;          DG=0;    DP=0;         //显示6        加个点          
  186.                          break;
  187.                          }
  188.                  case 70:
  189.                      {
  190.                          DA=0;  DB=0;   DC=0;          DD=1;   DE=1;  DF=1;          DG=1;     DP=0;         //显示7        加个点          
  191.                          break;
  192.                          }
  193.                  case 80:
  194.                      {
  195.                          DA=0;  DB=0;    DC=0;          DD=0;  DE=0;  DF=0;          DG=0;     DP=0;         //显示8        加个点          
  196.                          break;
  197.                          }
  198.                  case 90:
  199.                      {
  200.                          DA=0;  DB=0;  DC=0;          DD=0;   DE=1; DF=0;           DG=0;      DP=0;         //显示9        加个点          
  201.                          break;
  202.                          }
  203.                  default :
  204.                      {
  205.                           DA=1;  DB=1;   DC=1;          DD=1;   DE=1;  DF=1;          DG=1;     DP=1;         //全灭          
  206.                          break;
  207.                          }
  208.         }
  209. }

  211. void Display_num(unsigned int num,unsigned char weizhi)
  212. {
  213.    switch(weizhi)
  214.    {
  215.       case 1:
  216.                {
  217.                         B1=1; B4=0;B2=0;B3=0;
  218.                                   Display(num);
  219.                                 break;
  220.                         }
  221.            case 2:
  222.                {
  223.                         B2=1; B1=0;B3=0;B4=0;
  224.                                   Display(num);
  225.                                 break;
  226.                         }
  227.             case 3:
  228.                {
  229.                         B3=1; B1=0;B2=0;B4=0;
  230.                                   Display(num);
  231.                                 break;
  232.                         }
  233.                  case 4:
  234.                {
  235.                         B4=1; B1=0;B2=0;B3=0;
  236.                                   Display(num);
  237.                                 break;
  238.                         }


  241.     }  
  242. }  





  248. void Delay10us()                //@12.000MHz
  249. {
  250.         unsigned char i;

  252.         _nop_();
  253.         _nop_();
  254.         i = 24;
  255.         while (--i);
  256. }

  258. void delay_n_10us(unsigned int n) //延时n个10us的函数
  259. {      
  260.      while(n)         
  261.           {  
  262.               Delay10us();   
  263.                   n=n-1;//每循环一次n减小1  
  264.            }
  265. }
复制代码



显示器, 测试仪

评分

参与人数 1黑币 +100 收起 理由
admin + 100 共享资料的黑币奖励！

查看全部评分

相关帖子
回复

使用道具 举报

ID:603812 发表于 2021-12-13 10:01 | 显示全部楼层
高手谢谢分享，老贴子顶起别让它沉了
回复

使用道具 举报

ID:895060 发表于 2022-12-7 21:29 | 显示全部楼层
我来了来了 发表于 2021-12-13 10:01
高手谢谢分享，老贴子顶起别让它沉了

不错不错，学习了
回复

使用道具 举报

ID:1056411 发表于 2022-12-8 10:31 | 显示全部楼层
用什么软件编程的，我是新手
回复

使用道具 举报

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

本版积分规则

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

Powered by 单片机教程网

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