706-net-dsa-qca8k-add-IPQ4019-built-in-switch-support.patch 33 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132
  1. From a38126870488398932e017dd9d76174b4aadbbbb Mon Sep 17 00:00:00 2001
  2. From: Robert Marko <[email protected]>
  3. Date: Sat, 10 Sep 2022 15:46:09 +0200
  4. Subject: [PATCH] net: dsa: qca8k: add IPQ4019 built-in switch support
  5. Qualcomm IPQ40xx SoC-s have a variant of QCA8337N switch built-in.
  6. It shares most of the stuff with its external counterpart, however it is
  7. modified for the SoC.
  8. Namely, it doesn't have second CPU port (Port 6), so it has 6 ports
  9. instead of 7.
  10. It also has no built-in PHY-s but rather requires external PSGMII based
  11. companion PHY-s (QCA8072 and QCA8075) for which it first needs to carry
  12. out calibration before using them.
  13. PSGMII has a SoC built-in PHY that is used to connect to the PHY-s which
  14. unfortunately requires some magic values as the datasheet doesnt document
  15. the bits that are being set or the register at all.
  16. Since its built-in it is MMIO like other peripherals and doesn't have its
  17. own MDIO bus but depends on the SoC provided one.
  18. CPU connection is at Port 0 and it uses some kind of a internal connection
  19. and no traditional RGMII/SGMII.
  20. It also doesn't use in-band tagging like other qca8k switches so a out of
  21. band based tagger is used.
  22. Signed-off-by: Robert Marko <[email protected]>
  23. ---
  24. drivers/net/dsa/qca/Kconfig | 8 +
  25. drivers/net/dsa/qca/Makefile | 1 +
  26. drivers/net/dsa/qca/qca8k-common.c | 6 +-
  27. drivers/net/dsa/qca/qca8k-ipq4019.c | 948 ++++++++++++++++++++++++++++
  28. drivers/net/dsa/qca/qca8k.h | 56 ++
  29. 5 files changed, 1016 insertions(+), 3 deletions(-)
  30. create mode 100644 drivers/net/dsa/qca/qca8k-ipq4019.c
  31. --- a/drivers/net/dsa/qca/Kconfig
  32. +++ b/drivers/net/dsa/qca/Kconfig
  33. @@ -23,3 +23,11 @@ config NET_DSA_QCA8K_LEDS_SUPPORT
  34. help
  35. This enabled support for LEDs present on the Qualcomm Atheros
  36. QCA8K Ethernet switch chips.
  37. +
  38. +config NET_DSA_QCA8K_IPQ4019
  39. + tristate "Qualcomm Atheros IPQ4019 Ethernet switch support"
  40. + select NET_DSA_TAG_OOB
  41. + select REGMAP_MMIO
  42. + help
  43. + This enables support for the switch built-into Qualcomm Atheros
  44. + IPQ4019 SoCs.
  45. --- a/drivers/net/dsa/qca/Makefile
  46. +++ b/drivers/net/dsa/qca/Makefile
  47. @@ -5,3 +5,4 @@ qca8k-y += qca8k-common.o qca8k-8xxx.
  48. ifdef CONFIG_NET_DSA_QCA8K_LEDS_SUPPORT
  49. qca8k-y += qca8k-leds.o
  50. endif
  51. +obj-$(CONFIG_NET_DSA_QCA8K_IPQ4019) += qca8k-ipq4019.o qca8k-common.o
  52. --- a/drivers/net/dsa/qca/qca8k-common.c
  53. +++ b/drivers/net/dsa/qca/qca8k-common.c
  54. @@ -412,7 +412,7 @@ static int qca8k_vlan_del(struct qca8k_p
  55. /* Check if we're the last member to be removed */
  56. del = true;
  57. - for (i = 0; i < QCA8K_NUM_PORTS; i++) {
  58. + for (i = 0; i < priv->ds->num_ports; i++) {
  59. mask = QCA8K_VTU_FUNC0_EG_MODE_PORT_NOT(i);
  60. if ((reg & mask) != mask) {
  61. @@ -653,7 +653,7 @@ int qca8k_port_bridge_join(struct dsa_sw
  62. cpu_port = dsa_to_port(ds, port)->cpu_dp->index;
  63. port_mask = BIT(cpu_port);
  64. - for (i = 0; i < QCA8K_NUM_PORTS; i++) {
  65. + for (i = 0; i < ds->num_ports; i++) {
  66. if (dsa_is_cpu_port(ds, i))
  67. continue;
  68. if (!dsa_port_offloads_bridge(dsa_to_port(ds, i), &bridge))
  69. @@ -685,7 +685,7 @@ void qca8k_port_bridge_leave(struct dsa_
  70. cpu_port = dsa_to_port(ds, port)->cpu_dp->index;
  71. - for (i = 0; i < QCA8K_NUM_PORTS; i++) {
  72. + for (i = 0; i < ds->num_ports; i++) {
  73. if (dsa_is_cpu_port(ds, i))
  74. continue;
  75. if (!dsa_port_offloads_bridge(dsa_to_port(ds, i), &bridge))
  76. --- /dev/null
  77. +++ b/drivers/net/dsa/qca/qca8k-ipq4019.c
  78. @@ -0,0 +1,948 @@
  79. +// SPDX-License-Identifier: GPL-2.0
  80. +/*
  81. + * Copyright (C) 2009 Felix Fietkau <[email protected]>
  82. + * Copyright (C) 2011-2012, 2020-2021 Gabor Juhos <[email protected]>
  83. + * Copyright (c) 2015, 2019, The Linux Foundation. All rights reserved.
  84. + * Copyright (c) 2016 John Crispin <[email protected]>
  85. + * Copyright (c) 2022 Robert Marko <[email protected]>
  86. + */
  87. +
  88. +#include <linux/module.h>
  89. +#include <linux/phy.h>
  90. +#include <linux/netdevice.h>
  91. +#include <linux/bitfield.h>
  92. +#include <linux/regmap.h>
  93. +#include <net/dsa.h>
  94. +#include <linux/of_net.h>
  95. +#include <linux/of_mdio.h>
  96. +#include <linux/of_platform.h>
  97. +#include <linux/mdio.h>
  98. +#include <linux/phylink.h>
  99. +
  100. +#include "qca8k.h"
  101. +
  102. +static struct regmap_config qca8k_ipq4019_regmap_config = {
  103. + .reg_bits = 32,
  104. + .val_bits = 32,
  105. + .reg_stride = 4,
  106. + .max_register = 0x16ac, /* end MIB - Port6 range */
  107. + .rd_table = &qca8k_readable_table,
  108. +};
  109. +
  110. +static struct regmap_config qca8k_ipq4019_psgmii_phy_regmap_config = {
  111. + .name = "psgmii-phy",
  112. + .reg_bits = 32,
  113. + .val_bits = 32,
  114. + .reg_stride = 4,
  115. + .max_register = 0x7fc,
  116. +};
  117. +
  118. +static enum dsa_tag_protocol
  119. +qca8k_ipq4019_get_tag_protocol(struct dsa_switch *ds, int port,
  120. + enum dsa_tag_protocol mp)
  121. +{
  122. + return DSA_TAG_PROTO_OOB;
  123. +}
  124. +
  125. +static struct phylink_pcs *
  126. +qca8k_ipq4019_phylink_mac_select_pcs(struct dsa_switch *ds, int port,
  127. + phy_interface_t interface)
  128. +{
  129. + struct qca8k_priv *priv = ds->priv;
  130. + struct phylink_pcs *pcs = NULL;
  131. +
  132. + switch (interface) {
  133. + case PHY_INTERFACE_MODE_PSGMII:
  134. + switch (port) {
  135. + case 0:
  136. + pcs = &priv->pcs_port_0.pcs;
  137. + break;
  138. + }
  139. + break;
  140. + default:
  141. + break;
  142. + }
  143. +
  144. + return pcs;
  145. +}
  146. +
  147. +static int qca8k_ipq4019_pcs_config(struct phylink_pcs *pcs, unsigned int mode,
  148. + phy_interface_t interface,
  149. + const unsigned long *advertising,
  150. + bool permit_pause_to_mac)
  151. +{
  152. + return 0;
  153. +}
  154. +
  155. +static void qca8k_ipq4019_pcs_an_restart(struct phylink_pcs *pcs)
  156. +{
  157. +}
  158. +
  159. +static struct qca8k_pcs *pcs_to_qca8k_pcs(struct phylink_pcs *pcs)
  160. +{
  161. + return container_of(pcs, struct qca8k_pcs, pcs);
  162. +}
  163. +
  164. +static void qca8k_ipq4019_pcs_get_state(struct phylink_pcs *pcs,
  165. + struct phylink_link_state *state)
  166. +{
  167. + struct qca8k_priv *priv = pcs_to_qca8k_pcs(pcs)->priv;
  168. + int port = pcs_to_qca8k_pcs(pcs)->port;
  169. + u32 reg;
  170. + int ret;
  171. +
  172. + ret = qca8k_read(priv, QCA8K_REG_PORT_STATUS(port), &reg);
  173. + if (ret < 0) {
  174. + state->link = false;
  175. + return;
  176. + }
  177. +
  178. + state->link = !!(reg & QCA8K_PORT_STATUS_LINK_UP);
  179. + state->an_complete = state->link;
  180. + state->duplex = (reg & QCA8K_PORT_STATUS_DUPLEX) ? DUPLEX_FULL :
  181. + DUPLEX_HALF;
  182. +
  183. + switch (reg & QCA8K_PORT_STATUS_SPEED) {
  184. + case QCA8K_PORT_STATUS_SPEED_10:
  185. + state->speed = SPEED_10;
  186. + break;
  187. + case QCA8K_PORT_STATUS_SPEED_100:
  188. + state->speed = SPEED_100;
  189. + break;
  190. + case QCA8K_PORT_STATUS_SPEED_1000:
  191. + state->speed = SPEED_1000;
  192. + break;
  193. + default:
  194. + state->speed = SPEED_UNKNOWN;
  195. + break;
  196. + }
  197. +
  198. + if (reg & QCA8K_PORT_STATUS_RXFLOW)
  199. + state->pause |= MLO_PAUSE_RX;
  200. + if (reg & QCA8K_PORT_STATUS_TXFLOW)
  201. + state->pause |= MLO_PAUSE_TX;
  202. +}
  203. +
  204. +static const struct phylink_pcs_ops qca8k_pcs_ops = {
  205. + .pcs_get_state = qca8k_ipq4019_pcs_get_state,
  206. + .pcs_config = qca8k_ipq4019_pcs_config,
  207. + .pcs_an_restart = qca8k_ipq4019_pcs_an_restart,
  208. +};
  209. +
  210. +static void qca8k_ipq4019_setup_pcs(struct qca8k_priv *priv,
  211. + struct qca8k_pcs *qpcs,
  212. + int port)
  213. +{
  214. + qpcs->pcs.ops = &qca8k_pcs_ops;
  215. +
  216. + /* We don't have interrupts for link changes, so we need to poll */
  217. + qpcs->pcs.poll = true;
  218. + qpcs->priv = priv;
  219. + qpcs->port = port;
  220. +}
  221. +
  222. +static void qca8k_ipq4019_phylink_get_caps(struct dsa_switch *ds, int port,
  223. + struct phylink_config *config)
  224. +{
  225. + switch (port) {
  226. + case 0: /* CPU port */
  227. + __set_bit(PHY_INTERFACE_MODE_INTERNAL,
  228. + config->supported_interfaces);
  229. + break;
  230. +
  231. + case 1:
  232. + case 2:
  233. + case 3:
  234. + __set_bit(PHY_INTERFACE_MODE_PSGMII,
  235. + config->supported_interfaces);
  236. + break;
  237. + case 4:
  238. + case 5:
  239. + phy_interface_set_rgmii(config->supported_interfaces);
  240. + __set_bit(PHY_INTERFACE_MODE_PSGMII,
  241. + config->supported_interfaces);
  242. + break;
  243. + }
  244. +
  245. + config->mac_capabilities = MAC_ASYM_PAUSE | MAC_SYM_PAUSE |
  246. + MAC_10 | MAC_100 | MAC_1000FD;
  247. +
  248. + config->legacy_pre_march2020 = false;
  249. +}
  250. +
  251. +static void
  252. +qca8k_phylink_ipq4019_mac_link_down(struct dsa_switch *ds, int port,
  253. + unsigned int mode,
  254. + phy_interface_t interface)
  255. +{
  256. + struct qca8k_priv *priv = ds->priv;
  257. +
  258. + qca8k_port_set_status(priv, port, 0);
  259. +}
  260. +
  261. +static void
  262. +qca8k_phylink_ipq4019_mac_link_up(struct dsa_switch *ds, int port,
  263. + unsigned int mode, phy_interface_t interface,
  264. + struct phy_device *phydev, int speed,
  265. + int duplex, bool tx_pause, bool rx_pause)
  266. +{
  267. + struct qca8k_priv *priv = ds->priv;
  268. + u32 reg;
  269. +
  270. + if (phylink_autoneg_inband(mode)) {
  271. + reg = QCA8K_PORT_STATUS_LINK_AUTO;
  272. + } else {
  273. + switch (speed) {
  274. + case SPEED_10:
  275. + reg = QCA8K_PORT_STATUS_SPEED_10;
  276. + break;
  277. + case SPEED_100:
  278. + reg = QCA8K_PORT_STATUS_SPEED_100;
  279. + break;
  280. + case SPEED_1000:
  281. + reg = QCA8K_PORT_STATUS_SPEED_1000;
  282. + break;
  283. + default:
  284. + reg = QCA8K_PORT_STATUS_LINK_AUTO;
  285. + break;
  286. + }
  287. +
  288. + if (duplex == DUPLEX_FULL)
  289. + reg |= QCA8K_PORT_STATUS_DUPLEX;
  290. +
  291. + if (rx_pause || dsa_is_cpu_port(ds, port))
  292. + reg |= QCA8K_PORT_STATUS_RXFLOW;
  293. +
  294. + if (tx_pause || dsa_is_cpu_port(ds, port))
  295. + reg |= QCA8K_PORT_STATUS_TXFLOW;
  296. + }
  297. +
  298. + reg |= QCA8K_PORT_STATUS_TXMAC | QCA8K_PORT_STATUS_RXMAC;
  299. +
  300. + qca8k_write(priv, QCA8K_REG_PORT_STATUS(port), reg);
  301. +}
  302. +
  303. +static int psgmii_vco_calibrate(struct qca8k_priv *priv)
  304. +{
  305. + int val, ret;
  306. +
  307. + if (!priv->psgmii_ethphy) {
  308. + dev_err(priv->dev, "PSGMII eth PHY missing, calibration failed!\n");
  309. + return -ENODEV;
  310. + }
  311. +
  312. + /* Fix PSGMII RX 20bit */
  313. + ret = phy_write(priv->psgmii_ethphy, MII_BMCR, 0x5b);
  314. + /* Reset PHY PSGMII */
  315. + ret = phy_write(priv->psgmii_ethphy, MII_BMCR, 0x1b);
  316. + /* Release PHY PSGMII reset */
  317. + ret = phy_write(priv->psgmii_ethphy, MII_BMCR, 0x5b);
  318. +
  319. + /* Poll for VCO PLL calibration finish - Malibu(QCA8075) */
  320. + ret = phy_read_mmd_poll_timeout(priv->psgmii_ethphy,
  321. + MDIO_MMD_PMAPMD,
  322. + 0x28, val,
  323. + (val & BIT(0)),
  324. + 10000, 1000000,
  325. + false);
  326. + if (ret) {
  327. + dev_err(priv->dev, "QCA807x PSGMII VCO calibration PLL not ready\n");
  328. + return ret;
  329. + }
  330. + mdelay(50);
  331. +
  332. + /* Freeze PSGMII RX CDR */
  333. + ret = phy_write(priv->psgmii_ethphy, MII_RESV2, 0x2230);
  334. +
  335. + /* Start PSGMIIPHY VCO PLL calibration */
  336. + ret = regmap_set_bits(priv->psgmii,
  337. + PSGMIIPHY_VCO_CALIBRATION_CONTROL_REGISTER_1,
  338. + PSGMIIPHY_REG_PLL_VCO_CALIB_RESTART);
  339. +
  340. + /* Poll for PSGMIIPHY PLL calibration finish - Dakota(IPQ40xx) */
  341. + ret = regmap_read_poll_timeout(priv->psgmii,
  342. + PSGMIIPHY_VCO_CALIBRATION_CONTROL_REGISTER_2,
  343. + val, val & PSGMIIPHY_REG_PLL_VCO_CALIB_READY,
  344. + 10000, 1000000);
  345. + if (ret) {
  346. + dev_err(priv->dev, "IPQ PSGMIIPHY VCO calibration PLL not ready\n");
  347. + return ret;
  348. + }
  349. + mdelay(50);
  350. +
  351. + /* Release PSGMII RX CDR */
  352. + ret = phy_write(priv->psgmii_ethphy, MII_RESV2, 0x3230);
  353. + /* Release PSGMII RX 20bit */
  354. + ret = phy_write(priv->psgmii_ethphy, MII_BMCR, 0x5f);
  355. + mdelay(200);
  356. +
  357. + return ret;
  358. +}
  359. +
  360. +static void
  361. +qca8k_switch_port_loopback_on_off(struct qca8k_priv *priv, int port, int on)
  362. +{
  363. + u32 val = QCA8K_PORT_LOOKUP_LOOPBACK_EN;
  364. +
  365. + if (on == 0)
  366. + val = 0;
  367. +
  368. + qca8k_rmw(priv, QCA8K_PORT_LOOKUP_CTRL(port),
  369. + QCA8K_PORT_LOOKUP_LOOPBACK_EN, val);
  370. +}
  371. +
  372. +static int
  373. +qca8k_wait_for_phy_link_state(struct phy_device *phy, int need_status)
  374. +{
  375. + int a;
  376. + u16 status;
  377. +
  378. + for (a = 0; a < 100; a++) {
  379. + status = phy_read(phy, MII_QCA8075_SSTATUS);
  380. + status &= QCA8075_PHY_SPEC_STATUS_LINK;
  381. + status = !!status;
  382. + if (status == need_status)
  383. + return 0;
  384. + mdelay(8);
  385. + }
  386. +
  387. + return -1;
  388. +}
  389. +
  390. +static void
  391. +qca8k_phy_loopback_on_off(struct qca8k_priv *priv, struct phy_device *phy,
  392. + int sw_port, int on)
  393. +{
  394. + if (on) {
  395. + phy_write(phy, MII_BMCR, BMCR_ANENABLE | BMCR_RESET);
  396. + phy_modify(phy, MII_BMCR, BMCR_PDOWN, BMCR_PDOWN);
  397. + qca8k_wait_for_phy_link_state(phy, 0);
  398. + qca8k_write(priv, QCA8K_REG_PORT_STATUS(sw_port), 0);
  399. + phy_write(phy, MII_BMCR,
  400. + BMCR_SPEED1000 |
  401. + BMCR_FULLDPLX |
  402. + BMCR_LOOPBACK);
  403. + qca8k_wait_for_phy_link_state(phy, 1);
  404. + qca8k_write(priv, QCA8K_REG_PORT_STATUS(sw_port),
  405. + QCA8K_PORT_STATUS_SPEED_1000 |
  406. + QCA8K_PORT_STATUS_TXMAC |
  407. + QCA8K_PORT_STATUS_RXMAC |
  408. + QCA8K_PORT_STATUS_DUPLEX);
  409. + qca8k_rmw(priv, QCA8K_PORT_LOOKUP_CTRL(sw_port),
  410. + QCA8K_PORT_LOOKUP_STATE_FORWARD,
  411. + QCA8K_PORT_LOOKUP_STATE_FORWARD);
  412. + } else { /* off */
  413. + qca8k_write(priv, QCA8K_REG_PORT_STATUS(sw_port), 0);
  414. + qca8k_rmw(priv, QCA8K_PORT_LOOKUP_CTRL(sw_port),
  415. + QCA8K_PORT_LOOKUP_STATE_DISABLED,
  416. + QCA8K_PORT_LOOKUP_STATE_DISABLED);
  417. + phy_write(phy, MII_BMCR, BMCR_SPEED1000 | BMCR_ANENABLE | BMCR_RESET);
  418. + /* turn off the power of the phys - so that unused
  419. + ports do not raise links */
  420. + phy_modify(phy, MII_BMCR, BMCR_PDOWN, BMCR_PDOWN);
  421. + }
  422. +}
  423. +
  424. +static void
  425. +qca8k_phy_pkt_gen_prep(struct qca8k_priv *priv, struct phy_device *phy,
  426. + int pkts_num, int on)
  427. +{
  428. + if (on) {
  429. + /* enable CRC checker and packets counters */
  430. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_CRC_AND_PKTS_COUNT, 0);
  431. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_CRC_AND_PKTS_COUNT,
  432. + QCA8075_MMD7_CNT_FRAME_CHK_EN | QCA8075_MMD7_CNT_SELFCLR);
  433. + qca8k_wait_for_phy_link_state(phy, 1);
  434. + /* packet number */
  435. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_PKT_GEN_PKT_NUMB, pkts_num);
  436. + /* pkt size - 1504 bytes + 20 bytes */
  437. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_PKT_GEN_PKT_SIZE, 1504);
  438. + } else { /* off */
  439. + /* packet number */
  440. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_PKT_GEN_PKT_NUMB, 0);
  441. + /* disable CRC checker and packet counter */
  442. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_CRC_AND_PKTS_COUNT, 0);
  443. + /* disable traffic gen */
  444. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_PKT_GEN_CTRL, 0);
  445. + }
  446. +}
  447. +
  448. +static void
  449. +qca8k_wait_for_phy_pkt_gen_fin(struct qca8k_priv *priv, struct phy_device *phy)
  450. +{
  451. + int val;
  452. + /* wait for all traffic end: 4096(pkt num)*1524(size)*8ns(125MHz)=49938us */
  453. + phy_read_mmd_poll_timeout(phy, MDIO_MMD_AN, QCA8075_MMD7_PKT_GEN_CTRL,
  454. + val, !(val & QCA8075_MMD7_PKT_GEN_INPROGR),
  455. + 50000, 1000000, true);
  456. +}
  457. +
  458. +static void
  459. +qca8k_start_phy_pkt_gen(struct phy_device *phy)
  460. +{
  461. + /* start traffic gen */
  462. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_PKT_GEN_CTRL,
  463. + QCA8075_MMD7_PKT_GEN_START | QCA8075_MMD7_PKT_GEN_INPROGR);
  464. +}
  465. +
  466. +static int
  467. +qca8k_start_all_phys_pkt_gens(struct qca8k_priv *priv)
  468. +{
  469. + struct phy_device *phy;
  470. + phy = phy_device_create(priv->bus, QCA8075_MDIO_BRDCST_PHY_ADDR,
  471. + 0, 0, NULL);
  472. + if (!phy) {
  473. + dev_err(priv->dev, "unable to create mdio broadcast PHY(0x%x)\n",
  474. + QCA8075_MDIO_BRDCST_PHY_ADDR);
  475. + return -ENODEV;
  476. + }
  477. +
  478. + qca8k_start_phy_pkt_gen(phy);
  479. +
  480. + phy_device_free(phy);
  481. + return 0;
  482. +}
  483. +
  484. +static int
  485. +qca8k_get_phy_pkt_gen_test_result(struct phy_device *phy, int pkts_num)
  486. +{
  487. + u32 tx_ok, tx_error;
  488. + u32 rx_ok, rx_error;
  489. + u32 tx_ok_high16;
  490. + u32 rx_ok_high16;
  491. + u32 tx_all_ok, rx_all_ok;
  492. +
  493. + /* check counters */
  494. + tx_ok = phy_read_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_EG_FRAME_RECV_CNT_LO);
  495. + tx_ok_high16 = phy_read_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_EG_FRAME_RECV_CNT_HI);
  496. + tx_error = phy_read_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_EG_FRAME_ERR_CNT);
  497. + rx_ok = phy_read_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_IG_FRAME_RECV_CNT_LO);
  498. + rx_ok_high16 = phy_read_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_IG_FRAME_RECV_CNT_HI);
  499. + rx_error = phy_read_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_IG_FRAME_ERR_CNT);
  500. + tx_all_ok = tx_ok + (tx_ok_high16 << 16);
  501. + rx_all_ok = rx_ok + (rx_ok_high16 << 16);
  502. +
  503. + if (tx_all_ok < pkts_num)
  504. + return -1;
  505. + if(rx_all_ok < pkts_num)
  506. + return -2;
  507. + if(tx_error)
  508. + return -3;
  509. + if(rx_error)
  510. + return -4;
  511. + return 0; /* test is ok */
  512. +}
  513. +
  514. +static
  515. +void qca8k_phy_broadcast_write_on_off(struct qca8k_priv *priv,
  516. + struct phy_device *phy, int on)
  517. +{
  518. + u32 val;
  519. +
  520. + val = phy_read_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_MDIO_BRDCST_WRITE);
  521. +
  522. + if (on == 0)
  523. + val &= ~QCA8075_MMD7_MDIO_BRDCST_WRITE_EN;
  524. + else
  525. + val |= QCA8075_MMD7_MDIO_BRDCST_WRITE_EN;
  526. +
  527. + phy_write_mmd(phy, MDIO_MMD_AN, QCA8075_MMD7_MDIO_BRDCST_WRITE, val);
  528. +}
  529. +
  530. +static int
  531. +qca8k_test_dsa_port_for_errors(struct qca8k_priv *priv, struct phy_device *phy,
  532. + int port, int test_phase)
  533. +{
  534. + int res = 0;
  535. + const int test_pkts_num = QCA8075_PKT_GEN_PKTS_COUNT;
  536. +
  537. + if (test_phase == 1) { /* start test preps */
  538. + qca8k_phy_loopback_on_off(priv, phy, port, 1);
  539. + qca8k_switch_port_loopback_on_off(priv, port, 1);
  540. + qca8k_phy_broadcast_write_on_off(priv, phy, 1);
  541. + qca8k_phy_pkt_gen_prep(priv, phy, test_pkts_num, 1);
  542. + } else if (test_phase == 2) {
  543. + /* wait for test results, collect it and cleanup */
  544. + qca8k_wait_for_phy_pkt_gen_fin(priv, phy);
  545. + res = qca8k_get_phy_pkt_gen_test_result(phy, test_pkts_num);
  546. + qca8k_phy_pkt_gen_prep(priv, phy, test_pkts_num, 0);
  547. + qca8k_phy_broadcast_write_on_off(priv, phy, 0);
  548. + qca8k_switch_port_loopback_on_off(priv, port, 0);
  549. + qca8k_phy_loopback_on_off(priv, phy, port, 0);
  550. + }
  551. +
  552. + return res;
  553. +}
  554. +
  555. +static int
  556. +qca8k_do_dsa_sw_ports_self_test(struct qca8k_priv *priv, int parallel_test)
  557. +{
  558. + struct device_node *dn = priv->dev->of_node;
  559. + struct device_node *ports, *port;
  560. + struct device_node *phy_dn;
  561. + struct phy_device *phy;
  562. + int reg, err = 0, test_phase;
  563. + u32 tests_result = 0;
  564. +
  565. + ports = of_get_child_by_name(dn, "ports");
  566. + if (!ports) {
  567. + dev_err(priv->dev, "no ports child node found\n");
  568. + return -EINVAL;
  569. + }
  570. +
  571. + for (test_phase = 1; test_phase <= 2; test_phase++) {
  572. + if (parallel_test && test_phase == 2) {
  573. + err = qca8k_start_all_phys_pkt_gens(priv);
  574. + if (err)
  575. + goto error;
  576. + }
  577. + for_each_available_child_of_node(ports, port) {
  578. + err = of_property_read_u32(port, "reg", &reg);
  579. + if (err)
  580. + goto error;
  581. + if (reg >= QCA8K_NUM_PORTS) {
  582. + err = -EINVAL;
  583. + goto error;
  584. + }
  585. + phy_dn = of_parse_phandle(port, "phy-handle", 0);
  586. + if (phy_dn) {
  587. + phy = of_phy_find_device(phy_dn);
  588. + of_node_put(phy_dn);
  589. + if (phy) {
  590. + int result;
  591. + result = qca8k_test_dsa_port_for_errors(priv,
  592. + phy, reg, test_phase);
  593. + if (!parallel_test && test_phase == 1)
  594. + qca8k_start_phy_pkt_gen(phy);
  595. + put_device(&phy->mdio.dev);
  596. + if (test_phase == 2) {
  597. + tests_result <<= 1;
  598. + if (result)
  599. + tests_result |= 1;
  600. + }
  601. + }
  602. + }
  603. + }
  604. + }
  605. +
  606. +end:
  607. + of_node_put(ports);
  608. + qca8k_fdb_flush(priv);
  609. + return tests_result;
  610. +error:
  611. + tests_result |= 0xf000;
  612. + goto end;
  613. +}
  614. +
  615. +static int
  616. +psgmii_vco_calibrate_and_test(struct dsa_switch *ds)
  617. +{
  618. + int ret, a, test_result;
  619. + struct qca8k_priv *priv = ds->priv;
  620. +
  621. + for (a = 0; a <= QCA8K_PSGMII_CALB_NUM; a++) {
  622. + ret = psgmii_vco_calibrate(priv);
  623. + if (ret)
  624. + return ret;
  625. + /* first we run serial test */
  626. + test_result = qca8k_do_dsa_sw_ports_self_test(priv, 0);
  627. + /* and if it is ok then we run the test in parallel */
  628. + if (!test_result)
  629. + test_result = qca8k_do_dsa_sw_ports_self_test(priv, 1);
  630. + if (!test_result) {
  631. + if (a > 0) {
  632. + dev_warn(priv->dev, "PSGMII work was stabilized after %d "
  633. + "calibration retries !\n", a);
  634. + }
  635. + return 0;
  636. + } else {
  637. + schedule();
  638. + if (a > 0 && a % 10 == 0) {
  639. + dev_err(priv->dev, "PSGMII work is unstable !!! "
  640. + "Let's try to wait a bit ... %d\n", a);
  641. + set_current_state(TASK_INTERRUPTIBLE);
  642. + schedule_timeout(msecs_to_jiffies(a * 100));
  643. + }
  644. + }
  645. + }
  646. +
  647. + panic("PSGMII work is unstable !!! "
  648. + "Repeated recalibration attempts did not help(0x%x) !\n",
  649. + test_result);
  650. +
  651. + return -EFAULT;
  652. +}
  653. +
  654. +static int
  655. +ipq4019_psgmii_configure(struct dsa_switch *ds)
  656. +{
  657. + struct qca8k_priv *priv = ds->priv;
  658. + int ret;
  659. +
  660. + if (!priv->psgmii_calibrated) {
  661. + dev_info(ds->dev, "PSGMII calibration!\n");
  662. + ret = psgmii_vco_calibrate_and_test(ds);
  663. +
  664. + ret = regmap_clear_bits(priv->psgmii, PSGMIIPHY_MODE_CONTROL,
  665. + PSGMIIPHY_MODE_ATHR_CSCO_MODE_25M);
  666. + ret = regmap_write(priv->psgmii, PSGMIIPHY_TX_CONTROL,
  667. + PSGMIIPHY_TX_CONTROL_MAGIC_VALUE);
  668. +
  669. + priv->psgmii_calibrated = true;
  670. +
  671. + return ret;
  672. + }
  673. +
  674. + return 0;
  675. +}
  676. +
  677. +static void
  678. +qca8k_phylink_ipq4019_mac_config(struct dsa_switch *ds, int port,
  679. + unsigned int mode,
  680. + const struct phylink_link_state *state)
  681. +{
  682. + struct qca8k_priv *priv = ds->priv;
  683. +
  684. + switch (port) {
  685. + case 0:
  686. + /* CPU port, no configuration needed */
  687. + return;
  688. + case 1:
  689. + case 2:
  690. + case 3:
  691. + if (state->interface == PHY_INTERFACE_MODE_PSGMII)
  692. + if (ipq4019_psgmii_configure(ds))
  693. + dev_err(ds->dev, "PSGMII configuration failed!\n");
  694. + return;
  695. + case 4:
  696. + case 5:
  697. + if (state->interface == PHY_INTERFACE_MODE_RGMII ||
  698. + state->interface == PHY_INTERFACE_MODE_RGMII_ID ||
  699. + state->interface == PHY_INTERFACE_MODE_RGMII_RXID ||
  700. + state->interface == PHY_INTERFACE_MODE_RGMII_TXID) {
  701. + regmap_set_bits(priv->regmap,
  702. + QCA8K_IPQ4019_REG_RGMII_CTRL,
  703. + QCA8K_IPQ4019_RGMII_CTRL_CLK);
  704. + }
  705. +
  706. + if (state->interface == PHY_INTERFACE_MODE_PSGMII)
  707. + if (ipq4019_psgmii_configure(ds))
  708. + dev_err(ds->dev, "PSGMII configuration failed!\n");
  709. + return;
  710. + default:
  711. + dev_err(ds->dev, "%s: unsupported port: %i\n", __func__, port);
  712. + return;
  713. + }
  714. +}
  715. +
  716. +static int
  717. +qca8k_ipq4019_setup_port(struct dsa_switch *ds, int port)
  718. +{
  719. + struct qca8k_priv *priv = (struct qca8k_priv *)ds->priv;
  720. + int ret;
  721. +
  722. + /* CPU port gets connected to all user ports of the switch */
  723. + if (dsa_is_cpu_port(ds, port)) {
  724. + ret = qca8k_rmw(priv, QCA8K_PORT_LOOKUP_CTRL(port),
  725. + QCA8K_PORT_LOOKUP_MEMBER, dsa_user_ports(ds));
  726. + if (ret)
  727. + return ret;
  728. +
  729. + /* Disable CPU ARP Auto-learning by default */
  730. + ret = regmap_clear_bits(priv->regmap,
  731. + QCA8K_PORT_LOOKUP_CTRL(port),
  732. + QCA8K_PORT_LOOKUP_LEARN);
  733. + if (ret)
  734. + return ret;
  735. + }
  736. +
  737. + /* Individual user ports get connected to CPU port only */
  738. + if (dsa_is_user_port(ds, port)) {
  739. + ret = qca8k_rmw(priv, QCA8K_PORT_LOOKUP_CTRL(port),
  740. + QCA8K_PORT_LOOKUP_MEMBER,
  741. + BIT(QCA8K_IPQ4019_CPU_PORT));
  742. + if (ret)
  743. + return ret;
  744. +
  745. + /* Enable ARP Auto-learning by default */
  746. + ret = regmap_set_bits(priv->regmap, QCA8K_PORT_LOOKUP_CTRL(port),
  747. + QCA8K_PORT_LOOKUP_LEARN);
  748. + if (ret)
  749. + return ret;
  750. +
  751. + /* For port based vlans to work we need to set the
  752. + * default egress vid
  753. + */
  754. + ret = qca8k_rmw(priv, QCA8K_EGRESS_VLAN(port),
  755. + QCA8K_EGREES_VLAN_PORT_MASK(port),
  756. + QCA8K_EGREES_VLAN_PORT(port, QCA8K_PORT_VID_DEF));
  757. + if (ret)
  758. + return ret;
  759. +
  760. + ret = qca8k_write(priv, QCA8K_REG_PORT_VLAN_CTRL0(port),
  761. + QCA8K_PORT_VLAN_CVID(QCA8K_PORT_VID_DEF) |
  762. + QCA8K_PORT_VLAN_SVID(QCA8K_PORT_VID_DEF));
  763. + if (ret)
  764. + return ret;
  765. + }
  766. +
  767. + return 0;
  768. +}
  769. +
  770. +static int
  771. +qca8k_ipq4019_setup(struct dsa_switch *ds)
  772. +{
  773. + struct qca8k_priv *priv = (struct qca8k_priv *)ds->priv;
  774. + int ret, i;
  775. +
  776. + /* Make sure that port 0 is the cpu port */
  777. + if (!dsa_is_cpu_port(ds, QCA8K_IPQ4019_CPU_PORT)) {
  778. + dev_err(priv->dev, "port %d is not the CPU port",
  779. + QCA8K_IPQ4019_CPU_PORT);
  780. + return -EINVAL;
  781. + }
  782. +
  783. + qca8k_ipq4019_setup_pcs(priv, &priv->pcs_port_0, 0);
  784. +
  785. + /* Enable CPU Port */
  786. + ret = regmap_set_bits(priv->regmap, QCA8K_REG_GLOBAL_FW_CTRL0,
  787. + QCA8K_GLOBAL_FW_CTRL0_CPU_PORT_EN);
  788. + if (ret) {
  789. + dev_err(priv->dev, "failed enabling CPU port");
  790. + return ret;
  791. + }
  792. +
  793. + /* Enable MIB counters */
  794. + ret = qca8k_mib_init(priv);
  795. + if (ret)
  796. + dev_warn(priv->dev, "MIB init failed");
  797. +
  798. + /* Disable forwarding by default on all ports */
  799. + for (i = 0; i < QCA8K_IPQ4019_NUM_PORTS; i++) {
  800. + ret = qca8k_rmw(priv, QCA8K_PORT_LOOKUP_CTRL(i),
  801. + QCA8K_PORT_LOOKUP_MEMBER, 0);
  802. + if (ret)
  803. + return ret;
  804. + }
  805. +
  806. + /* Enable QCA header mode on the CPU port */
  807. + ret = qca8k_write(priv, QCA8K_REG_PORT_HDR_CTRL(QCA8K_IPQ4019_CPU_PORT),
  808. + FIELD_PREP(QCA8K_PORT_HDR_CTRL_TX_MASK, QCA8K_PORT_HDR_CTRL_ALL) |
  809. + FIELD_PREP(QCA8K_PORT_HDR_CTRL_RX_MASK, QCA8K_PORT_HDR_CTRL_ALL));
  810. + if (ret) {
  811. + dev_err(priv->dev, "failed enabling QCA header mode");
  812. + return ret;
  813. + }
  814. +
  815. + /* Disable MAC by default on all ports */
  816. + for (i = 0; i < QCA8K_IPQ4019_NUM_PORTS; i++) {
  817. + if (dsa_is_user_port(ds, i))
  818. + qca8k_port_set_status(priv, i, 0);
  819. + }
  820. +
  821. + /* Forward all unknown frames to CPU port for Linux processing */
  822. + ret = qca8k_write(priv, QCA8K_REG_GLOBAL_FW_CTRL1,
  823. + FIELD_PREP(QCA8K_GLOBAL_FW_CTRL1_IGMP_DP_MASK, BIT(QCA8K_IPQ4019_CPU_PORT)) |
  824. + FIELD_PREP(QCA8K_GLOBAL_FW_CTRL1_BC_DP_MASK, BIT(QCA8K_IPQ4019_CPU_PORT)) |
  825. + FIELD_PREP(QCA8K_GLOBAL_FW_CTRL1_MC_DP_MASK, BIT(QCA8K_IPQ4019_CPU_PORT)) |
  826. + FIELD_PREP(QCA8K_GLOBAL_FW_CTRL1_UC_DP_MASK, BIT(QCA8K_IPQ4019_CPU_PORT)));
  827. + if (ret)
  828. + return ret;
  829. +
  830. + /* Setup connection between CPU port & user ports */
  831. + for (i = 0; i < QCA8K_IPQ4019_NUM_PORTS; i++) {
  832. + ret = qca8k_ipq4019_setup_port(ds, i);
  833. + if (ret)
  834. + return ret;
  835. + }
  836. +
  837. + /* Setup our port MTUs to match power on defaults */
  838. + ret = qca8k_write(priv, QCA8K_MAX_FRAME_SIZE, ETH_FRAME_LEN + ETH_FCS_LEN);
  839. + if (ret)
  840. + dev_warn(priv->dev, "failed setting MTU settings");
  841. +
  842. + /* Flush the FDB table */
  843. + qca8k_fdb_flush(priv);
  844. +
  845. + /* Set min a max ageing value supported */
  846. + ds->ageing_time_min = 7000;
  847. + ds->ageing_time_max = 458745000;
  848. +
  849. + /* Set max number of LAGs supported */
  850. + ds->num_lag_ids = QCA8K_NUM_LAGS;
  851. +
  852. + /* CPU port HW learning doesnt work correctly, so let DSA handle it */
  853. + ds->assisted_learning_on_cpu_port = true;
  854. +
  855. + return 0;
  856. +}
  857. +
  858. +static const struct dsa_switch_ops qca8k_ipq4019_switch_ops = {
  859. + .get_tag_protocol = qca8k_ipq4019_get_tag_protocol,
  860. + .setup = qca8k_ipq4019_setup,
  861. + .get_strings = qca8k_get_strings,
  862. + .get_ethtool_stats = qca8k_get_ethtool_stats,
  863. + .get_sset_count = qca8k_get_sset_count,
  864. + .set_ageing_time = qca8k_set_ageing_time,
  865. + .get_mac_eee = qca8k_get_mac_eee,
  866. + .set_mac_eee = qca8k_set_mac_eee,
  867. + .port_enable = qca8k_port_enable,
  868. + .port_disable = qca8k_port_disable,
  869. + .port_change_mtu = qca8k_port_change_mtu,
  870. + .port_max_mtu = qca8k_port_max_mtu,
  871. + .port_stp_state_set = qca8k_port_stp_state_set,
  872. + .port_bridge_join = qca8k_port_bridge_join,
  873. + .port_bridge_leave = qca8k_port_bridge_leave,
  874. + .port_fast_age = qca8k_port_fast_age,
  875. + .port_fdb_add = qca8k_port_fdb_add,
  876. + .port_fdb_del = qca8k_port_fdb_del,
  877. + .port_fdb_dump = qca8k_port_fdb_dump,
  878. + .port_mdb_add = qca8k_port_mdb_add,
  879. + .port_mdb_del = qca8k_port_mdb_del,
  880. + .port_mirror_add = qca8k_port_mirror_add,
  881. + .port_mirror_del = qca8k_port_mirror_del,
  882. + .port_vlan_filtering = qca8k_port_vlan_filtering,
  883. + .port_vlan_add = qca8k_port_vlan_add,
  884. + .port_vlan_del = qca8k_port_vlan_del,
  885. + .phylink_mac_select_pcs = qca8k_ipq4019_phylink_mac_select_pcs,
  886. + .phylink_get_caps = qca8k_ipq4019_phylink_get_caps,
  887. + .phylink_mac_config = qca8k_phylink_ipq4019_mac_config,
  888. + .phylink_mac_link_down = qca8k_phylink_ipq4019_mac_link_down,
  889. + .phylink_mac_link_up = qca8k_phylink_ipq4019_mac_link_up,
  890. + .port_lag_join = qca8k_port_lag_join,
  891. + .port_lag_leave = qca8k_port_lag_leave,
  892. +};
  893. +
  894. +static const struct qca8k_match_data ipq4019 = {
  895. + .id = QCA8K_ID_IPQ4019,
  896. + .mib_count = QCA8K_QCA833X_MIB_COUNT,
  897. +};
  898. +
  899. +static int
  900. +qca8k_ipq4019_probe(struct platform_device *pdev)
  901. +{
  902. + struct device *dev = &pdev->dev;
  903. + struct qca8k_priv *priv;
  904. + void __iomem *base, *psgmii;
  905. + struct device_node *np = dev->of_node, *mdio_np, *psgmii_ethphy_np;
  906. + int ret;
  907. +
  908. + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
  909. + if (!priv)
  910. + return -ENOMEM;
  911. +
  912. + priv->dev = dev;
  913. + priv->info = &ipq4019;
  914. +
  915. + /* Start by setting up the register mapping */
  916. + base = devm_platform_ioremap_resource_byname(pdev, "base");
  917. + if (IS_ERR(base))
  918. + return PTR_ERR(base);
  919. +
  920. + priv->regmap = devm_regmap_init_mmio(dev, base,
  921. + &qca8k_ipq4019_regmap_config);
  922. + if (IS_ERR(priv->regmap)) {
  923. + ret = PTR_ERR(priv->regmap);
  924. + dev_err(dev, "base regmap initialization failed, %d\n", ret);
  925. + return ret;
  926. + }
  927. +
  928. + psgmii = devm_platform_ioremap_resource_byname(pdev, "psgmii_phy");
  929. + if (IS_ERR(psgmii))
  930. + return PTR_ERR(psgmii);
  931. +
  932. + priv->psgmii = devm_regmap_init_mmio(dev, psgmii,
  933. + &qca8k_ipq4019_psgmii_phy_regmap_config);
  934. + if (IS_ERR(priv->psgmii)) {
  935. + ret = PTR_ERR(priv->psgmii);
  936. + dev_err(dev, "PSGMII regmap initialization failed, %d\n", ret);
  937. + return ret;
  938. + }
  939. +
  940. + mdio_np = of_parse_phandle(np, "mdio", 0);
  941. + if (!mdio_np) {
  942. + dev_err(dev, "unable to get MDIO bus phandle\n");
  943. + of_node_put(mdio_np);
  944. + return -EINVAL;
  945. + }
  946. +
  947. + priv->bus = of_mdio_find_bus(mdio_np);
  948. + of_node_put(mdio_np);
  949. + if (!priv->bus) {
  950. + dev_err(dev, "unable to find MDIO bus\n");
  951. + return -EPROBE_DEFER;
  952. + }
  953. +
  954. + psgmii_ethphy_np = of_parse_phandle(np, "psgmii-ethphy", 0);
  955. + if (!psgmii_ethphy_np) {
  956. + dev_dbg(dev, "unable to get PSGMII eth PHY phandle\n");
  957. + of_node_put(psgmii_ethphy_np);
  958. + }
  959. +
  960. + if (psgmii_ethphy_np) {
  961. + priv->psgmii_ethphy = of_phy_find_device(psgmii_ethphy_np);
  962. + of_node_put(psgmii_ethphy_np);
  963. + if (!priv->psgmii_ethphy) {
  964. + dev_err(dev, "unable to get PSGMII eth PHY\n");
  965. + return -ENODEV;
  966. + }
  967. + }
  968. +
  969. + /* Check the detected switch id */
  970. + ret = qca8k_read_switch_id(priv);
  971. + if (ret)
  972. + return ret;
  973. +
  974. + priv->ds = devm_kzalloc(dev, sizeof(*priv->ds), GFP_KERNEL);
  975. + if (!priv->ds)
  976. + return -ENOMEM;
  977. +
  978. + priv->ds->dev = dev;
  979. + priv->ds->num_ports = QCA8K_IPQ4019_NUM_PORTS;
  980. + priv->ds->priv = priv;
  981. + priv->ds->ops = &qca8k_ipq4019_switch_ops;
  982. + mutex_init(&priv->reg_mutex);
  983. + platform_set_drvdata(pdev, priv);
  984. +
  985. + return dsa_register_switch(priv->ds);
  986. +}
  987. +
  988. +static int
  989. +qca8k_ipq4019_remove(struct platform_device *pdev)
  990. +{
  991. + struct qca8k_priv *priv = dev_get_drvdata(&pdev->dev);
  992. + int i;
  993. +
  994. + if (!priv)
  995. + return 0;
  996. +
  997. + for (i = 0; i < QCA8K_IPQ4019_NUM_PORTS; i++)
  998. + qca8k_port_set_status(priv, i, 0);
  999. +
  1000. + dsa_unregister_switch(priv->ds);
  1001. +
  1002. + platform_set_drvdata(pdev, NULL);
  1003. +
  1004. + return 0;
  1005. +}
  1006. +
  1007. +static const struct of_device_id qca8k_ipq4019_of_match[] = {
  1008. + { .compatible = "qca,ipq4019-qca8337n", },
  1009. + { /* sentinel */ },
  1010. +};
  1011. +
  1012. +static struct platform_driver qca8k_ipq4019_driver = {
  1013. + .probe = qca8k_ipq4019_probe,
  1014. + .remove = qca8k_ipq4019_remove,
  1015. + .driver = {
  1016. + .name = "qca8k-ipq4019",
  1017. + .of_match_table = qca8k_ipq4019_of_match,
  1018. + },
  1019. +};
  1020. +
  1021. +module_platform_driver(qca8k_ipq4019_driver);
  1022. +
  1023. +MODULE_AUTHOR("Mathieu Olivari, John Crispin <[email protected]>");
  1024. +MODULE_AUTHOR("Gabor Juhos <[email protected]>, Robert Marko <[email protected]>");
  1025. +MODULE_DESCRIPTION("Qualcomm IPQ4019 built-in switch driver");
  1026. +MODULE_LICENSE("GPL");
  1027. --- a/drivers/net/dsa/qca/qca8k.h
  1028. +++ b/drivers/net/dsa/qca/qca8k.h
  1029. @@ -19,7 +19,10 @@
  1030. #define QCA8K_ETHERNET_TIMEOUT 5
  1031. #define QCA8K_NUM_PORTS 7
  1032. +#define QCA8K_IPQ4019_NUM_PORTS 6
  1033. #define QCA8K_NUM_CPU_PORTS 2
  1034. +#define QCA8K_IPQ4019_NUM_CPU_PORTS 1
  1035. +#define QCA8K_IPQ4019_CPU_PORT 0
  1036. #define QCA8K_MAX_MTU 9000
  1037. #define QCA8K_NUM_LAGS 4
  1038. #define QCA8K_NUM_PORTS_FOR_LAG 4
  1039. @@ -28,6 +31,7 @@
  1040. #define QCA8K_ID_QCA8327 0x12
  1041. #define PHY_ID_QCA8337 0x004dd036
  1042. #define QCA8K_ID_QCA8337 0x13
  1043. +#define QCA8K_ID_IPQ4019 0x14
  1044. #define QCA8K_QCA832X_MIB_COUNT 39
  1045. #define QCA8K_QCA833X_MIB_COUNT 41
  1046. @@ -265,6 +269,7 @@
  1047. #define QCA8K_PORT_LOOKUP_STATE_LEARNING QCA8K_PORT_LOOKUP_STATE(0x3)
  1048. #define QCA8K_PORT_LOOKUP_STATE_FORWARD QCA8K_PORT_LOOKUP_STATE(0x4)
  1049. #define QCA8K_PORT_LOOKUP_LEARN BIT(20)
  1050. +#define QCA8K_PORT_LOOKUP_LOOPBACK_EN BIT(21)
  1051. #define QCA8K_PORT_LOOKUP_ING_MIRROR_EN BIT(25)
  1052. #define QCA8K_REG_GOL_TRUNK_CTRL0 0x700
  1053. @@ -341,6 +346,53 @@
  1054. #define MII_ATH_MMD_ADDR 0x0d
  1055. #define MII_ATH_MMD_DATA 0x0e
  1056. +/* IPQ4019 PSGMII PHY registers */
  1057. +#define QCA8K_IPQ4019_REG_RGMII_CTRL 0x004
  1058. +#define QCA8K_IPQ4019_RGMII_CTRL_RGMII_RXC GENMASK(1, 0)
  1059. +#define QCA8K_IPQ4019_RGMII_CTRL_RGMII_TXC GENMASK(9, 8)
  1060. +/* Some kind of CLK selection
  1061. + * 0: gcc_ess_dly2ns
  1062. + * 1: gcc_ess_clk
  1063. + */
  1064. +#define QCA8K_IPQ4019_RGMII_CTRL_CLK BIT(10)
  1065. +#define QCA8K_IPQ4019_RGMII_CTRL_DELAY_RMII0 GENMASK(17, 16)
  1066. +#define QCA8K_IPQ4019_RGMII_CTRL_INVERT_RMII0_REF_CLK BIT(18)
  1067. +#define QCA8K_IPQ4019_RGMII_CTRL_DELAY_RMII1 GENMASK(20, 19)
  1068. +#define QCA8K_IPQ4019_RGMII_CTRL_INVERT_RMII1_REF_CLK BIT(21)
  1069. +#define QCA8K_IPQ4019_RGMII_CTRL_INVERT_RMII0_MASTER_EN BIT(24)
  1070. +#define QCA8K_IPQ4019_RGMII_CTRL_INVERT_RMII1_MASTER_EN BIT(25)
  1071. +
  1072. +#define PSGMIIPHY_MODE_CONTROL 0x1b4
  1073. +#define PSGMIIPHY_MODE_ATHR_CSCO_MODE_25M BIT(0)
  1074. +#define PSGMIIPHY_TX_CONTROL 0x288
  1075. +#define PSGMIIPHY_TX_CONTROL_MAGIC_VALUE 0x8380
  1076. +#define PSGMIIPHY_VCO_CALIBRATION_CONTROL_REGISTER_1 0x9c
  1077. +#define PSGMIIPHY_REG_PLL_VCO_CALIB_RESTART BIT(14)
  1078. +#define PSGMIIPHY_VCO_CALIBRATION_CONTROL_REGISTER_2 0xa0
  1079. +#define PSGMIIPHY_REG_PLL_VCO_CALIB_READY BIT(0)
  1080. +
  1081. +#define QCA8K_PSGMII_CALB_NUM 100
  1082. +#define MII_QCA8075_SSTATUS 0x11
  1083. +#define QCA8075_PHY_SPEC_STATUS_LINK BIT(10)
  1084. +#define QCA8075_MMD7_CRC_AND_PKTS_COUNT 0x8029
  1085. +#define QCA8075_MMD7_PKT_GEN_PKT_NUMB 0x8021
  1086. +#define QCA8075_MMD7_PKT_GEN_PKT_SIZE 0x8062
  1087. +#define QCA8075_MMD7_PKT_GEN_CTRL 0x8020
  1088. +#define QCA8075_MMD7_CNT_SELFCLR BIT(1)
  1089. +#define QCA8075_MMD7_CNT_FRAME_CHK_EN BIT(0)
  1090. +#define QCA8075_MMD7_PKT_GEN_START BIT(13)
  1091. +#define QCA8075_MMD7_PKT_GEN_INPROGR BIT(15)
  1092. +#define QCA8075_MMD7_IG_FRAME_RECV_CNT_HI 0x802a
  1093. +#define QCA8075_MMD7_IG_FRAME_RECV_CNT_LO 0x802b
  1094. +#define QCA8075_MMD7_IG_FRAME_ERR_CNT 0x802c
  1095. +#define QCA8075_MMD7_EG_FRAME_RECV_CNT_HI 0x802d
  1096. +#define QCA8075_MMD7_EG_FRAME_RECV_CNT_LO 0x802e
  1097. +#define QCA8075_MMD7_EG_FRAME_ERR_CNT 0x802f
  1098. +#define QCA8075_MMD7_MDIO_BRDCST_WRITE 0x8028
  1099. +#define QCA8075_MMD7_MDIO_BRDCST_WRITE_EN BIT(15)
  1100. +#define QCA8075_MDIO_BRDCST_PHY_ADDR 0x1f
  1101. +#define QCA8075_PKT_GEN_PKTS_COUNT 4096
  1102. +
  1103. enum {
  1104. QCA8K_PORT_SPEED_10M = 0,
  1105. QCA8K_PORT_SPEED_100M = 1,
  1106. @@ -466,6 +518,10 @@ struct qca8k_priv {
  1107. struct qca8k_pcs pcs_port_6;
  1108. const struct qca8k_match_data *info;
  1109. struct qca8k_led ports_led[QCA8K_LED_COUNT];
  1110. + /* IPQ4019 specific */
  1111. + struct regmap *psgmii;
  1112. + struct phy_device *psgmii_ethphy;
  1113. + bool psgmii_calibrated;
  1114. };
  1115. struct qca8k_mib_desc {