drivers/net/wireless/ath/wil6210/wil_crash_dump.c

   1 /*
   2  * Copyright (c) 2015 Qualcomm Atheros, Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include "wil6210.h"
  18 #include <linux/devcoredump.h>
  19
  20 static int wil_fw_get_crash_dump_bounds(struct wil6210_priv *wil,
  21                                         u32 *out_dump_size, u32 *out_host_min)
  22 {
  23         int i;
  24         const struct fw_map *map;
  25         u32 host_min, host_max, tmp_max;
  26
  27         if (!out_dump_size)
  28                 return -EINVAL;
  29
  30         /* calculate the total size of the unpacked crash dump */
  31         BUILD_BUG_ON(ARRAY_SIZE(fw_mapping) == 0);
  32         map = &fw_mapping[0];
  33         host_min = map->host;
  34         host_max = map->host + (map->to - map->from);
  35
  36         for (i = 1; i < ARRAY_SIZE(fw_mapping); i++) {
  37                 map = &fw_mapping[i];
  38
  39                 if (map->host < host_min)
  40                         host_min = map->host;
  41
  42                 tmp_max = map->host + (map->to - map->from);
  43                 if (tmp_max > host_max)
  44                         host_max = tmp_max;
  45         }
  46
  47         *out_dump_size = host_max - host_min;
  48         if (out_host_min)
  49                 *out_host_min = host_min;
  50
  51         return 0;
  52 }
  53
  54 static int wil_fw_copy_crash_dump(struct wil6210_priv *wil, void *dest,
  55                                   u32 size)
  56 {
  57         int i;
  58         const struct fw_map *map;
  59         void *data;
  60         u32 host_min, dump_size, offset, len;
  61
  62         if (wil_fw_get_crash_dump_bounds(wil, &dump_size, &host_min)) {
  63                 wil_err(wil, "%s: fail to obtain crash dump size\n", __func__);
  64                 return -EINVAL;
  65         }
  66
  67         if (dump_size > size) {
  68                 wil_err(wil, "%s: not enough space for dump. Need %d have %d\n",
  69                         __func__, dump_size, size);
  70                 return -EINVAL;
  71         }
  72
  73         /* copy to crash dump area */
  74         for (i = 0; i < ARRAY_SIZE(fw_mapping); i++) {
  75                 map = &fw_mapping[i];
  76
  77                 data = (void * __force)wil->csr + HOSTADDR(map->host);
  78                 len = map->to - map->from;
  79                 offset = map->host - host_min;
  80
  81                 wil_dbg_misc(wil, "%s() - dump %s, size %d, offset %d\n",
  82                              __func__, fw_mapping[i].name, len, offset);
  83
  84                 wil_memcpy_fromio_32((void * __force)(dest + offset),
  85                                      (const void __iomem * __force)data, len);
  86         }
  87
  88         return 0;
  89 }
  90
  91 void wil_fw_core_dump(struct wil6210_priv *wil)
  92 {
  93         void *fw_dump_data;
  94         u32 fw_dump_size;
  95
  96         if (wil_fw_get_crash_dump_bounds(wil, &fw_dump_size, NULL)) {
  97                 wil_err(wil, "%s: fail to get fw dump size\n", __func__);
  98                 return;
  99         }
 100
 101         fw_dump_data = vzalloc(fw_dump_size);
 102         if (!fw_dump_data)
 103                 return;
 104
 105         if (wil_fw_copy_crash_dump(wil, fw_dump_data, fw_dump_size)) {
 106                 vfree(fw_dump_data);
 107                 return;
 108         }
 109         /* fw_dump_data will be free in device coredump release function
 110          * after 5 min
 111          */
 112         dev_coredumpv(wil_to_dev(wil), fw_dump_data, fw_dump_size, GFP_KERNEL);
 113         wil_info(wil, "%s: fw core dumped, size %d bytes\n", __func__,
 114                  fw_dump_size);
 115 }