tools/carlu/src/cmd.c

   1 /*
   2  * carl9170user - userspace testing utility for ar9170 devices
   3  *
   4  * Abstraction Layer for FW/HW command interface
   5  *
   6  * Copyright 2009, 2010 Christian Lamparter <chunkeey@googlemail.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License along
  19  * with this program; if not, write to the Free Software Foundation, Inc.,
  20  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  21  */
  22
  23 #ifdef HAVE_CONFIG_H
  24 #include <config.h>
  25 #endif
  26
  27 #include <stdio.h>
  28 #include <stdbool.h>
  29 #include <stdlib.h>
  30 #include <errno.h>
  31 #include <string.h>
  32 #include <stdlib.h>
  33 #include "libusb.h"
  34 #include <sys/types.h>
  35 #include <sys/stat.h>
  36 #include <unistd.h>
  37
  38 #include "carlu.h"
  39 #include "usb.h"
  40 #include "debug.h"
  41 #include "fwcmd.h"
  42 #include "eeprom.h"
  43
  44 int carlu_cmd_echo(struct carlu *ar, const uint32_t message)
  45 {
  46         uint32_t _message;
  47         int ret;
  48
  49         ret = carlusb_cmd(ar, CARL9170_CMD_ECHO,
  50                              (uint8_t *)&message, sizeof(message),
  51                              (uint8_t *)&_message, sizeof(_message));
  52
  53         if (ret == 0)
  54                 ret = (message == _message) ? 0 : -EIO;
  55
  56         return ret;
  57 }
  58
  59 struct carl9170_cmd *carlu_cmd_buf(struct carlu *ar,
  60         const enum carl9170_cmd_oids cmd, const unsigned int len)
  61 {
  62         struct carl9170_cmd *tmp;
  63
  64         if (len % 4 || (sizeof(struct carl9170_cmd_head) + len > 64))
  65                 return ERR_PTR(-EINVAL);
  66
  67         tmp = malloc(sizeof(struct carl9170_cmd_head) + len);
  68         if (tmp) {
  69                 tmp->hdr.cmd = cmd;
  70                 tmp->hdr.len = len;
  71         }
  72         return tmp;
  73 }
  74
  75 int carlu_cmd_reboot(struct carlu *ar)
  76 {
  77         struct carl9170_cmd *reboot;
  78         int err;
  79
  80         /* sure, we could put the struct on the stack too. */
  81         reboot = carlu_cmd_buf(ar, CARL9170_CMD_REBOOT_ASYNC, 0);
  82         if (IS_ERR_OR_NULL(reboot))
  83                 return reboot ? PTR_ERR(reboot) : -ENOMEM;
  84
  85         err = carlusb_cmd_async(ar, reboot, true);
  86         return err;
  87 }
  88
  89 int carlu_cmd_mem_dump(struct carlu *ar, const uint32_t start,
  90                         const unsigned int len, void *_buf)
  91 {
  92 #define RW      8       /* number of words to read at once */
  93 #define RB      (sizeof(uint32_t) * RW)
  94         uint8_t *buf = _buf;
  95         unsigned int i, j, block;
  96         int err;
  97         __le32 offsets[RW];
  98
  99         for (i = 0; i < (len + RB - 1) / RB; i++) {
 100                 block = min_t(unsigned int, (len - RB * i) / sizeof(uint32_t), RW);
 101                 for (j = 0; j < block; j++)
 102                         offsets[j] = cpu_to_le32(start + RB * i + 4 * j);
 103
 104                 err = carlusb_cmd(ar, CARL9170_CMD_RREG,
 105                                     (void *) &offsets, block * sizeof(uint32_t),
 106                                     (void *) buf + RB * i, RB);
 107
 108                 if (err)
 109                         return err;
 110         }
 111
 112 #undef RW
 113 #undef RB
 114
 115         return 0;
 116 }
 117
 118 int carlu_cmd_write_mem(struct carlu *ar, const uint32_t addr,
 119                         const uint32_t val)
 120 {
 121         int err;
 122         __le32 msg, block[2] = { addr, val };
 123
 124         err = carlusb_cmd(ar, CARL9170_CMD_WREG,
 125                           (void *) &block, sizeof(block),
 126                           (void *) &msg, sizeof(msg));
 127         return err;
 128 }
 129
 130 int carlu_cmd_read_eeprom(struct carlu *ar)
 131 {
 132
 133         int err;
 134
 135         err = carlu_cmd_mem_dump(ar, AR9170_EEPROM_START, sizeof(ar->eeprom),
 136                                   &ar->eeprom);
 137
 138 #ifndef __CHECKER__
 139         /* don't want to handle trailing remains */
 140         BUILD_BUG_ON(sizeof(ar->eeprom) % 8);
 141 #endif
 142
 143         if (ar->eeprom.length == cpu_to_le16(0xffff))
 144                 return -ENODATA;
 145
 146         return 0;
 147 }