FANUC外部轴添加以及协调功能.doc

FANUC机器人调试一、 添加外部轴“PREV” key and “NEXT” CONTROLLED START MENUS MAINTENANCE1. You will see similar screen to the following one .Setup Robot system variables (设置机器人系统变量)Group Robot Library/option (选择机器群组)1 ARC Mate 120ic *2 Basic positioner (远程位置调节器) Extended Axis ControlType ORD-NO Auto MANUAL2. Press arrow (上下键) keys and move the cursor to “Basic positioner”. Then press F4. MANUAL. 变位机9、10轴“Extended Axis Control”. Then press F4. MANUAL. 滑台7、8轴输入1，按ENTER 进行滑台7、8轴的添加输入2，按ENTER 进行滑台,9、10轴的添加3.You will see similar to the following - Hardware start axis setting - (开始安装轴部件)enter Hardware start axis (116) ?Default value=1 (省略补充) (7. 8)行走轴7作为“Extended Axis Control”- Group1机器人的第七轴，所以输入7，按ENTER旋转轴9作为“Basic positioner”-Group 2的第九轴，所以输入9，按ENTER旋转轴会出现下面4、5界面4.You will see similar screen to the followingFSSB configuration setting1. FSSB line1 (main axis card)2. FSSB line2 (main axis card)3. FSSB line3 (Auxiliary axis board)4. FSSB line5 (Auxiliary axis board) 默认输入1，按ENTER5.运动类型选择kinematics Type setting 1.known kinematics 2.unknown kinematics select kinematics Type ? (选择运动类型)default value=2 (省略补充等于2)输入2，未知类型6.You will see simlar screen to following one .集成轴（7、8轴）出现以下画面旋转轴（9、10）稍微有些区别七轴与九轴添加完八轴和十轴添加回到上画面继续添加第7组直线轴1 .Motor=aiF8/3000 40A2.Gear Ratio=8.63 .Direction=+Y EXTENDED AXIS TYPE=Integrated Rail(Linear Axis)4.Joint Max Speed=160.000 (mm/sec) （可改变附加轴的转动速度）5 .Motion sign= FALSE （可改变附加轴的转动方向）6 .Upper Limit=700 mm7 .Lower Limit=-700 mm8 .Master position=0.000 mm9 .Accel Time 1=256 Accel Time2=12811 .Exp Filter Valid= 12812 .Minimum Accel Time=38413 .Load Ratio=5.000 14 .axis amp Number=2 axis amp type=215.Brake Number=216 .Servo off valid=FALSE (Disable) Servo off Time=10.000第8组直线轴:1 .Motor=aiF8/3000 40A2.Gear Ratio=23 .Direction=+Z EXTENDED AXIS TYPE=Integrated Rail(Linear Axis)4.Joint Max Speed=100.000 (mm/sec) （可改变附加轴的转动速度）5 .Motion sign= FALSE (TRUE) （可改变附加轴的转动方向）6 .Upper Limit=560.000 mm7 .Lower Limit=-560.000mm8 .Master position=0.000 mm9 .Accel Time 1=256 Accel Time2=12811 .Exp Filter Valid= 12812 .Minimum Accel Time=38413 .Load Ratio=5.000 14 .axis amp Number=2 axis amp type=215.Brake Number=316 .Servo off valid=FALSE （Disable） Servo off Time=10.000第9组附加轴的设置示例：1 .Motor=aiF22/3000 80A2 .Amplifier Number=3Amplifier 3 Type=23 .Axis Type=Rotary Axis4 .Direction=+Y6 .Gear Ratio=570.007 .Maximum Speed=127.660 deg/sec （可改变附加轴的转动速度）8 .Motion sign=TRUE 9 .Upper Limit=360.000 deg10 .Lower Limit=-360.000 deg11 .Master position=0.000 deg12 .Accel Time 1=384 Accel Time2=19213 .Exp Filter Valid= FALSE14 .Minimum Accel Time=38415 .Load Ratio=5.000 (15的数值)16 .Brake Number=217 .Servo off valid=FALSE Servo off Time=10.000第10组附加轴的设置：1 .Motor=aiF22/3000 80A2 .Amplifier Number=3Amplifier 3 Type=23 .Axis Type=Rotary Axis4 .Direction=+Z （如安装在同一组内则为Y或Z均可）6 .Gear Ratio=391.47 .Maximum Speed=127.660 deg/sec （24.000）8 .Motion sign=TRUE9 .Upper Limit=360.000 deg （450.000）10 .Lower Limit=-360.000 deg （-450.000）11 .Master position=0.000 deg12 .Accel Time 1=384 Accel Time2=19213 .Exp Filter Valid=FALSE14 .Minimum Accel Time=38415 .Load Ratio=5.00016 .Brake Number=317 .Servo off valid=TRUE Servo off Time=10以上各轴添加设置好后，进行机械原点的标定。标定机械原点：1. 标定直线轴的机械原点（即零点位置）先通过群组切换键（GROUP）切换到所要标定零点的群组将需要标点的轴通过示教器移动到合适的位置MENUS选择SYSTEM选择Variables找到MASTERENB将” 0”改为“1”后确定按F1（Type）选择第三项“Master/call”将光标移动到“2.Zero Position Master”(注意：选择好此项后，在按下回车键前，请先确定好当前的动作群组，以免按下确定键后造成无法晚回到错误。)再将光标移动到第六项回车，重启动系统，标定完成。以上所有轴的零点标定都是同样操作。注明：零点不准确（机器人本体六轴在添加外步轴后对正零点标记看是否有偏差，若有则进行单轴标定）可能影响机器人TCP的校正。三设定协调功能：将动作群组切换成G2作为当前活动组，创建并记录三个点，做为一个简单的程序，将光标移动到P1设定为（31,0）、P2设定为（ 0,0）、P3设定为（31,0）；角度要求必须大于30。如下所示：1:J P1 70% FINE2:J P2 50% FINE3:J P3 50% FINE1、MENU6设定3 协调Enter 进入下面的协调设定界面：设定协调 0 协调双号码 : 1 主导 群组 : 2 从动 群组 : 1 X: 1620.465 Y: 6.888 Z: 84.370 W: 179.365 P: 0.715 R: -179.731 从动群组的定位方向 : 相对移动 主导群组的坐标系号码 : 1 类型 方法 2、按下F2选择2（置位形式）进入下面的画面： 设定协调 0 1/6 回转轴校准形式 协调双 : 1 群组号码 主导 : 2 从动 : 1 X: 1620.465 Y: 6.888 Z: 84.370 W: 179.365 P: 0.715 R: -179.731 轴号码 : 1 (轴数: 2) 轴形式 : 回转轴 轴方向 : +Y 参照点 1 : 使用完毕 参照点 2 : 使用完毕 参照点 3 : 使用完毕 类型 方法 计算 移动 记录 在变位机上作一个合适的记号尖点，执行上面创建的程序分别到P1、 P2、P3位置点，用手动坐标（全局坐标）分别移动并对准所作的记号尖点。按（Shift+记录）分别记录参照点1、参照点2、参照点3，记录完这三点后变位机轴1组记录完成。此时要将变位机的两个轴回到0位置。 3、将轴号码改为2.进入下面的界面：设定协调 0 1/6 回转轴校准形式 协调双 : 1 群组号码 主导 : 2 从动 : 1 X: 1620.465 Y: 6.888 Z: 84.370 W: 179.365 P: 0.715 R: -179.731 轴号码 : 2 (轴数: 2) 轴形式 : 回转轴 轴方向 : +Z 参照点 1 : 使用完毕 参照点 2 : 使用完毕 参照点 3 : 使用完毕 类型 方法 计算 移动 记录 回到创建的程序中，将光标移动到P1设定为（0,31）、P2设定为（ 0,0）、P3设定为（0,31）；执行程序到P1、 P2、P3位置点，分别记录到参照点1、参照点2、参照点3上，记录方法同上。记录完两个轴上的所有参照点（共六个参照点）后，按下示教盒上的计算按钮，协调功能设定完成，进行冷启动协调和生效。4、检验，将用坐标系切换到手动（全局）坐标，动作群组切换成G2组，按附加功能键“FCTN”,选择第8项“8协调功能切换键”,然后确认.此时示教器右上角中的当前动作群组显示由原来的“G2”变成“G2 C1”,用枪尖对准任意一点，转动“G2”组的两个轴，看枪尖是否与所设定的轴在作协调运动。如果此项检验没问题，再按坐标切换键“COORD”到滑台移动坐标系，移动滑台到另一位置，枪尖对准变位机上任意一点，再转动变位机，看是否保持着点对点不变。二、 机器人通讯林肯焊机 机器人控制柜 机器人控制柜 V+ - 24V+A (白色) - CL B (棕色) - CHC (蓝色) SHD (红色) V- - 24VE (黑色) CL 与CH 间并上120电阻 DN3跳线 1 2 3 4 5 6 防碰撞传感器接线：白色 - 2 棕色 - 5机器人I/O处理板（CRM5A）跳线：B A (ICOM1) (ICOM2) I/O定义： RACK SLOT 开始点 RACK SLOT 开始点 UI 1- 16 0 1 1 DO 13- 17 0 1 13UO 1- 6 0 1 1 DO 41- 63 0 1 18DI 1- 3 0 1 17DI 41- 61 0 1 20DO 1- 6 0 1 7三、 机器人清枪程序QQJS (滑台机器人清枪程序） 1: PR170=JPOS 2: 3: PR150,7=PR170,7 4: PR150,8=PR170,8 5: PR151,7=PR170,7 6: PR151,8=PR170,8 7: PR152,7=PR170,7 8: PR152,8=PR170,8 9: PR153,7=PR170,7 10: PR153,8=PR170,8 11: PR154,7=PR170,7 12: PR154,8=PR170,8 13: PR155,7=PR170,7 14: PR155,8=PR170,8 15: PR156,7=PR170,7 16: PR156,8=PR170,8 17: PR157,7=PR170,7 18: PR157,8=PR170,8 19: PR158,7=PR170,7 20: PR158,8=PR170,8 21: PR159,7=PR170,7 22: PR159,8=PR170,8 23: PR160,7=PR170,7 24: PR160,8=PR170,8 25: PR161,7=PR170,7 26: PR161,8=PR170,8 27: PR162,7=PR170,7 28: PR162,8=PR170,8 29: PR163,7=PR170,7 30: PR163,8=PR170,8 31: PR164,7=PR170,7 32: PR164,8=PR170,8 33: PR165,7=PR170,7 34: PR165,8=PR170,8 35: 36: 37:J PR150 50% FINE 38:J PR151 50% CNT100 39:J PR152 50% CNT100 40:J PR153 30% CNT100 41:L PR154 1