X-Git-Url: https://sigrok.org/gitweb/?a=blobdiff_plain;f=src%2Fhardware%2Fpipistrello-ols%2Fprotocol.c;h=421934b2318d3bd2cea53927cea4b0150e937610;hb=8256ed15c605db4f472f928dc67e9734947e0ab9;hp=81bbe8e647fe02e09f9b45716e1a0896adcd8c7f;hpb=0af636bed97c174bea46e61e961eaa1b0b162e0f;p=libsigrok.git diff --git a/src/hardware/pipistrello-ols/protocol.c b/src/hardware/pipistrello-ols/protocol.c index 81bbe8e6..421934b2 100644 --- a/src/hardware/pipistrello-ols/protocol.c +++ b/src/hardware/pipistrello-ols/protocol.c @@ -17,11 +17,9 @@ * along with this program. If not, see . */ +#include #include "protocol.h" -extern SR_PRIV struct sr_dev_driver p_ols_driver_info; -static struct sr_dev_driver *di = &p_ols_driver_info; - SR_PRIV int write_shortcommand(struct dev_context *devc, uint8_t command) { uint8_t buf[1]; @@ -219,16 +217,14 @@ SR_PRIV int pols_convert_trigger(const struct sr_dev_inst *sdi) SR_PRIV struct sr_dev_inst *p_ols_get_metadata(uint8_t *buf, int bytes_read, struct dev_context *devc) { struct sr_dev_inst *sdi; - struct sr_channel *ch; uint32_t tmp_int, ui; uint8_t key, type, token; GString *tmp_str, *devname, *version; guchar tmp_c; int index, i; - sdi = sr_dev_inst_new(); + sdi = g_malloc0(sizeof(struct sr_dev_inst)); sdi->status = SR_ST_INACTIVE; - sdi->driver = di; sdi->priv = devc; devname = g_string_new(""); @@ -288,12 +284,9 @@ SR_PRIV struct sr_dev_inst *p_ols_get_metadata(uint8_t *buf, int bytes_read, str switch (token) { case 0x00: /* Number of usable channels */ - for (ui = 0; ui < tmp_int; ui++) { - if (!(ch = sr_channel_new(ui, SR_CHANNEL_LOGIC, TRUE, - p_ols_channel_names[ui]))) - return 0; - sdi->channels = g_slist_append(sdi->channels, ch); - } + for (ui = 0; ui < tmp_int; ui++) + sr_channel_new(sdi, ui, SR_CHANNEL_LOGIC, TRUE, + p_ols_channel_names[ui]); break; case 0x01: /* Amount of sample memory available (bytes) */ @@ -304,7 +297,7 @@ SR_PRIV struct sr_dev_inst *p_ols_get_metadata(uint8_t *buf, int bytes_read, str /* what is this for? */ break; case 0x03: - /* Maximum sample rate (hz) */ + /* Maximum sample rate (Hz) */ devc->max_samplerate = tmp_int; break; case 0x04: @@ -325,12 +318,9 @@ SR_PRIV struct sr_dev_inst *p_ols_get_metadata(uint8_t *buf, int bytes_read, str switch (token) { case 0x00: /* Number of usable channels */ - for (ui = 0; ui < tmp_c; ui++) { - if (!(ch = sr_channel_new(ui, SR_CHANNEL_LOGIC, TRUE, - p_ols_channel_names[ui]))) - return 0; - sdi->channels = g_slist_append(sdi->channels, ch); - } + for (ui = 0; ui < tmp_c; ui++) + sr_channel_new(sdi, ui, SR_CHANNEL_LOGIC, TRUE, + p_ols_channel_names[ui]); break; case 0x01: /* protocol version */ @@ -392,7 +382,6 @@ SR_PRIV int p_ols_set_samplerate(const struct sr_dev_inst *sdi, return SR_OK; } - SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) { struct dev_context *devc; @@ -435,7 +424,7 @@ SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) if (bytes_read < 0) { sr_err("Failed to read FTDI data (%d): %s.", bytes_read, ftdi_get_error_string(devc->ftdic)); - sdi->driver->dev_acquisition_stop(sdi, sdi); + sdi->driver->dev_acquisition_stop(sdi); return FALSE; } if (bytes_read == 0) { @@ -514,7 +503,9 @@ SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) } /* Clear out the most significant bit of the sample */ devc->tmp_sample[devc->num_bytes - 1] &= 0x7f; - sr_spew("Expanded sample 1: 0x%.8x.", devc->tmp_sample); + sr_spew("Expanded sample 1: 0x%.2x%.2x%.2x%.2x.", + devc->tmp_sample[3], devc->tmp_sample[2], + devc->tmp_sample[1], devc->tmp_sample[0]); /* expand second sample */ memset(devc->tmp_sample2, 0, 4); @@ -530,7 +521,9 @@ SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) } /* Clear out the most significant bit of the sample */ devc->tmp_sample2[devc->num_bytes - 1] &= 0x7f; - sr_spew("Expanded sample 2: 0x%.8x.", devc->tmp_sample2); + sr_spew("Expanded sample 2: 0x%.2x%.2x%.2x%.2x.", + devc->tmp_sample2[3], devc->tmp_sample2[2], + devc->tmp_sample2[1], devc->tmp_sample2[0]); /* * OLS sends its sample buffer backwards. @@ -628,8 +621,9 @@ SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) } return TRUE; } else { - do bytes_read = ftdi_read_data(devc->ftdic, devc->ftdi_buf, FTDI_BUF_SIZE); - while (bytes_read > 0); + do { + bytes_read = ftdi_read_data(devc->ftdic, devc->ftdi_buf, FTDI_BUF_SIZE); + } while (bytes_read > 0); /* * We've acquired all the samples we asked for -- we're done. @@ -651,12 +645,12 @@ SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) logic.unitsize = 4; logic.data = devc->raw_sample_buf + (devc->limit_samples - devc->num_samples) * 4; - sr_session_send(cb_data, &packet); + sr_session_send(sdi, &packet); } /* Send the trigger. */ packet.type = SR_DF_TRIGGER; - sr_session_send(cb_data, &packet); + sr_session_send(sdi, &packet); /* Send post-trigger samples. */ packet.type = SR_DF_LOGIC; @@ -665,7 +659,7 @@ SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) logic.unitsize = 4; logic.data = devc->raw_sample_buf + devc->trigger_at * 4 + (devc->limit_samples - devc->num_samples) * 4; - sr_session_send(cb_data, &packet); + sr_session_send(sdi, &packet); } else { /* no trigger was used */ packet.type = SR_DF_LOGIC; @@ -674,11 +668,11 @@ SR_PRIV int p_ols_receive_data(int fd, int revents, void *cb_data) logic.unitsize = 4; logic.data = devc->raw_sample_buf + (devc->limit_samples - devc->num_samples) * 4; - sr_session_send(cb_data, &packet); + sr_session_send(sdi, &packet); } g_free(devc->raw_sample_buf); - sdi->driver->dev_acquisition_stop(sdi, cb_data); + sdi->driver->dev_acquisition_stop(sdi); } return TRUE;