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 "protocol.h"
  27
  28 /**
  29  * Send command with parameter.
  30  *
  31  * @param[in] cmd Command
  32  * @param[in] param Parameter (0..999, depending on command).
  33  *
  34  * @retval SR_OK Success.
  35  * @retval SR_ERR_ARG Invalid argument.
  36  * @retval SR_ERR Error.
  37  */
  38 SR_PRIV int send_msg1(const struct sr_dev_inst *sdi, char cmd, int param)
  39 {
  40         struct sr_serial_dev_inst *serial;
  41         char buf[5];
  42
  43         if (!sdi || !(serial = sdi->conn))
  44                 return SR_ERR_ARG;
  45
  46         snprintf(buf, sizeof(buf), "%c%03d", cmd, param);
  47         buf[4] = '\r';
  48
  49         sr_spew("send_msg1(): %c%c%c%c\\r", buf[0], buf[1], buf[2], buf[3]);
  50
  51         if (serial_write(serial, buf, sizeof(buf)) == -1) {
  52                 sr_err("Write error for cmd=%c: %d %s", cmd, errno, strerror(errno));
  53                 return SR_ERR;
  54         }
  55
  56         /*
  57          * Wait 50ms to ensure that the device does not swallow any of the
  58          * following commands.
  59          */
  60         g_usleep(50000);
  61
  62         return SR_OK;
  63 }