|
| 1 | +#!/usr/bin/env python |
| 2 | +import numpy as np |
| 3 | +import serial |
| 4 | +import struct |
| 5 | +import os |
| 6 | +import re |
| 7 | + |
| 8 | +DEFAULT_DEVICE='/dev/cu.usbmodem401' |
| 9 | + |
| 10 | +class CentSDR(): |
| 11 | + def __init__(self, dev = None): |
| 12 | + self.dev = dev or os.getenv('CENTSDR_DEVICE') or DEFAULT_DEVICE |
| 13 | + self.serial = None |
| 14 | + |
| 15 | + def __enter__(self): |
| 16 | + self.open() |
| 17 | + return self |
| 18 | + |
| 19 | + def __exit__(self, exc_type, exc_value, traceback): |
| 20 | + self.close() |
| 21 | + |
| 22 | + def open(self): |
| 23 | + if self.serial is None: |
| 24 | + self.serial = serial.Serial(self.dev) |
| 25 | + |
| 26 | + def close(self): |
| 27 | + if self.serial: |
| 28 | + self.serial.close() |
| 29 | + self.serial = None |
| 30 | + |
| 31 | + def send_command(self, cmd): |
| 32 | + self.open() |
| 33 | + self.serial.write(cmd) |
| 34 | + self.serial.readline() # discard empty line |
| 35 | + |
| 36 | + def set_frequency(self, freq): |
| 37 | + self.send_command("freq %d\r" % freq) |
| 38 | + |
| 39 | + def set_tune(self, freq): |
| 40 | + self.send_command("tune %d\r" % freq) |
| 41 | + |
| 42 | + def set_gain(self, gain): |
| 43 | + self.send_command("gain %d\r" % gain) |
| 44 | + |
| 45 | + def set_volume(self, gain): |
| 46 | + self.send_command("volume %d\r" % gain) |
| 47 | + |
| 48 | + def set_fs(self, fs): |
| 49 | + self.send_command("fs %d\r" % fs) |
| 50 | + |
| 51 | + def set_mode(self, mode): |
| 52 | + self.send_command("mode %s\r" % mode) |
| 53 | + |
| 54 | + def set_channel(self, chan): |
| 55 | + self.send_command("channel %d\r" % chan) |
| 56 | + |
| 57 | + def set_agc(self, agc): |
| 58 | + self.send_command("agc %s\r" % agc) |
| 59 | + |
| 60 | + def fetch_data(self): |
| 61 | + result = '' |
| 62 | + line = '' |
| 63 | + while True: |
| 64 | + c = self.serial.read() |
| 65 | + if c == chr(13): |
| 66 | + next # ignore CR |
| 67 | + line += c |
| 68 | + if c == chr(10): |
| 69 | + result += line |
| 70 | + line = '' |
| 71 | + next |
| 72 | + if line.endswith('ch>'): |
| 73 | + # stop on prompt |
| 74 | + break |
| 75 | + return result |
| 76 | + |
| 77 | + def fetch_array(self, sel): |
| 78 | + def hex16(h): |
| 79 | + return struct.unpack('>h', h.decode('hex'))[0] |
| 80 | + self.send_command("data %d\r" % sel) |
| 81 | + data = self.fetch_data() |
| 82 | + x = [] |
| 83 | + for line in data.split('\n'): |
| 84 | + if line: |
| 85 | + x.extend([hex16(d) for d in line.strip().split(' ')]) |
| 86 | + return np.array(x) |
| 87 | + |
| 88 | + def data(self, sel = 0): |
| 89 | + self.send_command("data %d\r" % sel) |
| 90 | + data = self.fetch_data() |
| 91 | + x = [] |
| 92 | + for line in data.split('\n'): |
| 93 | + if line: |
| 94 | + d = line.strip().split(' ') |
| 95 | + x.append(float(d[0])+float(d[1])*1.j) |
| 96 | + return np.array(x) |
| 97 | + |
| 98 | + def read_power(self): |
| 99 | + self.send_command("power\r") |
| 100 | + resp = self.fetch_data() |
| 101 | + m = re.match(r"power: ([\d.-]+)dBm", resp) |
| 102 | + return float(m.group(1)) |
| 103 | + |
| 104 | + def read_status(self, arg = ''): |
| 105 | + self.send_command("show %s\r" % arg) |
| 106 | + return self.fetch_data() |
| 107 | + |
| 108 | + def flush_data(self): |
| 109 | + self.send_command("\r") |
| 110 | + self.fetch_data() |
| 111 | + |
| 112 | +def run_as_command(): |
| 113 | + from optparse import OptionParser |
| 114 | + parser = OptionParser(usage="%prog [options]") |
| 115 | + parser.add_option("-d", "--dev", dest="device", |
| 116 | + help="device node (default from env var CENTSDR_DEVICE)", metavar="DEV") |
| 117 | + parser.add_option("-F", "--freqeucy", type="int", dest="freq", |
| 118 | + help="set tuning frequency", metavar="FREQ") |
| 119 | + parser.add_option("-G", "--gain", type="int", dest="gain", |
| 120 | + help="gain (0-95)", metavar="GAIN") |
| 121 | + parser.add_option("-V", "--volume", type="string", dest="volume", |
| 122 | + help="set volume", metavar="VOLUME") |
| 123 | + parser.add_option("-A", "--agc", type="string", dest="agc", |
| 124 | + help="set agc", metavar="AGC") |
| 125 | + parser.add_option("-M", "--mode", type="string", dest="mode", |
| 126 | + help="set modulation", metavar="MODE") |
| 127 | + parser.add_option("-C", "--channel", type="string", dest="channel", |
| 128 | + help="set channel", metavar="MODE") |
| 129 | + parser.add_option("-P", "--power", action="store_true", dest="power", |
| 130 | + help="show power") |
| 131 | + parser.add_option("-s", "--show", action="store_true", dest="show", |
| 132 | + help="show current setting") |
| 133 | + parser.add_option("-S", "--show-arg", type='string', dest="showarg", default='', |
| 134 | + help="show specific setting") |
| 135 | + parser.add_option("-p", "--plot", dest="buffer", |
| 136 | + help="plot buffer", metavar="BUFFER") |
| 137 | + parser.add_option("-l", "--loop", action="store_true", dest="loop", default=False, |
| 138 | + help="loop continuously") |
| 139 | + (opt, args) = parser.parse_args() |
| 140 | + sdr = CentSDR(opt.device) |
| 141 | + if opt.freq: |
| 142 | + sdr.set_tune(opt.freq) |
| 143 | + if opt.gain: |
| 144 | + sdr.set_gain(opt.gain) |
| 145 | + if opt.mode: |
| 146 | + sdr.set_mode(opt.mode) |
| 147 | + if opt.volume: |
| 148 | + sdr.set_volume(int(opt.volume)) |
| 149 | + if opt.channel: |
| 150 | + sdr.set_channel(int(opt.channel)) |
| 151 | + if opt.agc: |
| 152 | + sdr.set_agc(opt.agc) |
| 153 | + if opt.show: |
| 154 | + print sdr.read_status(opt.showarg) |
| 155 | + if opt.buffer: |
| 156 | + import pylab as pl |
| 157 | + sdr.flush_data() |
| 158 | + opt.buffer = int(opt.buffer) |
| 159 | + samp = sdr.fetch_array(opt.buffer) |
| 160 | + if opt.buffer == 0: |
| 161 | + samp = np.array(samp[0::2]) + np.array(samp[1::2])*1j |
| 162 | + x = range(len(samp)) |
| 163 | + if opt.loop: |
| 164 | + from signal import signal, SIGINT |
| 165 | + def sigint_handler(signum, frame): |
| 166 | + opt.loop = False |
| 167 | + signal(SIGINT, sigint_handler) |
| 168 | + pl.ion() |
| 169 | + g1 = pl.plot(x, np.real(samp)) |
| 170 | + g2 = pl.plot(x, np.imag(samp)) |
| 171 | + pl.ylim(-10000,10000) |
| 172 | + pl.xlim(0, len(samp)) |
| 173 | + while opt.loop: |
| 174 | + samp = sdr.fetch_array(opt.buffer) |
| 175 | + if opt.buffer == 0: |
| 176 | + samp = np.array(samp[0::2]) + np.array(samp[1::2])*1j |
| 177 | + x = range(len(samp)) |
| 178 | + g1[0].set_data(x, np.real(samp)) |
| 179 | + g2[0].set_data(x, np.imag(samp)) |
| 180 | + pl.draw() |
| 181 | + pl.pause(0.01) |
| 182 | + pl.show() |
| 183 | + exit(0) |
| 184 | + if opt.power: |
| 185 | + print sdr.read_power() |
| 186 | + exit(0) |
| 187 | + |
| 188 | +if __name__ == '__main__': |
| 189 | + run_as_command() |
0 commit comments