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