forked from M-Labs/artiq
artiq/devices: add pdq2.py
This commit is contained in:
parent
5e994071ce
commit
de158e0aeb
|
@ -0,0 +1,430 @@
|
|||
#!/usr/bin/python
|
||||
# -*- coding: utf8 -*-
|
||||
#
|
||||
# Robert Jordens <jordens@gmail.com>, 2012
|
||||
|
||||
import logging, struct
|
||||
import numpy as np
|
||||
from scipy import interpolate
|
||||
import warnings
|
||||
|
||||
logger = logging.getLogger("Pdq2")
|
||||
|
||||
|
||||
Ftdi = None
|
||||
|
||||
|
||||
try:
|
||||
import pylibftdi
|
||||
|
||||
class PyFtdi:
|
||||
def __init__(self, serial=None):
|
||||
self.dev = pylibftdi.Device(device_id=serial)
|
||||
|
||||
def write(self, data):
|
||||
written = self.dev.write(data)
|
||||
if written < 0:
|
||||
raise pylibftdi.FtdiError(written,
|
||||
self.dev.get_error_string())
|
||||
return written
|
||||
|
||||
def close(self):
|
||||
self.dev.close()
|
||||
del self.dev
|
||||
|
||||
Ftdi = PyFtdi
|
||||
except ImportError:
|
||||
pass
|
||||
|
||||
|
||||
try:
|
||||
import ftd2xx
|
||||
|
||||
class D2xxFtdi:
|
||||
def __init__(self, serial=None):
|
||||
if serial is not None:
|
||||
self.dev = ftd2xx.openEx(serial)
|
||||
else:
|
||||
self.dev = ftd2xx.open()
|
||||
self.dev.setTimeouts(read=5000, write=5000)
|
||||
|
||||
def write(self, data):
|
||||
written = self.dev.write(str(data))
|
||||
return written
|
||||
|
||||
def close(self):
|
||||
self.dev.close()
|
||||
del self.dev
|
||||
|
||||
Ftdi = D2xxFtdi
|
||||
except ImportError:
|
||||
pass
|
||||
|
||||
|
||||
if Ftdi is None:
|
||||
|
||||
class FileFtdi:
|
||||
def __init__(self, serial="unknown"):
|
||||
self.fil = open("pdq_%s_ftdi.bin" % serial, "wb")
|
||||
|
||||
def write(self, data):
|
||||
self.fil.write(data)
|
||||
return len(data)
|
||||
|
||||
def close(self):
|
||||
self.fil.close()
|
||||
del self.fil
|
||||
|
||||
warnings.warn("no ftdi library found. writing to files")
|
||||
Ftdi = FileFtdi
|
||||
|
||||
|
||||
class Pdq2:
|
||||
"""
|
||||
PDQ DAC (a.k.a. QC_Waveform)
|
||||
"""
|
||||
max_val = 1<<15 # signed 16 bit DAC
|
||||
max_out = 10.
|
||||
freq = 50e6 # samples/s
|
||||
max_time = 1<<16 # unsigned 16 bit timer
|
||||
num_dacs = 3
|
||||
num_frames = 8
|
||||
num_channels = 9
|
||||
max_data = 4*(1<<10) # 8kx16 8kx16 4kx16
|
||||
escape_char = b"\xa5"
|
||||
cordic_gain = 1.
|
||||
for i in range(16):
|
||||
cordic_gain *= np.sqrt(1 + 2**(-2*i))
|
||||
|
||||
commands = {
|
||||
"RESET_EN": b"\x00",
|
||||
"RESET_DIS": b"\x01",
|
||||
"TRIGGER_EN": b"\x02",
|
||||
"TRIGGER_DIS": b"\x03",
|
||||
"ARM_EN": b"\x04",
|
||||
"ARM_DIS": b"\x05",
|
||||
"DCM_EN": b"\x06",
|
||||
"DCM_DIS": b"\x07",
|
||||
"START_EN": b"\x08",
|
||||
"START_DIS": b"\x09",
|
||||
}
|
||||
|
||||
def __init__(self, serial=None):
|
||||
self.serial = serial
|
||||
self.dev = Ftdi(serial)
|
||||
|
||||
def close(self):
|
||||
self.dev.close()
|
||||
del self.dev
|
||||
|
||||
def cmd(self, cmd):
|
||||
return self.escape_char + self.commands[cmd]
|
||||
|
||||
def write_cmd(self, cmd):
|
||||
return self.write(self.cmd(cmd))
|
||||
|
||||
def escape(self, data):
|
||||
return data.replace(self.escape_char, self.escape_char +
|
||||
self.escape_char)
|
||||
|
||||
def write(self, *segments):
|
||||
"""
|
||||
writes data segments to device
|
||||
"""
|
||||
for segment in segments:
|
||||
written = self.dev.write(segment)
|
||||
if written != len(segment):
|
||||
raise IOError("wrote %i of %i" % (written, len(segment)))
|
||||
|
||||
def write_data(self, *segments):
|
||||
return self.write(*(self.escape(seg) for seg in segments))
|
||||
|
||||
def line_times(self, t, shift=0):
|
||||
scale = self.freq/2**shift
|
||||
t = t*scale
|
||||
tr = np.rint(t)
|
||||
dt = np.diff(tr)
|
||||
return t, tr, dt
|
||||
|
||||
def interpolate(self, t, v, order, shift=0, tr=None):
|
||||
"""
|
||||
calculate spline interpolation derivatives for data
|
||||
according to interpolation order
|
||||
also differentiates times (implicitly shifts to 0) and removes
|
||||
the last value (irrelevant since the frame ends here)
|
||||
"""
|
||||
if order == 0:
|
||||
return [v[:-1]]
|
||||
spline = interpolate.splrep(t, v, k=order)
|
||||
if tr is None:
|
||||
tr = t
|
||||
dv = [interpolate.splev(tr[:-1], spline, der=i)
|
||||
for i in range(order + 1)]
|
||||
# correct for adder chain latency
|
||||
correction_map = [
|
||||
(1, -1/2., 2),
|
||||
(1, -1/6., 3),
|
||||
(2, -1., 3),
|
||||
]
|
||||
for i, c, j in correction_map:
|
||||
if j >= len(dv):
|
||||
break
|
||||
dv[i] -= c*dv[j]
|
||||
return dv
|
||||
|
||||
def pack_frame(self, *parts_dtypes):
|
||||
frame = []
|
||||
for part, dtype in parts_dtypes:
|
||||
if dtype == "i6":
|
||||
part = part.astype("<i8")
|
||||
frame.append(part.astype("<i4"))
|
||||
frame.append((part >> 32).astype("<i2"))
|
||||
else:
|
||||
frame.append(part.astype("<" + dtype))
|
||||
frame = np.rec.fromarrays(frame) # interleave
|
||||
logger.debug("frame %s dtype %s shape %s length %s",
|
||||
frame, frame.dtype, frame.shape, len(bytes(frame.data)))
|
||||
return bytes(frame.data)
|
||||
|
||||
def frame(self, t, v, p=None, f=None,
|
||||
order=3, aux=None, shift=0, trigger=True, end=True,
|
||||
silence=False, stop=True, clear=True, wait=False):
|
||||
"""
|
||||
serialize frame data
|
||||
voltages in volts, times in seconds
|
||||
"""
|
||||
words = [1, 2, 3, 3, 1, 2, 2]
|
||||
n = order + 1
|
||||
if f is not None:
|
||||
n += 2
|
||||
if p is None:
|
||||
p = np.zeros_like(f)
|
||||
if p is not None:
|
||||
n += 1
|
||||
length = 1 + sum(words[:n])
|
||||
parts = []
|
||||
|
||||
head = np.zeros(len(t) - 1, "<u2")
|
||||
head[:] |= length # 4
|
||||
if p is not None:
|
||||
head[:] |= 1<<4 # typ # 2
|
||||
head[0] |= trigger<<6 # 1
|
||||
head[-1] |= (not stop and silence)<<7 # 1
|
||||
if aux is not None:
|
||||
head[:] |= aux[:len(head)]<<8 # 1
|
||||
head[:] |= shift<<9 # 4
|
||||
head[-1] |= (not stop and end)<<13 # 1
|
||||
head[0] |= clear<<14 # 1
|
||||
head[-1] |= (not stop and wait)<<15 # 1
|
||||
parts.append((head, "u2"))
|
||||
|
||||
t, tr, dt = self.line_times(t, shift)
|
||||
assert np.all(dt*2**shift > 1 + length), (dt, length)
|
||||
assert np.all(dt < self.max_time), dt
|
||||
|
||||
parts.append((dt, "u2"))
|
||||
|
||||
v = np.clip(v/self.max_out, -1, 1)
|
||||
if p is not None:
|
||||
v /= self.cordic_gain
|
||||
for dv, w in zip(self.interpolate(t, v, order, shift, tr), words):
|
||||
parts.append((np.rint(dv*(2**(16*w - 1))), "i%i" % (2*w)))
|
||||
|
||||
if p is not None:
|
||||
p = p/(2*np.pi)
|
||||
for dv, w in zip(self.interpolate(t, p, 0, shift, tr), [1]):
|
||||
parts.append((np.rint(dv*(2**(16*w))), "u%i" % (2*w)))
|
||||
|
||||
if f is not None:
|
||||
f = f/self.freq
|
||||
for dv, w in zip(self.interpolate(t, f, 1, shift, tr), [2, 2]):
|
||||
parts.append((np.rint(dv*(2**(16*w))), "i%i" % (2*w)))
|
||||
|
||||
frame = self.pack_frame(*parts)
|
||||
|
||||
if stop:
|
||||
if p is not None:
|
||||
frame += struct.pack("<HH hiihih H ii", (15<<0) | (1<<4) |
|
||||
(silence<<7) | (end<<13) | (wait<<15),
|
||||
1, int(v[-1]*2**15), 0, 0, 0, 0, 0,
|
||||
int(p[-1]*2**16), int(f[-1]*2**31), 0)
|
||||
else:
|
||||
frame += struct.pack("<HH h", (2<<0) |
|
||||
(silence<<7) | (end<<13) | (wait << 15),
|
||||
1, int(v[-1]*2**15))
|
||||
return frame
|
||||
|
||||
def line(self, dt, v=(), a=(), p=(), f=(), typ=0,
|
||||
silence=False, end=False, trigger=False, aux=False,
|
||||
clear=False):
|
||||
raise NotImplementedError
|
||||
fmt = "<HH"
|
||||
parts = [0, int(round(dt*self.freq))]
|
||||
for vi, wi in zip(v, [1, 2, 3, 3]):
|
||||
vi = int(round(vi*(2**(16*wi - 1))))
|
||||
if wi == 3:
|
||||
fmt += "Ih"
|
||||
parts += [vi & 0xffffffff, vi >> 32]
|
||||
else:
|
||||
fmt += "bih"[wi]
|
||||
parts += [vi]
|
||||
if p is not None:
|
||||
typ = 1
|
||||
|
||||
def map_frames(self, frames, map=None):
|
||||
table = []
|
||||
adr = self.num_frames
|
||||
for frame in frames:
|
||||
table.append(adr)
|
||||
adr += len(frame)//2
|
||||
assert adr <= self.max_data, adr
|
||||
t = []
|
||||
for i in range(self.num_frames):
|
||||
if map is not None and len(map) > i:
|
||||
i = map[i]
|
||||
if i is not None and len(table) > i:
|
||||
i = table[i]
|
||||
else:
|
||||
i = 0
|
||||
t.append(i)
|
||||
t = struct.pack("<" + "H"*self.num_frames, *t)
|
||||
return t + b"".join(frames)
|
||||
|
||||
def add_mem_header(self, board, dac, data, adr=0):
|
||||
assert dac in range(self.num_dacs)
|
||||
head = struct.pack("<HHH", (board << 4) | dac,
|
||||
adr, adr + len(data)//2 - 1)
|
||||
return head + data
|
||||
|
||||
def multi_frame(self, times_voltages, channel, map=None, **kwargs):
|
||||
frames = [self.frame(t, v, **kwargs) for t, v in times_voltages]
|
||||
data = self.map_frames(frames, map)
|
||||
board, dac = divmod(channel, self.num_dacs)
|
||||
data = self.add_mem_header(board, dac, data)
|
||||
return data
|
||||
|
||||
|
||||
def _main():
|
||||
import argparse
|
||||
import time
|
||||
|
||||
parser = argparse.ArgumentParser(description="""PDQ2 frontend.
|
||||
Evaluates times and voltages, interpolates and uploads
|
||||
them.""")
|
||||
parser.add_argument("-s", "--serial", default=None,
|
||||
help="device (FT245R) serial string [first]")
|
||||
parser.add_argument("-c", "--channel", default=0, type=int,
|
||||
help="channel: 3*board_num+dac_num [%(default)s]")
|
||||
parser.add_argument("-f", "--frame", default=0, type=int,
|
||||
help="frame [%(default)s]")
|
||||
parser.add_argument("-e", "--free", default=False,
|
||||
action="store_true",
|
||||
help="software trigger [%(default)s]")
|
||||
parser.add_argument("-n", "--disarm", default=False,
|
||||
action="store_true",
|
||||
help="disarm group [%(default)s]")
|
||||
parser.add_argument("-t", "--times",
|
||||
default="np.arange(5)*1e-6",
|
||||
help="sample times (s) [%(default)s]")
|
||||
parser.add_argument("-v", "--voltages",
|
||||
default="(1-np.cos(t/t[-1]*2*np.pi))/2",
|
||||
help="sample voltages (V) [%(default)s]")
|
||||
parser.add_argument("-o", "--order", default=3, type=int,
|
||||
help="interpolation (0: const, 1: lin, 2: quad, 3: cubic)"
|
||||
" [%(default)s]")
|
||||
parser.add_argument("-m", "--dcm", default=None, type=int,
|
||||
help="choose fast 100MHz clock [%(default)s]")
|
||||
parser.add_argument("-x", "--demo", default=False, action="store_true",
|
||||
help="demo mode: pulse and chirp, 1V*ch+0.1V*frame [%(default)s]")
|
||||
parser.add_argument("-p", "--plot", help="plot to file [%(default)s]")
|
||||
parser.add_argument("-d", "--debug", default=False,
|
||||
action="store_true", help="debug communications")
|
||||
parser.add_argument("-r", "--reset", default=False,
|
||||
action="store_true", help="do reset before")
|
||||
parser.add_argument("-b", "--bit", default=False,
|
||||
action="store_true", help="do bit test")
|
||||
|
||||
args = parser.parse_args()
|
||||
|
||||
if args.debug:
|
||||
logging.basicConfig(level=logging.DEBUG)
|
||||
else:
|
||||
logging.basicConfig(level=logging.WARNING)
|
||||
|
||||
times = eval(args.times, globals(), {})
|
||||
voltages = eval(args.voltages, globals(), dict(t=times))
|
||||
|
||||
dev = Pdq2(serial=args.serial)
|
||||
|
||||
if args.reset:
|
||||
dev.write(b"\x00") # flush any escape
|
||||
dev.write_cmd("RESET_EN")
|
||||
time.sleep(.1)
|
||||
if args.dcm:
|
||||
dev.write_cmd("DCM_EN")
|
||||
dev.freq = 100e6
|
||||
elif args.dcm == 0:
|
||||
dev.write_cmd("DCM_DIS")
|
||||
dev.freq = 50e6
|
||||
dev.write_cmd("START_DIS")
|
||||
|
||||
if args.demo:
|
||||
channels = [args.channel] if args.channel < dev.num_channels \
|
||||
else range(dev.num_channels)
|
||||
frames = [args.frame] if args.frame < dev.num_frames \
|
||||
else range(dev.num_frames)
|
||||
for channel in channels:
|
||||
f = []
|
||||
for frame in frames:
|
||||
vi = .1*frame + channel + voltages
|
||||
pi = 2*np.pi*(.01*frame + .1*channel + 0*voltages)
|
||||
fi = 10e6*times/times[-1]
|
||||
f.append(b"".join([
|
||||
dev.frame(times, vi, order=args.order, end=False),
|
||||
dev.frame(2*times, voltages, pi, fi, trigger=False),
|
||||
#dev.frame(2*times, 0*vi+.1, 0*pi, 0*fi+1e6),
|
||||
#dev.frame(times, 0*vi, order=args.order, silence=True),
|
||||
]))
|
||||
board, dac = divmod(channel, dev.num_dacs)
|
||||
dev.write_data(dev.add_mem_header(board, dac, dev.map_frames(f)))
|
||||
elif args.bit:
|
||||
map = [0] * dev.num_frames
|
||||
t = np.arange(2*16) * 1.
|
||||
v = [-1, 0, -1]
|
||||
for i in range(15):
|
||||
vi = 1<<i
|
||||
v.extend([vi - 1, vi])
|
||||
v = np.array(v)*dev.max_out/(1<<15)
|
||||
t, v = t[:3], v[:3]
|
||||
#print(t, v)
|
||||
for channel in range(dev.num_channels):
|
||||
dev.write_data(dev.multi_frame([(t, v)], channel=channel,
|
||||
order=0, map=map, shift=15, stop=False, trigger=False))
|
||||
else:
|
||||
tv = [(times, voltages)]
|
||||
map = [None] * dev.num_frames
|
||||
map[args.frame] = 0
|
||||
dev.write_data(dev.multi_frame(tv, channel=args.channel,
|
||||
order=args.order, map=map))
|
||||
|
||||
dev.write_cmd("START_EN")
|
||||
if not args.disarm:
|
||||
dev.write_cmd("ARM_EN")
|
||||
if args.free:
|
||||
dev.write_cmd("TRIGGER_EN")
|
||||
dev.close()
|
||||
|
||||
if args.plot:
|
||||
from matplotlib import pyplot as plt
|
||||
fig, ax0 = plt.subplots()
|
||||
ax0.plot(times, voltages, "xk", label="points")
|
||||
if args.order:
|
||||
spline = interpolate.splrep(times, voltages, k=args.order)
|
||||
ttimes = np.arange(0, times[-1], 1/dev.freq)
|
||||
vvoltages = interpolate.splev(ttimes, spline)
|
||||
ax0.plot(ttimes, vvoltages, ",b", label="interpolation")
|
||||
fig.savefig(args.plot)
|
||||
|
||||
|
||||
if __name__ == "__main__":
|
||||
_main()
|
Loading…
Reference in New Issue