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 int carlu_cmd_reboot(struct carlu *ar)
  60 {
  61         int err;
  62
  63         err = carlusb_cmd(ar, CARL9170_CMD_REBOOT,
  64                           NULL, 0, NULL, 0);
  65
  66         if (err == -ETIMEDOUT)
  67                 return 0;
  68
  69         return err ? err : -1;
  70 }
  71
  72 int carlu_cmd_mem_dump(struct carlu *ar, const uint32_t start,
  73                         const unsigned int len, void *_buf)
  74 {
  75 #define RW      8       /* number of words to read at once */
  76 #define RB      (sizeof(uint32_t) * RW)
  77         uint8_t *buf = _buf;
  78         unsigned int i, j, block;
  79         int err;
  80         __le32 offsets[RW];
  81
  82         for (i = 0; i < (len + RB - 1) / RB; i++) {
  83                 block = min_t(unsigned int, (len - RB * i) / sizeof(uint32_t), RW);
  84                 for (j = 0; j < block; j++)
  85                         offsets[j] = cpu_to_le32(start + RB * i + 4 * j);
  86
  87                 err = carlusb_cmd(ar, CARL9170_CMD_RREG,
  88                                     (void *) &offsets, block * sizeof(uint32_t),
  89                                     (void *) buf + RB * i, RB);
  90
  91                 if (err)
  92                         return err;
  93         }
  94
  95 #undef RW
  96 #undef RB
  97
  98         return 0;
  99 }
 100
 101 int carlu_cmd_write_mem(struct carlu *ar, const uint32_t addr,
 102                         const uint32_t val)
 103 {
 104         int err;
 105         __le32 msg, block[2] = { addr, val };
 106
 107         err = carlusb_cmd(ar, CARL9170_CMD_WREG,
 108                           (void *) &block, sizeof(block),
 109                           (void *) &msg, sizeof(msg));
 110         return err;
 111 }
 112
 113 int carlu_cmd_read_eeprom(struct carlu *ar)
 114 {
 115
 116         int err;
 117
 118         err = carlu_cmd_mem_dump(ar, AR9170_EEPROM_START, sizeof(ar->eeprom),
 119                                   &ar->eeprom);
 120
 121 #ifndef __CHECKER__
 122         /* don't want to handle trailing remains */
 123         BUILD_BUG_ON(sizeof(ar->eeprom) % 8);
 124 #endif
 125
 126         if (ar->eeprom.length == cpu_to_le16(0xffff))
 127                 return -ENODATA;
 128
 129         return 0;
 130 }