标题: 51单片机控制四个伺服电机的采摘机械手仿真和源程序 [打印本页]
作者: 口天天    时间: 2017-6-30 23:05
标题: 51单片机控制四个伺服电机的采摘机械手仿真和源程序
分享一个51单片机控制四个伺服电机的采摘机械手

仿真原理图如下（proteus仿真工程文件可到本帖附件中下载）：



单片机源程序如下:
  1.                    /***************   writer:shopping.w   ******************/
  2. #include <reg51.h>
  3. #include <intrins.h>
  4. #define uint unsigned int
  5. #define uchar unsigned char
  6. #define u16 unsigned int
  7. sbit K1   = P3^0;
  8. sbit K2   = P3^1;
  9. sbit K3   = P3^2;
  10. sbit K4   = P3^3;
  11. sbit LED1 = P0^0;
  12. sbit LED2 = P0^1;
  13. sbit LED3 = P0^2;
  14. sbit LED4 = P0^3;
  15. sbit MA   = P1^0;
  16. sbit MB   = P1^1;
  17. sbit MC   = P1^2;
  18. sbit MD   = P1^3;
  19. sbit ME   = P1^4;
  20. sbit MF   = P1^5;
  21. sbit MG   = P1^6;
  22. sbit MH   = P1^7;
  23. //***********************************************//
  24. void delay(u16 num)
  25. {
  26.   u16 x,y;
  27.   for(x=num;x>0;x--)
  28.   {
  29.     for(y=110;y>0;y--)
  30.         {
  31.           //延时1ms；
  32.         }
  33.   }
  34. }

  36. void main(void)
  37. {
  38.         LED1 = 1;
  39.         LED2 = 1;
  40.         LED3 = 1;
  41.         LED4 = 1;
  42.         while(1)
  43.         {
  44.                  if(K1 == 0)
  45.                 {
  46.                          while(K1 == 0);
  47.                         LED1 = 0;
  48.                         LED2 = 1;
  49.                         LED3 = 1;
  50.                         LED4 = 1;
  51.                         MA   = 1;
  52.                         MB   = 0;
  53.                 }
  54.         //        if(K2 == 0)
  55.         //        {
  56.         //                 while(K1 == 0);
  57.         //                LED1 = 1;
  58.         //                LED2 = 0;
  59.         //                LED3 = 1;
  60.         //                MA   = 1;
  61.         //                MB   = 0;
  62.         //        }
  63.                 if(K3 == 0)
  64.                 {
  65.                          while(K3 == 0);
  66.                         LED1 = 0;
  67.                         LED2 = 1;
  68.                         LED3 = 1;
  69.                         LED4 = 1;
  70.                         MA   = 0;
  71.                         MB   = 0;
  72.                         delay(2000);
  73.                         MC   = 1;
  74.                         MD   = 0;
  75.                         LED1 = 1;
  76.                         LED2 = 0;
  77.                         LED3 = 1;
  78.                         LED4 = 1;
  79.                 }
  80.                 if(K4 == 0)
  81.                 {
  82.                    // while(K4 == 0);
  83.                         LED1 = 1;
  84.                         LED2 = 0;
  85.                         LED3 = 1;
  86.                         LED4 = 1;
  87.                         MC   = 0;
  88.                         MD   = 0;
  89.                         delay(2000);
  90.                         ME   = 1;
  91.                         MF   = 0;
  92.                         LED1 = 1;
  93.                         LED2 = 1;
  94.                         LED3 = 0;
  95.                         LED4 = 1;
  96.                         delay(10000);
  97.                         MA   = 0;
  98.                         MB   = 1;
  99.                         delay(5000);
  100.                         LED1 = 1;
  101.                         LED2 = 1;
  102.                         LED3 = 1;
  103.                         LED4 = 0;
  104.                         MG   = 1;
  105.                         MH   = 0;
  106.                         delay(5000);
  107.                         LED1 = 1;
  108.                         LED2 = 0;
  109.                         LED3 = 1;
  110.                         LED4 = 1;
  111.                         MC   = 0;
  112.                         MD   = 1;
  113.                         delay(5000);
  114.                         LED1 = 1;
  115.                         LED2 = 1;
  116.                         LED3 = 1;
  117.                         LED4 = 0;
  118. ……………………

  120. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
51单片机控制四个伺服电机的采摘机械手.zip (73.67 KB, 下载次数: 244)


作者: gshang    时间: 2017-7-1 17:47
十分感谢楼主！！！！！！我最近正在做机械手课程设计
作者: 口天天    时间: 2017-7-2 09:34
一看名字就知道是你。
作者: gdatgb    时间: 2017-7-2 14:12
好资料!  感谢楼主共享！！！
作者: xwd2010    时间: 2017-7-3 15:00
单片机直接驱动不了电机的
作者: 口天天    时间: 2017-7-23 22:35
xwd2010 发表于 2017-7-3 15:00
单片机直接驱动不了电机的

我还不太会用伺服驱动器，这只是个模拟。
作者: 112233445566779    时间: 2018-4-23 19:11
电机3电机4  不运转呀？？？
作者: 18792791321    时间: 2019-5-12 23:16
很给力
作者: 蜗牛也很牛    时间: 2021-9-21 20:32
可以换成4个步进电机吗
作者: 雪糕yya    时间: 2024-3-27 21:26
电机3和4怎么动不了



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