2
0

602-01-wifi-rt2x00-Add-support-for-loading-EEPROM-from-user.patch 6.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225
  1. From 1046fc9e98936991aeb0b0656c84833d96a63c0f Mon Sep 17 00:00:00 2001
  2. From: Christian Marangi <[email protected]>
  3. Date: Sun, 15 Oct 2023 14:22:49 +0200
  4. Subject: [PATCH 1/5] wifi: rt2x00: Add support for loading EEPROM from
  5. userspace
  6. Add support for loading EEPROM from userspace.
  7. Signed-off-by: Christian Marangi <[email protected]>
  8. ---
  9. drivers/net/wireless/ralink/rt2x00/Kconfig | 5 ++
  10. drivers/net/wireless/ralink/rt2x00/Makefile | 1 +
  11. .../net/wireless/ralink/rt2x00/rt2800soc.c | 15 +---
  12. drivers/net/wireless/ralink/rt2x00/rt2x00.h | 1 +
  13. .../net/wireless/ralink/rt2x00/rt2x00dev.c | 9 +++
  14. .../net/wireless/ralink/rt2x00/rt2x00eeprom.c | 75 +++++++++++++++++++
  15. .../net/wireless/ralink/rt2x00/rt2800soc.c | 1 +
  16. .../net/wireless/ralink/rt2x00/rt2800soc.h | 9 +++
  17. 8 files changed, 102 insertions(+), 14 deletions(-)
  18. create mode 100644 drivers/net/wireless/ralink/rt2x00/rt2x00eeprom.c
  19. --- a/local-symbols
  20. +++ b/local-symbols
  21. @@ -336,6 +336,7 @@ RT2X00_LIB_FIRMWARE=
  22. RT2X00_LIB_CRYPTO=
  23. RT2X00_LIB_LEDS=
  24. RT2X00_LIB_DEBUGFS=
  25. +RT2X00_LIB_EEPROM=
  26. RT2X00_DEBUG=
  27. WLAN_VENDOR_REALTEK=
  28. RTL8180=
  29. --- a/drivers/net/wireless/ralink/rt2x00/Kconfig
  30. +++ b/drivers/net/wireless/ralink/rt2x00/Kconfig
  31. @@ -70,6 +70,7 @@ config RT2800PCI
  32. select RT2X00_LIB_MMIO
  33. select RT2X00_LIB_PCI
  34. select RT2X00_LIB_FIRMWARE
  35. + select RT2X00_LIB_EEPROM
  36. select RT2X00_LIB_CRYPTO
  37. depends on EEPROM_93CX6
  38. help
  39. @@ -213,6 +214,7 @@ config RT2800SOC
  40. select RT2X00_LIB_MMIO
  41. select RT2X00_LIB_CRYPTO
  42. select RT2X00_LIB_FIRMWARE
  43. + select RT2X00_LIB_EEPROM
  44. select RT2800_LIB
  45. select RT2800_LIB_MMIO
  46. help
  47. @@ -259,6 +261,9 @@ config RT2X00_LIB_FIRMWARE
  48. config RT2X00_LIB_CRYPTO
  49. bool
  50. +config RT2X00_LIB_EEPROM
  51. + bool
  52. +
  53. config RT2X00_LIB_LEDS
  54. bool
  55. default y if (RT2X00_LIB=y && LEDS_CLASS=y) || (RT2X00_LIB=m && LEDS_CLASS!=n)
  56. --- a/drivers/net/wireless/ralink/rt2x00/Makefile
  57. +++ b/drivers/net/wireless/ralink/rt2x00/Makefile
  58. @@ -8,6 +8,7 @@ rt2x00lib-$(CPTCFG_RT2X00_LIB_DEBUGFS) +
  59. rt2x00lib-$(CPTCFG_RT2X00_LIB_CRYPTO) += rt2x00crypto.o
  60. rt2x00lib-$(CPTCFG_RT2X00_LIB_FIRMWARE) += rt2x00firmware.o
  61. rt2x00lib-$(CPTCFG_RT2X00_LIB_LEDS) += rt2x00leds.o
  62. +rt2x00lib-$(CPTCFG_RT2X00_LIB_EEPROM) += rt2x00eeprom.o
  63. obj-$(CPTCFG_RT2X00_LIB) += rt2x00lib.o
  64. obj-$(CPTCFG_RT2X00_LIB_MMIO) += rt2x00mmio.o
  65. --- a/drivers/net/wireless/ralink/rt2x00/rt2800soc.c
  66. +++ b/drivers/net/wireless/ralink/rt2x00/rt2800soc.c
  67. @@ -90,19 +90,6 @@ static int rt2800soc_set_device_state(st
  68. return retval;
  69. }
  70. -static int rt2800soc_read_eeprom(struct rt2x00_dev *rt2x00dev)
  71. -{
  72. - void __iomem *base_addr = ioremap(0x1F040000, EEPROM_SIZE);
  73. -
  74. - if (!base_addr)
  75. - return -ENOMEM;
  76. -
  77. - memcpy_fromio(rt2x00dev->eeprom, base_addr, EEPROM_SIZE);
  78. -
  79. - iounmap(base_addr);
  80. - return 0;
  81. -}
  82. -
  83. /* Firmware functions */
  84. static char *rt2800soc_get_firmware_name(struct rt2x00_dev *rt2x00dev)
  85. {
  86. @@ -190,7 +177,7 @@ static const struct rt2800_ops rt2800soc
  87. .register_multiread = rt2x00mmio_register_multiread,
  88. .register_multiwrite = rt2x00mmio_register_multiwrite,
  89. .regbusy_read = rt2x00mmio_regbusy_read,
  90. - .read_eeprom = rt2800soc_read_eeprom,
  91. + .read_eeprom = rt2x00lib_read_eeprom,
  92. .hwcrypt_disabled = rt2800soc_hwcrypt_disabled,
  93. .drv_write_firmware = rt2800soc_write_firmware,
  94. .drv_init_registers = rt2800mmio_init_registers,
  95. @@ -304,6 +291,7 @@ static int rt2x00soc_probe(struct platfo
  96. rt2x00dev->name = pdev->dev.driver->name;
  97. rt2x00dev->csr.base = mem;
  98. + set_bit(REQUIRE_EEPROM_FILE, &rt2x00dev->cap_flags);
  99. rt2x00_set_chip_intf(rt2x00dev, RT2X00_CHIP_INTF_SOC);
  100. retval = rt2x00lib_probe_dev(rt2x00dev);
  101. --- a/drivers/net/wireless/ralink/rt2x00/rt2x00.h
  102. +++ b/drivers/net/wireless/ralink/rt2x00/rt2x00.h
  103. @@ -692,6 +692,7 @@ enum rt2x00_capability_flags {
  104. REQUIRE_HT_TX_DESC,
  105. REQUIRE_PS_AUTOWAKE,
  106. REQUIRE_DELAYED_RFKILL,
  107. + REQUIRE_EEPROM_FILE,
  108. /*
  109. * Capabilities
  110. @@ -1506,4 +1507,13 @@ void rt2x00lib_remove_dev(struct rt2x00_
  111. int rt2x00lib_suspend(struct rt2x00_dev *rt2x00dev);
  112. int rt2x00lib_resume(struct rt2x00_dev *rt2x00dev);
  113. +/*
  114. + * EEPROM file handlers.
  115. + */
  116. +#ifdef CPTCFG_RT2X00_LIB_EEPROM
  117. +int rt2x00lib_read_eeprom(struct rt2x00_dev *rt2x00dev);
  118. +#else
  119. +#define rt2x00lib_read_eeprom NULL
  120. +#endif /* CPTCFG_RT2X00_LIB_EEPROM */
  121. +
  122. #endif /* RT2X00_H */
  123. --- /dev/null
  124. +++ b/drivers/net/wireless/ralink/rt2x00/rt2x00eeprom.c
  125. @@ -0,0 +1,78 @@
  126. +// SPDX-License-Identifier: GPL-2.0-or-later
  127. +/* Copyright (C) 2004 - 2009 Ivo van Doorn <[email protected]>
  128. + * Copyright (C) 2004 - 2009 Gertjan van Wingerde <[email protected]>
  129. + * <http://rt2x00.serialmonkey.com>
  130. + */
  131. +
  132. +/* Module: rt2x00lib
  133. + * Abstract: rt2x00 eeprom file loading routines.
  134. + */
  135. +
  136. +#include <linux/kernel.h>
  137. +#include <linux/module.h>
  138. +#include <linux/of.h>
  139. +
  140. +#include "rt2x00.h"
  141. +
  142. +static const char *
  143. +rt2x00lib_get_eeprom_file_name(struct rt2x00_dev *rt2x00dev)
  144. +{
  145. + struct device_node *np = rt2x00dev->dev->of_node;
  146. + const char *eep;
  147. +
  148. + if (np && !of_property_read_string(np, "ralink,eeprom", &eep))
  149. + return eep;
  150. +
  151. + return NULL;
  152. +}
  153. +
  154. +static int rt2x00lib_read_eeprom_file(struct rt2x00_dev *rt2x00dev)
  155. +{
  156. + const struct firmware *ee;
  157. + const char *ee_name;
  158. + int retval;
  159. +
  160. + ee_name = rt2x00lib_get_eeprom_file_name(rt2x00dev);
  161. + if (!ee_name && test_bit(REQUIRE_EEPROM_FILE, &rt2x00dev->cap_flags)) {
  162. + rt2x00_err(rt2x00dev, "Required EEPROM name is missing.");
  163. + return -EINVAL;
  164. + }
  165. +
  166. + if (!ee_name)
  167. + return -ENOENT;
  168. +
  169. + rt2x00_info(rt2x00dev, "Loading EEPROM data from '%s'.\n", ee_name);
  170. +
  171. + retval = request_firmware(&ee, ee_name, rt2x00dev->dev);
  172. + if (retval) {
  173. + rt2x00_err(rt2x00dev, "Failed to request EEPROM.\n");
  174. + return retval;
  175. + }
  176. +
  177. + if (!ee || !ee->size || !ee->data) {
  178. + rt2x00_err(rt2x00dev, "Failed to read EEPROM file.\n");
  179. + retval = -ENOENT;
  180. + goto err_exit;
  181. + }
  182. +
  183. + if (ee->size != rt2x00dev->ops->eeprom_size) {
  184. + rt2x00_err(rt2x00dev,
  185. + "EEPROM file size is invalid, it should be %d bytes\n",
  186. + rt2x00dev->ops->eeprom_size);
  187. + retval = -EINVAL;
  188. + goto err_release_ee;
  189. + }
  190. +
  191. + memcpy(rt2x00dev->eeprom, ee->data, rt2x00dev->ops->eeprom_size);
  192. +
  193. +err_release_ee:
  194. + release_firmware(ee);
  195. +err_exit:
  196. + return retval;
  197. +}
  198. +
  199. +int rt2x00lib_read_eeprom(struct rt2x00_dev *rt2x00dev)
  200. +{
  201. + return rt2x00lib_read_eeprom_file(rt2x00dev);
  202. +}
  203. +EXPORT_SYMBOL_GPL(rt2x00lib_read_eeprom);
  204. --- a/drivers/net/wireless/ralink/rt2x00/rt2800pci.c
  205. +++ b/drivers/net/wireless/ralink/rt2x00/rt2800pci.c
  206. @@ -278,6 +278,9 @@ static int rt2800pci_read_eeprom(struct
  207. {
  208. int retval;
  209. + if (!rt2x00lib_read_eeprom(rt2x00dev))
  210. + return 0;
  211. +
  212. if (rt2800pci_efuse_detect(rt2x00dev))
  213. retval = rt2800pci_read_eeprom_efuse(rt2x00dev);
  214. else