设为首页收藏本站
首页 > 论坛 > 机器人

[项目]履带加伸缩机械手机器人 精华

RichardFu | 初级技师 | 创造力： | 帖子： | 发消息 | 串个门 | 加好友 | 打招呼
2016-4-1 14:56:40 [显示全部楼层]
85539浏览
13回复
8收藏
查看: 85539|回复: 13

[项目] 履带加伸缩机械手机器人

[复制链接]
本帖最后由 RichardFu 于 2016-4-1 14:59 编辑

视频展示



材料
1. Romeo BLE多合一控制器  (DFR0305)
2. L298N双路H桥电机驱动  (DRI0002)
3. 金属夹持器  (ROB0099)
4. Devastator履带机器人移动平台(ROB0112)
5. 全方位蜂巢云台  (ROB0114)
6. 云台舵机支架套件  (FIT0004)
7. 7.4V 2200MA 锂电池  (FIT0137)
8. 180度舵机(SER0020) x2
9. 螺纹电机 6V，100rpm
10. 3D打印伸缩臂


简介
履带加伸缩机械手机器人图1
创客喜欢用自己的双手进行创作，但有没有想过让自己做的机器人同样拥有动手能力呢？在这个项目里我打算把履带小车结合夹持器做一个有抓取功能的小车。由于装在小车上方难以抓到地面上的东西，因此还需要给小车增加伸缩的功能。我们使用3D打印机打印一个可以伸缩的支架，并找了一个可以配合的螺纹电机来实现伸缩功能。


这个机器人还是个比较粗略的原型，希望由此可以发展出更精密并且也容易制作的机械爪机器人。



制作流程

组装过程：
1.用3D打印机打印伸缩臂的零件，并用螺丝组装起来。另外还打印螺纹电机的支架，把螺纹电机和伸缩臂组装起来。（模型在最后附上）
2.将蜂巢云台装在履带机器人上。
3.在云台上使用舵机支架套件来安装一个舵机。
4.把螺纹电机装在舵机上。
5.把另一个舵机装在夹持器上，使它可以做抓取动作。
6.把夹持器的舵机固定到伸缩臂上。

使用下图进行连接：
履带加伸缩机械手机器人图2
M1 – 右轮电机
M2 – 左轮电机
数字13 – 电机驱动E1
数字12 – 电机驱动M1
数字9 – 机械臂抬起/降落舵机
数字8 – 夹持器舵机


Vin – 电机驱动VD
GND – 电机驱动GND
电机驱动M1 – 螺纹电机
电池 – 控制板电源
电池 – 电机驱动VS和GND


