"""
Focusing mirror temperature scan

"""

import math

FmuTemperatureSet = ch.psi.pshell.epics.ChannelDouble("FmuTemperatureSet", "X03DA-PC-HUBER:TEMP-SP")
FmuTemperatureRbk = ch.psi.pshell.epics.ChannelDouble("FmuTemperatureRbk", "X03DA-PC-HUBER:TEMP-I-RBV")
OpticsCameraSigmaX2 = ch.psi.pshell.epics.ChannelDouble("OpticsCameraSigmaX2", "X03DA-OP-PS1:Stats2:SigmaX_RBV")

FmuTemperatureSet.initialize()
FmuTemperatureRbk.initialize()
OpticsCameraSigmaX2.initialize()

#MOTORS = ["ca://X03DA-PC-HUBER:TEMP-SP"]
#SENSORS = [OpticsCameraCentroidX, OpticsCameraSigmaX, "ca://X03DA-PC-HUBER:TEMP-I-RBV"]
MOTORS = [FmuTemperatureSet]
SENSORS = [OpticsCameraCentroidX, OpticsCameraSigmaX, OpticsCameraSigmaX2, FmuTemperatureRbk]
STARTPOS = 21.5
ENDPOS = 23.0
STEPS = 0.1
RELATIVE = False
LATENCY = 60.0
ENDSCAN = False

adjust_sensors()
set_adc_averaging()

def trig_sensors():
    wait_beam()

try:
    #caput("X03DA-PC-HUBER:TEMP-SP", STARTPOS)
    #time.sleep(240.0)
    lscan(MOTORS, SENSORS, STARTPOS, ENDPOS, STEPS, LATENCY, RELATIVE, before_read=trig_sensors, after_read = after_readout)
finally:
    if ENDSCAN:
        after_scan()