Difference between revisions of "Program to Create the Alignment of Arm2 (Client) CMM in Dual Arm Configuration"

From ArcoWiki
Jump to: navigation, search
Line 46: Line 46:
  
 
RECALL/D(MAC)<br />
 
RECALL/D(MAC)<br />
 +
 +
DELETE/F(ARM1_SPH_1)<br />
 +
DELETE/F(ARM1_SPH_2)<br />
 +
DELETE/F(ARM1_SPH_3)<br />
 +
DELETE/F(ARM1_SPH_4)<br />
  
 
USE/F(ARM1_SPH_1)<br />
 
USE/F(ARM1_SPH_1)<br />

Revision as of 17:31, 15 December 2017

Description

This program is used to establish a new software alignment in a dual arm configuration.
The current software alignment, if present, will be wiped and overwritten with the new one.
The program runs in MAN mode, it is necessary to assign the variables to define the probe name and the sphere diameter.
This program runs together the relative Arm1 (Server) program which shall be started prior startthe Arm2 (Client) program.

Variables to be Assigned

In order to have the program run it is necessary to assign the following variables:

PROBE_NAME=ASSIGN/'P1_0_0P0_0' Name of the probe
DIAMETER=ASSIGN/25 Diameter of the sphere

Program

DECL/DOUBLE,DIAMETER
DECL/CHAR,100,PROBE_NAME
PROBE_NAME=ASSIGN/'P1_0_0P0_0'
DIAMETER=ASSIGN/25


SNSLCT/SA(@PROBE_NAME)

SETMACREF/INIT
RECALL/D(MAC)

TEXT/MAN,'Measure sphere 1'
F(ARM2_SPH_1)=FEAT/SPHERE,OUTER,CART,0,0,0,DIAMETER
MEAS/SPHERE,F(ARM2_SPH_1),5
ENDMES

TEXT/MAN,'Measure sphere 2'
F(ARM2_SPH_2)=FEAT/SPHERE,OUTER,CART,0,0,0,DIAMETER
MEAS/SPHERE,F(ARM2_SPH_2),5
ENDMES

TEXT/MAN,'Measure sphere 3'
F(ARM2_SPH_3)=FEAT/SPHERE,OUTER,CART,0,0,0,DIAMETER
MEAS/SPHERE,F(ARM2_SPH_3),5
ENDMES

TEXT/MAN,'Measure sphere 4'
F(ARM2_SPH_4)=FEAT/SPHERE,OUTER,CART,0,0,0,DIAMETER
MEAS/SPHERE,F(ARM2_SPH_4),5
ENDMES

RECALL/D(MAC)

DELETE/F(ARM1_SPH_1)
DELETE/F(ARM1_SPH_2)
DELETE/F(ARM1_SPH_3)
DELETE/F(ARM1_SPH_4)

USE/F(ARM1_SPH_1)
USE/F(ARM1_SPH_2)
USE/F(ARM1_SPH_3)
USE/F(ARM1_SPH_4)

DECL/DOUBLE,XX,YY,ZZ
XX=OBTAIN/F(ARM1_SPH_1),4
YY=OBTAIN/F(ARM1_SPH_1),5
ZZ=OBTAIN/F(ARM1_SPH_1),6
F(ARM2_SPH_1)=FEAT/SPHERE,OUTER,CART,XX,YY,ZZ,DIAMETER
XX=OBTAIN/F(ARM1_SPH_2),4
YY=OBTAIN/F(ARM1_SPH_2),5
ZZ=OBTAIN/F(ARM1_SPH_2),6
F(ARM2_SPH_2)=FEAT/SPHERE,OUTER,CART,XX,YY,ZZ,DIAMETER

XX=OBTAIN/F(ARM1_SPH_3),4
YY=OBTAIN/F(ARM1_SPH_3),5
ZZ=OBTAIN/F(ARM1_SPH_3),6
F(ARM2_SPH_3)=FEAT/SPHERE,OUTER,CART,XX,YY,ZZ,DIAMETER

XX=OBTAIN/F(ARM1_SPH_4),4
YY=OBTAIN/F(ARM1_SPH_4),5
ZZ=OBTAIN/F(ARM1_SPH_4),6
F(ARM2_SPH_4)=FEAT/SPHERE,OUTER,CART,XX,YY,ZZ,DIAMETER
D(ARM2_DUAL_ALIGNMENT) = LOCATE/FA(ARM2_SPH_1),FA(ARM2_SPH_2),FA(ARM2_SPH_3),FA(ARM2_SPH_4)

SETMACREF/ROTATE,D(ARM2_DUAL_ALIGNMENT)
SETMACREF/TRANS,D(ARM2_DUAL_ALIGNMENT)