Add AC/BC RTCP programs and 3D machine manager
This commit is contained in:
@@ -0,0 +1,53 @@
|
||||
#<r> = 60 ; sphere radius
|
||||
#<rdelta> = 5 ; safe distance
|
||||
#<drilldepth> = -5
|
||||
#<zstart> = 0
|
||||
#<bctmax> = 8
|
||||
#<cctmax> = 16
|
||||
#<toolno> = 100
|
||||
#<frate> = 1000
|
||||
|
||||
#<bct> = 0
|
||||
#<cct> = 0
|
||||
#<cdelta> = [360/#<cctmax>]
|
||||
#<bdelta> = [90/#<bctmax>]
|
||||
|
||||
g49
|
||||
t#<toolno>m6g43
|
||||
|
||||
g53 g0 x0y0z#<zstart>b0c0 w0
|
||||
g10l20 p0 x0 y0 z[#<r>+#<rdelta>] b0 c0 w0
|
||||
g0 z0
|
||||
f#<frate>
|
||||
o100 while [#<bct> lt #<bctmax>]
|
||||
#<b> = [#<bct>*#<bdelta>]
|
||||
#<rnow> = [[#<r>+#<rdelta>]*[cos[#<b>]]]
|
||||
#<x> = [#<rnow>]
|
||||
#<y> = 0
|
||||
#<z> = [-#<rnow>]
|
||||
g0 x#<x> y#<y>
|
||||
m66e0l0 ; force sync
|
||||
g0 z#<z>
|
||||
g0b[-90+#<b>]
|
||||
#<cct> = 0
|
||||
o200 while [#<cct> lt #<cctmax>]
|
||||
o210 if [[#<bct> mod 2] eq 0]
|
||||
#<c> = [#<cct> * #<cdelta>]
|
||||
o210 else
|
||||
#<c> = [360 - [1+ #<cct>] * #<cdelta>]
|
||||
o210 endif
|
||||
#<x> = [#<rnow>*[cos[#<c>]]]
|
||||
#<y> = [#<rnow>*[sin[#<c>]]]
|
||||
g0 x#<x> y#<y> z#<z> c#<c>
|
||||
f#<frate>
|
||||
g1 w[ #<drilldepth> - #<rdelta>]
|
||||
g0 w0
|
||||
m66e0l0 ;force sync
|
||||
#<cct> = [#<cct>+1]
|
||||
o200 endwhile
|
||||
#<bct> = [#<bct>+1]
|
||||
o100 endwhile
|
||||
|
||||
g0x0y0z0b0c0w0
|
||||
g53 g0 x0y0z0
|
||||
m2
|
||||
@@ -0,0 +1,24 @@
|
||||
;M428 by remap: select kinstype=0 genhexkins
|
||||
o<428remap>sub
|
||||
#<kinstype> = 0
|
||||
#<SWITCHKINS_PIN> = 3 ; set N as required: motion.analog-out-0N
|
||||
|
||||
o1 if [exists [#<_hal[motion.switchkins-type]>]]
|
||||
o1 else
|
||||
(debug,M428:Missing [RS274NGC]HAL_PIN_VARS=1)
|
||||
(debug,STOP)
|
||||
M2
|
||||
o1 endif
|
||||
|
||||
M68 E#<SWITCHKINS_PIN> Q#<kinstype> ; set kinstype value
|
||||
M66 E0 L0 ; force synch
|
||||
|
||||
o2 if [[#<_task> EQ 1] AND [#<_hal[motion.switchkins-type]> NE #<kinstype>]]
|
||||
(debug,M428: Wrong motion.switchkins-type)
|
||||
(debug,or missing hal net to analog-out-0x)
|
||||
(debug,STOP)
|
||||
M2
|
||||
o2 else
|
||||
o2 endif
|
||||
|
||||
o<428remap>endsub
|
||||
@@ -0,0 +1,24 @@
|
||||
;M429 by remap: select kinstype==1 Identity kinematics
|
||||
o<429remap>sub
|
||||
#<kinstype> = 1
|
||||
#<SWITCHKINS_PIN> = 3 ; set N as required: motion.analog-out-0N
|
||||
|
||||
o1 if [exists [#<_hal[motion.switchkins-type]>]]
|
||||
o1 else
|
||||
(debug,M429:Missing [RS274NGC]HAL_PIN_VARS=1)
|
||||
(debug,STOP)
|
||||
M2
|
||||
o1 endif
|
||||
|
||||
M68 E#<SWITCHKINS_PIN> Q#<kinstype> ; set kinstype value
|
||||
M66 E0 L0 ; force synch
|
||||
|
||||
o2 if [[#<_task> EQ 1] AND [#<_hal[motion.switchkins-type]> NE #<kinstype>]]
|
||||
(debug,M429:Wrong motion.switchkins-type)
|
||||
(debug,or missing hal net to analog-out-0x)
|
||||
(debug,STOP)
|
||||
M2
|
||||
o2 else
|
||||
o2 endif
|
||||
|
||||
o<429remap>endsub
|
||||
@@ -0,0 +1,24 @@
|
||||
;M430 by remap: select kinstype==2 userk kins
|
||||
o<430remap>sub
|
||||
#<kinstype> = 2
|
||||
#<SWITCHKINS_PIN> = 3 ; set N as required: motion.analog-out-0N
|
||||
|
||||
o1 if [exists [#<_hal[motion.switchkins-type]>]]
|
||||
o1 else
|
||||
(debug,M30:Missing [RS274NGC]HAL_PIN_VARS=1)
|
||||
(debug,STOP)
|
||||
M2
|
||||
o1 endif
|
||||
|
||||
M68 E#<SWITCHKINS_PIN> Q#<kinstype> ; set kinstype value
|
||||
M66 E0 L0 ; force synch
|
||||
|
||||
o2 if [[#<_task> EQ 1] AND [#<_hal[motion.switchkins-type]> NE #<kinstype>]]
|
||||
(debug,M430:Wrong motion.switchkins-type)
|
||||
(debug,or missing hal net to analog-out-0x)
|
||||
(debug,STOP)
|
||||
M2
|
||||
o2 else
|
||||
o2 endif
|
||||
|
||||
o<430remap>endsub
|
||||
Reference in New Issue
Block a user