import argparse

try:
    import cothread.catools as ca
except ImportError:
    _has_ca = False
else:
    _has_ca = True


parser = argparse.ArgumentParser()
parser.add_argument('-f0', '--fstart', help='Chirp start freq [Hz]',
                    dest='fstart', type=float, default=-50e3)
parser.add_argument('-f1', '--fstop', help='Chirp stop freq [Hz]',
                    dest='fstop', type=float, default=50e3)
parser.add_argument('-t', '--tfrac', help='Chirp length as fraction of waveform window [0.0 - 1.0]',
                    dest='fracofscreen', type=float, default=0.78)
parser.add_argument('-r', '--tramp', help='Ramp up time as fraction of chirp length [0.0 - 1.0]',
                    dest='rampratio', type=float, default=0.125)
parser.add_argument('-a', '--ampmax', help='Max amplitude as fraction of full scale. Defaults to value of SEL_ASET PV',
                    dest='ampmax', type=float)
parser.add_argument('-c', '--cryocav', help='Cryomodule/cavity in format 0xx0. 0320 is 2nd cavity in cryomodule 3',
                    dest='cyca', type=str, required=True)
parser.add_argument('-o', '--onoff', help='Chirp enable on/off',
                    dest='onoff', type=str, choices=['on', 'off'], required=True)
parser.add_argument('-d', '--debug', help='Enable debug mode without channel access',
                    dest='debug', action='store_true')
clargs = parser.parse_args()

if not _has_ca and not clargs.debug:
    raise ImportError("Could not import ca from cothread.catools")

A = "ACCL:L1B:%s" % clargs.cyca

if clargs.debug:  # Set typical default parameters
    sel_aset = 9
    acq_samp_period = 8*2*33*14/1320.0e6
else:
    sel_aset = ca.caget("%s:SEL_ASET" % A)
    acq_samp_period = ca.caget("%s:ACQ_SAMP_PERIOD" % A)


print('acq_samp_period', acq_samp_period)

fstart = clargs.fstart
fstop = clargs.fstop
fracofscreen = clargs.fracofscreen
rampratio = clargs.rampratio
ampmax = min(clargs.ampmax if clargs.ampmax else sel_aset/100.0, 1.0)
print('ampmax', ampmax)

# system parameters
fsamp = 1320.0e6/14
chirp_dt = 8.0/(fsamp)
waveformlength = 2048.0  # 16384 total points, 4 channels x 2 {I,Q}

cordicgain = 1.64676025812107

# Chirp firmware parameters
PH_WI = 32
DD_SHIFT = 8
AMP_WI = 20

waveform_dt = acq_samp_period
chirptime = fracofscreen*waveformlength*waveform_dt  # in seconds
ramptime = chirptime*rampratio  # in seconds

# actual FPGA registers
ACQ_PER_WF = 1
AMP_MAX = int(ampmax * 2**AMP_WI/cordicgain)
AMP_SLOPE = int(AMP_MAX/(ramptime/chirp_dt))
FREQ_SLOPE = int((fstop-fstart)/chirptime*chirp_dt*chirp_dt * 2**(PH_WI+DD_SHIFT-1))
FREQ_INIT = int(fstart * chirp_dt * 2**(PH_WI-1))
TIME = int(chirptime/chirp_dt)
ENABLE = 1 if clargs.onoff == 'on' else 0

if not clargs.debug:
    B = "%s:CHIRP" % A
    ca.caput(B+":ACQ_PER_WF", ACQ_PER_WF)
    ca.caput(B+":AMP_MAX", AMP_MAX)
    ca.caput(B+":AMP_SLOPE", AMP_SLOPE)
    ca.caput(B+":FREQ_SLOPE", FREQ_SLOPE)
    ca.caput(B+":FREQ_INIT", FREQ_INIT)
    ca.caput(B+":TIME", TIME)
    ca.caput(B+":ENABLE", ENABLE)

print("ACQ_PER_WF, AMP_MAX, AMP_SLOPE, FREQ_SLOPE, FREQ_INIT, TIME, ENABLE")
print(ACQ_PER_WF, AMP_MAX, AMP_SLOPE, FREQ_SLOPE, FREQ_INIT, TIME, ENABLE)