代码
  1. 

  2. #include <Servo.h>

  3. #include <Metro.h>

  4. #include "GoBLE.h"

  5. 

  6. int speedPin_M1 = 5;     //电机1速度控制 M1 Speed Control

  7. int speedPin_M2 = 6;     //电机2速度控制 M2 Speed Control

  8. int directionPin_M1 = 4;     //电机1方向控制 M1 Direction Control

  9. int directionPin_M2 = 7;     //电机2方向控制 M1 Direction Control

  10. 

  11. int E1 = 13;

  12. int M1 = 12;

  13. 

  14. int tGo = 13000;

  15. int tBack = 13000;

  16. 

  17. int tCatch = 2000;

  18. int tRelease = 2000;

  19. 

  20. bool catched = false;

  21. 

  22. Servo claw; //claw platform servo

  23. Servo top; //上层舵机 top servo

  24. 

  25. int clawPosition = 45; // 45 ~ 100

  26. int topPosition = 45; //45 ~ 155

  27. 

  28. int recordPin = 11;

  29. int playPin = 10;

  30. 

  31. int joystickX, joystickY;

  32. int buttonState[5];

  33. 

  34. bool leftPressed = false;

  35. bool rightPressed = false;

  36. 

  37. bool clawMoved = false;

  38. 

  39. void setup() {

  40.   Goble.begin(); //启动GoBLE

  41.   Serial.begin(115200);

  42.   top.attach(9);         // Top Servo– Digital 9

  43.   claw.attach(8);        // claw Servo - Digital 8

  44.   top.write(topPosition);   //写入起始角度

  45.   claw.write(clawPosition);  //写入起始角度

  46. 

  47.   pinMode(11, OUTPUT);

  48.   pinMode(12, OUTPUT);

  49.   pinMode(10, OUTPUT);

  50.   digitalWrite(10, LOW);

  51. 

  52.   digitalWrite(11, LOW);

  53. 

  54.   digitalWrite(12, LOW);

  55. 

  56.   pinMode(13, OUTPUT);

  57.   digitalWrite(13, HIGH);

  58. 

  59.   analogWrite(E1, 0);

  60. }

  61. 

  62. void loop() {

  63. 

  64.   if (Goble.available()) {

  65. 

  66.     joystickX = Goble.readJoystickX();

  67.     joystickY = Goble.readJoystickY();

  68. 

  69.     buttonState[SWITCH_UP]     = Goble.readSwitchUp();

  70.     buttonState[SWITCH_DOWN]   = Goble.readSwitchDown();

  71.     buttonState[SWITCH_LEFT]   = Goble.readSwitchLeft();

  72.     buttonState[SWITCH_RIGHT]  = Goble.readSwitchRight();

  73. 

  74. 

  75. 

  76.     //    Serial.print("Joystick Value: ");

  77.     //    Serial.print(joystickX);

  78.     //    Serial.print("  ");

  79.     //    Serial.println(joystickY);

  80. 

  81. 

  82.     if (joystickY > 196) {

  83.       Serial.println("turn right");

  84.       carTurnRight(250, 250);

  85.     }

  86.     else if (joystickY < 64) {

  87.       Serial.println("turn left");

  88.       carTurnLeft(250, 250);

  89.     }

  90.     else if (joystickX > 196) {

  91.       Serial.println("move forward");

  92.       carAdvance(400, 400);

  93.     }

  94.     else if (joystickX < 64) {

  95.       Serial.println("move backward");

  96.       carBack(400, 400);

  97.     }

  98.     else {

  99.       carStop();

  100.     }

  101. 

  102. 

  103.     if (buttonState[SWITCH_LEFT] == PRESSED && buttonState[SWITCH_RIGHT] == PRESSED) {

  104.       analogWrite(E1, 0);

  105.       if (!clawMoved) {

  106.         if (clawPosition <= 45) {

  107.           clawPosition = 100;

  108.           claw.write(clawPosition);

  109.         }

  110.         else {

  111.           clawPosition = 45;

  112.           claw.write(clawPosition);

  113.         }

  114.         clawMoved = true;

  115.       }

  116. 

  117. 

  118.     }

  119.     else if (buttonState[SWITCH_LEFT] == PRESSED) {

  120.       digitalWrite(M1, LOW);

  121.       analogWrite(E1, 255);

  122.     }

  123.     

  124.     else if (buttonState[SWITCH_RIGHT] == PRESSED) {

  125.       digitalWrite(M1, HIGH);

  126.       analogWrite(E1, 255);

  127.     }

  128.     else if (buttonState[SWITCH_UP] == PRESSED) {

  129.       topPosition -= 5;

  130.       if (topPosition <= 45) {

  131.         topPosition = 45;

  132.       }

  133.       top.write(topPosition);

  134.     }

  135.     else if (buttonState[SWITCH_DOWN] == PRESSED) {

  136.       topPosition += 5;

  137.       if (topPosition >= 155) {

  138.         topPosition = 155;

  139.       }

  140.       top.write(topPosition);

  141.     }

  142. 

  143.     if( buttonState[SWITCH_LEFT] == RELEASED && buttonState[SWITCH_RIGHT] == RELEASED){

  144.       analogWrite(E1, 0);

  145.     }

  146.     

  147.     if( buttonState[SWITCH_LEFT] == RELEASED || buttonState[SWITCH_RIGHT] == RELEASED){

  148.       clawMoved = false;

  149.     }

  150.   }

  151. 

  152. }

  153. 

  154. void carStop() {                //  Motor Stop

  155.   digitalWrite(speedPin_M2, 0);

  156.   digitalWrite(directionPin_M1, LOW);

  157.   digitalWrite(speedPin_M1, 0);

  158.   digitalWrite(directionPin_M2, LOW);

  159. }

  160. 

  161. void carTurnLeft(int leftSpeed, int rightSpeed) {       //Turn Left

  162.     analogWrite (speedPin_M2, leftSpeed);

  163.   digitalWrite(directionPin_M1, LOW);

  164.   analogWrite (speedPin_M1, rightSpeed);

  165.   digitalWrite(directionPin_M2, LOW);

  166.   

  167. }

  168. 

  169. void carTurnRight(int leftSpeed, int rightSpeed) {     //Turn Right

  170.   analogWrite (speedPin_M2, leftSpeed);

  171.   digitalWrite(directionPin_M1, HIGH);

  172.   analogWrite (speedPin_M1, rightSpeed);

  173.   digitalWrite(directionPin_M2, HIGH);

  174. }

  175. 

  176. void carBack(int leftSpeed, int rightSpeed) {           //Move backward

  177.   analogWrite (speedPin_M2, leftSpeed);             //PWM Speed Control

  178.   digitalWrite(directionPin_M1, HIGH);

  179.   analogWrite (speedPin_M1, rightSpeed);

  180.   digitalWrite(directionPin_M2, LOW);

  181.   

  182.   

  183. }

  184. void carAdvance(int leftSpeed, int rightSpeed) {         //Move forward

  185.   analogWrite (speedPin_M2, leftSpeed);

  186.   digitalWrite(directionPin_M1, LOW);

  187.   analogWrite (speedPin_M1, rightSpeed);

  188.   digitalWrite(directionPin_M2, HIGH);

  189.   

  190.   

  191. }

复制代码



实际效果
小车可以用iOS系统的GoBLE软件控制。用左边的遥杆控制小车移动，右边的键控制机械臂升起降落以及伸缩，左右键同时按可以让夹持器夹持或松开。

注意事项
1.螺纹电机转速过慢，可以再尝试一下其它型号。
2.机械臂负重过多，会导致弯曲以及无法伸展。以后可以考虑修改构造把夹持器舵机放到后面。
3.组装时尽量把机械臂放在直立状态。
4.注意将电线和驱动固定，各个连接口打胶。


模型
下载附件伸缩臂模型.zip





回复

使用道具 举报

精彩评论(13)

hnyzcj  版主

发表于 2016-4-1 15:43:53

为什么每次总强在我前面
回复

使用道具 举报

hnyzcj  版主

发表于 2016-4-1 15:46:32

楼主这个有点抖，哈哈
回复

使用道具 举报

dsweiliang  初级技神

发表于 2016-4-1 17:46:26

一抖一抖的，很搞笑
回复

使用道具 举报

iooops  中级技匠

发表于 2016-4-1 21:42:07

语音识别 - - ？

楼主你好神奇……
回复

使用道具 举报

丄帝De咗臂  高级技匠

发表于 2016-4-7 17:20:43

hnyzcj 发表于 2016-4-1 15:43
为什么每次总强在我前面

你是大忙人啊
回复

使用道具 举报

hnyzcj  版主

发表于 2016-4-7 17:33:31

丄帝De咗臂 发表于 2016-4-7 17:20
你是大忙人啊

在你面前我不敢说自己忙！
回复

使用道具 举报

zhengx84  见习技师

发表于 2016-6-12 16:11:36

都这么高大上
回复

使用道具 举报

DFSkangKjBr  中级技师

发表于 2019-9-3 14:16:26

学习中，希望自己能成功做出一个来！谢谢分享！
回复

使用道具 举报

DFS1w2cb8o8  中级技师

发表于 2020-6-12 21:16:34

厉害厉害
回复

使用道具 举报

20060606  高级技匠

发表于 2020-8-27 05:53:41

系统有些抖
回复

使用道具 举报

KkQ1VrB7W776  高级技师

发表于 2022-1-30 10:26:18

66666666666666666666666666666666666
回复

使用道具 举报

Amos Young  中级技师

发表于 2023-8-22 16:10:29

机械舞的灵感就是这么来的，抖啊抖
回复

使用道具 举报

刘睿鹏  中级技师

发表于 2024-7-10 12:38:13

这抖来抖去的能抓稳吗？
回复

使用道具 举报

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

本版积分规则

为本项目制作心愿单
购买心愿单
心愿单 编辑
[[wsData.name]]

硬件清单

  • [[d.name]]
btnicon
我也要做!
点击进入购买页面
撰写新帖
关于楼主

楼主的其它帖子

background 创造力兑换 background 心愿单 background 创客导航
上海智位机器人股份有限公司 沪ICP备09038501号-4 备案 沪公网安备31011502402448

© 2013-2025 Comsenz Inc. Powered by Discuz! X3.4 Licensed

mail