CN108748096B - 一种绘图机械臂及其控制系统 - Google Patents
一种绘图机械臂及其控制系统 Download PDFInfo
- Publication number
- CN108748096B CN108748096B CN201810596728.3A CN201810596728A CN108748096B CN 108748096 B CN108748096 B CN 108748096B CN 201810596728 A CN201810596728 A CN 201810596728A CN 108748096 B CN108748096 B CN 108748096B
- Authority
- CN
- China
- Prior art keywords
- steering engine
- arm
- lifting
- platform
- graph
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
Abstract
发明公开了本发明公开了一种机械臂绘图机构,包括支撑平台和升降平台,其中所述升降平台与支撑平台之间通过升降机构连接,在所述升降平台上分别设有上电机和下电机,在所述下电机上连接有主臂,在所述上电机上连接有辅臂,在所述辅臂的另一端铰接有连杆,在所述连杆的另一端铰接有工作臂,在所述工作臂的另一端设有笔夹,所述主臂的另一端与所述工作臂铰接,首先通过对舵机的线性补偿、曲率调速、虚位补偿和图形反馈补偿等手段解决了舵机本身的缺陷,然后通过上电机与下电机的配合,使得工作臂前端的笔夹可以落在画板的任意一个位置,整个装置的成本低、结构简单、体积小,适用范围大。
Description
技术领域
发明涉及一种绘图装置,尤其是一种绘图机械臂及其控制系统。
背景技术
目前,现有的绘图装置中,基本采用的是步进电机,由于采用步进电机存在成本大的缺陷,因此本方案中采用了造价较低的舵机,而针对舵机本身精度低,角度控制不精确等缺陷。
实用新型内容
发明的技术任务是针对以上现有技术的不足,而提供一种绘图机械臂及其控制系统。
发明解决其技术问题所采用的技术方案是:一种绘图机械臂,包括支撑平台和升降平台,其中所述升降平台与支撑平台之间通过升降机构连接,所述升降机构包括升降舵机和升降轴,所述升降轴设置在支撑平台上,所述升降轴的顶部穿过升降平台后连接有限位板,所述升降舵机设置在支撑平台的一侧,在所述升降平台与支撑平台之间设有凸轮,所述凸轮与所述升降舵机连接,在所述升降平台上分别设有上舵机和下舵机,在所述下舵机上连接有主臂,在所述上舵机上连接有辅臂,在所述辅臂的另一端铰接有连杆,在所述连杆的另一端铰接有工作臂,在所述工作臂的另一端设有笔夹,所述主臂的另一端与所述工作臂铰接。
一种用于控制绘图机械臂的系统,其中包括以下步骤:
步骤一:采用线性补偿对舵机进行校正;首先输入标准的脉冲信号,测出舵机的实际旋转角度,然后根据舵机的实际旋转角度与理想旋转角度进行对比分析,得出脉冲信号对应的修正值,将所有的修正值集合在一起为该舵机的线性修正表,将线性修正表存在在单片机内;
步骤二:曲率调速:绘图前,首先将图像导入单片机,随后将图像分成若干条曲线段,根据每条曲线段上不同像素点处的曲率大小,确定每条曲线段上像素点的密度以及不同像素点的坐标,每个像素点的坐标与该像素点的曲率合并成为一个绘图点;
步骤三:绘图时,舵机根据像素点的坐标,确定舵机需要旋转的角度,首先将像素点的坐标转换为舵机输入的脉冲信号,然后再根据线性修正表上对应的修正值,从而确定舵机的旋转角度;
根据像素点处的曲率,计算出舵机旋转的速度,进而计算出延迟时间,最终通过舵机的旋转角度与舵机旋转的速度从而完成每个绘图点的绘制。
进一步改进:在完成线性补偿后,在单片机内插入对舵机进行虚位补偿。
进一步改进:在完成步骤三后,将绘图机械臂画出的图形与原图进行对比,原图与绘图机械臂画出的图形之间的误差形成图形反馈补偿,将图形反馈补偿存储在单片机内,然后再依次完成步骤一至三,在进行到步骤三时,除了原有的线性修正表外,还会增加图形反馈补偿。
发明的优点:首先选用舵机作为机械臂的动力源,从而降低了整个装置的成本,同时通过对舵机本身的线性补偿、曲率调速、虚位补偿、图形反馈补偿,等软件方式来克服舵机本身的缺陷,从而确保整个装置的稳定运行。
附图说明
图1是本发明的结构示意图。
图2是本发明控制流程框架图。
支撑平台1、凸轮2、升降舵机3、升降轴4、弹簧41、限位板5、升降平台6、上舵机7、辅臂8、连杆9、工作臂10、笔夹11、主臂12、下舵机13。
具体实施方式
下面结合说明书附图对发明做以下详细说明。
如图所示,一种绘图机械臂,包括支撑平台1和升降平台6,其中所述升降平台6与支撑平台1之间通过升降机构连接,所述升降机构包括升降舵机3和升降轴4,所述升降轴4设置在支撑平台1上,所述升降轴4的顶部穿过升降平台1后连接有限位板5,所述升降舵机3设置在支撑平台1的一侧,在所述升降平台6与支撑平台1之间设有凸轮2,所述凸轮2与所述升降舵机3连接,在所述升降轴4上套有弹簧41,所述弹簧41位于升降平台6与限位板5之间,在所述升降平台6上分别设有上舵机7和下舵机13,在所述下舵机13上连接有主臂12,在所述上舵机7上连接有辅臂8,在所述辅臂8的另一端铰接有连杆9,在所述连杆9的另一端铰接有工作臂10,在所述工作臂10的另一端设有笔夹11,所述主臂12的另一端与所述工作臂10铰接。
其工作原理是:
步骤一:采用线性补偿对舵机进行校正;首先输入标准的脉冲信号,测出舵机的实际旋转角度,然后根据舵机的实际旋转角度与理想旋转角度进行对比分析,得出脉冲信号对应的修正值,将所有的修正值集合在一起为该舵机的线性修正表,将线性修正表存在在单片机内;
步骤二:曲率调速:绘图前,首先将图像导入单片机,成为像素坐标队列,随后将图像分成若干条曲线段,根据每条曲线段上不同像素点处的曲率大小,确定每条曲线段上像素点的密度以及不同像素点的坐标,每个像素点的坐标与该像素点的曲率合并成为一个绘图点,将所有的绘图点集合在一起,形成一个绘图文件;
步骤三:绘图时,舵机根据像素点的坐标,确定舵机需要旋转的角度,首先将像素点的坐标转换为舵机输入的脉冲信号,然后再根据线性修正表上对应的修正值,从而确定舵机的旋转角度;
根据像素点处的曲率,计算出舵机旋转的速度,进而计算出延迟时间,最终通过舵机的旋转角度与舵机旋转的速度从而完成每个绘图点的绘制。
进一步改进:在完成线性补偿后,在单片机内插入对舵机进行虚位补偿。
进一步改进:在完成步骤三后,将绘图机械臂画出的图形与原图进行对比,原图与绘图机械臂画出的图形之间的误差形成图形反馈补偿,将图形反馈补偿存储在单片机内,然后再依次完成步骤一至三,在进行到步骤三时,除了原有的线性修正表外,还会增加图形反馈补偿。
以上所述仅为发明的实施例,并非因此限制发明的专利范围,凡是利用发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在发明的专利保护范围内。
Claims (3)
1.一种用于控制绘图机械臂的系统,所述绘图机械臂包括支撑平台和升降平台,其特征在于:所述升降平台与支撑平台之间通过升降机构连接,所述升降机构包括升降舵机和升降轴,所述升降轴设置在支撑平台上,所述升降轴的顶部穿过升降平台后连接有限位板,所述升降舵机设置在支撑平台的一侧,在所述升降平台与支撑平台之间设有凸轮,所述凸轮与所述升降舵机连接,在所述升降平台上分别设有上舵机和下舵机,在所述下舵机上连接有主臂,在所述上舵机上连接有辅臂,在所述辅臂的另一端铰接有连杆,在所述连杆的另一端铰接有工作臂,在所述工作臂的另一端设有笔夹,所述主臂的另一端与所述工作臂铰接;
所述系统包括以下步骤:
步骤一:采用线性补偿对舵机进行校正;首先输入标准的脉冲信号,测出舵机的实际旋转角度,然后根据舵机的实际旋转角度与理想旋转角度进行对比分析,得出脉冲信号对应的修正值,将所有的修正值集合在一起为该舵机的线性修正表,将线性修正表存在单片机内;
步骤二:曲率调速:绘图前,首先将图像导入单片机,随后将图像分成若干条曲线段,根据每条曲线段上不同像素点处的曲率大小,确定每条曲线段上像素点的密度以及不同像素点的坐标,每个像素点的坐标与该像素点的曲率合并成为一个绘图点;
步骤三:绘图时,舵机根据像素点的坐标,确定舵机需要旋转的角度,首先将像素点的坐标转换为舵机输入的脉冲信号,然后再根据线性修正表上对应的修正值,从而确定舵机的旋转角度;
根据像素点处的曲率,计算出舵机旋转的速度,进而计算出延迟时间,最终通过舵机的旋转角度与舵机旋转的速度从而完成每个绘图点的绘制。
2.根据权利要求1所述的一种用于控制绘图机械臂的系统,其特征在于:在完成线性补偿后,在单片机内插入对舵机进行虚位补偿。
3.根据权利要求1所述的一种用于控制绘图机械臂的系统,其特征在于:在完成步骤三后,将绘图机械臂画出的图形与原图进行对比,原图与绘图机械臂画出的图形之间的误差形成图形反馈补偿,将图形反馈补偿存储在单片机内,然后再依次完成步骤一至三,在进行到步骤三时,除了原有的线性修正表外,还会增加图形反馈补偿。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810596728.3A CN108748096B (zh) | 2018-06-11 | 2018-06-11 | 一种绘图机械臂及其控制系统 |
PCT/CN2019/086969 WO2019237874A1 (zh) | 2018-06-11 | 2019-05-15 | 一种绘图机械臂及其控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810596728.3A CN108748096B (zh) | 2018-06-11 | 2018-06-11 | 一种绘图机械臂及其控制系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108748096A CN108748096A (zh) | 2018-11-06 |
CN108748096B true CN108748096B (zh) | 2020-06-02 |
Family
ID=64022455
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810596728.3A Active CN108748096B (zh) | 2018-06-11 | 2018-06-11 | 一种绘图机械臂及其控制系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN108748096B (zh) |
WO (1) | WO2019237874A1 (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108748096B (zh) * | 2018-06-11 | 2020-06-02 | 深圳市小怪兽教育科技有限公司 | 一种绘图机械臂及其控制系统 |
CN109435544B (zh) * | 2018-12-20 | 2020-12-25 | 深圳市小怪兽教育科技有限公司 | 一种机械臂绘图装置 |
CN111872487B (zh) * | 2020-07-31 | 2021-04-20 | 苏州市诚阳金属制品有限公司 | 一种金属圆片裁切用辅助装置 |
CN112140096A (zh) * | 2020-09-11 | 2020-12-29 | 广州市标准化研究院 | 标准化推进模型构建曲线图绘制设备及其方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02181494A (ja) * | 1989-01-06 | 1990-07-16 | Matsushita Electric Ind Co Ltd | 描画装置 |
CN104669277A (zh) * | 2015-03-11 | 2015-06-03 | 宿州学院 | 一种双臂型写字机器人及其控制方法 |
CN104827464A (zh) * | 2015-04-14 | 2015-08-12 | 马鞍山鼎泰稀土新材料股份有限公司 | 一种四自由度高速搬运机器人水平驱动机构 |
CN205272977U (zh) * | 2015-12-19 | 2016-06-01 | 沈伟 | 一种工业电气自动化的绘图机械手 |
CN106355990A (zh) * | 2016-10-27 | 2017-01-25 | 上海建桥学院 | 一种双自由度平面五杆机构演示仪 |
CN107116787A (zh) * | 2017-06-16 | 2017-09-01 | 浙江大学 | 一种三维打印平台的调平系统及其测距装置与调平方法 |
CN206968251U (zh) * | 2017-04-20 | 2018-02-06 | 四川建筑职业技术学院 | 一种写字机用的自适应式笔架 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05147391A (ja) * | 1991-11-26 | 1993-06-15 | Mutoh Ind Ltd | プロツタの自動給芯装置 |
JPH08160124A (ja) * | 1994-12-07 | 1996-06-21 | Kaijo Corp | 魚群探知機用記録器 |
JP3674892B2 (ja) * | 1997-01-10 | 2005-07-27 | 株式会社ニレコ | 2面同時マーキング装置 |
JP2003280741A (ja) * | 2002-01-17 | 2003-10-02 | Matsushita Electric Works Ltd | モータ制御システム、及びこれを搭載したパンタグラフ |
US7165331B1 (en) * | 2005-05-24 | 2007-01-23 | Micro Processing Technology, Inc. | Apparatus and method for scribing a semiconductor wafer while controlling scribing forces |
CN105034658B (zh) * | 2015-07-30 | 2017-03-15 | 深圳市创客工场科技有限公司 | 绘图装置 |
CN204955857U (zh) * | 2015-07-30 | 2016-01-13 | 深圳市创客工场科技有限公司 | 绘图装置 |
CN206605965U (zh) * | 2017-01-25 | 2017-11-03 | 江门市宏汇科技有限公司 | 一种绘图工具组件 |
CN108748096B (zh) * | 2018-06-11 | 2020-06-02 | 深圳市小怪兽教育科技有限公司 | 一种绘图机械臂及其控制系统 |
CN208664735U (zh) * | 2018-06-11 | 2019-03-29 | 深圳市小怪兽教育科技有限公司 | 一种机械臂绘图机构 |
-
2018
- 2018-06-11 CN CN201810596728.3A patent/CN108748096B/zh active Active
-
2019
- 2019-05-15 WO PCT/CN2019/086969 patent/WO2019237874A1/zh active Application Filing
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02181494A (ja) * | 1989-01-06 | 1990-07-16 | Matsushita Electric Ind Co Ltd | 描画装置 |
CN104669277A (zh) * | 2015-03-11 | 2015-06-03 | 宿州学院 | 一种双臂型写字机器人及其控制方法 |
CN104827464A (zh) * | 2015-04-14 | 2015-08-12 | 马鞍山鼎泰稀土新材料股份有限公司 | 一种四自由度高速搬运机器人水平驱动机构 |
CN205272977U (zh) * | 2015-12-19 | 2016-06-01 | 沈伟 | 一种工业电气自动化的绘图机械手 |
CN106355990A (zh) * | 2016-10-27 | 2017-01-25 | 上海建桥学院 | 一种双自由度平面五杆机构演示仪 |
CN206968251U (zh) * | 2017-04-20 | 2018-02-06 | 四川建筑职业技术学院 | 一种写字机用的自适应式笔架 |
CN107116787A (zh) * | 2017-06-16 | 2017-09-01 | 浙江大学 | 一种三维打印平台的调平系统及其测距装置与调平方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108748096A (zh) | 2018-11-06 |
WO2019237874A1 (zh) | 2019-12-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108748096B (zh) | 一种绘图机械臂及其控制系统 | |
CN104057612B (zh) | 3d打印机用自动调平装置及3d打印机及调平方法 | |
CN102345390B (zh) | 一种混凝土泵车臂架变形量的补偿方法 | |
CN107102645B (zh) | 一种飞机姿态调节装置 | |
CN105751518A (zh) | 一种fdm3d打印机及其自动调平打印方法和系统 | |
CN106584513A (zh) | 一种工业机器人重复定位精度测试方法及测试装置 | |
CN110285816B (zh) | 一种小卫星星上设备高精度姿态测量系统及方法 | |
CN112558607A (zh) | 单舵轮agv车自动校准的方法、装置及设备 | |
CN104723338A (zh) | 机器人、机器人的控制方法及机器人的控制程序 | |
CN109465831B (zh) | 一种提升工业机器人工具坐标系标定精度的方法 | |
CN105865825A (zh) | 一种机械手臂测试平台 | |
CN104731015B (zh) | 一种快速对中方法 | |
CN109949370A (zh) | 一种用于imu-相机联合标定的自动化方法 | |
CN110764522A (zh) | 一种基于倾角补偿的调平控制系统及其方法 | |
CN106813833A (zh) | 一种调距桨桨叶重心测量方法 | |
CN106881719A (zh) | 机器人视觉系统及控制方法 | |
CN206717882U (zh) | 一种天花吊顶装修施工机器人 | |
CN109895098A (zh) | 一种机器人结构参数和手眼关系的统一标定模型 | |
CN205665024U (zh) | 机械手测试平台 | |
CN206782225U (zh) | 一种装盒机换模具快速调节机构 | |
CN113311877B (zh) | 一种四腿支撑作业平台的自动调平方法 | |
CN106313972A (zh) | 绘图仪及其使用方法 | |
CN113684765A (zh) | 节段梁线形控制系统、方法、计算机装置和存储介质 | |
CN206840094U (zh) | 机器人视觉系统 | |
CN103196679B (zh) | 汽车车轮定位仪远程控制方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |