static void skip_samples(struct parport *port, uint8_t ctrl, size_t num)
{
while (num--) {
ieee1284_write_control(port, ctrl & ~C1284_NSTROBE);
ieee1284_write_control(port, ctrl);
}
}
SR_PRIV uint8_t hung_chang_dso_2100_read_mbox(struct parport *port, float timeout)
{
GTimer *timer = NULL;
uint8_t val;
ieee1284_write_control(port, C1284_NSTROBE | C1284_NSELECTIN);
ieee1284_write_control(port, C1284_NSELECTIN);
for (;;) {
if (ieee1284_read_data(port)) {
/* Always read the value a second time.
* The first one may be unstable. */
val = ieee1284_read_data(port);
break;
}
if (!timer) {
timer = g_timer_new();
} else if (g_timer_elapsed(timer, NULL) > timeout) {
val = 0;
break;
}
}
ieee1284_write_control(port, C1284_NSTROBE | C1284_NSELECTIN);
ieee1284_write_control(port,
C1284_NSTROBE | C1284_NAUTOFD | C1284_NINIT | C1284_NSELECTIN);
if (timer)
g_timer_destroy(timer);
sr_dbg("mbox == %X", val);
return val;
}
static void read_samples(struct parport *port, uint8_t ctrl, uint8_t *buf, size_t num, size_t stride)
{
while (num--) {
ieee1284_write_control(port, ctrl & ~C1284_NSTROBE);
*buf = ieee1284_read_data(port);
buf += stride;
ieee1284_write_control(port, ctrl);
}
}
SR_PRIV void hung_chang_dso_2100_write_mbox(struct parport *port, uint8_t val)
{
sr_dbg("mbox <= %X", val);
ieee1284_write_control(port,
C1284_NSTROBE | C1284_NINIT | C1284_NSELECTIN);
ieee1284_data_dir(port, 0);
ieee1284_write_data(port, val);
ieee1284_write_control(port, C1284_NINIT | C1284_NSELECTIN);
ieee1284_write_control(port,
C1284_NSTROBE | C1284_NINIT | C1284_NSELECTIN);
ieee1284_data_dir(port, 1);
ieee1284_write_control(port,
C1284_NSTROBE | C1284_NAUTOFD | C1284_NINIT | C1284_NSELECTIN);
}
static int read_subframe(const struct sr_dev_inst *sdi, uint8_t *buf)
{
struct dev_context *devc = sdi->priv;
uint8_t sig[3], ctrl;
unsigned int num;
gboolean interleave;
interleave = readout_steps[devc->step].interleave;
ctrl = C1284_NSTROBE;
if ((interleave && devc->adc2) || (!interleave && devc->channel == 2))
ctrl |= C1284_NAUTOFD;
ieee1284_write_control(sdi->conn, ctrl);
num = readout_steps[devc->step].num;
if (num < 1000)
skip_samples(sdi->conn, ctrl, 1000 - num);
read_samples(sdi->conn, ctrl, buf + (devc->adc2 ? 1 : 0), num,
interleave ? 2 : 1);
read_samples(sdi->conn, ctrl, sig, 3, 1);
if (sig[0] != 0x01 || sig[1] != 0xfe || sig[2] != 0x80) {
if (--devc->retries) {
sr_dbg("Missing signature at end of buffer, %i tries remaining",
devc->retries);
return TRUE;
} else {
sr_err("Failed to read frame without transfer errors");
devc->step = 0;
}
} else {
if (interleave && !devc->adc2) {
devc->adc2 = TRUE;
devc->retries = MAX_RETRIES;
return TRUE;
} else {
if (interleave)
num *= 2;
if (!devc->step) {
struct sr_datafeed_packet packet = {
.type = SR_DF_TRIGGER
};
push_samples(sdi, buf, 6);
sr_session_send(sdi, &packet);
buf += 6;
num -= 6;
}
push_samples(sdi, buf, num);
if (++devc->step > devc->last_step)
devc->step = 0;
}
}
devc->adc2 = FALSE;
devc->retries = MAX_RETRIES;
return devc->step > 0;
}
SR_PRIV gboolean hung_chang_dso_2100_check_id(struct parport *port)
{
gboolean ret = FALSE;
if (ieee1284_data_dir(port, 1) != E1284_OK)
goto fail;
ieee1284_write_control(port, C1284_NSTROBE | C1284_NAUTOFD | C1284_NSELECTIN);
ieee1284_write_control(port, C1284_NAUTOFD | C1284_NSELECTIN);
if (ieee1284_read_data(port) != 0x55)
goto fail;
ret = TRUE;
fail:
hung_chang_dso_2100_reset_port(port);
return ret;
}
/* Send the low nibble of d to the control port.
The mask affects which bits are changed. */
static void outcont(struct parport *port, int d, int mask)
{
static int control_port_status = 0;
control_port_status = (control_port_status & ~mask) | (d & mask);
ieee1284_write_control(port, (control_port_status & 0x0f));
}
SR_PRIV void hung_chang_dso_2100_reset_port(struct parport *port)
{
ieee1284_write_control(port,
C1284_NSTROBE | C1284_NAUTOFD | C1284_NSELECTIN);
ieee1284_data_dir(port, 0);
}
