0  BEGIN PGM WAVE_SURFACING MM 
1  BLK FORM 0.1 Z X+0 Y+0 Z-40
2  BLK FORM 0.2  X+100  Y+100  Z+0
3  ;
4  ; ===================================================
5  ; --- CYCLE 32: SMOOTH CONTROLLING FOR HIGH SPEED ---
6  ; Allows the controller to blend small linear moves
7  ; into a smooth surface and prevents stuttering.
8  ; ===================================================
9  CYCL DEF 32.0 TOLERANCE
10 CYCL DEF 32.1 HSC-MODE:1 TA+0.05
11 ;
12 ; ===================================================
13 ; --- CONFIGURATION PARAMETERS ---
14 ; ===================================================
15 Q1 = 0    ; X-coordinate tracker (starts at 0)
16 Q2 = 0    ; Y-coordinate tracker (starts at 0)
17 ;
18 ; Step size of 0.5mm is ideal for surface finish with
19 ; a ball-nose endmill while keeping program size reasonable.
20 ; 100mm / 0.5mm step size = 200 steps.
21 ; Note: In Heidenhain, CALL LBL REP executes the label
22 ; N additional times. So REP 199 runs the block 200 times.
23 Q10 = 199 ; Repetitions for X-axis (200 steps total)
24 Q11 = 99  ; Repetitions for Y-axis (100 double-passes total)
25 ;
; ===================================================
; --- TOOL CALL AND INITIAL POSITIONING ---
; --- REQUIRED TOOL: 3MM BALL ENDMILL (BALL NOSE) ---
; ===================================================
TOOL CALL 1 Z S10000 F1500
30 L Z+10 R0 FMAX M3
31 L X+Q1 Y+Q2 R0 FMAX
32 ;
33 ; ===================================================
34 ; --- MAIN BI-DIRECTIONAL SCANNING LOOP ---
35 ; ===================================================
36 LBL 1
37   ; -------------------------------------------------
38   ; PASS 1: Left-to-Right Sweep (X increases)
39   ; -------------------------------------------------
40   LBL 2
41     ; --- WAVE PROPAGATION SURFACE FORMULA (RIPPLE) ---
42     ; Wave center is at (50, 50) - the middle of the block.
43     Q30 = Q1 - 50 ; DX (Distance in X from center)
44     Q31 = Q2 - 50 ; DY (Distance in Y from center)
45     Q32 = ( Q30 * Q30 ) + ( Q31 * Q31 ) ; Distance squared
46     Q33 = SQRT ( Q32 ) ; Radial distance d from center (mm)
47     
48     ; Calculate wave phase in degrees (24 deg/mm -> ~15mm wavelength)
49     Q34 = Q33 * 24
50     
51     ; Linear decay factor: wave dies out near the corners (~70.7mm)
52     Q35 = 1 - ( Q33 / 72 )
53     
54     ; Calculate Z height:
55     ; Peak amplitude is 4mm. We shift by -4mm so that the highest
56     ; peak is at Z=0 (top of stock) and troughs carve down to Z=-8mm.
57     Q3 = ( COS( Q34 ) * 4 * Q35 ) - 4
58     
59     ; Move to calculated 3D point
60     L X+Q1 Y+Q2 Z+Q3 R0 F1500
61     
62     ; Increment X-axis tracker
63     Q1 = Q1 + 0.5
64   CALL LBL 2 REP Q10
65   ;
66   ; Step Y-axis forward by 0.5mm
67   Q2 = Q2 + 0.5
68   L Y+Q2 R0 F1500
69   ;
70   ; -------------------------------------------------
71   ; PASS 2: Right-to-Left Sweep (X decreases)
72   ; -------------------------------------------------
73   LBL 3
74     ; --- WAVE PROPAGATION SURFACE FORMULA (RIPPLE) ---
75     Q30 = Q1 - 50
76     Q31 = Q2 - 50
77     Q32 = ( Q30 * Q30 ) + ( Q31 * Q31 )
78     Q33 = SQRT ( Q32 )
79     Q34 = Q33 * 24
80     Q35 = 1 - ( Q33 / 72 )
81     Q3 = ( COS( Q34 ) * 4 * Q35 ) - 4
82     
83     ; Move to calculated 3D point
84     L X+Q1 Y+Q2 Z+Q3 R0 F1500
85     
86     ; Decrement X-axis tracker
87     Q1 = Q1 - 0.5
88   CALL LBL 3 REP Q10
89   ;
90   ; Step Y-axis forward again by 0.5mm
91   Q2 = Q2 + 0.5
92   L Y+Q2 R0 F1500
93   ;
94   ; Repeat the entire double-pass cycle until Y reaches 100mm
95 CALL LBL 1 REP Q11
96 ;
97 ; ===================================================
98 ; --- CLEANUP AND EXIT ---
99 ; ===================================================
100 L Z+20 R0 FMAX M2
101 END PGM WAVE_SURFACING MM