Advertisement
Guest User

Untitled

a guest
Jul 16th, 2014
276
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 3.90 KB | None | 0 0
  1. loadrt trivkins
  2. loadrt [EMCMOT]EMCMOT base_period_nsec=[EMCMOT]BASE_PERIOD servo_period_nsec=[EMCMOT]SERVO_PERIOD num_joints=[TRAJ]AXES
  3. loadrt probe_parport
  4. loadrt hal_parport cfg="0xdc00 out"
  5. setp parport.0.reset-time 5000
  6. loadrt stepgen step_type=0,0,0,0,0
  7. loadrt abs count=1
  8.  
  9. addf parport.0.read base-thread
  10. addf stepgen.make-pulses base-thread
  11. addf parport.0.write base-thread
  12. addf parport.0.reset base-thread
  13.  
  14. addf stepgen.capture-position servo-thread
  15. addf motion-command-handler servo-thread
  16. addf motion-controller servo-thread
  17. addf stepgen.update-freq servo-thread
  18. addf abs.0 servo-thread
  19. net spindle-cmd <= motion.spindle-speed-out
  20. net spindle-at-speed => motion.spindle-at-speed
  21.  
  22. net xenable => parport.0.pin-01-out
  23. setp parport.0.pin-02-out-invert 1
  24. net xstep => parport.0.pin-02-out
  25. setp parport.0.pin-02-out-reset 1
  26. net ydir => parport.0.pin-03-out
  27. net adir => parport.0.pin-05-out
  28. net astep => parport.0.pin-06-out
  29. setp parport.0.pin-06-out-reset 1
  30. net bdir => parport.0.pin-17-out
  31. net bstep => parport.0.pin-04-out
  32. setp parport.0.pin-04-out-reset 1
  33. net zstep => parport.0.pin-07-out
  34. setp parport.0.pin-07-out-reset 1
  35. net zdir => parport.0.pin-08-out
  36. net xdir => parport.0.pin-14-out
  37. net ystep => parport.0.pin-16-out
  38. setp parport.0.pin-16-out-reset 1
  39. net estop-ext <= parport.0.pin-15-in-not
  40.  
  41. setp stepgen.0.position-scale [AXIS_0]SCALE
  42. setp stepgen.0.steplen 1
  43. setp stepgen.0.stepspace 1
  44. setp stepgen.0.dirhold 50000
  45. setp stepgen.0.dirsetup 50000
  46. setp stepgen.0.maxaccel [AXIS_0]STEPGEN_MAXACCEL
  47. net xpos-cmd axis.0.motor-pos-cmd => stepgen.0.position-cmd
  48. net xpos-fb stepgen.0.position-fb => axis.0.motor-pos-fb
  49. net xstep <= stepgen.0.step
  50. net xdir <= stepgen.0.dir
  51. net xenable axis.0.amp-enable-out => stepgen.0.enable
  52.  
  53. setp stepgen.1.position-scale [AXIS_1]SCALE
  54. setp stepgen.1.steplen 1
  55. setp stepgen.1.stepspace 1
  56. setp stepgen.1.dirhold 50000
  57. setp stepgen.1.dirsetup 50000
  58. setp stepgen.1.maxaccel [AXIS_1]STEPGEN_MAXACCEL
  59. net ypos-cmd axis.1.motor-pos-cmd => stepgen.1.position-cmd
  60. net ypos-fb stepgen.1.position-fb => axis.1.motor-pos-fb
  61. net ystep <= stepgen.1.step
  62. net ydir <= stepgen.1.dir
  63. net yenable axis.1.amp-enable-out => stepgen.1.enable
  64.  
  65. setp stepgen.2.position-scale [AXIS_2]SCALE
  66. setp stepgen.2.steplen 1
  67. setp stepgen.2.stepspace 1
  68. setp stepgen.2.dirhold 50000
  69. setp stepgen.2.dirsetup 50000
  70. setp stepgen.2.maxaccel [AXIS_2]STEPGEN_MAXACCEL
  71. net zpos-cmd axis.2.motor-pos-cmd => stepgen.2.position-cmd
  72. net zpos-fb stepgen.2.position-fb => axis.2.motor-pos-fb
  73. net zstep <= stepgen.2.step
  74. net zdir <= stepgen.2.dir
  75. net zenable axis.2.amp-enable-out => stepgen.2.enable
  76.  
  77. setp stepgen.3.position-scale [AXIS_3]SCALE
  78. setp stepgen.3.steplen 1
  79. setp stepgen.3.stepspace 1
  80. setp stepgen.3.dirhold 50000
  81. setp stepgen.3.dirsetup 50000
  82. setp stepgen.3.maxaccel [AXIS_3]STEPGEN_MAXACCEL
  83. net apos-cmd axis.3.motor-pos-cmd => stepgen.3.position-cmd
  84. net apos-fb stepgen.3.position-fb => axis.3.motor-pos-fb
  85. net astep <= stepgen.3.step
  86. net adir <= stepgen.3.dir
  87. net aenable axis.3.amp-enable-out => stepgen.3.enable
  88.  
  89. setp stepgen.4.position-scale [AXIS_4]SCALE
  90. setp stepgen.4.steplen 1
  91. setp stepgen.4.stepspace 1
  92. setp stepgen.4.dirhold 50000
  93. setp stepgen.4.dirsetup 50000
  94. setp stepgen.4.maxaccel [AXIS_4]STEPGEN_MAXACCEL
  95. net bpos-cmd axis.4.motor-pos-cmd => stepgen.4.position-cmd
  96. net bpos-fb stepgen.4.position-fb => axis.4.motor-pos-fb
  97. net bstep <= stepgen.4.step
  98. net bdir <= stepgen.4.dir
  99. net benable axis.4.amp-enable-out => stepgen.4.enable
  100.  
  101. net estop-out <= iocontrol.0.user-enable-out
  102. net estop-ext => iocontrol.0.emc-enable-in
  103.  
  104. loadusr -W hal_manualtoolchange
  105. net tool-change iocontrol.0.tool-change => hal_manualtoolchange.change
  106. net tool-changed iocontrol.0.tool-changed <= hal_manualtoolchange.changed
  107. net tool-number iocontrol.0.tool-prep-number => hal_manualtoolchange.number
  108. net tool-prepare-loopback iocontrol.0.tool-prepare => iocontrol.0.tool-prepared
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement