After a day to clear my head and start fresh, I got back to it tonight and got it fully funtional. Here is a video:
http://www.youtube.com/watch?v=DsizLpAXTnsHere is the Code in case anyone else has something like this:
'Tool change macro for 7 tool turret
Sub Main()
'Sets variable OldTool to what is currently loaded
OldTool=GetCurrentTool()
'Sets variable Newtool to the one being selected
NewTool=GetSelectedTool()
'Sets Variable MaxToolNum to the max number of tools possible
MaxToolNum=7
'Get positions before moving to do tool change
x = GetToolChangeStart( 0 )
y = GetToolChangeStart( 1 )
z = GetToolChangeStart( 2 )
a = GetToolChangeStart( 3 )
b = GetToolChangeStart( 4 )
c = GetToolChangeStart( 5 )
'If the current tool loaded is 0 or greater than 7 then tool has been lost
'so need to ask what tool is currently loaded
While OldTool=0 Or OldTool>7
OldTool=Question ("Current tool unknown, enter tool in spindle 1 to " & MaxToolNum)
Wend
'Sets CurrentTool to Oldtool in case a it was lost and entered above
SetCurrentTool(OldTool)
'If the tool asked for is invalid then this makes you select a valid tool
While NewTool > MaxToolNum Or NewTool <1
NewTool = Question ("Invalid tool selected, select a tool number 1 to " & MaxToolNum)
Wend
'If the tool asked for is the same one that is already loaded then exit macro
If NewTool=OldTool Then
Exit Sub
End If
'Turn off soft limits if they are on
If GetOEMLED(23) Then
DoOEMButton(119)
End If
'Moves To Z home from where ever it is
code "G53G0Z0"
While IsMoving()
Wend
'Sets ChangeNums to 0 for safety in case it is not at 0
ChangeNums=0
'Makes the magic happen and moves the proper number of times if new tool is higher than old
If NewTool>OldTool Then
For ChangeNums=1 To NewTool-OldTool
'Moves Z axiis to the top of tool change
code "G53 G1 F70 Z5.800"
While IsMoving()
Wend
'Moves back to bottom of tool change area
code "G53 G1 F70 Z3.8"
While IsMoving()
Wend
Next
'Makes the magic happen and moves the proper number of times if new tool is lower than old
Else
For ChangeNums=(OldTool-NewTool) To 6
'Moves Z axis to the top of tool change
code "G53 G1 F70 Z5.800"
While IsMoving()
Wend
'Moves back to bottom of tool change area
code "G53 G1 F70 Z3.8"
While IsMoving()
Wend
Next
End If
'Move Back to Z Home
code "G53 G1 F70 Z0"
While IsMoving()
Wend
'Should be a succesful tool change at this point so this sets the NewTool as the current tool
SetCurrentTool(NewTool)
'Turn back on soft limits
DoOEMButton(119)
End Sub