hexagon logo

Alignment in Subroutine Not Working

Hi All,

I've worked with subroutines a bit before, but so far mostly to put math stuff in one place out of the main program. Today I'm working on writing an external subroutine to measure a threaded hole using something like this: < https://www.pcdmisforum.com/forum/pc...ion-of-threads>. I think this might be my first subroutine that I've actually tried to measure features in.

My first step in the subroutine is to create an alignment directly over the hole, which vastly simplifies the feature programming. However, PC-DMIS is not using the alignment properly. Move points move the machine relative to the alignment as I would expect; however, it is trying to probe all of my measured features as if they were at the CAD origin rather than at the center of my alignment!

Here is my subroutine code so far:


SUBROUTINE/THREADSCANNER,
POSITION = : POSITION OF HOLE IN ACTIVE ALIGNMENT,
DIRECTION = : DIRECTION VECTOR (POINTING STRAIGHT OUT OF HOLE) IN ACTIVE ALIGNMENT,
ORIENTATION = : VECTOR NORMAL TO DIRECTION, POINTING TO SIDE TO VERTICALLY SCAN,
MINOR_DIA = : NOMINAL MINOR DIAMETER OF HOLE,
MAX_DEPTH = : DEPTH TO START VERTICAL SCAN AT (MUST BE AT LEAST 2*PITCH BELOW TOP),
PITCH = : PITCH OF THREAD,
SCAN_REVS = : NUMBER OF REVOLUTIONS TO SPIRAL SCAN (MUST FIT WITHIN HOLE),
MOVESPD = : SPEED DURING MOTION,
RADIAL_DISTANCE_TOL = 0.001 : POINTS WITHIN THIS DISTANCE FROM HIGH POINT WILL BE CONSIDERED ON THE CREST,
MIN_CREST_TOL = 0.125 : MINIMUM ACCEPTABLE CREST WIDTH AS A PERCENTAGE OF PITCH,
MAX_CREST_TOL = 0.375 : MAXIMUM ACCEPTABLE CREST WIDTH AS A PERCENTAGE OF PITCH,
=
$$ NO,
**WARNING: THIS WILL MOVE THE MACHINE!!!**
If you type in dumb numbers, it will do dumb things.
Also, make sure your tip angle is right.
ACCELERATION/MAXACCELX=250, MAXACCELY=250, MAXACCELZ=250
MOVESPEED/ MOVESPD
$$ NO,
Align to hole, move to top
POSITION_POINT=GENERIC/POINT,DEPENDENT,CARTESIAN,$
NOM/XYZ,<POSITION.X,POSITION.Y,POSITION.Z>,$
MEAS/XYZ,<POSITION.X,POSITION.Y,POSITION.Z>,$
NOM/IJK,<DIRECTION.X,DIRECTION.Y,DIRECTION.Z>,$
MEAS/IJK,<DIRECTION.X,DIRECTION.Y,DIRECTION.Z>
ORIENTATION_LINE=GENERIC/LINE,DEPENDENT,CARTESIAN,$
NOM/XYZ,<POSITION.X,POSITION.Y,POSITION.Z>,$
MEAS/XYZ,<POSITION.X,POSITION.Y,POSITION.Z>,$
NOM/IJK,<ORIENTATION.X,ORIENTATION.Y,ORIENTATION.Z>,$
MEAS/IJK,<ORIENTATION.X,ORIENTATION.Y,ORIENTATION.Z>,$
DISTANCE/1,1
[COLOR=#2980b9]HOLE_ALIGNMENT=ALIGNMENT/START,RECALL:STARTUP,LIST=YES
ALIGNMENT/LEVEL,ZPLUS,POSITION_POINT
ALIGNMENT/ROTATE,XPLUS,TO,ORIENTATION_LINE,ABOUT,ZPLUS
ALIGNMENT/TRANS,XAXIS,POSITION_POINT
ALIGNMENT/TRANS,YAXIS,POSITION_POINT
ALIGNMENT/TRANS,ZAXIS,POSITION_POINT
ALIGNMENT/END[/COLOR]
[COLOR=#27ae60]MOVE/POINT,NORMAL,<0,0,0>
MOVE/POINT,NORMAL,<0,0,0.1>
MOVE/POINT,NORMAL,<0.05,0,0>
MOVE/POINT,NORMAL,<0,0,0>
MOVE/INCREMENT,<0,0,0.1>
MOVE/INCREMENT,<0.1,0,0>[/COLOR]
[COLOR=#e74c3c]TEST_MEAS_POINT=FEAT/POINT,CARTESIAN
THEO/<0,0,0>,<0,0,1>
ACTL/<0,0,0>,<0,0,1>
MEAS/POINT,1,WORKPLANE
HIT/BASIC,NORMAL,<0,0,0>,<0,0,1>,<0,0,0>,USE THEO=YES
ENDMEAS/[/COLOR]
[COLOR=#e74c3c]TEST_POINT =FEAT/CONTACT/VECTOR POINT/DEFAULT,CARTESIAN
THEO/<0,0,0>,<0,0,1>
ACTL/<0,0,0>,<0,0,1>
TARG/<0,0,0>,<0,0,1>
SNAP=NO
SHOW FEATURE PARAMETERS=NO
SHOW CONTACT PARAMETERS=YES
AVOIDANCE MOVE=NO,DISTANCE=0.4
SHOW HITS=NO[/COLOR]
$$ NO,
Set scanning options to take ~1 second with 100 points, make vertical scan
ASSIGN/VERTICAL_SCAN_LENGTH=PITCH*2
ASSIGN/VERTICAL_SCAN_LENGTH_MM=VERTICAL_SCAN_LENGTH*25.4
SCANSPEED/VERTICAL_SCAN_LENGTH_MM
OPTIONPROBE/MAXFORCE=0.36,LOWFORCE=0.06,UPPERFORCE=0.18,TRIGGE RFORCE=0.06,
PROBEACCURACY=0.1,POSACCURACY=0.1,#RETURNDATA=7,
RETURNSPEED=1,SCANPNTDENSITY=100/VERTICAL_SCAN_LENGTH_MM,
SCANACCELERATION=10,SCANOFFSETFORCE=0.06,
PROBINGMODE=DFL,MANFINEPROBING=NO
PREHIT/MINOR_DIA/2
RETRACT/MINOR_DIA/2
TOUCHSPEED/ 1
[COLOR=#e74c3c]VERT_LINE_SCAN=BASICSCAN/LINE,NUMBER OF HITS=2,SHOW HITS=YES,SHOWALLPARAMS=YES
<MINOR_DIA/2,0,-MAX_DEPTH>,<MINOR_DIA/2,0,-MAX_DEPTH+VERTICAL_SCAN_LENGTH>,CutVec=0,1,0,DirVe c=0,0,1
InitVec=-1,0,0,EndVec=-1,0,0,THICKNESS=0,PROBECOMP=YES,AVOIDANCE MOVE=NO,DISTANCE=0
FILTER/NULLFILTER,
EXEC MODE=DEFINED
BOUNDARY/PLANE,<0,0,0>,PlaneVec=0,0,-1,Crossings=1
HITTYPE/VECTOR
NOMS MODE=NOM,0.05
HIT/VECTOR,<0,0,0>,<-1,0,0>,<0,0,0>,T=0
HIT/VECTOR,<0,0,0>,<-1,0,0>,<0,0,0>,T=0
ENDSCAN[/COLOR]
ENDSUB/



The move points in green work, both in simulation and on the machine; the features in red do not work in either simulation or reality (or at least, the first one doesn't in reality; I didn't let it bury itself in my part just to test the next two Slight smile ). Here's the code I'm calling it with, if that helps:


MOVE/CLEARPLANE
MILL_MILL_1=CALLSUB/THREADSCANNER,"THREAD_SCANNER":MPOINT(-0.15,0.375,0),MPOINT(0,0,1),MPOINT(0,1,0),0.07,0.0 5,1/56,1,20,,



This is preceded by manual, rough, and finish alignments which I can post as well if that would be helpful.

Does anyone know why my alignment might work for movements but not for measurements, or how I can fix it so it works for both?

Thank you,
Matthew
Parents
  • OK, I've started to get the rotation stuff figured out. Using a vector to specify the orientation of the hole and a second to fix rotation about the hole, this (sub-)subroutine creates a matrix of three orthogonal unit vectors defining the coordinate system:

    SUBROUTINE/ORTHONORMALIZE,
    DIRECTIONVEC = : DIRECTION VECTOR,
    ORIENTATIONVEC = : ORIENTATION VECTOR,
    BASISMAT = : RETURN VARIABLE TO BE POPULATED WTIH 2D ARRAY,
    =
    $$ NO,
    Orthogonalize Orientation Vector
    ASSIGN/ORTHOVEC2=ORIENTATIONVEC - (DOT(DIRECTIONVEC, ORIENTATIONVEC)/DOT(DIRECTIONVEC, DIRECTIONVEC) * DIRECTIONVEC)
    $$ NO,
    Compute Cross Product to get third vector (guaranteed orthogonal by the cross product)
    ASSIGN/ORTHOVEC3=CROSS(DIRECTIONVEC, ORIENTATIONVEC)
    $$ NO,
    Check to make sure all vectors are nonzero
    IF/DOT(DIRECTIONVEC, DIRECTIONVEC) < 0.00000001
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Very small magnitude direction vector - did you input the zero vector by mistake?
    ROUTINE/END
    END_IF/
    IF/DOT(ORTHOVEC2, ORTHOVEC2) < 0.00000001
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Very small magnitude orthogonalized orienation vector - was it parallel to the to the direction vector?
    ROUTINE/END
    END_IF/
    IF/DOT(ORTHOVEC3, ORTHOVEC3) < 0.00000001
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Very small magnitude orthogonalized third vector - are your direction and orientation vectors tiny or nearly parallel?
    ROUTINE/END
    END_IF/
    $$ NO,
    Normalize orthogonal vectors
    ASSIGN/ORTHONORMALVEC1=UNIT(DIRECTIONVEC)
    ASSIGN/ORTHONORMALVEC2=UNIT(ORTHOVEC2)
    ASSIGN/ORTHONORMALVEC3=UNIT(ORTHOVEC3)
    $$ NO,
    Store results in a "matrix" (super messy because it basically needs to be transposed)
    ASSIGN/BASISMAT=ARRAY(MPOINT(ORTHONORMALVEC1.X, ORTHONORMALVEC2.X, ORTHONORMALVEC3.X), MPOINT(ORTHONORMALVEC1.Y, ORTHONORMALVEC2.Y, ORTHONORMALVEC3.Y), MPOINT(ORTHONORMALVEC1.Z, ORTHONORMALVEC2.Z, ORTHONORMALVEC3.Z))
    ENDSUB/
    


    Using the matrix created by that subroutine, this one will rotate and translate a position vector from the custom coordinate system into the current alignment:

    SUBROUTINE/TRANSFORMXYZ,
    BASISMATRIX = : MATRIX OUTPUT FROM ORTHONORMALIZE,
    POSITION_OFFSET = : POSITION VECTOR OF SUB ORIGIN RELATIVE TO ACTUAL ALIGNMENT,
    ORIGINAL_VECTOR = : UNTRANSFORMED VECTOR,
    TRANSFORMED_VECTOR = : RETURN VARIABLE FOR THE RESULT,
    =
    $$ NO,
    Rotate vector using basis matrix
    ASSIGN/ROTATED_VECTOR=MPOINT(DOT(BASISMATRIX[1], ORIGINAL_VECTOR), DOT(BASISMATRIX[2], ORIGINAL_VECTOR), DOT(BASISMATRIX[3], ORIGINAL_VECTOR))
    $$ NO,
    Translate vector using position offset
    ASSIGN/TRANSFORMED_VECTOR=ROTATED_VECTOR + POSITION_OFFSET
    ENDSUB/
    


    Finally, this sub will rotate but not translate a direction vector:

    SUBROUTINE/TRANSFORMIJK,
    BASISMATRIX = : MATRIX OUTPUT FROM ORTHONORMALIZE,
    ORIGINAL_VECTOR = : UNTRANSFORMED VECTOR,
    TRANSFORMED_VECTOR = : RETURN VARIABLE FOR THE RESULT,
    =
    $$ NO,
    Rotate vector using basis matrix - don't translate
    ASSIGN/TRANSFORMED_VECTOR=MPOINT(DOT(BASISMATRIX[1], ORIGINAL_VECTOR), DOT(BASISMATRIX[2], ORIGINAL_VECTOR), DOT(BASISMATRIX[3], ORIGINAL_VECTOR))
    ENDSUB/
    


    Here's my (outer) subroutine code that actually drives things, up to the basic scan:

    SUBROUTINE/THREADSCANNER,
    POSITION = : POSITION OF HOLE IN ACTIVE ALIGNMENT,
    DIRECTION = : DIRECTION VECTOR (POINTING STRAIGHT OUT OF HOLE) IN ACTIVE ALIGNMENT,
    ORIENTATION = : VECTOR NORMAL TO DIRECTION, POINTING TO SIDE TO VERTICALLY SCAN,
    MINOR_DIA = : NOMINAL MINOR DIAMETER OF HOLE,
    MAX_DEPTH = : DEPTH TO START VERTICAL SCAN AT (MUST BE AT LEAST 2*PITCH BELOW TOP),
    PITCH = : PITCH OF THREAD,
    SCAN_REVS = : NUMBER OF REVOLUTIONS TO SPIRAL SCAN (MUST FIT WITHIN HOLE),
    MOVESPD = : SPEED DURING MOTION,
    RADIAL_DISTANCE_TOL = 0.0002 : POINTS WITHIN THIS DISTANCE FROM HIGH POINT WILL BE CONSIDERED ON THE CREST,
    MIN_CREST_TOL = 0.125 : MINIMUM ACCEPTABLE CREST WIDTH AS A PERCENTAGE OF PITCH,
    MAX_CREST_TOL = 0.375 : MAXIMUM ACCEPTABLE CREST WIDTH AS A PERCENTAGE OF PITCH,
    =
    $$ NO,
    **WARNING: THIS WILL MOVE THE MACHINE!!!**
    If you type in dumb numbers, it will do dumb things.
    Also, make sure your tip angle is right.
    ACCELERATION/MAXACCELX=250, MAXACCELY=250, MAXACCELZ=250
    MOVESPEED/ MOVESPD
    MODE/DCC
    TOUCHSPEED/ 1
    ASSIGN/PREHITAMOUNT=MIN(ARRAY(MINOR_DIA/2,0.02))
    PREHIT/PREHITAMOUNT
    RETRACT/PREHITAMOUNT
    $$ NO,
    Calculate vector space basis for hole coordinate system
    ASSIGN/HOLE_BASIS=0
    CS1 =CALLSUB/ORTHONORMALIZE,[emoticon:6D505171FAA4497C85C5CA27290C555D]IRECTION,ORIENTATION,HOLE_BASIS,,
    $$ NO,
    Make sure it actually calculated something
    IF/HOLE_BASIS == 0
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Orthonormalization of direction and orientation vectors failed! Exiting.
    ROUTINE/END
    END_IF/
    $$ NO,
    Move to start point using transformation
    ASSIGN/START_POINT=MPOINT(0,0,0)
    CS2 =CALLSUB/TRANSFORMXYZ,:HOLE_BASIS,POSITION,START_POINT,STAR T_POINT,,
    MOVE/POINT,NORMAL,<START_POINT.X,START_POINT.Y,START_PO INT.Z>
    $$ NO,
    Calculate and set scan density to yield ~100 points over 2 pitch lengths
    ASSIGN/SCAN_DENSITY=100/(PITCH*25.4)
    OPTIONPROBE/MAXFORCE=0.36,LOWFORCE=0.06,UPPERFORCE=0.18,TRIGGE RFORCE=0.06,
    PROBEACCURACY=0.1,POSACCURACY=0.1,#RETURNDATA=7,
    RETURNSPEED=1,SCANPNTDENSITY=SCAN_DENSITY,
    SCANACCELERATION=10,SCANOFFSETFORCE=0.06,
    PROBINGMODE=DFL,MANFINEPROBING=NO
    $$ NO,
    Calculate scan speed to spend ~1 second scanning, ignoring acceleration time
    SCANSPEED/2*PITCH*25.4
    $$ NO,
    Set and transform scan points
    ASSIGN/SCAN_START_POINT=MPOINT(-MAX_DEPTH, MINOR_DIA/2, 0)
    ASSIGN/SCAN_END_POINT=MPOINT(-MAX_DEPTH+2*PITCH, MINOR_DIA/2, 0)
    CS8 =CALLSUB/TRANSFORMXYZ,:HOLE_BASIS,POSITION,SCAN_START_POINT ,SCAN_START_POINT,,
    CS9 =CALLSUB/TRANSFORMXYZ,:HOLE_BASIS,POSITION,SCAN_END_POINT,S CAN_END_POINT,,
    $$ NO,
    Set and transform scan vectors
    ASSIGN/SCAN_INIT_VEC=MPOINT(0, -1, 0)
    ASSIGN/SCAN_DIR_VEC=MPOINT(1, 0, 0)
    ASSIGN/SCAN_CUT_VEC=MPOINT(0, 0, 1)
    ASSIGN/SCAN_END_VEC=MPOINT(0, -1, 0)
    CS10 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_INIT_VEC,SCAN_INIT_V EC,,
    CS11 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_DIR_VEC,SCAN_DIR_VEC ,,
    CS12 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_CUT_VEC,SCAN_CUT_VEC ,,
    CS13 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_END_VEC,SCAN_END_VEC ,,
    $$ NO,
    Scan Hole Wall
    WALL_LINE_SCAN=BASICSCAN/LINE,NUMBER OF HITS=2,SHOW HITS=YES,SHOWALLPARAMS=YES
    <SCAN_START_POINT.X,SCAN_START_POINT.Y,SCAN_START_ POINT.Z>,<SCAN_END_POINT.X,SCAN_END_POINT.Y,SCAN_E ND_POINT.Z>,CutVec=SCAN_CUT_VEC.I,SCAN_CUT_VEC.J,S CAN_CUT_VEC.K,DirVec=SCAN_DIR_VEC.I,SCAN_DIR_VEC.J ,SCAN_DIR_VEC.K
    InitVec=SCAN_INIT_VEC.I,SCAN_INIT_VEC.J,SCAN_INIT_ VEC.K,EndVec=SCAN_END_VEC.I,SCAN_END_VEC.J,SCAN_EN D_VEC.K,THICKNESS=0,PROBECOMP=YES,AVOIDANCE MOVE=NO,DISTANCE=0
    FILTER/NULLFILTER,
    EXEC MODE=RELEARN
    BOUNDARY/PLANE,<SCAN_END_POINT.X,SCAN_END_POINT.Y,SCAN_END_ POINT.Z>,PlaneVec=-SCAN_DIR_VEC.I,-SCAN_DIR_VEC.J,-SCAN_DIR_VEC.K,Crossings=1
    HITTYPE/VECTOR
    NOMS MODE=FINDNOMS,0.05
    HIT/VECTOR,<0,0,0>,<0,-1,0>,<0,0,0>,T=0
    HIT/VECTOR,<0,0,0>,<0,-1,0>,<0,0,0>,T=0
    ENDSCAN
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    "Numhits:" + WALL_LINE_SCAN.NUMHITS
    


    I'm having some trouble with the basic scan analysis - I need to calculate the distance between the points in the scan and the (possibly skewed) central axis of my hole. But I'm making progress.
Reply
  • OK, I've started to get the rotation stuff figured out. Using a vector to specify the orientation of the hole and a second to fix rotation about the hole, this (sub-)subroutine creates a matrix of three orthogonal unit vectors defining the coordinate system:

    SUBROUTINE/ORTHONORMALIZE,
    DIRECTIONVEC = : DIRECTION VECTOR,
    ORIENTATIONVEC = : ORIENTATION VECTOR,
    BASISMAT = : RETURN VARIABLE TO BE POPULATED WTIH 2D ARRAY,
    =
    $$ NO,
    Orthogonalize Orientation Vector
    ASSIGN/ORTHOVEC2=ORIENTATIONVEC - (DOT(DIRECTIONVEC, ORIENTATIONVEC)/DOT(DIRECTIONVEC, DIRECTIONVEC) * DIRECTIONVEC)
    $$ NO,
    Compute Cross Product to get third vector (guaranteed orthogonal by the cross product)
    ASSIGN/ORTHOVEC3=CROSS(DIRECTIONVEC, ORIENTATIONVEC)
    $$ NO,
    Check to make sure all vectors are nonzero
    IF/DOT(DIRECTIONVEC, DIRECTIONVEC) < 0.00000001
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Very small magnitude direction vector - did you input the zero vector by mistake?
    ROUTINE/END
    END_IF/
    IF/DOT(ORTHOVEC2, ORTHOVEC2) < 0.00000001
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Very small magnitude orthogonalized orienation vector - was it parallel to the to the direction vector?
    ROUTINE/END
    END_IF/
    IF/DOT(ORTHOVEC3, ORTHOVEC3) < 0.00000001
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Very small magnitude orthogonalized third vector - are your direction and orientation vectors tiny or nearly parallel?
    ROUTINE/END
    END_IF/
    $$ NO,
    Normalize orthogonal vectors
    ASSIGN/ORTHONORMALVEC1=UNIT(DIRECTIONVEC)
    ASSIGN/ORTHONORMALVEC2=UNIT(ORTHOVEC2)
    ASSIGN/ORTHONORMALVEC3=UNIT(ORTHOVEC3)
    $$ NO,
    Store results in a "matrix" (super messy because it basically needs to be transposed)
    ASSIGN/BASISMAT=ARRAY(MPOINT(ORTHONORMALVEC1.X, ORTHONORMALVEC2.X, ORTHONORMALVEC3.X), MPOINT(ORTHONORMALVEC1.Y, ORTHONORMALVEC2.Y, ORTHONORMALVEC3.Y), MPOINT(ORTHONORMALVEC1.Z, ORTHONORMALVEC2.Z, ORTHONORMALVEC3.Z))
    ENDSUB/
    


    Using the matrix created by that subroutine, this one will rotate and translate a position vector from the custom coordinate system into the current alignment:

    SUBROUTINE/TRANSFORMXYZ,
    BASISMATRIX = : MATRIX OUTPUT FROM ORTHONORMALIZE,
    POSITION_OFFSET = : POSITION VECTOR OF SUB ORIGIN RELATIVE TO ACTUAL ALIGNMENT,
    ORIGINAL_VECTOR = : UNTRANSFORMED VECTOR,
    TRANSFORMED_VECTOR = : RETURN VARIABLE FOR THE RESULT,
    =
    $$ NO,
    Rotate vector using basis matrix
    ASSIGN/ROTATED_VECTOR=MPOINT(DOT(BASISMATRIX[1], ORIGINAL_VECTOR), DOT(BASISMATRIX[2], ORIGINAL_VECTOR), DOT(BASISMATRIX[3], ORIGINAL_VECTOR))
    $$ NO,
    Translate vector using position offset
    ASSIGN/TRANSFORMED_VECTOR=ROTATED_VECTOR + POSITION_OFFSET
    ENDSUB/
    


    Finally, this sub will rotate but not translate a direction vector:

    SUBROUTINE/TRANSFORMIJK,
    BASISMATRIX = : MATRIX OUTPUT FROM ORTHONORMALIZE,
    ORIGINAL_VECTOR = : UNTRANSFORMED VECTOR,
    TRANSFORMED_VECTOR = : RETURN VARIABLE FOR THE RESULT,
    =
    $$ NO,
    Rotate vector using basis matrix - don't translate
    ASSIGN/TRANSFORMED_VECTOR=MPOINT(DOT(BASISMATRIX[1], ORIGINAL_VECTOR), DOT(BASISMATRIX[2], ORIGINAL_VECTOR), DOT(BASISMATRIX[3], ORIGINAL_VECTOR))
    ENDSUB/
    


    Here's my (outer) subroutine code that actually drives things, up to the basic scan:

    SUBROUTINE/THREADSCANNER,
    POSITION = : POSITION OF HOLE IN ACTIVE ALIGNMENT,
    DIRECTION = : DIRECTION VECTOR (POINTING STRAIGHT OUT OF HOLE) IN ACTIVE ALIGNMENT,
    ORIENTATION = : VECTOR NORMAL TO DIRECTION, POINTING TO SIDE TO VERTICALLY SCAN,
    MINOR_DIA = : NOMINAL MINOR DIAMETER OF HOLE,
    MAX_DEPTH = : DEPTH TO START VERTICAL SCAN AT (MUST BE AT LEAST 2*PITCH BELOW TOP),
    PITCH = : PITCH OF THREAD,
    SCAN_REVS = : NUMBER OF REVOLUTIONS TO SPIRAL SCAN (MUST FIT WITHIN HOLE),
    MOVESPD = : SPEED DURING MOTION,
    RADIAL_DISTANCE_TOL = 0.0002 : POINTS WITHIN THIS DISTANCE FROM HIGH POINT WILL BE CONSIDERED ON THE CREST,
    MIN_CREST_TOL = 0.125 : MINIMUM ACCEPTABLE CREST WIDTH AS A PERCENTAGE OF PITCH,
    MAX_CREST_TOL = 0.375 : MAXIMUM ACCEPTABLE CREST WIDTH AS A PERCENTAGE OF PITCH,
    =
    $$ NO,
    **WARNING: THIS WILL MOVE THE MACHINE!!!**
    If you type in dumb numbers, it will do dumb things.
    Also, make sure your tip angle is right.
    ACCELERATION/MAXACCELX=250, MAXACCELY=250, MAXACCELZ=250
    MOVESPEED/ MOVESPD
    MODE/DCC
    TOUCHSPEED/ 1
    ASSIGN/PREHITAMOUNT=MIN(ARRAY(MINOR_DIA/2,0.02))
    PREHIT/PREHITAMOUNT
    RETRACT/PREHITAMOUNT
    $$ NO,
    Calculate vector space basis for hole coordinate system
    ASSIGN/HOLE_BASIS=0
    CS1 =CALLSUB/ORTHONORMALIZE,[emoticon:6D505171FAA4497C85C5CA27290C555D]IRECTION,ORIENTATION,HOLE_BASIS,,
    $$ NO,
    Make sure it actually calculated something
    IF/HOLE_BASIS == 0
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    Orthonormalization of direction and orientation vectors failed! Exiting.
    ROUTINE/END
    END_IF/
    $$ NO,
    Move to start point using transformation
    ASSIGN/START_POINT=MPOINT(0,0,0)
    CS2 =CALLSUB/TRANSFORMXYZ,:HOLE_BASIS,POSITION,START_POINT,STAR T_POINT,,
    MOVE/POINT,NORMAL,<START_POINT.X,START_POINT.Y,START_PO INT.Z>
    $$ NO,
    Calculate and set scan density to yield ~100 points over 2 pitch lengths
    ASSIGN/SCAN_DENSITY=100/(PITCH*25.4)
    OPTIONPROBE/MAXFORCE=0.36,LOWFORCE=0.06,UPPERFORCE=0.18,TRIGGE RFORCE=0.06,
    PROBEACCURACY=0.1,POSACCURACY=0.1,#RETURNDATA=7,
    RETURNSPEED=1,SCANPNTDENSITY=SCAN_DENSITY,
    SCANACCELERATION=10,SCANOFFSETFORCE=0.06,
    PROBINGMODE=DFL,MANFINEPROBING=NO
    $$ NO,
    Calculate scan speed to spend ~1 second scanning, ignoring acceleration time
    SCANSPEED/2*PITCH*25.4
    $$ NO,
    Set and transform scan points
    ASSIGN/SCAN_START_POINT=MPOINT(-MAX_DEPTH, MINOR_DIA/2, 0)
    ASSIGN/SCAN_END_POINT=MPOINT(-MAX_DEPTH+2*PITCH, MINOR_DIA/2, 0)
    CS8 =CALLSUB/TRANSFORMXYZ,:HOLE_BASIS,POSITION,SCAN_START_POINT ,SCAN_START_POINT,,
    CS9 =CALLSUB/TRANSFORMXYZ,:HOLE_BASIS,POSITION,SCAN_END_POINT,S CAN_END_POINT,,
    $$ NO,
    Set and transform scan vectors
    ASSIGN/SCAN_INIT_VEC=MPOINT(0, -1, 0)
    ASSIGN/SCAN_DIR_VEC=MPOINT(1, 0, 0)
    ASSIGN/SCAN_CUT_VEC=MPOINT(0, 0, 1)
    ASSIGN/SCAN_END_VEC=MPOINT(0, -1, 0)
    CS10 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_INIT_VEC,SCAN_INIT_V EC,,
    CS11 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_DIR_VEC,SCAN_DIR_VEC ,,
    CS12 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_CUT_VEC,SCAN_CUT_VEC ,,
    CS13 =CALLSUB/TRANSFORMIJK,:HOLE_BASIS,SCAN_END_VEC,SCAN_END_VEC ,,
    $$ NO,
    Scan Hole Wall
    WALL_LINE_SCAN=BASICSCAN/LINE,NUMBER OF HITS=2,SHOW HITS=YES,SHOWALLPARAMS=YES
    <SCAN_START_POINT.X,SCAN_START_POINT.Y,SCAN_START_ POINT.Z>,<SCAN_END_POINT.X,SCAN_END_POINT.Y,SCAN_E ND_POINT.Z>,CutVec=SCAN_CUT_VEC.I,SCAN_CUT_VEC.J,S CAN_CUT_VEC.K,DirVec=SCAN_DIR_VEC.I,SCAN_DIR_VEC.J ,SCAN_DIR_VEC.K
    InitVec=SCAN_INIT_VEC.I,SCAN_INIT_VEC.J,SCAN_INIT_ VEC.K,EndVec=SCAN_END_VEC.I,SCAN_END_VEC.J,SCAN_EN D_VEC.K,THICKNESS=0,PROBECOMP=YES,AVOIDANCE MOVE=NO,DISTANCE=0
    FILTER/NULLFILTER,
    EXEC MODE=RELEARN
    BOUNDARY/PLANE,<SCAN_END_POINT.X,SCAN_END_POINT.Y,SCAN_END_ POINT.Z>,PlaneVec=-SCAN_DIR_VEC.I,-SCAN_DIR_VEC.J,-SCAN_DIR_VEC.K,Crossings=1
    HITTYPE/VECTOR
    NOMS MODE=FINDNOMS,0.05
    HIT/VECTOR,<0,0,0>,<0,-1,0>,<0,0,0>,T=0
    HIT/VECTOR,<0,0,0>,<0,-1,0>,<0,0,0>,T=0
    ENDSCAN
    COMMENT/OPER,NO,FULL SCREEN=NO,AUTO-CONTINUE=NO,
    "Numhits:" + WALL_LINE_SCAN.NUMHITS
    


    I'm having some trouble with the basic scan analysis - I need to calculate the distance between the points in the scan and the (possibly skewed) central axis of my hole. But I'm making progress.
Children