# $Revision: 1.1 $
# $Date: 2006-11-03 05:19:42 $
# Author: Ferdi Franceschini (ffr@ansto.gov.au)
# Last revision by: $Author: ffr $

# Cycle motors 
clientput "drive to zero reference"
drive ss2vg 10 ss2hg 10 ss1vg 10 ss1hg 10
drive som 0 ss1vo 0 ss2vo 0 ss2vo 0 ss2ho 0  sphi 0 schi 90 sx 0 sz 0

clientput "zero done"
set starttime [sicstime]

#About 120 iterations per hour
for {set i 0} {$i < 240} {incr i} {
    clientput "cycle: $i"
    set soff [expr 10 * ($i%2)]
    set omega [expr 10 * ($i%5)]
    set phi [expr $i%5]
    set chi [expr 90 + $i%5]
    set xpos [expr $i%5]
    set zpos [expr $i%5]
    clientput "drive slits to $soff mm"
    drive ss1vo $soff ss1ho $soff ss2vo $soff ss2ho $soff
    clientput "drive som to $omega degrees"
    clientput "drive sphi to $phi degrees"
    clientput "drive schi to $chi degrees"
    clientput "drive sx to $xpos mm"
    clientput "drive sz to $zpos mm"
    drive som $omega sphi $phi schi $chi sx $xpos sz $zpos
    clientput "drive to zero reference"
    drive som 0 ss1vo 0 ss1ho 0 ss2vo 0 ss2ho 0  sphi 0 schi 90 sx 0 sz 0
}


set stoptime [sicstime]
clientput "started: $starttime"
clientput "stopped: $stoptime"