5自由度并联机械臂实现搬运功能

news2024/12/23 9:25:10

1. 功能说明

      本文示例将实现R306样机5自由度并联机械臂搬运牛奶到指定地点的功能。该机械臂由1个5自由度并联机械臂和1个单轴丝杠平台构成,机械臂通过并联的方式同时控制同一个端点的运动。其驱动系统采用大扭矩舵机和小扭矩舵机、执行末端为夹持机构。

 

2. 并联机械臂机械系统

      并联机械臂与串联机械臂每个独立的关节模块组成不同,并联机械臂是通过连杆组将多个驱动同时共同控制机械臂末端,如下图(四连杆并联机械臂)所示,可以分解为三个部分:

       第一个部分是下图中蓝色的四连杆,舵机y作为驱动,舵机x固定不动,这时会形成一个FBCD四连杆结构,FB为机架,FD为驱动杆;

      第二个部分是下图中红色的四连杆,舵机x作为驱动,舵机y固定不动,这时会形成一个ABCD四连杆,其中AD作为机架,AB作为驱动杆,BC作为传动杆,CD作为随动杆;  

      第三部分为DGHI平行四连杆,这个部分没有驱动,主要作用是保证执行端HI保持一个方向;

      综上可知CD杆为第一部分四连杆和第二部分四连杆共同控制的杆件。

 3. 并联机械臂运动学算法

      当机械臂完成动作时,需通过舵机对L1和L2了两根连杆进行控制和调节,2个舵机的角度分别为θ1和θ2。为了方便分析,将机械臂简化进行分析。

       图中L1=AB,L2=BC,L3=CD,L4=DA,L5=AF,L6=DF,其中假设舵机x和舵机y的0°和180°的极限位置为AF杆方向,θ1和θ2分别为舵机x和舵机y的转动角度,其中L1、L2、L3、L5、L6都为已知尺寸(可用尺子量出)。

      在这个模型中,并联机械臂的运动算法就是CD杆的运动轨迹,如果要求出CD杆的运动轨迹,实际是求出CD杆与DF杆的夹角∠CDF。

      从图中可知:∠CDF=∠CDA+∠ADF;

      ∠CDA位于四连杆ABCD中,通过欧拉公式可以推导;∠ADF位于三角形ADF中,可以通过三角形余弦定理推导;

      求解∠CDA,假设∠CAD=α:

根据欧拉公式展开得:

      从上面的公式中可知我们还需要求出L4和∠BAD;

      L4位于三角形ADF中,可通过三角函数求解得出。在三角形ADF中需要知道两条相邻边长和该相邻边的夹角,其中L6和L5为已知量,所以:

       其中∠DFA=180°-θ2;

      ∠BAD=180°-θ1-∠DAF;

        同理可得:

         最终可解得:

         计算机械臂的端点I的运动轨迹,可建立舵机x和舵机y转动中心连线为x轴的平面坐标系,如下图所示:

         如上图所示,对D点和I点(x,y)作平面直角坐标系的投影,根据前面计算出的D点角度位置计算I点的运动坐标,最终可获得I(f(θ1,θ2),f(θ1,θ2))的关系。

4. 电子硬件

       在这个示例中,采用了以下硬件,请大家参考:

主控板

Basra主控板(兼容Arduino Uno)‍

扩展板

Bigfish2.1扩展板‍

电池7.4V锂电池

电路连接:舵机接线:由上至下分别连接在Bigfish扩展板的D4、D7、D3、D8、D12接口。

5. 功能实现

上位机:Controller 1.0

下位机编程环境:Arduino 1.8.19

① 将参考例程(get_milk_new2.ino)下载到主控板:

/*------------------------------------------------------------------------------------

  版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.

           Distributed under MIT license.See file LICENSE for detail or copy at

           https://opensource.org/licenses/MIT

           by 机器谱 2023-04-07 https://www.robotway.com/

  ------------------------------*/

#include <Servo.h>


#define servo_speed 120   //servo_speed

#define action_delay 1000 //action_delay


Servo myServo[5];

int servo_port[5]={4, 7, 3, 8, 12};   //servo_pin

float value_init[5]={115, 60, 156, 35, 75};   //servo_value_inital


int num = 10;   

int servo_num = sizeof(servo_port)/sizeof(servo_port[0]); //servo_pin length

boolean debug = false;   //if(true) debug


void setup() {

  Serial.begin(9600);  

  for(int i=0;i<servo_num;i++)

    ServoGo(i,value_init[i]);  

  delay(action_delay);

}


void loop() {

      servo_move(115, 105, 160, 110, 20);

      servo_move(140, 60, 160, 35, 75);

      get_milk();

      putMilk_near();

     

      servo_move(115, 105, 160, 110, 20);

      servo_move(140, 60, 160, 35, 75);

      get_milk();

      putMilk_far();

}


void ServoStart(int which)

{

  if(!myServo[which].attached())myServo[which].attach(servo_port[which]);

  pinMode(servo_port[which], OUTPUT);

}


void ServoStop(int which)

{

  myServo[which].detach();

  digitalWrite(servo_port[which],LOW);

}


void ServoGo(int which , int where)

{

  if(where!=200)

  {

    if(where==201) ServoStop(which);

    else

    {

      ServoStart(which);

      myServo[which].write(where);

    }

  }  

  ServoStart(which);

  myServo[which].write(where);

}


void get_milk()

{

  servo_move(115, 105, 160, 110, 20);   //down

  servo_move(160, 95, 160, 95, 40);    //get

  servo_move(160, 60, 160, 35, 75);    //up  

  delay(action_delay);  

  servo_move(160, 60, 25, 35, 75); //turn  

}



void putMilk_near()

{

  //Serial.println("near");

  servo_move(160, 60, 25, 60, 65); //down

  servo_move(140, 60, 25, 60, 65); //put

  servo_move(115, 60, 160, 35, 75);//reset

}


void putMilk_far()

{

  //Serial.println("far");

  servo_move(160, 100, 22, 56, 54); //down

  servo_move(140, 103, 22, 56, 54); //put

  servo_move(115, 60, 160, 35, 75); //reset

}



void servo_move(float value0, float value1, float value2, float value3, float value4)

{

  //Serial.println("begin");  

  float value_arguments[] = {value0, value1, value2, value3, value4};

  float value_delta[servo_num];  

  for(int i=0;i<servo_num;i++)

  {

    value_delta[i] = (value_arguments[i] - value_init[i]) / num;

  }  

  for(int i=0;i<num;i++)

  {

    for(int k=0;k<servo_num;k++)

    {

      value_init[k] = value_delta[k] == 0 ? value_arguments[k] : value_init[k] + value_delta[k];

    }

   

    for(int j=0;j<servo_num;j++)

    {

      ServoGo(j,value_init[j]);

    }

    delay(servo_speed);

  }

  delay(action_delay);  

}

② 双击打开Controller 1.0.exe。将波特率与串口设置好,同时留下4、7、3、8、12几个舵机串口,调试舵机角度。具体操作步骤可参考【U002】如何驱动模拟舵机-Controller 1.0b软件的使用

 ③ 将调试好的舵机角度写到对应例程(get_milk_new2.ino)中的位置;这里以几个角度为例,大家可尝试自己更改角度使其动作看起来更流畅。

6. 资料内容

①搬运-例程源代码

②搬运-样机3D文件

③Controller1.0b资料包

资料内容详见:5自由度并联机械臂-搬运

本文来自互联网用户投稿,该文观点仅代表作者本人,不代表本站立场。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如若转载,请注明出处:http://www.coloradmin.cn/o/455602.html

如若内容造成侵权/违法违规/事实不符,请联系多彩编程网进行投诉反馈,一经查实,立即删除!

相关文章

SEO优化中的外链与反链是什么意思?它们之间有什么区别?

在SEO优化中&#xff0c;外链和反链是两个非常重要的概念。虽然它们听起来很相似&#xff0c;但实际上却有着很大的区别。那么&#xff0c;什么是外链和反链&#xff1f;它们之间有什么区别呢&#xff1f;本文将为您详细介绍。 一、什么是外链 外链&#xff0c;也被称为入站链…

C++---区间DP---环形石子合并(每日一道算法2023.4.24)

注意事项&#xff1a; 本题是"区间dp—石子合并"的扩展题&#xff0c;dp思路完全一样&#xff0c;就不多详细讲了&#xff0c;可以去那篇文章看&#xff0c;这题主要讲一下如何处理环形。 题目&#xff1a; 将 n 堆石子绕圆形操场排放&#xff0c;现要将石子有序地合…

ES的索引结构与算法解析

作者&#xff1a;京东物流 李洪吉 提到ES&#xff0c;大多数爱好者想到的都是搜索引擎&#xff0c;但是明确一点&#xff0c;ES不等同于搜索引擎。不管是谷歌、百度、必应、搜狗为代表的自然语言处理(NLP)、爬虫、网页处理、大数据处理的全文搜索引擎&#xff0c;还是有明确搜…

DAY03_循环语句

1&#xff1a;for循环结构 来&#xff0c;继续啊&#xff0c;下面我们来学习循环结构语句&#xff0c;循环结构有三种语句&#xff0c;分别是&#xff1a; for循环 while循环 do…while循环 这三种循环可以做相同的事情&#xff0c;当然它们也有小的区别&#xff0c;至于它…

【LeetCode】322. 零钱兑换

322. 零钱兑换&#xff08;中等&#xff09; 思路 由于题目提到 「每种硬币的数量是无限的」&#xff0c;所以这道题本质上完全背包问题&#xff0c;我直接使用了空间压缩的写法。dp[j] 表示当前区间在 [0, i]的硬币可以表示成 j 的最小数量。注意&#xff0c;这里把 dp数组初始…

windows安装sqli-labs靶场,两种方式

1、安装phpstudy 官网打不开了&#xff0c;下载地址在这儿https://download.csdn.net/download/weixin_59679023/87711536 双击安装 点自定义安装&#xff0c;选择安装目录&#xff0c;注意目录不要有空格和中文 安装完成启动红框内的两个服务 2、安装sqli靶场 这个包支持ph…

4.23学习周报

文章目录 前言文献阅读摘要简介方法结果结论 时间序列预测学习总结 前言 本周阅读文献《A novel hybrid model for water quality prediction based on synchrosqueezed wavelet transform technique and improved long short-term memory》&#xff0c;文献主要提出一种新型混…

动力节点Springsecurity笔记06-13基于数据库的方法授权

6 密码处理 6.1 为什么要加密&#xff1f; csdn 密码泄露事件 泄露事件经过&#xff1a;https://www.williamlong.info/archives/2933.html 泄露数据分析&#xff1a;https://blog.csdn.net/crazyhacking/article/details/10443849 6.2加密方案 密码加密一般使用散列函数&a…

react-9 函数式写法rsc,配合HOOKS基础钩子函数

函数组件和类组件区别&#xff1a; 1.函数组件中没有this 2.函数组件无需继承 3.函数组件默认没有状态&#xff0c;想要使用组件状态必须通过 HOOK 函数引入 4.函数组件默认没有生命周期函数 5.函数组件的渲染&#xff0c;只需要一次函数调用即可 useState &#xff1a;用…

【react全家桶学习】react中JSX语法规则

目录 JSX的定义 XML的含义 JSX的语法规则 &#xff08;1&#xff09;定义类名&#xff0c;用className而不是class &#xff08;2&#xff09;如何使用内联样式设置样式 &#xff08;3&#xff09;虚拟dom必须只有一个根标签 &#xff08;4&#xff09;在react组件中使用变…

谷歌将发布全新搜索引擎,你期待吗?

