hardware/cem-dt-885x/protocol.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2013 Bert Vermeulen <bert@biot.com>
   5  *
   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.
  10  *
  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.
  15  *
  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/>.
  18  */
  19
  20 #include <string.h>
  21 #include "protocol.h"
  22
  23 /* Length of expected payload for each token. */
  24 static int token_payloads[][2] = {
  25         { TOKEN_WEIGHT_TIME_FAST, 0 },
  26         { TOKEN_WEIGHT_TIME_SLOW, 0 },
  27         { TOKEN_HOLD_MAX, 0 },
  28         { TOKEN_HOLD_MIN, 0 },
  29         { TOKEN_TIME, 3 },
  30         { TOKEN_MEAS_RANGE_OVER, 0 },
  31         { TOKEN_MEAS_RANGE_UNDER, 0 },
  32         { TOKEN_STORE_FULL, 0 },
  33         { TOKEN_RECORDING_ON, 0 },
  34         { TOKEN_MEAS_WAS_READOUT, 1 },
  35         { TOKEN_MEAS_WAS_BARGRAPH, 0 },
  36         { TOKEN_MEASUREMENT, 2 },
  37         { TOKEN_HOLD_NONE, 0 },
  38         { TOKEN_BATTERY_LOW, 0 },
  39         { TOKEN_MEAS_RANGE_OK, 0 },
  40         { TOKEN_STORE_OK, 0 },
  41         { TOKEN_RECORDING_OFF, 0 },
  42         { TOKEN_WEIGHT_FREQ_A, 1 },
  43         { TOKEN_WEIGHT_FREQ_C, 1 },
  44         { TOKEN_BATTERY_OK, 0 },
  45         { TOKEN_MEAS_RANGE_30_80, 0 },
  46         { TOKEN_MEAS_RANGE_30_130, 0 },
  47         { TOKEN_MEAS_RANGE_50_100, 0 },
  48         { TOKEN_MEAS_RANGE_80_130, 0 },
  49 };
  50
  51 static int find_token_payload_len(unsigned char c)
  52 {
  53         unsigned int i;
  54
  55         for (i = 0; i < ARRAY_SIZE(token_payloads); i++) {
  56                 if (token_payloads[i][0] == c)
  57                         return token_payloads[i][1];
  58         }
  59
  60         return -1;
  61 }
  62
  63 /* Process measurement or setting (0xa5 command). */
  64 static void process_mset(const struct sr_dev_inst *sdi)
  65 {
  66         struct dev_context *devc;
  67         struct sr_datafeed_packet packet;
  68         struct sr_datafeed_analog analog;
  69         GString *dbg;
  70         float fvalue;
  71         int i;
  72
  73         devc = sdi->priv;
  74         if (sr_log_loglevel_get() >= SR_LOG_SPEW) {
  75                 dbg = g_string_sized_new(128);
  76                 g_string_printf(dbg, "got command 0x%.2x token 0x%.2x",
  77                                 devc->cmd, devc->token);
  78                 if (devc->buf_len) {
  79                         g_string_append_printf(dbg, " payload");
  80                         for (i = 0; i < devc->buf_len; i++)
  81                                 g_string_append_printf(dbg, " %.2x", devc->buf[i]);
  82                 }
  83                 sr_spew("%s", dbg->str);
  84                 g_string_free(dbg, TRUE);
  85         }
  86
  87         switch(devc->token) {
  88         case TOKEN_WEIGHT_TIME_FAST:
  89                 devc->cur_mqflags |= SR_MQFLAG_SPL_TIME_WEIGHT_F;
  90                 devc->cur_mqflags &= ~SR_MQFLAG_SPL_TIME_WEIGHT_S;
  91                 break;
  92         case TOKEN_WEIGHT_TIME_SLOW:
  93                 devc->cur_mqflags |= SR_MQFLAG_SPL_TIME_WEIGHT_S;
  94                 devc->cur_mqflags &= ~SR_MQFLAG_SPL_TIME_WEIGHT_F;
  95                 break;
  96         case TOKEN_WEIGHT_FREQ_A:
  97                 devc->cur_mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_A;
  98                 devc->cur_mqflags &= ~SR_MQFLAG_SPL_FREQ_WEIGHT_C;
  99                 break;
 100         case TOKEN_WEIGHT_FREQ_C:
 101                 devc->cur_mqflags |= SR_MQFLAG_SPL_FREQ_WEIGHT_C;
 102                 devc->cur_mqflags &= ~SR_MQFLAG_SPL_FREQ_WEIGHT_A;
 103                 break;
 104         case TOKEN_HOLD_MAX:
 105                 devc->cur_mqflags |= SR_MQFLAG_HOLD | SR_MQFLAG_MAX;
 106                 devc->cur_mqflags &= ~SR_MQFLAG_MIN;
 107                 break;
 108         case TOKEN_HOLD_MIN:
 109                 devc->cur_mqflags |= SR_MQFLAG_HOLD | SR_MQFLAG_MIN;
 110                 devc->cur_mqflags &= ~SR_MQFLAG_MAX;
 111                 break;
 112         case TOKEN_HOLD_NONE:
 113                 devc->cur_mqflags &= ~(SR_MQFLAG_MAX | SR_MQFLAG_MIN | SR_MQFLAG_HOLD);
 114                 break;
 115         case TOKEN_MEASUREMENT:
 116                 fvalue = ((devc->buf[0] & 0xf0) >> 4) * 100;
 117                 fvalue += (devc->buf[0] & 0x0f) * 10;
 118                 fvalue += ((devc->buf[1] & 0xf0) >> 4);
 119                 fvalue += (devc->buf[1] & 0x0f) / 10.0;
 120                 devc->last_spl = fvalue;
 121                 break;
 122         case TOKEN_MEAS_WAS_READOUT:
 123         case TOKEN_MEAS_WAS_BARGRAPH:
 124                 if (devc->cur_mqflags & (SR_MQFLAG_MAX | SR_MQFLAG_MIN)) {
 125                         if (devc->token == TOKEN_MEAS_WAS_BARGRAPH) {
 126                                 /* The device still sends bargraph measurements even
 127                                  * when in max/min hold mode. Suppress them here, unless
 128                                  * they're readout values. This duplicates the behavior
 129                                  * of the device display exactly. */
 130                                 break;
 131                         }
 132                 }
 133                 memset(&analog, 0, sizeof(struct sr_datafeed_analog));
 134                 analog.mq = SR_MQ_SOUND_PRESSURE_LEVEL;
 135                 analog.mqflags = devc->cur_mqflags;
 136                 analog.unit = SR_UNIT_DECIBEL_SPL;
 137                 analog.probes = sdi->probes;
 138                 analog.num_samples = 1;
 139                 analog.data = &devc->last_spl;
 140                 packet.type = SR_DF_ANALOG;
 141                 packet.payload = &analog;
 142                 sr_session_send(devc->cb_data, &packet);
 143
 144                 devc->num_samples++;
 145                 if (devc->limit_samples && devc->num_samples >= devc->limit_samples)
 146                         sdi->driver->dev_acquisition_stop((struct sr_dev_inst *)sdi,
 147                                         devc->cb_data);
 148                 break;
 149         case TOKEN_TIME:
 150         case TOKEN_STORE_OK:
 151         case TOKEN_STORE_FULL:
 152         case TOKEN_RECORDING_ON:
 153         case TOKEN_RECORDING_OFF:
 154         case TOKEN_BATTERY_OK:
 155         case TOKEN_BATTERY_LOW:
 156         case TOKEN_MEAS_RANGE_OK:
 157         case TOKEN_MEAS_RANGE_OVER:
 158         case TOKEN_MEAS_RANGE_UNDER:
 159         case TOKEN_MEAS_RANGE_30_80:
 160         case TOKEN_MEAS_RANGE_30_130:
 161         case TOKEN_MEAS_RANGE_50_100:
 162         case TOKEN_MEAS_RANGE_80_130:
 163                 /* Not useful, or not expressable in sigrok. */
 164                 break;
 165         }
 166
 167 }
 168
 169 static void process_byte(const struct sr_dev_inst *sdi, const unsigned char c)
 170 {
 171         struct dev_context *devc;
 172         int len;
 173
 174         if (!(devc = sdi->priv))
 175                 return;
 176
 177         if (c == 0xff) {
 178                 /* Device is in hold mode */
 179                 devc->cur_mqflags |= SR_MQFLAG_HOLD;
 180
 181                 /* TODO: send out the last measurement at the same
 182                  * rate as it normally gets sent */
 183
 184                 /* When the device leaves hold mode, it starts from scratch. */
 185                 devc->state = ST_INIT;
 186                 return;
 187         }
 188         devc->cur_mqflags &= ~SR_MQFLAG_HOLD;
 189
 190         if (devc->state == ST_INIT) {
 191                 if (c == 0xa5) {
 192                         devc->cmd = c;
 193                         devc->token = 0x00;
 194                         devc->state = ST_GET_TOKEN;
 195                 } else if (c == 0xbb) {
 196                         devc->cmd = c;
 197                         devc->buf_len = 0;
 198                         devc->state = ST_GET_LOG;
 199                 }
 200         } else if (devc->state == ST_GET_TOKEN) {
 201                 devc->token = c;
 202                 devc->buf_len = 0;
 203                 len = find_token_payload_len(devc->token);
 204                 if (len == -1 || len > 0) {
 205                         devc->buf_len = 0;
 206                         devc->state = ST_GET_DATA;
 207                 } else {
 208                         process_mset(sdi);
 209                         devc->state = ST_INIT;
 210                 }
 211         } else if (devc->state == ST_GET_DATA) {
 212                 len = find_token_payload_len(devc->token);
 213                 if (len == -1) {
 214                         /* We don't know this token. */
 215                         sr_dbg("Unknown 0xa5 token 0x%.2x", devc->token);
 216                         if (c == 0xa5 || c == 0xbb) {
 217                                 /* Looks like a new command however. */
 218                                 process_mset(sdi);
 219                                 devc->state = ST_INIT;
 220                         } else {
 221                                 devc->buf[devc->buf_len++] = c;
 222                                 if (devc->buf_len > BUF_SIZE) {
 223                                         /* Shouldn't happen, ignore. */
 224                                         devc->state = ST_INIT;
 225                                 }
 226                         }
 227                 } else {
 228                         devc->buf[devc->buf_len++] = c;
 229                         if (devc->buf_len == len) {
 230                                 process_mset(sdi);
 231                                 devc->state = ST_INIT;
 232                         } else if (devc->buf_len > BUF_SIZE) {
 233                                 /* Shouldn't happen, ignore. */
 234                                 devc->state = ST_INIT;
 235                         }
 236                 }
 237         } else if (devc->state == ST_GET_LOG) {
 238         }
 239
 240 }
 241
 242 SR_PRIV int cem_dt_885x_receive_data(int fd, int revents, void *cb_data)
 243 {
 244         const struct sr_dev_inst *sdi;
 245         struct sr_serial_dev_inst *serial;
 246         unsigned char c;
 247
 248         (void)fd;
 249
 250         if (!(sdi = cb_data))
 251                 return TRUE;
 252
 253         serial = sdi->conn;
 254         if (revents == G_IO_IN) {
 255                 if (serial_read(serial, &c, 1) != 1)
 256                         return TRUE;
 257                 process_byte(sdi, c);
 258         }
 259
 260         return TRUE;
 261 }