* along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
+#include <config.h>
#include <string.h>
-#include <errno.h>
#include "protocol.h"
-static void dump_packet(char *msg, uint8_t *packet)
+static void dump_packet(const char *msg, uint8_t *packet)
{
int i;
char str[128];
struct dev_context *devc;
struct sr_datafeed_packet packet;
struct sr_datafeed_analog analog;
+ struct sr_analog_encoding encoding;
+ struct sr_analog_meaning meaning;
+ struct sr_analog_spec spec;
float value, data[MAX_CHANNELS];
int offset, i;
devc = sdi->priv;
dump_packet("received", devc->packet);
+
+ /* Note: digits/spec_digits will be overridden later. */
+ sr_analog_init(&analog, &encoding, &meaning, &spec, 0);
+
packet.type = SR_DF_ANALOG;
packet.payload = &analog;
- analog.channels = sdi->channels;
+ analog.meaning->channels = sdi->channels;
analog.num_samples = 1;
- analog.mq = SR_MQ_VOLTAGE;
- analog.unit = SR_UNIT_VOLT;
- analog.mqflags = SR_MQFLAG_DC;
+ analog.meaning->mq = SR_MQ_VOLTAGE;
+ analog.meaning->unit = SR_UNIT_VOLT;
+ analog.meaning->mqflags = SR_MQFLAG_DC;
+ analog.encoding->digits = 2;
+ analog.spec->spec_digits = 2;
analog.data = data;
for (i = 0; i < devc->model->num_channels; i++) {
offset = 2 + i * 4;
value = ((devc->packet[offset] << 8) + devc->packet[offset + 1]) / 100.0;
- analog.data[i] = value;
+ ((float *)analog.data)[i] = value;
devc->config[i].output_voltage_last = value;
}
sr_session_send(sdi, &packet);
- analog.mq = SR_MQ_CURRENT;
- analog.unit = SR_UNIT_AMPERE;
- analog.mqflags = 0;
+ analog.meaning->mq = SR_MQ_CURRENT;
+ analog.meaning->unit = SR_UNIT_AMPERE;
+ analog.meaning->mqflags = 0;
+ analog.encoding->digits = 3;
+ analog.spec->spec_digits = 3;
analog.data = data;
for (i = 0; i < devc->model->num_channels; i++) {
offset = 4 + i * 4;
value = ((devc->packet[offset] << 8) + devc->packet[offset + 1]) / 1000.0;
- analog.data[i] = value;
+ ((float *)analog.data)[i] = value;
devc->config[i].output_current_last = value;
}
sr_session_send(sdi, &packet);
SR_PRIV void send_packet(const struct sr_dev_inst *sdi, uint8_t *packet)
{
+ struct dev_context *devc;
struct sr_serial_dev_inst *serial;
+ devc = sdi->priv;
serial = sdi->conn;
- if (serial_write_blocking(serial, packet, PACKET_SIZE) == -1)
- sr_dbg("Failed to send packet: %s", strerror(errno));
+ if (serial_write_blocking(serial, packet, PACKET_SIZE, devc->delay_ms) < PACKET_SIZE)
+ sr_dbg("Failed to send packet.");
dump_packet("sent", packet);
}
struct dev_context *devc;
const struct sr_dev_inst *sdi;
struct sr_serial_dev_inst *serial;
- struct sr_datafeed_packet packet;
unsigned char c;
(void)fd;
send_config(sdi);
else {
serial_source_remove(sdi->session, serial);
- packet.type = SR_DF_END;
- sr_session_send(sdi, &packet);
+ std_session_send_df_end(sdi);
}
}
}
return TRUE;
}
-