src/hardware/conrad-digi-35-cpu/protocol.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2014 Matthias Heidbrink <m-sigrok@heidbrink.biz>
   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 /**
  21  * @file
  22  * <em>Conrad DIGI 35 CPU</em> power supply driver
  23  * @internal
  24  */
  25
  26 #include <config.h>
  27 #include "protocol.h"
  28
  29 /**
  30  * Send command with parameter.
  31  *
  32  * @param[in] cmd Command
  33  * @param[in] param Parameter (0..999, depending on command).
  34  *
  35  * @retval SR_OK Success.
  36  * @retval SR_ERR_ARG Invalid argument.
  37  * @retval SR_ERR Error.
  38  */
  39 SR_PRIV int send_msg1(const struct sr_dev_inst *sdi, char cmd, int param)
  40 {
  41         struct sr_serial_dev_inst *serial;
  42         char buf[5];
  43
  44         if (!sdi || !(serial = sdi->conn))
  45                 return SR_ERR_ARG;
  46
  47         snprintf(buf, sizeof(buf), "%c%03d", cmd, param);
  48         buf[4] = '\r';
  49
  50         sr_spew("send_msg1(): %c%c%c%c\\r", buf[0], buf[1], buf[2], buf[3]);
  51
  52         if (serial_write_blocking(serial, buf, sizeof(buf),
  53                         serial_timeout(serial, sizeof(buf))) < (int)sizeof(buf)) {
  54                 sr_err("Write error for cmd=%c", cmd);
  55                 return SR_ERR;
  56         }
  57
  58         /*
  59          * Wait 50ms to ensure that the device does not swallow any of the
  60          * following commands.
  61          */
  62         g_usleep(50 * 1000);
  63
  64         return SR_OK;
  65 }