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

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