Google一身自带AI属性的新搜索最首要的目标并非急于取代传统搜索引擎&#xff0c;或者说彻底打败ChatGPT&#xff0c;而是能够用全新的产品说服用户&#xff0c;变得与竞争对手同样“强大、能力出众以及顺应AI潮流”。 对于Google而言&#xff0c;搜索就是命脉。Google每年的收…

Java基础——多线程创建

&#xff08;1&#xff09;什么是线程&#xff1f; 线程(thread)是一个程序内部的一条执行路径。程序中只有一条执行路径&#xff0c;那么这个程序就是单线程的程序。 &#xff08;2&#xff09;多线程是什么&#xff1f; 多线程是指从软硬件上实现多执行流程的技术。 &…

Python入门教程+项目实战-10.5节: 程序实战-冒泡排序算法

目录 10.5.1 排序算法简介 10.5.2 冒泡排序算法 10.5.3 系统学习python 10.5.1 排序算法简介 所谓排序&#xff0c;是指将数据集合中的元素按从小到大的顺序进行排列&#xff0c;或按从大到小的顺序进行排列。前者称为升序排序&#xff0c;后者称为降序排序。在数据结构与算…

jenkins自动化部署配置

文章目录 1. jenkins 插件安装2. 配置2.1 全局工具配置2.2 全局配置2.2.1 gitee 配置 3. 创建任务添加gitee ssh jenkins 开机自启动 1. jenkins 插件安装 ant Build Failure AnalyzerBuild Monitor ViewBuild Timeout dockerEmail Extension Plugin giteegithubgradle javama…

【11 EL表达式JSTL 学习笔记 】

EL表达式 学习笔记 1. EL表达式介绍2. EL表达式的基本使用3. EL 表达式获取数据4. EL注意事项5. EL表达式运算符关系运算符逻辑运算符empty&三元运算符 6. EL表达式细节7. EL表达式11个隐式对象8. JSTL8.1 JSTL的基本使用 1. EL表达式介绍 简化了 java代码块和jsp表达式的…

ChatGPT的开源平替,终于来了!

最近这段时间&#xff0c;一个号称全球最大ChatGPT开源平替项目Open Assistant引起了大家的注意。 这不最近还登上了GitHub的Trending热榜。 https://github.com/LAION-AI/Open-Assistant 根据官方的介绍&#xff0c;Open Assistant也是一个对话式的大型语言模型项目&#xff…

RUST 每日一省:生命周期作用域

生命周期 一个变量的生命周期就是它从创建到销毁的整个过程。 作用域 我们声明的每个变量都有作用域。作用域其实是变量和值存在的环境。作用域是由一对花括号表示的。例如&#xff0c;使用块表达式会创建一个作用域&#xff0c;即任何以花括号开头和结尾的表达式。此…

RabbitMQ-整合mqtt

用 springboot rabbitmq可以搭建物联网&#xff08;IOT&#xff09;平台&#xff0c;rabbitmq 不是消息队列吗&#xff0c;原来rabbitmq有两种协议&#xff0c;消息队列是用的AMQP协议&#xff0c;而用在智能硬件中的是MQTT协议。 一、rabbitmq是什么&#xff1f; RabbitMQ就…

一张图了解GPU、CUDA、CUDA toolkit和pytorch的关系

文章目录 GPU、Cuda Driver和 Cuda Toolkit的图解关系省流&#xff0c;简略版本要实现多版本的cuda怎么办 复杂版&#xff08;你要是觉得简略版说的太简单&#xff0c;这里给你找文档证明&#xff09;一、Nvidia Driver和CUDA Toolkit的关系安装GPU显卡驱动Nvidia Driver 二、C…

uniapp请求图片时候发现提示GET http://localhost:xxxx/undefined 401,undefined:1解决办法【伸手党福利】

同理解决问题&#xff1a;所有请求发起完成之后执行业务逻辑 目录 现象原因解决办法方法1&#xff1a;提前给变量一个非空默认值方法2&#xff1a;使用前端图片代替后端方法3&#xff1a;使用异步加载判断&#xff1a;注意&#xff1a;这种直接在页面判断内容是否为空或者undef…