CN205466174U - 基于stm32单片机的delta机器人搬运系统 - Google Patents
基于stm32单片机的delta机器人搬运系统 Download PDFInfo
- Publication number
- CN205466174U CN205466174U CN201620244278.8U CN201620244278U CN205466174U CN 205466174 U CN205466174 U CN 205466174U CN 201620244278 U CN201620244278 U CN 201620244278U CN 205466174 U CN205466174 U CN 205466174U
- Authority
- CN
- China
- Prior art keywords
- chip microcomputer
- stm32 single
- connecting shaft
- arm
- stepper motor
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000012545 processing Methods 0.000 claims abstract description 19
- 238000004891 communication Methods 0.000 claims abstract description 16
- 238000011161 development Methods 0.000 claims abstract description 14
- 230000000712 assembly Effects 0.000 claims description 4
- 238000000429 assembly Methods 0.000 claims description 4
- 210000000078 claw Anatomy 0.000 abstract description 10
- 238000004364 calculation method Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000000034 method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Landscapes
- Manipulator (AREA)
Abstract
本实用新型公开了一种基于stm32单片机的delta机器人搬运系统，其技术要点包括处理模块、通讯模块、stm32f103zet6开发板、stm32单片机、安装架、固定平台、步进电机驱动器、57步进电机、舵机和并联机械手装置，所述stm32单片机安装在stm32f103zet6开发板上，所述处理模块与stm32单片机之间通过通讯模块连接，所述并联机械手装置包括并行机械手与机械爪，所述并联机械手装置通过固定平台安装在安装架上，所述stm32单片机控制步进电机驱动器，所述步进电机驱动器控制57步进电机，所述57步进电机控制并行机械手，所述stm32单片机控制舵机，所述舵机用于控制机械抓，所述处理模块通过通讯模块控制stm32单片机建立坐标标点，能够对传送带上物体实现在自动化搬运，且减小成本的delta机器人。
Description
技术领域
本实用新型涉及搬运领域，尤其涉及一种基于stm32单片机的delta机器人搬运系统。
背景技术
随着自动化控制技术的飞速发展，传统的手工操作因为其过低的工作效率而被半自动或者全自动机器人代替，然而，目前传送带上的物品还是手工完成，其工作效率低下，搬运成本高，而且稳定性极差。
实用新型内容
针对现有技术存在的不足，本实用新型的目的在于提供一种能够对传送带上物体实现在自动化搬运，且减小成本的delta机器人。
为实现上述目的，本实用新型提供了如下技术方案：一种基于stm32单片机的delta机器人搬运系统，包括处理模块、通讯模块、stm32f103zet6开发板、stm32单片机、安装架、固定平台、步进电机驱动器、57步进电机、舵机和并联机械手装置，所述stm32单片机安装在stm32f103zet6开发板上，所述处理模块与stm32单片机之间通过通讯模块连接，所述并联机械手装置包括并行机械手与机械爪，所述并联机械手装置通过固定平台安装在安装架上，所述stm32单片机控制步进电机驱动器，所述步进电机驱动器控制57步进电机，所述57步进电机控制并行机械手，所述stm32单片机控制舵机，所述舵机用于控制机械爪，所述处理模块通过通讯模块控制stm32单片机建立坐标标点。
作为优选，所述并行机械手包括步进电机组件、运动臂组件、运动平台以及固定平台，所述步进电机组件包括步进电机以及步进电机控制器；在所述固定平台的顶面上设置有单片机以及三个步进电机驱动器，在所述固定平台的底面上设置有三个步进电机，每个所述步进电机带动一运动臂组件动作，每个所述运动臂组件的下端同时固定在运动平台上，在所述运动平台的底面与机械爪连接，所述stm32单片机控制步进电机驱动器，所述步进电机驱动器控制步进电机。
作为优选，所述运动臂组件包括连接臂、上运动臂、下运动臂、上连接轴、下连接轴、关节球以及连接块，所述连接臂的一端套接在步进电机的轴上并随步进电机一同转动，其另一端与上运动臂的上端连接，所述上连接轴活动地套接在上运动臂的下端，所述关节球分别套在上连接轴以及下连接轴上，且分别位于上运动臂以及下运动臂的两侧，所述下运动臂的上端通过关节球与上连接轴连接，其下端通过另一关节球与下连接轴连接，所述连接块一端与下连接轴连接，其另一端与运动平台连接。
本实用新型的有益效果是：实现自动化的搬运，并能够减少工业所应用的delta机器人的成本，该套delta机器人系统，在标定好坐标系的情况下，在空间运动上给出坐标点，在实际的机械手运动中，能够到达指定位置，并且控制机械爪的松开和抓取，该类机械手的抓取速度为120~150次/min，可在一定的空间内运动，该套分拣系统适合在传送带上物体运动到指定位置对目标进行搬运。
附图说明
图1为本实用新型控制系统总体结构图。
图2本实用新型基于stm32单片机的delta机器人搬运系统的结构示意图；
图3为本实用新型基于stm32单片机的delta机器人搬运系统的并行机械手结构示意图。
图中：1、安装架；2、固定平台；3、运动平台；4、步进电机；5、连接臂；6、上运动臂；7、下运动臂；8、上连接轴；9、下连接轴；10、关节球；11、连接块；12、机械爪。
具体实施方式
参照图1至图3所示，本案例实施的一种基于stm32单片机的delta机器人搬运系统，包括处理模块、通讯模块、stm32f103zet6开发板、stm32单片机、安装架1、固定平台2、步进电机驱动器、57步进电机4、舵机和并联机械手装置，所述stm32单片机安装在stm32f103zet6开发板上，所述处理模块与stm32单片机之间通过通讯模块连接，所述并联机械手装置包括并行机械手与机械爪12，所述并联机械手装置通过固定平台2安装在安装架1上，所述stm32单片机控制步进电机驱动器，所述步进电机驱动器控制57步进电机4，所述57步进电机4控制并行机械手，所述stm32单片机控制舵机，所述舵机用于控制机械爪12，所述处理模块通过通讯模块控制stm32单片机建立坐标标点。
所述并行机械手包括步进电机4组件、运动臂组件、运动平台3以及固定平台2，所述步进电机4组件包括步进电机4以及步进电机4控制器；在所述固定平台2的顶面上设置有单片机以及三个步进电机驱动器，在所述固定平台2的底面上设置有三个步进电机4，每个所述步进电机4带动一运动臂组件动作，每个所述运动臂组件的下端同时固定在运动平台3上，在所述运动平台3的底面与机械爪12连接，所述stm32单片机控制步进电机驱动器，所述步进电机驱动器控制步进电机4。
所述运动臂组件包括连接臂5、上运动臂6、下运动臂7、上连接轴8、下连接轴9、关节球10以及连接块11，所述连接臂5的一端套接在步进电机4的轴上并随步进电机4一同转动，其另一端与上运动臂6的上端连接，所述上连接轴8活动地套接在上运动臂6的下端，所述关节球10分别套在上连接轴8以及下连接轴9上，且分别位于上运动臂6以及下运动臂7的两侧，所述下运动臂7的上端通过关节球10与上连接轴8连接，其下端通过另一关节球10与下连接轴9连接，所述连接块11一端与下连接轴9连接，其另一端与运动平台3连接。
Delta机器人控制系统的软件环境主要是由processing和keil mdk v5.00，而其硬件组成则是处理模块（优选为个人计算机）、通讯模块（优选为usb转ttl通讯模块）、stm32f103zet6开发板、步进电机驱动器、57步进电机4、舵机和并联机械手装置等，Delta机器人分拣系统主要包括以下的功能部分：虚拟Delta机器人图像的建立；Delta逆向运动学计算以及坐标系转换功能；上位机与stm32f103zet6开发板的通讯；基于processing和stm32f103zet6开发板实现步进电机4的闭环控制方法。
Delta机器人分拣系统在工作时，所要做的任务包括整个机械装置空间坐标系、抓取物体所需的舵机角度的标定、抓取物体时初步的运动轨迹的规划等。
Delta机器人可以在个人计算机processing程序上实现虚拟的图像，用来更加直观地反映出机械手实际的运动情况，在processing中所建立的虚拟图像，Delta机器人的逆向运动学的算法，是将空间上的坐标点转化成步进电机4驱动的中间量，由于该系统的Delta机器人为三轴，对于同个坐标点的逆向运动学计算总共要三次，需要在三个坐标系下进行坐标系转换，同时计算所要抓取的物体大小，得到机械爪12舵机所需张开的角度，转化为中间量，通过计算机串口发送相应数据。
上位机与stm32单片机的通讯主要还是由processing将步进电机4驱动的中间量以及舵机控制的中间量发送给stm32单片机，在stm32单片机上完成相关的数值计算，并驱动步进电机4使机械执行装置移动到指定位置，并且舵机的旋转角到达指定位置，以完成抓取和松开的动作。
步进电机4在工作状态下需要保证其运行速度以及其精度，需要对其采用闭环控制，步进电机4的闭环控制同样是需要通过processing以及步进电机4上的增量式编码器，由于在processing已经建立了机械手的空间坐标系，只需将delta机器人将要运动到的空间点，进行计算，转化为步进电机4编码器需要的脉冲当量，并且将数据发送到stm32单片机中，在步进电机4实际运动的行程中，在电机将要停止时刻，对编码器输出与计数值进行比较，判断是否需要对步进电机4的执行作出相应的补偿。
该系统的功能主要是为了实现delta机器人对于指定空间点的目标运动，在processing软件中，绘制机械手的虚拟图像，使其具有实际的机械手运动的特性，通过计算机读取包含运动坐标点的txt文件，txt文件中记录了机械手的运动的空间坐标点，将空间运动的坐标点通过processing程序生成相应的步进电机4运动的中间量，并且通过计算机串口和usb转ttl模块将中间量的值连续发送给stm32f103zet6开发板，stm32f103zet6开发板将接受的数据记录下来，通过运算转化成57步进电机4驱动的脉冲数并且控制其运动方向，同时为了考虑57步进电机4的运动精度，将该系统设计成闭环控制，对于在processing程序中建立起来空间坐标系的机械手而言，其目标位置坐标系转换成编码器计数所需的中间量，也通过usb转ttl的模块发出，对步进电机4运动时输出实际编码器脉冲进行比较，并对失步的情况作出数据的补偿。
以上所述仅是本实用新型的优选实施方式，本实用新型的保护范围并不仅局限于上述实施例，凡属于本实用新型思路下的技术方案均属于本实用新型的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本实用新型原理前提下的若干改进和润饰，这些改进和润饰也应视为本实用新型的保护范围。
Claims (3)
1.一种基于stm32单片机的delta机器人搬运系统，其特征在于：包括处理模块、通讯模块、stm32f103zet6开发板、stm32单片机、安装架、固定平台、步进电机驱动器、57步进电机、舵机和并联机械手装置，所述stm32单片机安装在stm32f103zet6开发板上，所述处理模块与stm32单片机之间通过通讯模块连接，所述并联机械手装置包括并行机械手与机械爪，所述并联机械手装置通过固定平台安装在安装架上，所述stm32单片机控制步进电机驱动器，所述步进电机驱动器控制57步进电机，所述57步进电机控制并行机械手，所述stm32单片机控制舵机，所述舵机用于控制机械爪，所述处理模块通过通讯模块控制stm32单片机建立坐标标点。
2.根据权利要求1所述的基于stm32单片机的delta机器人搬运系统，其特征在于：所述并行机械手包括步进电机组件、运动臂组件、运动平台以及固定平台，所述步进电机组件包括步进电机以及步进电机控制器；在所述固定平台的顶面上设置有单片机以及三个步进电机驱动器，在所述固定平台的底面上设置有三个步进电机，每个所述步进电机带动一运动臂组件动作，每个所述运动臂组件的下端同时固定在运动平台上，在所述运动平台的底面与机械爪连接，所述stm32单片机控制步进电机驱动器，所述步进电机驱动器控制步进电机。
3.根据权利要求2所述的基于stm32单片机的delta机器人搬运系统，其特征在于：所述运动臂组件包括连接臂、上运动臂、下运动臂、上连接轴、下连接轴、关节球以及连接块，所述连接臂的一端套接在步进电机的轴上并随步进电机一同转动，其另一端与上运动臂的上端连接，所述上连接轴活动地套接在上运动臂的下端，所述关节球分别套在上连接轴以及下连接轴上，且分别位于上运动臂以及下运动臂的两侧，所述下运动臂的上端通过关节球与上连接轴连接，其下端通过另一关节球与下连接轴连接，所述连接块一端与下连接轴连接，其另一端与运动平台连接。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201620244278.8U CN205466174U (zh) | 2016-03-28 | 2016-03-28 | 基于stm32单片机的delta机器人搬运系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201620244278.8U CN205466174U (zh) | 2016-03-28 | 2016-03-28 | 基于stm32单片机的delta机器人搬运系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN205466174U true CN205466174U (zh) | 2016-08-17 |
Family
ID=56647391
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201620244278.8U Active CN205466174U (zh) | 2016-03-28 | 2016-03-28 | 基于stm32单片机的delta机器人搬运系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN205466174U (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106530881A (zh) * | 2016-09-13 | 2017-03-22 | 广东工业大学 | 一种多机器人教学实训平台 |
| CN106564049A (zh) * | 2016-09-13 | 2017-04-19 | 广东工业大学 | 一种由舵机驱动的小型Delta机器人 |
-
2016
- 2016-03-28 CN CN201620244278.8U patent/CN205466174U/zh active Active
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106530881A (zh) * | 2016-09-13 | 2017-03-22 | 广东工业大学 | 一种多机器人教学实训平台 |
| CN106564049A (zh) * | 2016-09-13 | 2017-04-19 | 广东工业大学 | 一种由舵机驱动的小型Delta机器人 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105116961B (zh) | 一种智能化力反馈手柄及其控制方法 | |
| CN107738255A (zh) | 机械臂及基于Leap Motion的机械臂控制方法 | |
| CN111775145B (zh) | 一种串并联机器人的控制系统 | |
| CN110977990A (zh) | 一种基于末端六维力传感器的机械臂拖动示教方法 | |
| CN203712722U (zh) | 三自由度机械手 | |
| CN106945023A (zh) | 掏膛机械手、臂以及方法 | |
| CN104570938A (zh) | 一种插装生产中的双臂机器人系统及其智能控制方法 | |
| CN109048901B (zh) | 基于虚拟摩擦力的牵引示教轨迹规划方法及装置 | |
| CN108582082A (zh) | 具有精确回零位功能的机器人、回零位方法、系统和介质 | |
| CN108482000A (zh) | 一种绘画机器人系统 | |
| CN205466174U (zh) | 基于stm32单片机的delta机器人搬运系统 | |
| CN2645862Y (zh) | 移动机械手系统 | |
| CN205564114U (zh) | 堆垛式载运教学机器人 | |
| CN108582081A (zh) | 具有回零位功能的机器人、回零位方法、系统和介质 | |
| CN109278055A (zh) | 一种绘画机器人 | |
| CN205386836U (zh) | 辅助工业机器人自动抓取的料仓系统 | |
| CN208020198U (zh) | 一种基于rgbd的智能抓取机器人 | |
| CN203696999U (zh) | 流水线取件机械手 | |
| CN207618651U (zh) | 一种三自由度电力驱动码垛上下料机械手 | |
| CN116945153A (zh) | 机械臂的控制方法、装置、设备及存储介质 | |
| CN205363903U (zh) | 一种REbot-V-6R机械臂装置 | |
| CN107253180B (zh) | 一种基于工业机器人的物体姿态调整装置及姿态调整方法 | |
| CN110480685A (zh) | 一种农用车轮自动加工生产线视觉机械手 | |
| CN209050758U (zh) | 一种绘画机器人 | |
| CN108527405A (zh) | 一种协作机器人引导示教系统 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant |