2 * This file is part of the libsigrok project.
4 * Copyright (C) 2013 Aurelien Jacobs <aurel@gnuage.org>
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
33 static gboolean appa_55ii_checksum(const uint8_t *buf)
35 int i, size, checksum;
39 for (i = 0; i < size; i++)
42 return buf[size] == (checksum & 0xFF);
45 SR_PRIV gboolean appa_55ii_packet_valid(const uint8_t *buf)
47 if (buf[0] == 0x55 && buf[1] == 0x55 && buf[3] <= 32
48 && appa_55ii_checksum(buf))
54 static uint64_t appa_55ii_flags(const uint8_t *buf)
59 disp_mode = buf[4 + 13];
61 if ((disp_mode & 0xF0) == 0x20)
62 flags |= SR_MQFLAG_HOLD;
63 if ((disp_mode & 0x0C) == 0x04)
64 flags |= SR_MQFLAG_MAX;
65 if ((disp_mode & 0x0C) == 0x08)
66 flags |= SR_MQFLAG_MIN;
67 if ((disp_mode & 0x0C) == 0x0C)
68 flags |= SR_MQFLAG_AVG;
73 static float appa_55ii_temp(const uint8_t *buf, int ch, int *digits)
79 ptr = buf + 4 + 14 + 3 * ch;
88 return (float)temp / 10;
93 static void appa_55ii_live_data(struct sr_dev_inst *sdi, const uint8_t *buf)
95 struct dev_context *devc;
96 struct sr_datafeed_packet packet;
97 struct sr_datafeed_analog analog;
98 struct sr_analog_encoding encoding;
99 struct sr_analog_meaning meaning;
100 struct sr_analog_spec spec;
101 struct sr_channel *ch;
107 if (devc->data_source != DATA_SOURCE_LIVE)
110 for (i = 0; i < APPA_55II_NUM_CHANNELS; i++) {
111 ch = g_slist_nth_data(sdi->channels, i);
115 value = appa_55ii_temp(buf, i, &digits);
117 sr_analog_init(&analog, &encoding, &meaning, &spec, digits);
118 analog.num_samples = 1;
119 analog.data = &value;
120 analog.meaning->mq = SR_MQ_TEMPERATURE;
121 analog.meaning->unit = SR_UNIT_CELSIUS;
122 analog.meaning->mqflags = appa_55ii_flags(buf);
123 analog.meaning->channels = g_slist_append(NULL, ch);
125 packet.type = SR_DF_ANALOG;
126 packet.payload = &analog;
127 sr_session_send(sdi, &packet);
128 g_slist_free(analog.meaning->channels);
131 sr_sw_limits_update_samples_read(&devc->limits, 1);
134 static void appa_55ii_log_metadata(struct sr_dev_inst *sdi, const uint8_t *buf)
136 struct dev_context *devc;
139 devc->num_log_records = (buf[5] << 8) + buf[4];
142 static void appa_55ii_log_data_parse(struct sr_dev_inst *sdi)
144 struct dev_context *devc;
145 struct sr_datafeed_packet packet;
146 struct sr_datafeed_analog analog;
147 struct sr_analog_encoding encoding;
148 struct sr_analog_meaning meaning;
149 struct sr_analog_spec spec;
150 struct sr_channel *ch;
151 float values[APPA_55II_NUM_CHANNELS], *val_ptr;
159 while (devc->log_buf_len >= 20 && devc->num_log_records > 0) {
160 buf = devc->log_buf + offset;
163 /* FIXME: Timestamp should be sent in the packet. */
164 sr_dbg("Timestamp: %02d:%02d:%02d", buf[2], buf[3], buf[4]);
166 sr_analog_init(&analog, &encoding, &meaning, &spec, 0);
167 analog.num_samples = 1;
168 analog.meaning->mq = SR_MQ_TEMPERATURE;
169 analog.meaning->unit = SR_UNIT_CELSIUS;
170 analog.data = values;
172 for (i = 0; i < APPA_55II_NUM_CHANNELS; i++) {
173 temp = RL16(buf + 12 + 2 * i);
174 ch = g_slist_nth_data(sdi->channels, i);
177 analog.meaning->channels = g_slist_append(analog.meaning->channels, ch);
178 *val_ptr++ = temp == 0x7FFF ? INFINITY : (float)temp / 10;
181 packet.type = SR_DF_ANALOG;
182 packet.payload = &analog;
183 sr_session_send(sdi, &packet);
184 g_slist_free(analog.meaning->channels);
186 sr_sw_limits_update_samples_read(&devc->limits, 1);
187 devc->log_buf_len -= 20;
189 devc->num_log_records--;
192 memmove(devc->log_buf, devc->log_buf + offset, devc->log_buf_len);
195 static void appa_55ii_log_data(struct sr_dev_inst *sdi, const uint8_t *buf)
197 struct dev_context *devc;
203 if (devc->data_source != DATA_SOURCE_MEMORY)
209 s = MIN(size, sizeof(devc->log_buf) - devc->log_buf_len);
210 memcpy(devc->log_buf + devc->log_buf_len, ptr, s);
211 devc->log_buf_len += s;
215 appa_55ii_log_data_parse(sdi);
219 static void appa_55ii_log_end(struct sr_dev_inst *sdi)
221 struct dev_context *devc;
224 if (devc->data_source != DATA_SOURCE_MEMORY)
227 sdi->driver->dev_acquisition_stop(sdi);
230 static const uint8_t *appa_55ii_parse_data(struct sr_dev_inst *sdi,
231 const uint8_t *buf, int len)
234 /* Need more data. */
237 if (buf[0] != 0x55 || buf[1] != 0x55)
238 /* Try to re-synchronize on a packet start. */
241 if (len < 5 + buf[3])
242 /* Need more data. */
245 if (!appa_55ii_checksum(buf))
246 /* Skip broken packet. */
247 return buf + 4 + buf[3] + 1;
249 switch ((packet_type)buf[2]) {
251 appa_55ii_live_data(sdi, buf);
254 appa_55ii_log_metadata(sdi, buf);
257 appa_55ii_log_data(sdi, buf);
262 appa_55ii_log_end(sdi);
265 sr_warn("Invalid packet type: 0x%02x.", buf[2]);
269 return buf + 4 + buf[3] + 1;
272 SR_PRIV int appa_55ii_receive_data(int fd, int revents, void *cb_data)
274 struct sr_dev_inst *sdi;
275 struct dev_context *devc;
276 struct sr_serial_dev_inst *serial;
277 const uint8_t *ptr, *next_ptr, *end_ptr;
282 if (!(sdi = cb_data) || !(devc = sdi->priv) || revents != G_IO_IN)
286 /* Try to get as much data as the buffer can hold. */
287 len = sizeof(devc->buf) - devc->buf_len;
288 len = serial_read_nonblocking(serial, devc->buf + devc->buf_len, len);
290 sr_err("Serial port read error: %d.", len);
293 devc->buf_len += len;
295 /* Now look for packets in that data. */
297 end_ptr = ptr + devc->buf_len;
298 while ((next_ptr = appa_55ii_parse_data(sdi, ptr, end_ptr - ptr)))
301 /* If we have any data left, move it to the beginning of our buffer. */
302 memmove(devc->buf, ptr, end_ptr - ptr);
303 devc->buf_len -= ptr - devc->buf;
305 /* If buffer is full and no valid packet was found, wipe buffer. */
306 if (devc->buf_len >= sizeof(devc->buf)) {
311 if (sr_sw_limits_check(&devc->limits)) {
312 sdi->driver->dev_acquisition_stop(sdi);