CN108762071A - 一种恒力研磨控制系统及方法 - Google Patents
一种恒力研磨控制系统及方法 Download PDFInfo
- Publication number
- CN108762071A CN108762071A CN201810441250.7A CN201810441250A CN108762071A CN 108762071 A CN108762071 A CN 108762071A CN 201810441250 A CN201810441250 A CN 201810441250A CN 108762071 A CN108762071 A CN 108762071A
- Authority
- CN
- China
- Prior art keywords
- grinding
- signal
- robot
- control
- module
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 35
- 238000006073 displacement reaction Methods 0.000 claims abstract description 10
- 238000001914 filtration Methods 0.000 claims abstract description 7
- 230000033001 locomotion Effects 0.000 claims description 50
- 230000007246 mechanism Effects 0.000 claims description 27
- 230000006870 function Effects 0.000 claims description 24
- 230000008569 process Effects 0.000 claims description 20
- 238000005070 sampling Methods 0.000 claims description 18
- 229910000831 Steel Inorganic materials 0.000 claims description 14
- 239000010959 steel Substances 0.000 claims description 14
- 230000008878 coupling Effects 0.000 claims description 12
- 238000010168 coupling process Methods 0.000 claims description 12
- 238000005859 coupling reaction Methods 0.000 claims description 12
- 230000000737 periodic effect Effects 0.000 claims description 9
- 230000001360 synchronised effect Effects 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 7
- 230000005611 electricity Effects 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 6
- 238000004519 manufacturing process Methods 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 4
- 238000011161 development Methods 0.000 claims description 4
- 230000018109 developmental process Effects 0.000 claims description 4
- 238000009434 installation Methods 0.000 claims description 4
- 230000003993 interaction Effects 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000007789 sealing Methods 0.000 claims description 3
- 230000035945 sensitivity Effects 0.000 claims description 3
- 238000003860 storage Methods 0.000 claims description 3
- 230000009897 systematic effect Effects 0.000 claims description 3
- 230000000007 visual effect Effects 0.000 claims description 3
- 229910001651 emery Inorganic materials 0.000 abstract 1
- 238000005498 polishing Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 239000012636 effector Substances 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 230000013011 mating Effects 0.000 description 2
- 210000001367 artery Anatomy 0.000 description 1
- 238000007630 basic procedure Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000005553 drilling Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004080 punching Methods 0.000 description 1
- 238000007634 remodeling Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 210000003462 vein Anatomy 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/048—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators using a predictor
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D15/00—Control of mechanical force or stress; Control of mechanical pressure
- G05D15/01—Control of mechanical force or stress; Control of mechanical pressure characterised by the use of electric means
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Constituent Portions Of Griding Lathes, Driving, Sensing And Control (AREA)
Abstract
本发明公开了一种恒力研磨控制系统及方法,该系统主要包括机器人、研磨机、精密直线运动模组、交流伺服电机、压力传感器及工业计算机等,所述交流伺服电机和精密直线运动模组带动研磨机进行浮动位移,所述机器人按照预先编制好的运行程序,带动工件在浮动的研磨机上不断研磨,使期间研磨力可控制在期望研磨力附近,并通过压力传感器将实际研磨力信号传输至工业计算机,所述工业计算机采用了卡尔曼滤波对噪声进行处理,采用模糊控制算法实现恒力磨削。本发明的恒力研磨控制系统及方法可明显改善研磨质量,传感系统采用高效实时控制系统,可实现对研磨力信号的毫秒级的实时数据采集,并实时控制交流伺服电机带动砂盘做上下位移实现恒力研磨。
Description
技术领域
本发明涉及机器人研磨加工与控制工程领域,特别涉及一种研磨加工过程 研磨力稳定在期望值附近的研磨控制系统及方法。
背景技术
传统制造行业,抛光研磨是最基础的一道工序,但是其成本占到总成本的 30%。研磨抛光件不但品种繁多而且绝大部分外观复杂,通常工业研磨抛光作 业均由人工操作完成,作业劳动强度大,工作效率低,作业环境极差。市场对 少部分规则工件研发的抛光研磨专机仅能完成单一的工艺任务,基本完成不了 除原始工艺之外的其他任务,开发过程繁琐且柔性利用性很差,成本昂贵。
机器人研磨抛光有如下优点:(1)提高研磨质量和产品光洁度,保证其一致 性;(2)提高生产率;(3)改善工人劳动条件,可在有害环境下长期工作;(4)降低 对工人操作技术的要求;(5)缩短产品改型换代的周期,减少相应的设备投资; (6)可再开发性,用户可根据不同样件进行二次编程。
发明内容
本发明的目的在于解决人工研磨产品表面质量不高与效率低的问题,提供 一种恒力研磨控制系统,采用此装置可进行机器人恒力研磨的研究,包括机械 主体的设计、控制技术、和滤波器设计,从而达到研磨过程中研磨力稳定在期 望研磨力附近,改善工件表面质量并提高加工效率。
本发明的另一目的在于,提出一种恒力研磨控制系统的控制方法。
为实现以上目的,本发明采取如下技术方案:
一种恒力研磨控制系统,包括:机械主体、交流伺服驱动机构、以及控制 模块;所述机械主体包括手动示教器、机器人、以及研磨机构,所述机器人和 研磨机构固定在同一平板底座上;所述手动示教器用于编制所述机器人的运动 轨迹;所述机器人的末端执行器上设置专用夹具,夹持工件做特定轨迹运动; 所述交流伺服驱动机构用于控制研磨机构的电机转动速度;所述研磨机构包括 研磨平台、压力传感器、伺服运动机构、以及辅助部件;所述辅助部件包括滑 轮组和对重块,通过滑轮组和对重块平衡研磨平台的大部分重量;所述研磨平 台设置有定速转动的研磨盘,所述研磨盘用于机器人夹持工件做恒力研磨;所述伺服运动机构用于控制研磨平台在竖直方向上的位移;所述压力传感器用于 检测研磨平台在竖直方向上受到的压力信号,并将所述压力信号传输给控制模 块,所述控制模块对检测到的间接研磨力与期望研磨力之间的偏差信号和研磨 过程中噪声信号做出相应处理,采用模糊控制算法对工件实现恒力磨削。
作为优选的技术方案,所述研磨机构包括研磨平台、压力传感器、伺服运 动机构、以及辅助部件;所述辅助部件包括平板底座、T型支架、滑轮组、细绳、 以及对重块;所述伺服运动机构包括直线导轨、直线运动模组、联轴器、以及 第一交流伺服电机;所述研磨平台包括研磨盘、第二交流伺服电机、以及电机 支架;
所述机器人通过螺栓连接机器人底座并固定在平板底座上,所述T型支架 与平板底座由若干个螺栓连接固定,所述T型支架设有尺寸为420*500*660mm 的竖直钢板;在所述竖直钢板的侧平面上安装直线运动模组,在直线运动模组 的上部安装联轴器,所述联轴器连接第一交流伺服电机;
所述第二交流伺服电机固定在倒置的电机支架上,第二交流伺服电机上部 与研磨盘通过键槽相连,从而驱动研磨盘做定速旋转,共同组成研磨平台;所 述研磨平台的电机支架的侧面并排连接压力传感器和直线导轨的一端,压力传 感器和直线导轨的另一端连接直线运动模组,具体是:所述压力传感器一端连 接电机支架,另一端连接直线运动模组的滑块,所述直线导轨包括导轨和导轨 滑块,所述直线导轨的导轨滑块连接电机支架,与导轨滑块配套的导轨连接直 线运动模组的滑块;所述第一交流伺服电机通过驱动直线运动模组,直线运动 模组通过直线导轨带动研磨平台在竖直方向进行位移;
所述竖直钢板上部安装滑轮组,所述对重块与研磨平台通过细绳相连接, 细绳绕在滑轮组上,对重块质量与研磨平台质量相当;在研磨平台未受到外力 时保证压力传感器示数趋近于0。
作为优选的技术方案,所述交流伺服驱动机构包括第一交流伺服电机驱动 器和第二交流伺服电机驱动器;所述第一交流伺服电机和第二交流伺服电机的 光电编码器均分别通过伺服驱动器上的标准化接口CN2端子与第一交流伺服电 机驱动器和第二交流伺服电机驱动连接;所述第一交流伺服电机驱动器工作在 位置控制模式,通过外部输入的脉冲的频率来确定所述第一交流伺服电机转动 速度的大小,通过脉冲的个数来确定转动的角度,同时控制第一交流伺服电机 的输出脉冲,并输出第一交流伺服电机的光电编码器当前值;所述第二交流伺 服电机驱动器工作在速度控制模式,通过脉冲的频率进行转动速度的控制,控 制第二交流伺服电机的脉冲输出频率,达到速度控制的目的。
作为优选的技术方案,所述控制模块包括控制器、耦合器、模拟量输入模 块、数字量输入模块、数字量输出模块、以及单通道运算放大器;所述控制器 采用安装有德国倍福的实时控制软件TwinCAT的工业计算机,通过以太网线与 耦合器通讯;所述耦合器用于控制模拟量输入模块、数字量输入模块和数字量 输出模块,最小采样周期为1毫秒;
所述单通道运算放大器将压力传感器输出的电荷信号转换为与之对应的 ±5v模拟量电压信号,由模拟量输入模块A/D转换后输入所述的工业计算机;
所述数字量输入模块用于将机器人诊断信号输入所述的工业计算机,所述 机器人诊断信号为检测机器人是否故障和是否运动的信号;
所述数字量输出模块用于将远程控制机器人开关机以及紧急停止操作的数 字信号输出到机器人控制柜中的I/O接口。
作为优选的技术方案,所述手动示教器设置机器人控制柜,控制机器人运 动轨迹的指令通过机器人控制柜传递给机器人。
作为优选的技术方案,所述压力传感器采用微小S型压力传感器,量程为 5kg,输出为-5~5V电压信号,灵敏度为2.0±0.1mv/V,密封等级为IP66。
作为优选的技术方案,所述机器人采用丹麦生产的协作机器人UR5,具体 为六自由度机器人,通过螺栓连接在机器人底座并最终固定在平板底座上。
作为优选的技术方案,所述控制模块的软件包括实时模块与非实时模块, 所述非实时模块采用Microsoft Visual Studio 2010平台开发,用于完成人机交互 功能,包括设置期望研磨力、显示与存储研磨力信号与伺服电机脉冲信号、设 置采样周期,启动和停止控制系统运行;所述实时模块基于德国倍福TwinCAT 软件的实时核上,采用可编程序控制器编程语言的国际标准IEC61131-3开发, 用于采集输入信号、发出数字输出信号、以及编制控制算法程序,所述输入信 号包括压力传感器输入信号和数字输入信号。
一种恒力研磨控制系统的控制方法,包括下述步骤:
S1、控制器设定期望研磨力信号,并设定控制系统的采样周期;
S2、控制器通过设定研磨电机转速使研磨速度达到设定值;所述研磨电机 即为第二交流伺服电机;
S3、控制器通过压力传感器、以及模拟量输入模块获得研磨平台的压力信 号,由第一交流伺服电机脉冲信号得到研磨平台的当前位置信号;
S4、控制器对采集的研磨平台的压力信号和当前位置信号进行卡尔曼滤波 处理,并经过模糊控制器产生输出信号,经过伺服驱动器转变为电压信号控制 第一交流伺服电机运动,并结合直线运动模组使研磨平台在竖直方向移动,研 磨盘对工件进行研磨,压力传感器获取研磨平台在竖直方向的压力信号并传输 给控制器,所述控制器将压力信号与期望研磨力信号比较,并重复步骤S3及当 前步骤,实现恒力研磨控制;
所述卡尔曼滤波处理,具体如下:
时间更新:
x(k|k-1)=Ax(k-1|k-1)+BU(k-1) (1)
p(k|k-1)=Ap(k-1|k-1)AT+Q (2)
状态更新:
kg(k)=p(k|k-1)HT/[Hp(k|k-1)+R] (3)
x(k|k)=x(k|k-1)+kg(k)[Z(k)-Hx(k|k-1)] (4)
p(k|k)=[I-kg(k)H]p(k|k-1) (5)
式中x(k|k-1)是利用上一周期状态预测的结果,x(k-1|k-1)是上一周期状态最优的结果,U(k-1)是上一周期状态的控制量,p(k|k-1)是x(k|k-1)对应的协 方差,p(k-1|k-1)是x(k-1|k-1)对应的协方差,Q和R是过程与测量噪声,假 定Q和R为高斯白噪声;kg(k)表示当前状态的卡尔曼增益;Z(k)表示观测量; A,B为系统参数,H为观测系统参数;x(k|k)表示当前状态下最优的估算值,p(k|k) 是x(k|k)对应的协方差;
通过不断迭代令时间更新与状态更新不断更新至过程结束得到最优输出信 号。
作为优选的技术方案,所述模糊控制器产生输出信号,具体包括下述步骤:
(1)将研磨力偏差信号与偏差变化率模糊化为模糊控制器输入,所述研磨力 偏差信号由当前压力信号和期望研磨力信号作差值计算得到,研磨力偏差变化 率由当前研磨力偏差信号和上一时刻的研磨力偏差信号作差值计算得到;在模 糊化过程中,隶属度函数采用如下的三角形隶属度函数:
(2)依据人工控制经验制定模糊控制规则库或模糊法则;
(3)依据模糊控制规则库或模糊法则,根据模糊输入推理得到模糊输出控制 量;在解模糊过程中,隶属度函数采用三角形隶属度函数,利用重心法得到模 糊输出控制量;所述重心法利用的公式如下:
式中,<>表示取整运算,表示模糊值Ai对应的隶属度函数值,下标Ai表示 模糊集合中的第i个模糊值,a,b,c表示三角形隶属度函数三个拐点对应的 横坐标值,ui表示模糊输出量;表示模糊输出量对应的隶属度函数值;u*表 示模糊输出控制量;
(4)将模糊输出控制量经过清晰化处理得到精确输出控制量。
本发明相对于现有技术具有如下的优点和效果:
(1)本发明采用一维力传感器,成本低且测力精确,相比其他恒力装置采用 六维力传感本发明更简单可靠。
(2)本发明采用模糊控制算法,是一种智能控制算法。无需花大量时间在系 统模型上便能达到好的预期效果,且系统稳定性更好。
(3)本发明通过配重系统使研磨机大部分重量被平衡,可选用小量程高精度 传感器。
(4)本发明采用的实时模块运行于德国倍福TwinCAT软件的实时核上,结 合高速工业以太网总线EtherCAT通讯系统,控制系统采样周期最小可达到1毫 秒。
附图说明
图1是本发明恒力研磨控制系统的框图示意图;
图2(a)和图2(b)是本发明恒力研磨控制系统的机械主体的结构示意图; 其中图2(a)为手动示教器示意图;图2(b)为机器人和研磨机构示意图;附 图标记:1—工业机器人UR5,2—夹具,3—工件,4—联轴器,5—交流伺服电 机,6—滑轮,7—细绳,8—对重块,9—交流伺服电机,10—电机架,11—研 磨盘,12—S型压力传感器,13—直线导轨,14—直线运动模组,15—机器人控 制柜,16—手动示教器,17—机器人底座,18—平板底座,19—T型支架;
图3是本发明恒力研磨控制系统的法的电气原理示意图;
图4是本发明恒力研磨控制系统的控制流程图。
具体实施方式
为了使本发明的目的、技术方案以及优点更加清楚明白,以下结合附图及 实施例,对本发明进行进一步的详细说明。应当理解,此处所描述的具体实施 例仅用于解释本发明,并不限于本发明。
实施例
如图1所示,一种恒力研磨控制系统,主要包括:工业机器人UR5、机器 人控制柜、工件、研磨盘、第一交流伺服电机、第二交流伺服电机、直线运动 模组、第一交流伺服驱动器、第二交流伺服驱动器、S型压力传感器、模拟量输 入模块、数字量输入模块、数字量输出模块、耦合器、以及工业计算机;
工作原理:工业机器人UR5按照预先编制的程序运动,带动固连在末端执 行器上的工件做研磨进给运动,研磨主运动是第二交流伺服电机驱动研磨盘的 恒速旋转运动。第二交流伺服电机与研磨盘的位置组成研磨平台,研磨平台与 工件的相对位移由第一交流伺服电机驱动直线运动模组决定,准确的位移量由 压力传感器测得的研磨力与期望值的差值及差值变化率计算得到。从而实现研 磨过程研磨平台根据研磨力的大小实时浮动(间接调节研磨深度)达到恒力研 磨的目的。
在本实施例中,将恒力研磨控制系统分为三大部分描述,即机械主体、交 流伺服驱动机构、以及控制模块,具体如下:
(一)机械主体
如图2(a)和图2(b)所示,所述机械主体包括机器人1、专用夹具2、 工件3、联轴器4、第一交流伺服电机5、滑轮组6、细绳7、对重块8、第二交 流伺服电机9、电机支架10、研磨盘11、压力传感器12、直线导轨13、直线运 动模组14、机器人控制柜15、手动示教器16、机器人底座17、平板底座18、T 型支架19;
所述手动示教器16用于编制机器人的运动轨迹,所述手动示教器16设置 机器人控制柜15,控制机器人运动轨迹的指令通过机器人控制柜15传递给机器 人1;所述机器人1的末端执行器上设置专用夹具2,夹持工件3做特定轨迹运 动;
所述机器人1通过螺栓连接在机器人底座17并最终固定在平板底座18上, 所述T型支架19与平板底座18由若干个螺栓连接,所述T型支架设有尺寸为 420*500*660mm的竖直钢板;在所述竖直钢板的侧平面上安装直线运动模组14, 在直线运动模组14的上部安装联轴器4,所述联轴器4连接第一交流伺服电机 5;所述直线运动模组14的底座与T型支架19的竖直钢板由螺栓连接;
所述第二交流伺服电机9在倒置的电机支架10上,其上部与研磨盘11通 过键槽相连,从而驱动研磨盘11做定速旋转,共同组成研磨平台;所述研磨平 台的电机支架10的侧面并排连接压力传感器12和直线导轨13的一端,压力传 感器12和直线导轨13的另一端连接直线运动模组14,以此限制研磨平台在竖 直方向位移,具体的连接方式是:所述压力传感器12一端连接电机支架10,另 一端连接直线运动模组14的滑块,所述直线导轨13包括导轨和导轨滑块,所 述直线导轨13的导轨滑块连接电机支架10,与导轨滑块配套的导轨连接直线运 动模组14的滑块;
所述第一交流伺服电机5通过驱动直线运动模组14,直线运动模组14通过 直线导轨13带动研磨平台在竖直方向进行位移;
所述压力传感器12的安装固定方式能够使压力传感器更准确地检测研磨平 台在竖直方向上受到的压力信号;在研磨平台未受到外力时保证压力传感器示 数趋近于0,便于选择小量程高精度的压力传感器;
一对钢制高精度的滑轮组6通过螺栓螺母固定在T型支架19的上部,所述 对重块8与研磨平台通过细绳7相连接,细绳绕在所述滑轮组6上,对重块8 质量与研磨平台质量相当,且滑轮组6的布置位置确保细绳7两侧处于竖直状 态;
在本实施例中,所述机器人1采用丹麦生产的协作机器人UR5,具体为六 自由度机器人;
所述压力传感器12采用蚌埠传感器公司的微小S型拉压力传感器,量程为 5kg,输出为-5~5V电压信号,灵敏度为2.0±0.1mv/V,密封等级为IP66;
所述第一交流伺服电机5和第二交流伺服点9均采用台达公司生产的交流 伺服电机ECMA-CA0604RS,其额定功率为400W,额定转速为3000r/min,额 定转矩为1.27N·m,不带电磁制动器;
所述联轴器4采用绕线式弹性联轴器;
所述直线运动模组14采用台湾上银公司生产的KK86系列,结构紧凑型, 行程为210mm的滚动导轨智能组合单元;
所述直线导轨13采用上银公司生产的MGW7C系列导轨,基本额定静载荷 为210kgf,基本额定动载荷为140kgf;
所述T型支架19采用12mm厚钢板焊接,其竖直钢板的尺寸为 420*500*660mm;
所述电机支架10采用6mm厚钢板焊接而成,整体尺寸为130*112*80mm;
所述研磨盘11采用厚度为6mm钢材经过切削加工且经过动平衡处理。
(二)交流伺服驱动机构
所述交流伺服驱动机构包括第一交流伺服电机驱动器和第二交流伺服电机 驱动器;
所述第一交流伺服电机驱动器工作在位置控制模式,通过外部输入的脉冲 的频率来确定所述第一交流伺服电机转动速度的大小,通过脉冲的个数来确定 转动的角度,同时控制第一交流伺服电机的输出脉冲,并输出第一交流伺服电 机的光电编码器当前值;
所述第二交流伺服电机驱动器工作在速度控制模式,通过脉冲的频率进行 转动速度的控制,控制第二交流伺服电机的脉冲输出频率,达到速度控制的目 的;
在本实施例中,所述第一交流伺服电机驱动器和第二交流伺服电机驱动器 采用ASD-A2-041-E电机驱动器,额定输出400W;
所述第一交流伺服电机和第二交流伺服电机的光电编码器均分别通过伺服 驱动器上的标准化接口CN2端子与第一交流伺服电机驱动器和第二交流伺服电 机驱动连接;
(三)控制模块
所述控制模块用于对检测到的间接研磨力与期望研磨力之间的偏差信号和 研磨过程中噪声信号做出相应处理,采用模糊控制算法实现恒力磨削。
所述控制模块包括控制器、耦合器、模拟量输入模块、数字量输入模块、 数字量输出模块、以及单通道运算放大器;所述耦合器用于控制模拟量输入模 块、数字量输入模块和数字量输出模块,最小采样周期为1毫秒;
在本实施例中,所述控制器采用安装有德国倍福的实时控制软件TwinCAT 的工业计算机,通过以太网线与耦合器通讯,所述耦合器和I/O端子模块一起安 装在DIN卡条上;所述耦合器采用EtherCAT耦合器EK1100,其额定电压为 24VDC,最大负载电流10A,外形尺寸为44*100*68mm,带LED信号显示灯;
在本实施例中,所有I/O模块电源额定电压均为24VDC,防护等级均为IP20, 均带有LED信号显示灯,宽度单模为12mm,双模24mm;
所述单通道运算放大器将压力传感器输出的电荷信号转换为与之对应的 ±5v模拟量电压信号,由模拟量输入模块A/D转换后输入所述的工业计算机; 在本实施例中,所述模拟量输入模块采用EL3104,为4通道模拟量输出端子模 块,输出-10v~+10v电压信号,16位分辨率,E-bus电流消耗典型值为180mA;
所述数字量输入模块用于将机器人诊断信号输入所述的工业计算机,所述 机器人诊断信号为检测机器人是否故障和是否运动的信号;在本实施例中,所 述数字量输入模块采用EL1008,为8通道数字量输入端子模块,带3ms输入滤 波,E-bus电流消耗典型值为90mA;
所述数字量输出模块用于将远程控制机器人开关机以及紧急停止操作的数 字信号输出到机器人控制柜中的I/O接口;在本实施例中,所述数字量输出模块 采用EL2008,为8通道数字量输出端子模块,E-bus电流消耗典型值为110mA;
在本实施例中,机器人的运动状态与是否紧急停机的数字输出信号由数字 量输入模块的第1、2和3、4通道采集;控制机器人开关机及运动模式转换等 信号由数字量输出模块发出并传递给机器人控制柜的数字量输入模块。
在本实施例中,如图3所示,本系统的控制模块还采用常规电气元件,包 括总电源、三组空气开关、开关电源、电磁继电器、信号放大器、断路器;所 述总电源为整个系统提供220v,50Hz交流电;其中两组空气开关对伺服驱动器 和交流伺服电机起到过载及短路保护的作用;所述开关电源为耦合器和电磁继 电器供电;所述信号放大器输出的模拟量电压信号由模拟量输入模块的第1通 道采集;
在本实施例中,所述三组空气开关选用正太电工公司生产的DZ47-60系列, 额定电流为10A;所述电磁继电器组选择RM16E双向隔离型继电器控制模块, 模块工作电压为24V。
在本实施例中,所述控制模块的软件包括实时模块与非实时模块,所述非 实时模块采用Microsoft Visual Studio 2010平台开发,用于完成人机交互功能, 包括设置期望研磨力、显示与存储研磨力信号与伺服电机脉冲信号、设置采样 周期,启动和停止控制系统运行;
所述实时模块基于德国倍福TwinCAT软件的实时核上,采用可编程序控制 器编程语言的国际标准IEC61131-3开发,用于采集输入信号、发出数字输出信 号、以及编制控制算法程序,所述输入信号包括压力传感器输入信号和数字输 入信号。
在本实施例中,如图4所示,一种恒力研磨控制系统的控制方法,包括下 述步骤:
S1、控制器设定期望研磨力信号,并设定控制系统的采样周期;
S2、控制器通过设定研磨电机转速使研磨速度达到设定值;所述研磨电机 即为第二交流伺服电机;
S3、控制器通过压力传感器、以及模拟量输入模块获得研磨平台的压力信 号,由第一交流伺服电机的脉冲信号得到研磨平台的当前位置信号;在本实施 例中,在压力传感器和模拟量输入模块之间安装信号放大器,保证研磨平台的 压力信号被很好接收;
S4、控制器对采集的研磨平台的压力信号和当前位置信号进行卡尔曼滤波 处理,并经过模糊控制器产生输出信号,经过伺服驱动器转变为电压信号控制 第一交流伺服电机运动,并结合直线运动模组使研磨平台在竖直方向移动,研 磨盘对工件进行研磨,压力传感器获取研磨平台在竖直方向的压力信号并传输 给控制器,并重复步骤S3及当前步骤,实现恒力研磨控制;
所述卡尔曼滤波处理,具体如下:
时间更新:
x(k|k-1)=Ax(k-1|k-1)+BU(k-1) (1)
p(k|k-1)=Ap(k-1|k-1)AT+Q (2)
状态更新:
kg(k)=p(k|k-1)HT/[Hp(k|k-1)+R] (3)
x(k|k)=x(k|k-1)+kg(k)[Z(k)-Hx(k|k-1)] (4)
p(k|k)=[I-kg(k)H]p(k|k-1) (5)
式中x(k|k-1)是利用上一周期状态预测的结果,x(k-1|k-1)是上一周期状态最优的结果,U(k-1)是上一周期状态的控制量,p(k|k-1)是x(k|k-1)对应的协 方差,p(k-1|k-1)是x(k-1|k-1)对应的协方差,Q和R是过程与测量噪声,假 定Q和R为高斯白噪声;kg(k)表示当前状态的卡尔曼增益;Z(k)表示观测量; A,B为系统参数,H为观测系统参数;x(k|k)表示当前状态下最优的估算值,p(k|k) 是x(k|k)对应的协方差;
通过不断迭代令时间更新与状态更新不断更新至过程结束得到最优输出信 号。
在本实施例中,所述模糊控制器产生输出信号,具体包括下述步骤:
(1)将研磨力偏差信号与偏差变化率模糊化为模糊控制器输入,所述研磨力 偏差信号由当前压力信号和期望研磨力信号作差值计算得到,研磨力偏差变化 率由当前研磨力偏差信号和上一时刻的研磨力偏差信号作差值计算得到;在模 糊化过程中,隶属度函数采用如下的三角形隶属度函数:
(2)依据人工控制经验制定模糊控制规则库或模糊法则;
(3)依据模糊控制规则库或模糊法则,根据模糊输入推理得到模糊输出控制 量;在解模糊过程中,隶属度函数采用三角形隶属度函数,利用重心法得到模 糊输出控制量;所述重心法利用的公式如下:
式中,<>表示取整运算,表示模糊值Ai对应的隶属度函数值,下标Ai表示 模糊集合中的第i个模糊值,a,b,c表示三角形隶属度函数三个拐点对应的 横坐标值,ui表示模糊输出量;表示模糊输出量对应的隶属度函数值;u*表 示模糊输出控制量;
(4)将模糊输出控制量经过清晰化处理得到精确输出控制量。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细, 但并不能因此而理解为对本发明专利范围的限制。应当指出的是,对于本领域 的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和 改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以权利 要求所述为准。
Claims (10)
1.一种恒力研磨控制系统,其特征在于,包括:机械主体、交流伺服驱动机构、以及控制模块;所述机械主体包括手动示教器、机器人、以及研磨机构,所述机器人和研磨机构固定在同一平板底座上;所述手动示教器用于编制所述机器人的运动轨迹;所述机器人的末端执行器上设置专用夹具,夹持工件做特定轨迹运动;所述交流伺服驱动机构用于控制研磨机构的电机转动速度;所述研磨机构包括研磨平台、压力传感器、伺服运动机构、以及辅助部件;所述辅助部件包括滑轮组和对重块,通过滑轮组和对重块平衡研磨平台的大部分重量;所述研磨平台设置有定速转动的研磨盘,所述研磨盘用于机器人夹持工件做恒力研磨;所述伺服运动机构用于控制研磨平台在竖直方向上的位移;所述压力传感器用于检测研磨平台在竖直方向上受到的压力信号,并将所述压力信号传输给控制模块,所述控制模块对检测到的间接研磨力与期望研磨力之间的偏差信号和研磨过程中噪声信号做出相应处理,采用模糊控制算法对工件实现恒力磨削。
2.根据权利要求1所述的恒力研磨控制系统,其特征在于,所述研磨机构包括研磨平台、压力传感器、伺服运动机构、以及辅助部件;所述辅助部件包括平板底座、T型支架、滑轮组、细绳、以及对重块;所述伺服运动机构包括直线导轨、直线运动模组、联轴器、以及第一交流伺服电机;所述研磨平台包括研磨盘、第二交流伺服电机、以及电机支架;
所述机器人通过螺栓连接机器人底座并固定在平板底座上,所述T型支架与平板底座由若干个螺栓连接固定,所述T型支架设有尺寸为420*500*660mm的竖直钢板;在所述竖直钢板的侧平面上安装直线运动模组,在直线运动模组的上部安装联轴器,所述联轴器连接第一交流伺服电机;
所述第二交流伺服电机固定在倒置的电机支架上,第二交流伺服电机上部与研磨盘通过键槽相连,从而驱动研磨盘做定速旋转,共同组成研磨平台;所述研磨平台的电机支架的侧面并排连接压力传感器和直线导轨的一端,压力传感器和直线导轨的另一端连接直线运动模组,具体是:所述压力传感器一端连接电机支架,另一端连接直线运动模组的滑块,所述直线导轨包括导轨和导轨滑块,所述直线导轨的导轨滑块连接电机支架,与导轨滑块配套的导轨连接直线运动模组的滑块;所述第一交流伺服电机通过驱动直线运动模组,直线运动模组通过直线导轨带动研磨平台在竖直方向进行位移;
所述竖直钢板上部安装滑轮组,所述对重块与研磨平台通过细绳相连接,细绳绕在滑轮组上,对重块质量与研磨平台质量相当;在研磨平台未受到外力时保证压力传感器示数趋近于0。
3.根据权利要求1所述的恒力研磨控制系统,其特征在于,所述交流伺服驱动机构包括第一交流伺服电机驱动器和第二交流伺服电机驱动器;所述第一交流伺服电机和第二交流伺服电机的光电编码器均分别通过伺服驱动器上的标准化接口CN2端子与第一交流伺服电机驱动器和第二交流伺服电机驱动连接;所述第一交流伺服电机驱动器工作在位置控制模式,通过外部输入的脉冲的频率来确定所述第一交流伺服电机转动速度的大小,通过脉冲的个数来确定转动的角度,同时控制第一交流伺服电机的输出脉冲,并输出第一交流伺服电机的光电编码器当前值;所述第二交流伺服电机驱动器工作在速度控制模式,通过脉冲的频率进行转动速度的控制,控制第二交流伺服电机的脉冲输出频率,达到速度控制的目的。
4.根据权利要求1所述的恒力研磨控制系统,其特征在于,所述控制模块包括控制器、耦合器、模拟量输入模块、数字量输入模块、数字量输出模块、以及单通道运算放大器;所述控制器采用安装有德国倍福的实时控制软件TwinCAT的工业计算机,通过以太网线与耦合器通讯;所述耦合器用于控制模拟量输入模块、数字量输入模块和数字量输出模块,最小采样周期为1毫秒;
所述单通道运算放大器将压力传感器输出的电荷信号转换为与之对应的±5v模拟量电压信号,由模拟量输入模块A/D转换后输入所述的工业计算机;
所述数字量输入模块用于将机器人诊断信号输入所述的工业计算机,所述机器人诊断信号为检测机器人是否故障和是否运动的信号;
所述数字量输出模块用于将远程控制机器人开关机以及紧急停止操作的数字信号输出到机器人控制柜中的I/O接口。
5.根据权利要求1所述的恒力研磨控制系统,其特征在于,所述手动示教器设置机器人控制柜,控制机器人运动轨迹的指令通过机器人控制柜传递给机器人。
6.根据权利要求2所述的恒力研磨控制系统,其特征在于,所述压力传感器采用微小S型压力传感器,量程为5kg,输出为-5~5V电压信号,灵敏度为2.0±0.1mv/V,密封等级为IP66。
7.根据权利要求2所述的恒力研磨控制系统,其特征在于,所述机器人采用丹麦生产的协作机器人UR5,具体为六自由度机器人,通过螺栓连接在机器人底座并最终固定在平板底座上。
8.根据权利要求4所述的恒力研磨控制系统,其特征在于,所述控制模块的软件包括实时模块与非实时模块,所述非实时模块采用Microsoft Visual Studio 2010平台开发,用于完成人机交互功能,包括设置期望研磨力、显示与存储研磨力信号与伺服电机脉冲信号、设置采样周期,启动和停止控制系统运行;所述实时模块基于德国倍福TwinCAT软件的实时核上,采用可编程序控制器编程语言的国际标准IEC61131-3开发,用于采集输入信号、发出数字输出信号、以及编制控制算法程序,所述输入信号包括压力传感器输入信号和数字输入信号。
9.根据权利要求1~8任一项所述的恒力研磨控制系统的控制方法,其特征在于,包括下述步骤:
S1、控制器设定期望研磨力信号,并设定控制系统的采样周期;
S2、控制器通过设定研磨电机转速使研磨速度达到设定值;所述研磨电机即为第二交流伺服电机;
S3、控制器通过压力传感器、以及模拟量输入模块获得研磨平台的压力信号,由第一交流伺服电机脉冲信号得到研磨平台的当前位置信号;
S4、控制器对采集的研磨平台的压力信号和当前位置信号进行卡尔曼滤波处理,并经过模糊控制器产生输出信号,经过伺服驱动器转变为电压信号控制第一交流伺服电机运动,并结合直线运动模组使研磨平台在竖直方向移动,研磨盘对工件进行研磨,压力传感器获取研磨平台在竖直方向的压力信号并传输给控制器,所述控制器将压力信号与期望研磨力信号比较,并重复步骤S3及当前步骤,实现恒力研磨控制;
所述卡尔曼滤波处理,具体如下:
时间更新:
x(k|k-1)=Ax(k-1|k-1)+BU(k-1) (1)
p(k|k-1)=Ap(k-1|k-1)AT+Q (2)
状态更新:
kg(k)=p(k|k-1)HT/[Hp(k|k-1)+R] (3)
x(k|k)=x(k|k-1)+kg(k)[Z(k)-Hx(k|k-1)] (4)
p(k|k)=[I-kg(k)H]p(k|k-1) (5)
式中x(k|k-1)是利用上一周期状态预测的结果,x(k-1|k-1)是上一周期状态最优的结果,U(k-1)是上一周期状态的控制量,p(k|k-1)是x(k|k-1)对应的协方差,p(k-1|k-1)是x(k-1|k-1)对应的协方差,Q和R是过程与测量噪声,假定Q和R为高斯白噪声;kg(k)表示当前状态的卡尔曼增益;Z(k)表示观测量;A,B为系统参数,H为观测系统参数;x(k|k)表示当前状态下最优的估算值,p(k|k)是x(k|k)对应的协方差;
通过不断迭代令时间更新与状态更新不断更新至过程结束得到最优输出信号。
10.根据权利要求9所述的恒力研磨控制系统的控制方法,其特征在于,所述模糊控制器产生输出信号,具体包括下述步骤:
(1)将研磨力偏差信号与偏差变化率模糊化为模糊控制器输入,所述研磨力偏差信号由当前压力信号和期望研磨力信号作差值计算得到,研磨力偏差变化率由当前研磨力偏差信号和上一时刻的研磨力偏差信号作差值计算得到;在模糊化过程中,隶属度函数采用如下的三角形隶属度函数:
(2)依据人工控制经验制定模糊控制规则库或模糊法则;
(3)依据模糊控制规则库或模糊法则,根据模糊输入推理得到模糊输出控制量;在解模糊过程中,隶属度函数采用三角形隶属度函数,利用重心法得到模糊输出控制量;所述重心法利用的公式如下:
式中,<>表示取整运算,表示模糊值Ai对应的隶属度函数值,下标Ai表示模糊集合中的第i个模糊值,a,b,c表示三角形隶属度函数三个拐点对应的横坐标值,ui表示模糊输出量;uc*表示模糊输出量对应的隶属度函数值;u*表示模糊输出控制量;
(4)将模糊输出控制量经过清晰化处理得到精确输出控制量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810441250.7A CN108762071B (zh) | 2018-05-10 | 2018-05-10 | 一种恒力研磨控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810441250.7A CN108762071B (zh) | 2018-05-10 | 2018-05-10 | 一种恒力研磨控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108762071A true CN108762071A (zh) | 2018-11-06 |
CN108762071B CN108762071B (zh) | 2023-12-22 |
Family
ID=64009723
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810441250.7A Active CN108762071B (zh) | 2018-05-10 | 2018-05-10 | 一种恒力研磨控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108762071B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113761455A (zh) * | 2021-08-31 | 2021-12-07 | 长沙长泰机器人有限公司 | 一种打磨力的计算方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5126645A (en) * | 1989-09-30 | 1992-06-30 | Kabushiki Kaisha Toshiba | Grinder robot |
CN101412197A (zh) * | 2008-12-02 | 2009-04-22 | 深圳市翔通光电技术有限公司 | 光纤陶瓷插芯自动研磨机及自动研磨方法 |
CN202097652U (zh) * | 2011-05-05 | 2012-01-04 | 四川飞普科技有限公司 | 自动控制研磨机 |
CN103885334A (zh) * | 2013-12-30 | 2014-06-25 | 深圳先进技术研究院 | 一种抛光打磨力-位混合控制方法和系统 |
CN105204441A (zh) * | 2015-09-24 | 2015-12-30 | 苏州安柯那智能科技有限公司 | 手推示教式五轴抛光打磨机器人 |
CN107695866A (zh) * | 2017-11-17 | 2018-02-16 | 黄欣 | 一种实时自动控制阀门研磨机研磨力的装置及方法 |
CN208861156U (zh) * | 2018-05-10 | 2019-05-14 | 华南理工大学 | 一种恒力研磨控制系统 |
-
2018
- 2018-05-10 CN CN201810441250.7A patent/CN108762071B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5126645A (en) * | 1989-09-30 | 1992-06-30 | Kabushiki Kaisha Toshiba | Grinder robot |
CN101412197A (zh) * | 2008-12-02 | 2009-04-22 | 深圳市翔通光电技术有限公司 | 光纤陶瓷插芯自动研磨机及自动研磨方法 |
CN202097652U (zh) * | 2011-05-05 | 2012-01-04 | 四川飞普科技有限公司 | 自动控制研磨机 |
CN103885334A (zh) * | 2013-12-30 | 2014-06-25 | 深圳先进技术研究院 | 一种抛光打磨力-位混合控制方法和系统 |
CN105204441A (zh) * | 2015-09-24 | 2015-12-30 | 苏州安柯那智能科技有限公司 | 手推示教式五轴抛光打磨机器人 |
CN107695866A (zh) * | 2017-11-17 | 2018-02-16 | 黄欣 | 一种实时自动控制阀门研磨机研磨力的装置及方法 |
CN208861156U (zh) * | 2018-05-10 | 2019-05-14 | 华南理工大学 | 一种恒力研磨控制系统 |
Non-Patent Citations (1)
Title |
---|
张铁 等: "《基于浮动平台的机器人恒力控制研磨方法》" * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113761455A (zh) * | 2021-08-31 | 2021-12-07 | 长沙长泰机器人有限公司 | 一种打磨力的计算方法 |
CN113761455B (zh) * | 2021-08-31 | 2024-07-02 | 长沙长泰机器人有限公司 | 一种打磨力的计算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108762071B (zh) | 2023-12-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN208861156U (zh) | 一种恒力研磨控制系统 | |
CN105538095B (zh) | 一种大型风电叶片多机器人协同打磨系统及方法 | |
US3634664A (en) | Adaptive and manual control system for machine tool | |
CN101547785B (zh) | 伺服压力机设备及其控制方法 | |
CN105290925B (zh) | 基于工业机器人的调距桨型面砂带磨削装置及其加工方法 | |
CN111872850A (zh) | 一种基于焊缝打磨的恒力控制系统 | |
CN105489104B (zh) | 一种基于plc控制的工件钳工划线三维数控设备 | |
CN102023610A (zh) | 利用工艺软件实现飞剪定位及剪切控制的方法及装置 | |
CN113282062B (zh) | 一种带伺服仿形高速双端封边机的控制系统 | |
CN209239473U (zh) | 大型复杂曲面叶片智能铣削磨抛多机器人作业系统 | |
CN104097264B (zh) | 一种桥切机 | |
CN107791161A (zh) | 箱式多轴全自动喷砂机 | |
CN108762071A (zh) | 一种恒力研磨控制系统及方法 | |
CN104950801B (zh) | 采用路径自动寻优的预制构件边模摆放设备电控装置 | |
CN201998057U (zh) | 一种磨边机磨边头进给量智能控制装置 | |
CN203003600U (zh) | 插床自动控制系统 | |
CN113268039B (zh) | 一种高速双端封边机的控制系统 | |
CN202147179U (zh) | 飞剪定位及剪切控制的装置 | |
CN114274047B (zh) | 一种基于力感知测量的高效精密研抛轨迹优化方法 | |
CN108672583A (zh) | 一种冲压自动化送料线用对中台自动调整装置 | |
CN109772944B (zh) | 一种钣金加工机器人随动折弯控制方法 | |
CN202861896U (zh) | 刀具数控磨床 | |
CN111113267A (zh) | 一种抛光打磨设备的控制系统 | |
CN212240604U (zh) | 一种基于焊缝打磨的恒力控制装置 | |
CN109213075A (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 |