I now realize I had a ton of fluff in my subroutines. This is a simplified version of my code which sticks to using 2 subroutines. I’ll update if this fixes my problems.
[code]# Pololu Scripting Code
2 0 speed
2 1 speed
2 2 speed
2 3 speed
6000 6000 6000 6000
resetcycle
sub resetcycle
begin
depth
while
3 servo 2 servo 1 servo 0 servo
3000 delay
repeat
6080 6080 6080 6080
6070 6070 6070 6070
5950 5950 5950 5950
6080 6080 6080 6080
6080 6080 6080 6080
6100 6100 6100 6100
6060 6060 6060 6060
6100 6100 6100 6100
6060 6060 6060 6060
6130 6130 6130 6130
5940 5940 5940 5940
6090 6090 6090 6090
6130 6130 6130 6130
6150 6150 6150 6150
6080 6080 6080 6080
6070 6070 6070 6070
6060 6060 6060 6060
6060 6060 6060 6060
6130 6130 6130 6130
6070 6070 6070 6070
6070 6070 6070 6070
6070 6070 6070 6070
6060 6060 6060 6060
5930 5930 5930 5930
6070 6070 6070 6070
6120 6120 6120 6120
6100 6100 6100 6100
6060 6060 6060 6060
6080 6080 6080 6080
6060 6060 6060 6060
6100 6100 6100 6100
movementenvelope
6050 6050 6050 6050
6110 6110 6110 6110
6120 6120 6120 6120
6080 6080 6080 6080
6050 6050 6050 6050
6070 6070 6070 6070
6070 6070 6070 6070
6100 6100 6100 6100
6090 6090 6090 6090
6100 6100 6100 6100
6100 6100 6100 6100
6050 6050 6050 6050
6060 6060 6060 6060
6070 6070 6070 6070
6060 6060 6060 6060
6050 6050 6050 6050
6060 6060 6060 6060
6070 6070 6070 6070
5930 5930 5930 5930
6070 6070 6070 6070
6110 6110 6110 6110
6070 6070 6070 6070
6070 6070 6070 6070
6090 6090 6090 6090
6080 6080 6080 6080
6110 6110 6110 6110
5940 5940 5940 5940
5920 5920 5920 5920
6060 6060 6060 6060
6090 6090 6090 6090
6050 6050 6050 6050
movementenvelope
5930 5930 5930 5930
6060 6060 6060 6060
6070 6070 6070 6070
5920 5920 5920 5920
5950 5950 5950 5950
6080 6080 6080 6080
6110 6110 6110 6110
6160 6160 6160 6160
6090 6090 6090 6090
6070 6070 6070 6070
6110 6110 6110 6110
5920 5920 5920 5920
6050 6050 6050 6050
6080 6080 6080 6080
6090 6090 6090 6090
6090 6090 6090 6090
6050 6050 6050 6050
5880 5880 5880 5880
5910 5910 5910 5910
5950 5950 5950 5950
6080 6080 6080 6080
6080 6080 6080 6080
5940 5940 5940 5940
5920 5920 5920 5920
6080 6080 6080 6080
5860 5860 5860 5860
5910 5910 5910 5910
5960 5960 5960 5960
6080 6080 6080 6080
6070 6070 6070 6070
6100 6100 6100 6100
movementenvelope
6120 6120 6120 6120
6080 6080 6080 6080
6110 6110 6110 6110
5940 5940 5940 5940
5890 5890 5890 5890
5950 5950 5950 5950
6060 6060 6060 6060
6080 6080 6080 6080
6090 6090 6090 6090
6070 6070 6070 6070
6110 6110 6110 6110
6060 6060 6060 6060
6080 6080 6080 6080
5960 5960 5960 5960
6060 6060 6060 6060
6050 6050 6050 6050
6060 6060 6060 6060
6080 6080 6080 6080
6080 6080 6080 6080
6070 6070 6070 6070
5940 5940 5940 5940
6060 6060 6060 6060
6050 6050 6050 6050
6080 6080 6080 6080
6060 6060 6060 6060
5900 5900 5900 5900
5800 5800 5800 5800
5950 5950 5950 5950
5950 5950 5950 5950
6090 6090 6090 6090
6100 6100 6100 6100
movementenvelope
6060 6060 6060 6060
6070 6070 6070 6070
6070 6070 6070 6070
6070 6070 6070 6070
6060 6060 6060 6060
6090 6090 6090 6090
6070 6070 6070 6070
6060 6060 6060 6060
5930 5930 5930 5930
5930 5930 5930 5930
5950 5950 5950 5950
6070 6070 6070 6070
6090 6090 6090 6090
6050 6050 6050 6050
5930 5930 5930 5930
5940 5940 5940 5940
5960 5960 5960 5960
6050 6050 6050 6050
6060 6060 6060 6060
6080 6080 6080 6080
6070 6070 6070 6070
6090 6090 6090 6090
6070 6070 6070 6070
6050 6050 6050 6050
6070 6070 6070 6070
6090 6090 6090 6090
6050 6050 6050 6050
6100 6100 6100 6100
6080 6080 6080 6080
6060 6060 6060 6060
6070 6070 6070 6070
movementenvelope
6100 6100 6100 6100
6120 6120 6120 6120
6110 6110 6110 6110
6100 6100 6100 6100
6050 6050 6050 6050
6050 6050 6050 6050
6060 6060 6060 6060
6080 6080 6080 6080
6080 6080 6080 6080
6090 6090 6090 6090
6110 6110 6110 6110
6100 6100 6100 6100
6090 6090 6090 6090
6080 6080 6080 6080
6060 6060 6060 6060
6070 6070 6070 6070
6060 6060 6060 6060
6090 6090 6090 6090
6060 6060 6060 6060
6050 6050 6050 6050
6080 6080 6080 6080
6050 6050 6050 6050
6070 6070 6070 6070
6090 6090 6090 6090
6060 6060 6060 6060
6070 6070 6070 6070
6110 6110 6110 6110
6070 6070 6070 6070
6090 6090 6090 6090
6050 6050 6050 6050
6060 6060 6060 6060
movementenvelope
6070 6070 6070 6070
6080 6080 6080 6080
6050 6050 6050 6050
6070 6070 6070 6070
6090 6090 6090 6090
6050 6050 6050 6050
6110 6110 6110 6110
6110 6110 6110 6110
6050 6050 6050 6050
6080 6080 6080 6080
6070 6070 6070 6070
6130 6130 6130 6130
6130 6130 6130 6130
6100 6100 6100 6100
6070 6070 6070 6070
5900 5900 5900 5900
6070 6070 6070 6070
6060 6060 6060 6060
6080 6080 6080 6080
6120 6120 6120 6120
6050 6050 6050 6050
6050 6050 6050 6050
6060 6060 6060 6060
6070 6070 6070 6070
6060 6060 6060 6060
6050 6050 6050 6050
6110 6110 6110 6110
6080 6080 6080 6080
6100 6100 6100 6100
6050 6050 6050 6050
6050 6050 6050 6050
movementenvelope
6090 6090 6090 6090
6110 6110 6110 6110
6080 6080 6080 6080
6070 6070 6070 6070
6050 6050 6050 6050
6050 6050 6050 6050
6070 6070 6070 6070
6080 6080 6080 6080
6060 6060 6060 6060
6080 6080 6080 6080
6060 6060 6060 6060
6060 6060 6060 6060
6100 6100 6100 6100
5920 5920 5920 5920
6060 6060 6060 6060
6080 6080 6080 6080
6050 6050 6050 6050
6130 6130 6130 6130
6120 6120 6120 6120
6090 6090 6090 6090
5950 5950 5950 5950
6080 6080 6080 6080
6090 6090 6090 6090
6070 6070 6070 6070
6080 6080 6080 6080
6060 6060 6060 6060
6090 6090 6090 6090
6090 6090 6090 6090
6110 6110 6110 6110
6060 6060 6060 6060
6070 6070 6070 6070
movementenvelope
6050 6050 6050 6050
6070 6070 6070 6070
6100 6100 6100 6100
6070 6070 6070 6070
6060 6060 6060 6060
6060 6060 6060 6060
6090 6090 6090 6090
6080 6080 6080 6080
6080 6080 6080 6080
5930 5930 5930 5930
6080 6080 6080 6080
6080 6080 6080 6080
6080 6080 6080 6080
6060 6060 6060 6060
6060 6060 6060 6060
6080 6080 6080 6080
6070 6070 6070 6070
6060 6060 6060 6060
6050 6050 6050 6050
6070 6070 6070 6070
6050 6050 6050 6050
6050 6050 6050 6050
6070 6070 6070 6070
6090 6090 6090 6090
6050 6050 6050 6050
6050 6050 6050 6050
6050 6050 6050 6050
6060 6060 6060 6060
6070 6070 6070 6070
6080 6080 6080 6080
6050 6050 6050 6050
movementenvelope
6070 6070 6070 6070
6100 6100 6100 6100
5940 5940 5940 5940
5920 5920 5920 5920
6090 6090 6090 6090
6080 6080 6080 6080
6100 6100 6100 6100
6070 6070 6070 6070
5920 5920 5920 5920
6060 6060 6060 6060
5940 5940 5940 5940
6060 6060 6060 6060
5930 5930 5930 5930
6060 6060 6060 6060
6080 6080 6080 6080
5890 5890 5890 5890
5800 5800 5800 5800
6100 6100 6100 6100
6090 6090 6090 6090
6100 6100 6100 6100
6070 6070 6070 6070
6120 6120 6120 6120
5940 5940 5940 5940
6100 6100 6100 6100
6140 6140 6140 6140
5950 5950 5950 5950
6100 6100 6100 6100
6050 6050 6050 6050
5950 5950 5950 5950
5930 5930 5930 5930
5930 5930 5930 5930
movementenvelope
6080 6080 6080 6080
6050 6050 6050 6050
6070 6070 6070 6070
6100 6100 6100 6100
5950 5950 5950 5950
6090 6090 6090 6090
5910 5910 5910 5910
5940 5940 5940 5940
5880 5880 5880 5880
6050 6050 6050 6050
5940 5940 5940 5940
5920 5920 5920 5920
5870 5870 5870 5870
5880 5880 5880 5880
5930 5930 5930 5930
5940 5940 5940 5940
5920 5920 5920 5920
5900 5900 5900 5900
5940 5940 5940 5940
5920 5920 5920 5920
5900 5900 5900 5900
5920 5920 5920 5920
5940 5940 5940 5940
5930 5930 5930 5930
6070 6070 6070 6070
5940 5940 5940 5940
5900 5900 5900 5900
5870 5870 5870 5870
5940 5940 5940 5940
6100 6100 6100 6100
6140 6140 6140 6140
movementenvelope
5870 5870 5870 5870
5930 5930 5930 5930
5920 5920 5920 5920
6130 6130 6130 6130
6060 6060 6060 6060
5880 5880 5880 5880
5890 5890 5890 5890
5840 5840 5840 5840
6070 6070 6070 6070
5910 5910 5910 5910
5950 5950 5950 5950
6080 6080 6080 6080
5930 5930 5930 5930
5930 5930 5930 5930
5900 5900 5900 5900
6070 6070 6070 6070
5890 5890 5890 5890
6100 6100 6100 6100
5880 5880 5880 5880
5880 5880 5880 5880
5930 5930 5930 5930
6170 6170 6170 6170
5950 5950 5950 5950
5950 5950 5950 5950
5860 5860 5860 5860
5900 5900 5900 5900
5900 5900 5900 5900
5940 5940 5940 5940
5930 5930 5930 5930
5900 5900 5900 5900
5930 5930 5930 5930
movementenvelope
5910 5910 5910 5910
5930 5930 5930 5930
5940 5940 5940 5940
5960 5960 5960 5960
5860 5860 5860 5860
5890 5890 5890 5890
5920 5920 5920 5920
5890 5890 5890 5890
5900 5900 5900 5900
6070 6070 6070 6070
6220 6220 6220 6220
6060 6060 6060 6060
5940 5940 5940 5940
5950 5950 5950 5950
5820 5820 5820 5820
6090 6090 6090 6090
6050 6050 6050 6050
5950 5950 5950 5950
5890 5890 5890 5890
5920 5920 5920 5920
5910 5910 5910 5910
6080 6080 6080 6080
6080 6080 6080 6080
5920 5920 5920 5920
5870 5870 5870 5870
5950 5950 5950 5950
6150 6150 6150 6150
5850 5850 5850 5850
6080 6080 6080 6080
5910 5910 5910 5910
5920 5920 5920 5920
movementenvelope
5860 5860 5860 5860
5920 5920 5920 5920
5880 5880 5880 5880
6190 6190 6190 6190
5920 5920 5920 5920
5950 5950 5950 5950
5930 5930 5930 5930
6060 6060 6060 6060
6060 6060 6060 6060
6050 6050 6050 6050
5930 5930 5930 5930
5940 5940 5940 5940
5940 5940 5940 5940
5910 5910 5910 5910
5900 5900 5900 5900
5890 5890 5890 5890
6050 6050 6050 6050
6130 6130 6130 6130
6090 6090 6090 6090
6070 6070 6070 6070
6060 6060 6060 6060
5920 5920 5920 5920
6110 6110 6110 6110
6060 6060 6060 6060
6110 6110 6110 6110
movementenvelope
sub movementenvelope
begin
depth
while
3 servo 2 servo 1 servo 0 servo
1200 delay
repeat
return[/code]