"""
front end calibration scans using Femto amplifiers

start pshell using start-femto script to enable the devices!

SampleCurrent: not connected
RefCurrent: RMU
AuxCurrent: not connected
"""

import time

SENSORS = (RefCurrent, MachineCurrent)
STARTPOS = (-1.5)
ENDPOS = (+1.5)
STEPS = 0.01
LATENCY = 1.0
DWELL = 0.1

def trig():
    caput("X03DA-OP-10ADC:TRG.PROC", 1)
    #time.sleep(DWELL)
    
value = DWELL * 10.0
SampleCurrentAveraging.write(value)
RefCurrentAveraging.write(value)
AuxCurrentAveraging.write(value)

SampleCurrentGain.write("L, 10^3")
RefCurrentGain.write("L, 10^7")
AuxCurrentGain.write("L, 10^7")

FrontendHSize.write(2.0)
FrontendVSize.write(2.0)
ExitSlit.write(25.0)
caput("X03DA-PGM:ronbeta.A", -87.0)
caput("X03DA-PGM:rontheta.A", +87.0)

MonoBeta.waitValueInRange(-87.1, -86.9, 100000)


POSITIONERS = (FrontendBladeUp)
FrontendBladeUp.write(STARTPOS)
FrontendBladeDown.write(-2.0)
time.sleep(5.0)
lscan(POSITIONERS, SENSORS, STARTPOS, ENDPOS, STEPS, LATENCY, before_read=trig)

POSITIONERS = (FrontendBladeDown)
FrontendBladeDown.write(STARTPOS)
FrontendBladeUp.write(+2.0)
time.sleep(5.0)
lscan(POSITIONERS, SENSORS, STARTPOS, ENDPOS, STEPS, LATENCY, before_read=trig)

FrontendHSize.write(2.0)
FrontendVSize.write(2.0)
time.sleep(10.0)

STARTPOS = (-4.0)
ENDPOS = (+4.0)
STEPS = 0.1

POSITIONERS = (FrontendBladeRing)
FrontendBladeRing.write(STARTPOS)
FrontendBladeWall.write(-4.0)
time.sleep(5.0)
lscan(POSITIONERS, SENSORS, STARTPOS, ENDPOS, STEPS, LATENCY, before_read=trig)

POSITIONERS = (FrontendBladeWall)
FrontendBladeWall.write(STARTPOS)
FrontendBladeRing.write(+4.0)
time.sleep(5.0)
lscan(POSITIONERS, SENSORS, STARTPOS, ENDPOS, STEPS, LATENCY, before_read=trig)

FrontendHSize.write(0.0)
FrontendVSize.write(0.0)