鱼C论坛

 找回密码
 立即注册
查看: 5052|回复: 44

[学习笔记] 大一最后作品,51 控制 Mearm 机械臂

[复制链接]
发表于 2021-7-4 20:44:11 | 显示全部楼层 |阅读模式

马上注册,结交更多好友,享用更多功能^_^

您需要 登录 才可以下载或查看,没有账号?立即注册

x
本帖最后由 小伤口 于 2021-7-4 20:43 编辑

看到咱祖国天宫的七个自由度机械臂强大如斯,顶尖科技,做到对人的手臂最完美的还原,
想起参加变废为宝比赛,自己做的三自由度机械臂,搞得我头皮发麻。
最后还很鸡肋,害~。
啥也不说了为祖国点赞!!!

演示视频请看评论区沙发

下载 (1).jpg

机械臂是我在淘宝买的散件组装的,
然后用 51 单片机控制。整体外观如图:

IMG_20210701_225337.jpg

IMG_20210702_182113.jpg

通过两个 ADC0834 来采集两个摇杆的电压值,根据电压值的变化来达到控制机械臂的目的
没办法社团里只找到 ADC0834 。
控制机械臂换言之其实就是控制舵机,舵机用 51单片机的定时器模拟 PWM 就可以了。
Mearm 有四个舵机,很容易导致单片机出现电压不稳的情况,所以供电用的是一个大号电池加上一个降压模块。
组装和调试过程中,把机械臂搞坏了好几次,没粘好,所以转动会出现抖动的状态。
主代码:
  1. #include <REGX52.H>
  2. #include "AD.h"
  3. #include "Delay1s.h"
  4. #include "timer0.h"

  5. typedef unsigned int u16;
  6. typedef unsigned char u8;

  7. u8 Counter = 0;//计时
  8. u8 result=10,result_1=10,result_2=10,result_3=5;//初始位置
  9. //u8 degree;
  10. sbit PWM = P1^4;  //设定PWM输出的I/O端口
  11. sbit PWM_1 = P1^5;  //设定PWM输出的I/O端口
  12. sbit PWM_2 = P1^3;  //设定PWM输出的I/O端口
  13. sbit PWM_3 = P1^2;  //设定PWM输出的I/O端口
  14. sbit D1 = P0^0;

  15. unsigned long int NUM_1,NUM_2,NUM_3;
  16. void main()   
  17. {   
  18.         Timer0_Init();
  19.         while(1)               
  20.         {
  21.                        
  22.                
  23.                 NUM_1=(unsigned long int)5*100*AD0834(0)/256;//转台
  24.                
  25.                 if (NUM_1>290)
  26.                 {
  27.                         result+=1;
  28.                         if (result>15)
  29.                 {
  30.                         result=15;
  31.                 }
  32.                 }
  33.                 if (NUM_1<200)
  34.                 {
  35.                         result-=1;
  36.                         if (result<5)
  37.                                 {
  38.                                         result=5;   
  39.                                 }
  40.                 }
  41.                 NUM_2=(unsigned long int)5*100*AD0834_2(0)/256;//手臂
  42.                 if (NUM_2>290)
  43.                 {
  44.                         result_2+=1;
  45.                         if (result_2>15)
  46.                 {
  47.                         result_2=15;
  48.                 }
  49.                 }
  50.                 if (NUM_2<200)
  51.                 {
  52.                         result_2-=1;
  53.                         if (result_2<6)
  54.                                 {
  55.                                         result_2=6;  
  56.                                 }
  57.                 }
  58.                 NUM_3=(unsigned long int)5*100*AD0834(1)/256;
  59.                 if (NUM_3>290)
  60.                 {
  61.                         result_3+=1;
  62.                         if (result_3>15)
  63.                 {
  64.                         result_3=15;
  65.                 }
  66.                 }
  67.                 if (NUM_3<200)
  68.                 {
  69.                         result_3-=1;
  70.                         if (result_3<5)
  71.                                 {
  72.                                         result_3=5;   
  73.                                 }
  74.                 }
  75.                 if(D1==0)//手部
  76.                 {
  77.                         result_1=10;
  78.                 }
  79.                 else
  80.                 {
  81.                         result_1=5;
  82.                 }
  83.         }   
  84.        
  85. }   
  86. /*T0中断初始化*/
  87. void Time0_Init() interrupt 1
  88. {
  89.         TR0 = 0;
  90.         TL0 = 0x9C;                //设置定时初始值
  91.         TH0 = 0xFF;                //设置定时初始值
  92.         if(Counter <= result) //5==0° 15==90°
  93.         {
  94.                 PWM = 1;
  95.         }
  96.         else
  97.         {
  98.                 PWM = 0;
  99.         }
  100.        
  101.         if(Counter<= result_1)
  102.         {
  103.                 PWM_1 = 1;
  104.         }
  105.         else
  106.         {
  107.                 PWM_1 = 0;
  108.         }
  109.        
  110.         if(Counter<= result_2)
  111.         {
  112.                 PWM_2 = 1;
  113.         }
  114.         else
  115.         {
  116.                 PWM_2 = 0;
  117.         }
  118.        
  119.        
  120.         if(Counter<= result_3)
  121.         {
  122.                 PWM_3 = 1;
  123.         }
  124.         else
  125.         {
  126.                 PWM_3 = 0;
  127.         }
  128.        
  129.         Counter++;
  130.         if(Counter == 200)

  131.         {

  132.                 Counter= 0;

  133.                 PWM= 1;//拉高电平的引脚,来维持50hz的频率
  134.                 PWM_1= 1;
  135.                 PWM_2= 1;
  136.                 PWM_3=1;
  137.         }
  138.         TR0 = 1; //开启T0
  139. }
  140.                                        
复制代码

(鱼币全部拿去搞排行榜了呜呜┭┮﹏┭┮)

全部文件:
游客,如果您要查看本帖隐藏内容请回复


时间。。。。。。、

过的真快啊~

也不知道还有机会没有.)(.

评分

参与人数 5荣誉 +16 鱼币 +16 贡献 +9 收起 理由
yayc_zcyd + 2 + 2 鱼C有你更精彩^_^
糖甜弯了嘴 + 5 + 5 + 3 无条件支持楼主!
hrpzcf + 5 + 5 + 3 无条件支持楼主!
1406598279 + 1 + 1 给个赞,支持支持!
小甲鱼的二师兄 + 3 + 3 + 3 厉害!!

查看全部评分

本帖被以下淘专辑推荐:

想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-4 20:48:21 | 显示全部楼层
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

发表于 2021-7-4 22:29:03 | 显示全部楼层

回帖奖励 +1 鱼币

66666
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

发表于 2021-7-5 09:06:11 | 显示全部楼层
大神~支持~
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

发表于 2021-7-5 09:06:50 | 显示全部楼层

回帖奖励 +1 鱼币

路过学习一下
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

发表于 2021-7-5 10:34:35 | 显示全部楼层

回帖奖励 +1 鱼币

想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 10:43:56 | 显示全部楼层

回帖奖励 +1 鱼币

想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 12:14:44 | 显示全部楼层
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 15:24:02 | 显示全部楼层
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 15:48:51 | 显示全部楼层
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 17:57:34 | 显示全部楼层

回帖奖励 +1 鱼币

厉害啊
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

发表于 2021-7-5 20:43:05 | 显示全部楼层
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 21:02:42 | 显示全部楼层

回帖奖励 +1 鱼币

看看
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 21:51:23 | 显示全部楼层

回帖奖励 +1 鱼币

想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-5 23:27:42 | 显示全部楼层
NB
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-6 01:15:47 | 显示全部楼层

回帖奖励 +1 鱼币

666,大神~
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

发表于 2021-7-6 11:18:33 | 显示全部楼层

回帖奖励 +1 鱼币

牛啊
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-6 11:19:23 | 显示全部楼层
感谢分享!
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

发表于 2021-7-6 13:48:37 | 显示全部楼层

回帖奖励 +1 鱼币

牛啊
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复

使用道具 举报

发表于 2021-7-6 17:27:57 | 显示全部楼层

回帖奖励 +1 鱼币

好家伙
想知道小甲鱼最近在做啥?请访问 -> ilovefishc.com
回复 支持 反对

使用道具 举报

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

本版积分规则

小黑屋|手机版|Archiver|鱼C工作室 ( 粤ICP备18085999号-1 | 粤公网安备 44051102000585号)

GMT+8, 2024-4-27 15:30

Powered by Discuz! X3.4

© 2001-2023 Discuz! Team.

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