713-v6.9-05-net-phy-qcom-detach-qca808x-PHY-driver-from-at803x.patch 63 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936
  1. From c89414adf2ec7cd9e7080c419aa5847f1db1009c Mon Sep 17 00:00:00 2001
  2. From: Christian Marangi <[email protected]>
  3. Date: Mon, 29 Jan 2024 15:15:23 +0100
  4. Subject: [PATCH 5/5] net: phy: qcom: detach qca808x PHY driver from at803x
  5. Almost all the QCA8081 PHY driver OPs are specific and only some of them
  6. use the generic at803x.
  7. To make the at803x code slimmer, move all the specific qca808x regs and
  8. functions to a dedicated PHY driver.
  9. Probe function and priv struct is reworked to allocate and use only the
  10. qca808x specific data. Unused data from at803x PHY driver are dropped
  11. from at803x priv struct.
  12. Also a new Kconfig is introduced QCA808X_PHY, to compile the newly
  13. introduced PHY driver for QCA8081 PHY.
  14. As the Kconfig name starts with Qualcomm the same order is kept.
  15. Signed-off-by: Christian Marangi <[email protected]>
  16. Reviewed-by: Andrew Lunn <[email protected]>
  17. Link: https://lore.kernel.org/r/[email protected]
  18. Signed-off-by: Jakub Kicinski <[email protected]>
  19. ---
  20. drivers/net/phy/qcom/Kconfig | 6 +
  21. drivers/net/phy/qcom/Makefile | 1 +
  22. drivers/net/phy/qcom/at803x.c | 897 +------------------------------
  23. drivers/net/phy/qcom/qca808x.c | 934 +++++++++++++++++++++++++++++++++
  24. 4 files changed, 942 insertions(+), 896 deletions(-)
  25. create mode 100644 drivers/net/phy/qcom/qca808x.c
  26. --- a/drivers/net/phy/qcom/Kconfig
  27. +++ b/drivers/net/phy/qcom/Kconfig
  28. @@ -14,3 +14,9 @@ config QCA83XX_PHY
  29. select QCOM_NET_PHYLIB
  30. help
  31. Currently supports the internal QCA8337(Internal qca8k PHY) model
  32. +
  33. +config QCA808X_PHY
  34. + tristate "Qualcomm QCA808x PHYs"
  35. + select QCOM_NET_PHYLIB
  36. + help
  37. + Currently supports the QCA8081 model
  38. --- a/drivers/net/phy/qcom/Makefile
  39. +++ b/drivers/net/phy/qcom/Makefile
  40. @@ -2,3 +2,4 @@
  41. obj-$(CONFIG_QCOM_NET_PHYLIB) += qcom-phy-lib.o
  42. obj-$(CONFIG_AT803X_PHY) += at803x.o
  43. obj-$(CONFIG_QCA83XX_PHY) += qca83xx.o
  44. +obj-$(CONFIG_QCA808X_PHY) += qca808x.o
  45. --- a/drivers/net/phy/qcom/at803x.c
  46. +++ b/drivers/net/phy/qcom/at803x.c
  47. @@ -96,8 +96,6 @@
  48. #define ATH8035_PHY_ID 0x004dd072
  49. #define AT8030_PHY_ID_MASK 0xffffffef
  50. -#define QCA8081_PHY_ID 0x004dd101
  51. -
  52. #define QCA9561_PHY_ID 0x004dd042
  53. #define AT803X_PAGE_FIBER 0
  54. @@ -110,201 +108,7 @@
  55. /* disable hibernation mode */
  56. #define AT803X_DISABLE_HIBERNATION_MODE BIT(2)
  57. -/* ADC threshold */
  58. -#define QCA808X_PHY_DEBUG_ADC_THRESHOLD 0x2c80
  59. -#define QCA808X_ADC_THRESHOLD_MASK GENMASK(7, 0)
  60. -#define QCA808X_ADC_THRESHOLD_80MV 0
  61. -#define QCA808X_ADC_THRESHOLD_100MV 0xf0
  62. -#define QCA808X_ADC_THRESHOLD_200MV 0x0f
  63. -#define QCA808X_ADC_THRESHOLD_300MV 0xff
  64. -
  65. -/* CLD control */
  66. -#define QCA808X_PHY_MMD3_ADDR_CLD_CTRL7 0x8007
  67. -#define QCA808X_8023AZ_AFE_CTRL_MASK GENMASK(8, 4)
  68. -#define QCA808X_8023AZ_AFE_EN 0x90
  69. -
  70. -/* AZ control */
  71. -#define QCA808X_PHY_MMD3_AZ_TRAINING_CTRL 0x8008
  72. -#define QCA808X_MMD3_AZ_TRAINING_VAL 0x1c32
  73. -
  74. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB 0x8014
  75. -#define QCA808X_MSE_THRESHOLD_20DB_VALUE 0x529
  76. -
  77. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB 0x800E
  78. -#define QCA808X_MSE_THRESHOLD_17DB_VALUE 0x341
  79. -
  80. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB 0x801E
  81. -#define QCA808X_MSE_THRESHOLD_27DB_VALUE 0x419
  82. -
  83. -#define QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB 0x8020
  84. -#define QCA808X_MSE_THRESHOLD_28DB_VALUE 0x341
  85. -
  86. -#define QCA808X_PHY_MMD7_TOP_OPTION1 0x901c
  87. -#define QCA808X_TOP_OPTION1_DATA 0x0
  88. -
  89. -#define QCA808X_PHY_MMD3_DEBUG_1 0xa100
  90. -#define QCA808X_MMD3_DEBUG_1_VALUE 0x9203
  91. -#define QCA808X_PHY_MMD3_DEBUG_2 0xa101
  92. -#define QCA808X_MMD3_DEBUG_2_VALUE 0x48ad
  93. -#define QCA808X_PHY_MMD3_DEBUG_3 0xa103
  94. -#define QCA808X_MMD3_DEBUG_3_VALUE 0x1698
  95. -#define QCA808X_PHY_MMD3_DEBUG_4 0xa105
  96. -#define QCA808X_MMD3_DEBUG_4_VALUE 0x8001
  97. -#define QCA808X_PHY_MMD3_DEBUG_5 0xa106
  98. -#define QCA808X_MMD3_DEBUG_5_VALUE 0x1111
  99. -#define QCA808X_PHY_MMD3_DEBUG_6 0xa011
  100. -#define QCA808X_MMD3_DEBUG_6_VALUE 0x5f85
  101. -
  102. -/* master/slave seed config */
  103. -#define QCA808X_PHY_DEBUG_LOCAL_SEED 9
  104. -#define QCA808X_MASTER_SLAVE_SEED_ENABLE BIT(1)
  105. -#define QCA808X_MASTER_SLAVE_SEED_CFG GENMASK(12, 2)
  106. -#define QCA808X_MASTER_SLAVE_SEED_RANGE 0x32
  107. -
  108. -/* Hibernation yields lower power consumpiton in contrast with normal operation mode.
  109. - * when the copper cable is unplugged, the PHY enters into hibernation mode in about 10s.
  110. - */
  111. -#define QCA808X_DBG_AN_TEST 0xb
  112. -#define QCA808X_HIBERNATION_EN BIT(15)
  113. -
  114. -#define QCA808X_CDT_ENABLE_TEST BIT(15)
  115. -#define QCA808X_CDT_INTER_CHECK_DIS BIT(13)
  116. -#define QCA808X_CDT_STATUS BIT(11)
  117. -#define QCA808X_CDT_LENGTH_UNIT BIT(10)
  118. -
  119. -#define QCA808X_MMD3_CDT_STATUS 0x8064
  120. -#define QCA808X_MMD3_CDT_DIAG_PAIR_A 0x8065
  121. -#define QCA808X_MMD3_CDT_DIAG_PAIR_B 0x8066
  122. -#define QCA808X_MMD3_CDT_DIAG_PAIR_C 0x8067
  123. -#define QCA808X_MMD3_CDT_DIAG_PAIR_D 0x8068
  124. -#define QCA808X_CDT_DIAG_LENGTH_SAME_SHORT GENMASK(15, 8)
  125. -#define QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT GENMASK(7, 0)
  126. -
  127. -#define QCA808X_CDT_CODE_PAIR_A GENMASK(15, 12)
  128. -#define QCA808X_CDT_CODE_PAIR_B GENMASK(11, 8)
  129. -#define QCA808X_CDT_CODE_PAIR_C GENMASK(7, 4)
  130. -#define QCA808X_CDT_CODE_PAIR_D GENMASK(3, 0)
  131. -
  132. -#define QCA808X_CDT_STATUS_STAT_TYPE GENMASK(1, 0)
  133. -#define QCA808X_CDT_STATUS_STAT_FAIL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 0)
  134. -#define QCA808X_CDT_STATUS_STAT_NORMAL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 1)
  135. -#define QCA808X_CDT_STATUS_STAT_SAME_OPEN FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 2)
  136. -#define QCA808X_CDT_STATUS_STAT_SAME_SHORT FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 3)
  137. -
  138. -#define QCA808X_CDT_STATUS_STAT_MDI GENMASK(3, 2)
  139. -#define QCA808X_CDT_STATUS_STAT_MDI1 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 1)
  140. -#define QCA808X_CDT_STATUS_STAT_MDI2 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 2)
  141. -#define QCA808X_CDT_STATUS_STAT_MDI3 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 3)
  142. -
  143. -/* NORMAL are MDI with type set to 0 */
  144. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI1
  145. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  146. - QCA808X_CDT_STATUS_STAT_MDI1)
  147. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  148. - QCA808X_CDT_STATUS_STAT_MDI1)
  149. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI2
  150. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  151. - QCA808X_CDT_STATUS_STAT_MDI2)
  152. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  153. - QCA808X_CDT_STATUS_STAT_MDI2)
  154. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI3
  155. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  156. - QCA808X_CDT_STATUS_STAT_MDI3)
  157. -#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  158. - QCA808X_CDT_STATUS_STAT_MDI3)
  159. -
  160. -/* Added for reference of existence but should be handled by wait_for_completion already */
  161. -#define QCA808X_CDT_STATUS_STAT_BUSY (BIT(1) | BIT(3))
  162. -
  163. -#define QCA808X_MMD7_LED_GLOBAL 0x8073
  164. -#define QCA808X_LED_BLINK_1 GENMASK(11, 6)
  165. -#define QCA808X_LED_BLINK_2 GENMASK(5, 0)
  166. -/* Values are the same for both BLINK_1 and BLINK_2 */
  167. -#define QCA808X_LED_BLINK_FREQ_MASK GENMASK(5, 3)
  168. -#define QCA808X_LED_BLINK_FREQ_2HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x0)
  169. -#define QCA808X_LED_BLINK_FREQ_4HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x1)
  170. -#define QCA808X_LED_BLINK_FREQ_8HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x2)
  171. -#define QCA808X_LED_BLINK_FREQ_16HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x3)
  172. -#define QCA808X_LED_BLINK_FREQ_32HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x4)
  173. -#define QCA808X_LED_BLINK_FREQ_64HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x5)
  174. -#define QCA808X_LED_BLINK_FREQ_128HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x6)
  175. -#define QCA808X_LED_BLINK_FREQ_256HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x7)
  176. -#define QCA808X_LED_BLINK_DUTY_MASK GENMASK(2, 0)
  177. -#define QCA808X_LED_BLINK_DUTY_50_50 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x0)
  178. -#define QCA808X_LED_BLINK_DUTY_75_25 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x1)
  179. -#define QCA808X_LED_BLINK_DUTY_25_75 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x2)
  180. -#define QCA808X_LED_BLINK_DUTY_33_67 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x3)
  181. -#define QCA808X_LED_BLINK_DUTY_67_33 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x4)
  182. -#define QCA808X_LED_BLINK_DUTY_17_83 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x5)
  183. -#define QCA808X_LED_BLINK_DUTY_83_17 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x6)
  184. -#define QCA808X_LED_BLINK_DUTY_8_92 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x7)
  185. -
  186. -#define QCA808X_MMD7_LED2_CTRL 0x8074
  187. -#define QCA808X_MMD7_LED2_FORCE_CTRL 0x8075
  188. -#define QCA808X_MMD7_LED1_CTRL 0x8076
  189. -#define QCA808X_MMD7_LED1_FORCE_CTRL 0x8077
  190. -#define QCA808X_MMD7_LED0_CTRL 0x8078
  191. -#define QCA808X_MMD7_LED_CTRL(x) (0x8078 - ((x) * 2))
  192. -
  193. -/* LED hw control pattern is the same for every LED */
  194. -#define QCA808X_LED_PATTERN_MASK GENMASK(15, 0)
  195. -#define QCA808X_LED_SPEED2500_ON BIT(15)
  196. -#define QCA808X_LED_SPEED2500_BLINK BIT(14)
  197. -/* Follow blink trigger even if duplex or speed condition doesn't match */
  198. -#define QCA808X_LED_BLINK_CHECK_BYPASS BIT(13)
  199. -#define QCA808X_LED_FULL_DUPLEX_ON BIT(12)
  200. -#define QCA808X_LED_HALF_DUPLEX_ON BIT(11)
  201. -#define QCA808X_LED_TX_BLINK BIT(10)
  202. -#define QCA808X_LED_RX_BLINK BIT(9)
  203. -#define QCA808X_LED_TX_ON_10MS BIT(8)
  204. -#define QCA808X_LED_RX_ON_10MS BIT(7)
  205. -#define QCA808X_LED_SPEED1000_ON BIT(6)
  206. -#define QCA808X_LED_SPEED100_ON BIT(5)
  207. -#define QCA808X_LED_SPEED10_ON BIT(4)
  208. -#define QCA808X_LED_COLLISION_BLINK BIT(3)
  209. -#define QCA808X_LED_SPEED1000_BLINK BIT(2)
  210. -#define QCA808X_LED_SPEED100_BLINK BIT(1)
  211. -#define QCA808X_LED_SPEED10_BLINK BIT(0)
  212. -
  213. -#define QCA808X_MMD7_LED0_FORCE_CTRL 0x8079
  214. -#define QCA808X_MMD7_LED_FORCE_CTRL(x) (0x8079 - ((x) * 2))
  215. -
  216. -/* LED force ctrl is the same for every LED
  217. - * No documentation exist for this, not even internal one
  218. - * with NDA as QCOM gives only info about configuring
  219. - * hw control pattern rules and doesn't indicate any way
  220. - * to force the LED to specific mode.
  221. - * These define comes from reverse and testing and maybe
  222. - * lack of some info or some info are not entirely correct.
  223. - * For the basic LED control and hw control these finding
  224. - * are enough to support LED control in all the required APIs.
  225. - *
  226. - * On doing some comparison with implementation with qca807x,
  227. - * it was found that it's 1:1 equal to it and confirms all the
  228. - * reverse done. It was also found further specification with the
  229. - * force mode and the blink modes.
  230. - */
  231. -#define QCA808X_LED_FORCE_EN BIT(15)
  232. -#define QCA808X_LED_FORCE_MODE_MASK GENMASK(14, 13)
  233. -#define QCA808X_LED_FORCE_BLINK_1 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x3)
  234. -#define QCA808X_LED_FORCE_BLINK_2 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x2)
  235. -#define QCA808X_LED_FORCE_ON FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x1)
  236. -#define QCA808X_LED_FORCE_OFF FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x0)
  237. -
  238. -#define QCA808X_MMD7_LED_POLARITY_CTRL 0x901a
  239. -/* QSDK sets by default 0x46 to this reg that sets BIT 6 for
  240. - * LED to active high. It's not clear what BIT 3 and BIT 4 does.
  241. - */
  242. -#define QCA808X_LED_ACTIVE_HIGH BIT(6)
  243. -
  244. -/* QCA808X 1G chip type */
  245. -#define QCA808X_PHY_MMD7_CHIP_TYPE 0x901d
  246. -#define QCA808X_PHY_CHIP_TYPE_1G BIT(0)
  247. -
  248. -#define QCA8081_PHY_SERDES_MMD1_FIFO_CTRL 0x9072
  249. -#define QCA8081_PHY_FIFO_RSTN BIT(11)
  250. -
  251. -MODULE_DESCRIPTION("Qualcomm Atheros AR803x and QCA808X PHY driver");
  252. +MODULE_DESCRIPTION("Qualcomm Atheros AR803x PHY driver");
  253. MODULE_AUTHOR("Matus Ujhelyi");
  254. MODULE_LICENSE("GPL");
  255. @@ -318,7 +122,6 @@ struct at803x_priv {
  256. bool is_1000basex;
  257. struct regulator_dev *vddio_rdev;
  258. struct regulator_dev *vddh_rdev;
  259. - int led_polarity_mode;
  260. };
  261. struct at803x_context {
  262. @@ -519,9 +322,6 @@ static int at803x_probe(struct phy_devic
  263. if (!priv)
  264. return -ENOMEM;
  265. - /* Init LED polarity mode to -1 */
  266. - priv->led_polarity_mode = -1;
  267. -
  268. phydev->priv = priv;
  269. ret = at803x_parse_dt(phydev);
  270. @@ -1216,672 +1016,6 @@ static int at8035_probe(struct phy_devic
  271. return at8035_parse_dt(phydev);
  272. }
  273. -static int qca808x_phy_fast_retrain_config(struct phy_device *phydev)
  274. -{
  275. - int ret;
  276. -
  277. - /* Enable fast retrain */
  278. - ret = genphy_c45_fast_retrain(phydev, true);
  279. - if (ret)
  280. - return ret;
  281. -
  282. - phy_write_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_TOP_OPTION1,
  283. - QCA808X_TOP_OPTION1_DATA);
  284. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB,
  285. - QCA808X_MSE_THRESHOLD_20DB_VALUE);
  286. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB,
  287. - QCA808X_MSE_THRESHOLD_17DB_VALUE);
  288. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB,
  289. - QCA808X_MSE_THRESHOLD_27DB_VALUE);
  290. - phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB,
  291. - QCA808X_MSE_THRESHOLD_28DB_VALUE);
  292. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_1,
  293. - QCA808X_MMD3_DEBUG_1_VALUE);
  294. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_4,
  295. - QCA808X_MMD3_DEBUG_4_VALUE);
  296. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_5,
  297. - QCA808X_MMD3_DEBUG_5_VALUE);
  298. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_3,
  299. - QCA808X_MMD3_DEBUG_3_VALUE);
  300. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_6,
  301. - QCA808X_MMD3_DEBUG_6_VALUE);
  302. - phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_2,
  303. - QCA808X_MMD3_DEBUG_2_VALUE);
  304. -
  305. - return 0;
  306. -}
  307. -
  308. -static int qca808x_phy_ms_seed_enable(struct phy_device *phydev, bool enable)
  309. -{
  310. - u16 seed_value;
  311. -
  312. - if (!enable)
  313. - return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  314. - QCA808X_MASTER_SLAVE_SEED_ENABLE, 0);
  315. -
  316. - seed_value = get_random_u32_below(QCA808X_MASTER_SLAVE_SEED_RANGE);
  317. - return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  318. - QCA808X_MASTER_SLAVE_SEED_CFG | QCA808X_MASTER_SLAVE_SEED_ENABLE,
  319. - FIELD_PREP(QCA808X_MASTER_SLAVE_SEED_CFG, seed_value) |
  320. - QCA808X_MASTER_SLAVE_SEED_ENABLE);
  321. -}
  322. -
  323. -static bool qca808x_is_prefer_master(struct phy_device *phydev)
  324. -{
  325. - return (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_FORCE) ||
  326. - (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_PREFERRED);
  327. -}
  328. -
  329. -static bool qca808x_has_fast_retrain_or_slave_seed(struct phy_device *phydev)
  330. -{
  331. - return linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  332. -}
  333. -
  334. -static int qca808x_config_init(struct phy_device *phydev)
  335. -{
  336. - int ret;
  337. -
  338. - /* Active adc&vga on 802.3az for the link 1000M and 100M */
  339. - ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_ADDR_CLD_CTRL7,
  340. - QCA808X_8023AZ_AFE_CTRL_MASK, QCA808X_8023AZ_AFE_EN);
  341. - if (ret)
  342. - return ret;
  343. -
  344. - /* Adjust the threshold on 802.3az for the link 1000M */
  345. - ret = phy_write_mmd(phydev, MDIO_MMD_PCS,
  346. - QCA808X_PHY_MMD3_AZ_TRAINING_CTRL,
  347. - QCA808X_MMD3_AZ_TRAINING_VAL);
  348. - if (ret)
  349. - return ret;
  350. -
  351. - if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  352. - /* Config the fast retrain for the link 2500M */
  353. - ret = qca808x_phy_fast_retrain_config(phydev);
  354. - if (ret)
  355. - return ret;
  356. -
  357. - ret = genphy_read_master_slave(phydev);
  358. - if (ret < 0)
  359. - return ret;
  360. -
  361. - if (!qca808x_is_prefer_master(phydev)) {
  362. - /* Enable seed and configure lower ramdom seed to make phy
  363. - * linked as slave mode.
  364. - */
  365. - ret = qca808x_phy_ms_seed_enable(phydev, true);
  366. - if (ret)
  367. - return ret;
  368. - }
  369. - }
  370. -
  371. - /* Configure adc threshold as 100mv for the link 10M */
  372. - return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_ADC_THRESHOLD,
  373. - QCA808X_ADC_THRESHOLD_MASK,
  374. - QCA808X_ADC_THRESHOLD_100MV);
  375. -}
  376. -
  377. -static int qca808x_read_status(struct phy_device *phydev)
  378. -{
  379. - struct at803x_ss_mask ss_mask = { 0 };
  380. - int ret;
  381. -
  382. - ret = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_STAT);
  383. - if (ret < 0)
  384. - return ret;
  385. -
  386. - linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->lp_advertising,
  387. - ret & MDIO_AN_10GBT_STAT_LP2_5G);
  388. -
  389. - ret = genphy_read_status(phydev);
  390. - if (ret)
  391. - return ret;
  392. -
  393. - /* qca8081 takes the different bits for speed value from at803x */
  394. - ss_mask.speed_mask = QCA808X_SS_SPEED_MASK;
  395. - ss_mask.speed_shift = __bf_shf(QCA808X_SS_SPEED_MASK);
  396. - ret = at803x_read_specific_status(phydev, ss_mask);
  397. - if (ret < 0)
  398. - return ret;
  399. -
  400. - if (phydev->link) {
  401. - if (phydev->speed == SPEED_2500)
  402. - phydev->interface = PHY_INTERFACE_MODE_2500BASEX;
  403. - else
  404. - phydev->interface = PHY_INTERFACE_MODE_SGMII;
  405. - } else {
  406. - /* generate seed as a lower random value to make PHY linked as SLAVE easily,
  407. - * except for master/slave configuration fault detected or the master mode
  408. - * preferred.
  409. - *
  410. - * the reason for not putting this code into the function link_change_notify is
  411. - * the corner case where the link partner is also the qca8081 PHY and the seed
  412. - * value is configured as the same value, the link can't be up and no link change
  413. - * occurs.
  414. - */
  415. - if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  416. - if (phydev->master_slave_state == MASTER_SLAVE_STATE_ERR ||
  417. - qca808x_is_prefer_master(phydev)) {
  418. - qca808x_phy_ms_seed_enable(phydev, false);
  419. - } else {
  420. - qca808x_phy_ms_seed_enable(phydev, true);
  421. - }
  422. - }
  423. - }
  424. -
  425. - return 0;
  426. -}
  427. -
  428. -static int qca808x_soft_reset(struct phy_device *phydev)
  429. -{
  430. - int ret;
  431. -
  432. - ret = genphy_soft_reset(phydev);
  433. - if (ret < 0)
  434. - return ret;
  435. -
  436. - if (qca808x_has_fast_retrain_or_slave_seed(phydev))
  437. - ret = qca808x_phy_ms_seed_enable(phydev, true);
  438. -
  439. - return ret;
  440. -}
  441. -
  442. -static bool qca808x_cdt_fault_length_valid(int cdt_code)
  443. -{
  444. - switch (cdt_code) {
  445. - case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  446. - case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  447. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  448. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  449. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  450. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  451. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  452. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  453. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  454. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  455. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  456. - return true;
  457. - default:
  458. - return false;
  459. - }
  460. -}
  461. -
  462. -static int qca808x_cable_test_result_trans(int cdt_code)
  463. -{
  464. - switch (cdt_code) {
  465. - case QCA808X_CDT_STATUS_STAT_NORMAL:
  466. - return ETHTOOL_A_CABLE_RESULT_CODE_OK;
  467. - case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  468. - return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
  469. - case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  470. - return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
  471. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  472. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  473. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  474. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  475. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  476. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  477. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  478. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  479. - case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  480. - return ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT;
  481. - case QCA808X_CDT_STATUS_STAT_FAIL:
  482. - default:
  483. - return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  484. - }
  485. -}
  486. -
  487. -static int qca808x_cdt_fault_length(struct phy_device *phydev, int pair,
  488. - int result)
  489. -{
  490. - int val;
  491. - u32 cdt_length_reg = 0;
  492. -
  493. - switch (pair) {
  494. - case ETHTOOL_A_CABLE_PAIR_A:
  495. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_A;
  496. - break;
  497. - case ETHTOOL_A_CABLE_PAIR_B:
  498. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_B;
  499. - break;
  500. - case ETHTOOL_A_CABLE_PAIR_C:
  501. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_C;
  502. - break;
  503. - case ETHTOOL_A_CABLE_PAIR_D:
  504. - cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_D;
  505. - break;
  506. - default:
  507. - return -EINVAL;
  508. - }
  509. -
  510. - val = phy_read_mmd(phydev, MDIO_MMD_PCS, cdt_length_reg);
  511. - if (val < 0)
  512. - return val;
  513. -
  514. - if (result == ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT)
  515. - val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_SAME_SHORT, val);
  516. - else
  517. - val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT, val);
  518. -
  519. - return at803x_cdt_fault_length(val);
  520. -}
  521. -
  522. -static int qca808x_cable_test_start(struct phy_device *phydev)
  523. -{
  524. - int ret;
  525. -
  526. - /* perform CDT with the following configs:
  527. - * 1. disable hibernation.
  528. - * 2. force PHY working in MDI mode.
  529. - * 3. for PHY working in 1000BaseT.
  530. - * 4. configure the threshold.
  531. - */
  532. -
  533. - ret = at803x_debug_reg_mask(phydev, QCA808X_DBG_AN_TEST, QCA808X_HIBERNATION_EN, 0);
  534. - if (ret < 0)
  535. - return ret;
  536. -
  537. - ret = at803x_config_mdix(phydev, ETH_TP_MDI);
  538. - if (ret < 0)
  539. - return ret;
  540. -
  541. - /* Force 1000base-T needs to configure PMA/PMD and MII_BMCR */
  542. - phydev->duplex = DUPLEX_FULL;
  543. - phydev->speed = SPEED_1000;
  544. - ret = genphy_c45_pma_setup_forced(phydev);
  545. - if (ret < 0)
  546. - return ret;
  547. -
  548. - ret = genphy_setup_forced(phydev);
  549. - if (ret < 0)
  550. - return ret;
  551. -
  552. - /* configure the thresholds for open, short, pair ok test */
  553. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8074, 0xc040);
  554. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8076, 0xc040);
  555. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8077, 0xa060);
  556. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8078, 0xc050);
  557. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807a, 0xc060);
  558. - phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807e, 0xb060);
  559. -
  560. - return 0;
  561. -}
  562. -
  563. -static int qca808x_cable_test_get_pair_status(struct phy_device *phydev, u8 pair,
  564. - u16 status)
  565. -{
  566. - int length, result;
  567. - u16 pair_code;
  568. -
  569. - switch (pair) {
  570. - case ETHTOOL_A_CABLE_PAIR_A:
  571. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_A, status);
  572. - break;
  573. - case ETHTOOL_A_CABLE_PAIR_B:
  574. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_B, status);
  575. - break;
  576. - case ETHTOOL_A_CABLE_PAIR_C:
  577. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_C, status);
  578. - break;
  579. - case ETHTOOL_A_CABLE_PAIR_D:
  580. - pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_D, status);
  581. - break;
  582. - default:
  583. - return -EINVAL;
  584. - }
  585. -
  586. - result = qca808x_cable_test_result_trans(pair_code);
  587. - ethnl_cable_test_result(phydev, pair, result);
  588. -
  589. - if (qca808x_cdt_fault_length_valid(pair_code)) {
  590. - length = qca808x_cdt_fault_length(phydev, pair, result);
  591. - ethnl_cable_test_fault_length(phydev, pair, length);
  592. - }
  593. -
  594. - return 0;
  595. -}
  596. -
  597. -static int qca808x_cable_test_get_status(struct phy_device *phydev, bool *finished)
  598. -{
  599. - int ret, val;
  600. -
  601. - *finished = false;
  602. -
  603. - val = QCA808X_CDT_ENABLE_TEST |
  604. - QCA808X_CDT_LENGTH_UNIT;
  605. - ret = at803x_cdt_start(phydev, val);
  606. - if (ret)
  607. - return ret;
  608. -
  609. - ret = at803x_cdt_wait_for_completion(phydev, QCA808X_CDT_ENABLE_TEST);
  610. - if (ret)
  611. - return ret;
  612. -
  613. - val = phy_read_mmd(phydev, MDIO_MMD_PCS, QCA808X_MMD3_CDT_STATUS);
  614. - if (val < 0)
  615. - return val;
  616. -
  617. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_A, val);
  618. - if (ret)
  619. - return ret;
  620. -
  621. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_B, val);
  622. - if (ret)
  623. - return ret;
  624. -
  625. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_C, val);
  626. - if (ret)
  627. - return ret;
  628. -
  629. - ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_D, val);
  630. - if (ret)
  631. - return ret;
  632. -
  633. - *finished = true;
  634. -
  635. - return 0;
  636. -}
  637. -
  638. -static int qca808x_get_features(struct phy_device *phydev)
  639. -{
  640. - int ret;
  641. -
  642. - ret = genphy_c45_pma_read_abilities(phydev);
  643. - if (ret)
  644. - return ret;
  645. -
  646. - /* The autoneg ability is not existed in bit3 of MMD7.1,
  647. - * but it is supported by qca808x PHY, so we add it here
  648. - * manually.
  649. - */
  650. - linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported);
  651. -
  652. - /* As for the qca8081 1G version chip, the 2500baseT ability is also
  653. - * existed in the bit0 of MMD1.21, we need to remove it manually if
  654. - * it is the qca8081 1G chip according to the bit0 of MMD7.0x901d.
  655. - */
  656. - ret = phy_read_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_CHIP_TYPE);
  657. - if (ret < 0)
  658. - return ret;
  659. -
  660. - if (QCA808X_PHY_CHIP_TYPE_1G & ret)
  661. - linkmode_clear_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  662. -
  663. - return 0;
  664. -}
  665. -
  666. -static int qca808x_config_aneg(struct phy_device *phydev)
  667. -{
  668. - int phy_ctrl = 0;
  669. - int ret;
  670. -
  671. - ret = at803x_prepare_config_aneg(phydev);
  672. - if (ret)
  673. - return ret;
  674. -
  675. - /* The reg MII_BMCR also needs to be configured for force mode, the
  676. - * genphy_config_aneg is also needed.
  677. - */
  678. - if (phydev->autoneg == AUTONEG_DISABLE)
  679. - genphy_c45_pma_setup_forced(phydev);
  680. -
  681. - if (linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->advertising))
  682. - phy_ctrl = MDIO_AN_10GBT_CTRL_ADV2_5G;
  683. -
  684. - ret = phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_CTRL,
  685. - MDIO_AN_10GBT_CTRL_ADV2_5G, phy_ctrl);
  686. - if (ret < 0)
  687. - return ret;
  688. -
  689. - return __genphy_config_aneg(phydev, ret);
  690. -}
  691. -
  692. -static void qca808x_link_change_notify(struct phy_device *phydev)
  693. -{
  694. - /* Assert interface sgmii fifo on link down, deassert it on link up,
  695. - * the interface device address is always phy address added by 1.
  696. - */
  697. - mdiobus_c45_modify_changed(phydev->mdio.bus, phydev->mdio.addr + 1,
  698. - MDIO_MMD_PMAPMD, QCA8081_PHY_SERDES_MMD1_FIFO_CTRL,
  699. - QCA8081_PHY_FIFO_RSTN,
  700. - phydev->link ? QCA8081_PHY_FIFO_RSTN : 0);
  701. -}
  702. -
  703. -static int qca808x_led_parse_netdev(struct phy_device *phydev, unsigned long rules,
  704. - u16 *offload_trigger)
  705. -{
  706. - /* Parsing specific to netdev trigger */
  707. - if (test_bit(TRIGGER_NETDEV_TX, &rules))
  708. - *offload_trigger |= QCA808X_LED_TX_BLINK;
  709. - if (test_bit(TRIGGER_NETDEV_RX, &rules))
  710. - *offload_trigger |= QCA808X_LED_RX_BLINK;
  711. - if (test_bit(TRIGGER_NETDEV_LINK_10, &rules))
  712. - *offload_trigger |= QCA808X_LED_SPEED10_ON;
  713. - if (test_bit(TRIGGER_NETDEV_LINK_100, &rules))
  714. - *offload_trigger |= QCA808X_LED_SPEED100_ON;
  715. - if (test_bit(TRIGGER_NETDEV_LINK_1000, &rules))
  716. - *offload_trigger |= QCA808X_LED_SPEED1000_ON;
  717. - if (test_bit(TRIGGER_NETDEV_LINK_2500, &rules))
  718. - *offload_trigger |= QCA808X_LED_SPEED2500_ON;
  719. - if (test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &rules))
  720. - *offload_trigger |= QCA808X_LED_HALF_DUPLEX_ON;
  721. - if (test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &rules))
  722. - *offload_trigger |= QCA808X_LED_FULL_DUPLEX_ON;
  723. -
  724. - if (rules && !*offload_trigger)
  725. - return -EOPNOTSUPP;
  726. -
  727. - /* Enable BLINK_CHECK_BYPASS by default to make the LED
  728. - * blink even with duplex or speed mode not enabled.
  729. - */
  730. - *offload_trigger |= QCA808X_LED_BLINK_CHECK_BYPASS;
  731. -
  732. - return 0;
  733. -}
  734. -
  735. -static int qca808x_led_hw_control_enable(struct phy_device *phydev, u8 index)
  736. -{
  737. - u16 reg;
  738. -
  739. - if (index > 2)
  740. - return -EINVAL;
  741. -
  742. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  743. -
  744. - return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  745. - QCA808X_LED_FORCE_EN);
  746. -}
  747. -
  748. -static int qca808x_led_hw_is_supported(struct phy_device *phydev, u8 index,
  749. - unsigned long rules)
  750. -{
  751. - u16 offload_trigger = 0;
  752. -
  753. - if (index > 2)
  754. - return -EINVAL;
  755. -
  756. - return qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  757. -}
  758. -
  759. -static int qca808x_led_hw_control_set(struct phy_device *phydev, u8 index,
  760. - unsigned long rules)
  761. -{
  762. - u16 reg, offload_trigger = 0;
  763. - int ret;
  764. -
  765. - if (index > 2)
  766. - return -EINVAL;
  767. -
  768. - reg = QCA808X_MMD7_LED_CTRL(index);
  769. -
  770. - ret = qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  771. - if (ret)
  772. - return ret;
  773. -
  774. - ret = qca808x_led_hw_control_enable(phydev, index);
  775. - if (ret)
  776. - return ret;
  777. -
  778. - return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  779. - QCA808X_LED_PATTERN_MASK,
  780. - offload_trigger);
  781. -}
  782. -
  783. -static bool qca808x_led_hw_control_status(struct phy_device *phydev, u8 index)
  784. -{
  785. - u16 reg;
  786. - int val;
  787. -
  788. - if (index > 2)
  789. - return false;
  790. -
  791. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  792. -
  793. - val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  794. -
  795. - return !(val & QCA808X_LED_FORCE_EN);
  796. -}
  797. -
  798. -static int qca808x_led_hw_control_get(struct phy_device *phydev, u8 index,
  799. - unsigned long *rules)
  800. -{
  801. - u16 reg;
  802. - int val;
  803. -
  804. - if (index > 2)
  805. - return -EINVAL;
  806. -
  807. - /* Check if we have hw control enabled */
  808. - if (qca808x_led_hw_control_status(phydev, index))
  809. - return -EINVAL;
  810. -
  811. - reg = QCA808X_MMD7_LED_CTRL(index);
  812. -
  813. - val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  814. - if (val & QCA808X_LED_TX_BLINK)
  815. - set_bit(TRIGGER_NETDEV_TX, rules);
  816. - if (val & QCA808X_LED_RX_BLINK)
  817. - set_bit(TRIGGER_NETDEV_RX, rules);
  818. - if (val & QCA808X_LED_SPEED10_ON)
  819. - set_bit(TRIGGER_NETDEV_LINK_10, rules);
  820. - if (val & QCA808X_LED_SPEED100_ON)
  821. - set_bit(TRIGGER_NETDEV_LINK_100, rules);
  822. - if (val & QCA808X_LED_SPEED1000_ON)
  823. - set_bit(TRIGGER_NETDEV_LINK_1000, rules);
  824. - if (val & QCA808X_LED_SPEED2500_ON)
  825. - set_bit(TRIGGER_NETDEV_LINK_2500, rules);
  826. - if (val & QCA808X_LED_HALF_DUPLEX_ON)
  827. - set_bit(TRIGGER_NETDEV_HALF_DUPLEX, rules);
  828. - if (val & QCA808X_LED_FULL_DUPLEX_ON)
  829. - set_bit(TRIGGER_NETDEV_FULL_DUPLEX, rules);
  830. -
  831. - return 0;
  832. -}
  833. -
  834. -static int qca808x_led_hw_control_reset(struct phy_device *phydev, u8 index)
  835. -{
  836. - u16 reg;
  837. -
  838. - if (index > 2)
  839. - return -EINVAL;
  840. -
  841. - reg = QCA808X_MMD7_LED_CTRL(index);
  842. -
  843. - return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  844. - QCA808X_LED_PATTERN_MASK);
  845. -}
  846. -
  847. -static int qca808x_led_brightness_set(struct phy_device *phydev,
  848. - u8 index, enum led_brightness value)
  849. -{
  850. - u16 reg;
  851. - int ret;
  852. -
  853. - if (index > 2)
  854. - return -EINVAL;
  855. -
  856. - if (!value) {
  857. - ret = qca808x_led_hw_control_reset(phydev, index);
  858. - if (ret)
  859. - return ret;
  860. - }
  861. -
  862. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  863. -
  864. - return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  865. - QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  866. - QCA808X_LED_FORCE_EN | value ? QCA808X_LED_FORCE_ON :
  867. - QCA808X_LED_FORCE_OFF);
  868. -}
  869. -
  870. -static int qca808x_led_blink_set(struct phy_device *phydev, u8 index,
  871. - unsigned long *delay_on,
  872. - unsigned long *delay_off)
  873. -{
  874. - int ret;
  875. - u16 reg;
  876. -
  877. - if (index > 2)
  878. - return -EINVAL;
  879. -
  880. - reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  881. -
  882. - /* Set blink to 50% off, 50% on at 4Hz by default */
  883. - ret = phy_modify_mmd(phydev, MDIO_MMD_AN, QCA808X_MMD7_LED_GLOBAL,
  884. - QCA808X_LED_BLINK_FREQ_MASK | QCA808X_LED_BLINK_DUTY_MASK,
  885. - QCA808X_LED_BLINK_FREQ_4HZ | QCA808X_LED_BLINK_DUTY_50_50);
  886. - if (ret)
  887. - return ret;
  888. -
  889. - /* We use BLINK_1 for normal blinking */
  890. - ret = phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  891. - QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  892. - QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_BLINK_1);
  893. - if (ret)
  894. - return ret;
  895. -
  896. - /* We set blink to 4Hz, aka 250ms */
  897. - *delay_on = 250 / 2;
  898. - *delay_off = 250 / 2;
  899. -
  900. - return 0;
  901. -}
  902. -
  903. -static int qca808x_led_polarity_set(struct phy_device *phydev, int index,
  904. - unsigned long modes)
  905. -{
  906. - struct at803x_priv *priv = phydev->priv;
  907. - bool active_low = false;
  908. - u32 mode;
  909. -
  910. - for_each_set_bit(mode, &modes, __PHY_LED_MODES_NUM) {
  911. - switch (mode) {
  912. - case PHY_LED_ACTIVE_LOW:
  913. - active_low = true;
  914. - break;
  915. - default:
  916. - return -EINVAL;
  917. - }
  918. - }
  919. -
  920. - /* PHY polarity is global and can't be set per LED.
  921. - * To detect this, check if last requested polarity mode
  922. - * match the new one.
  923. - */
  924. - if (priv->led_polarity_mode >= 0 &&
  925. - priv->led_polarity_mode != active_low) {
  926. - phydev_err(phydev, "PHY polarity is global. Mismatched polarity on different LED\n");
  927. - return -EINVAL;
  928. - }
  929. -
  930. - /* Save the last PHY polarity mode */
  931. - priv->led_polarity_mode = active_low;
  932. -
  933. - return phy_modify_mmd(phydev, MDIO_MMD_AN,
  934. - QCA808X_MMD7_LED_POLARITY_CTRL,
  935. - QCA808X_LED_ACTIVE_HIGH,
  936. - active_low ? 0 : QCA808X_LED_ACTIVE_HIGH);
  937. -}
  938. -
  939. static struct phy_driver at803x_driver[] = {
  940. {
  941. /* Qualcomm Atheros AR8035 */
  942. @@ -1989,34 +1123,6 @@ static struct phy_driver at803x_driver[]
  943. .read_status = at803x_read_status,
  944. .soft_reset = genphy_soft_reset,
  945. .config_aneg = at803x_config_aneg,
  946. -}, {
  947. - /* Qualcomm QCA8081 */
  948. - PHY_ID_MATCH_EXACT(QCA8081_PHY_ID),
  949. - .name = "Qualcomm QCA8081",
  950. - .flags = PHY_POLL_CABLE_TEST,
  951. - .probe = at803x_probe,
  952. - .config_intr = at803x_config_intr,
  953. - .handle_interrupt = at803x_handle_interrupt,
  954. - .get_tunable = at803x_get_tunable,
  955. - .set_tunable = at803x_set_tunable,
  956. - .set_wol = at803x_set_wol,
  957. - .get_wol = at803x_get_wol,
  958. - .get_features = qca808x_get_features,
  959. - .config_aneg = qca808x_config_aneg,
  960. - .suspend = genphy_suspend,
  961. - .resume = genphy_resume,
  962. - .read_status = qca808x_read_status,
  963. - .config_init = qca808x_config_init,
  964. - .soft_reset = qca808x_soft_reset,
  965. - .cable_test_start = qca808x_cable_test_start,
  966. - .cable_test_get_status = qca808x_cable_test_get_status,
  967. - .link_change_notify = qca808x_link_change_notify,
  968. - .led_brightness_set = qca808x_led_brightness_set,
  969. - .led_blink_set = qca808x_led_blink_set,
  970. - .led_hw_is_supported = qca808x_led_hw_is_supported,
  971. - .led_hw_control_set = qca808x_led_hw_control_set,
  972. - .led_hw_control_get = qca808x_led_hw_control_get,
  973. - .led_polarity_set = qca808x_led_polarity_set,
  974. }, };
  975. module_phy_driver(at803x_driver);
  976. @@ -2028,7 +1134,6 @@ static struct mdio_device_id __maybe_unu
  977. { PHY_ID_MATCH_EXACT(ATH8035_PHY_ID) },
  978. { PHY_ID_MATCH_EXACT(ATH9331_PHY_ID) },
  979. { PHY_ID_MATCH_EXACT(QCA9561_PHY_ID) },
  980. - { PHY_ID_MATCH_EXACT(QCA8081_PHY_ID) },
  981. { }
  982. };
  983. --- /dev/null
  984. +++ b/drivers/net/phy/qcom/qca808x.c
  985. @@ -0,0 +1,934 @@
  986. +// SPDX-License-Identifier: GPL-2.0+
  987. +
  988. +#include <linux/phy.h>
  989. +#include <linux/module.h>
  990. +#include <linux/ethtool_netlink.h>
  991. +
  992. +#include "qcom.h"
  993. +
  994. +/* ADC threshold */
  995. +#define QCA808X_PHY_DEBUG_ADC_THRESHOLD 0x2c80
  996. +#define QCA808X_ADC_THRESHOLD_MASK GENMASK(7, 0)
  997. +#define QCA808X_ADC_THRESHOLD_80MV 0
  998. +#define QCA808X_ADC_THRESHOLD_100MV 0xf0
  999. +#define QCA808X_ADC_THRESHOLD_200MV 0x0f
  1000. +#define QCA808X_ADC_THRESHOLD_300MV 0xff
  1001. +
  1002. +/* CLD control */
  1003. +#define QCA808X_PHY_MMD3_ADDR_CLD_CTRL7 0x8007
  1004. +#define QCA808X_8023AZ_AFE_CTRL_MASK GENMASK(8, 4)
  1005. +#define QCA808X_8023AZ_AFE_EN 0x90
  1006. +
  1007. +/* AZ control */
  1008. +#define QCA808X_PHY_MMD3_AZ_TRAINING_CTRL 0x8008
  1009. +#define QCA808X_MMD3_AZ_TRAINING_VAL 0x1c32
  1010. +
  1011. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB 0x8014
  1012. +#define QCA808X_MSE_THRESHOLD_20DB_VALUE 0x529
  1013. +
  1014. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB 0x800E
  1015. +#define QCA808X_MSE_THRESHOLD_17DB_VALUE 0x341
  1016. +
  1017. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB 0x801E
  1018. +#define QCA808X_MSE_THRESHOLD_27DB_VALUE 0x419
  1019. +
  1020. +#define QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB 0x8020
  1021. +#define QCA808X_MSE_THRESHOLD_28DB_VALUE 0x341
  1022. +
  1023. +#define QCA808X_PHY_MMD7_TOP_OPTION1 0x901c
  1024. +#define QCA808X_TOP_OPTION1_DATA 0x0
  1025. +
  1026. +#define QCA808X_PHY_MMD3_DEBUG_1 0xa100
  1027. +#define QCA808X_MMD3_DEBUG_1_VALUE 0x9203
  1028. +#define QCA808X_PHY_MMD3_DEBUG_2 0xa101
  1029. +#define QCA808X_MMD3_DEBUG_2_VALUE 0x48ad
  1030. +#define QCA808X_PHY_MMD3_DEBUG_3 0xa103
  1031. +#define QCA808X_MMD3_DEBUG_3_VALUE 0x1698
  1032. +#define QCA808X_PHY_MMD3_DEBUG_4 0xa105
  1033. +#define QCA808X_MMD3_DEBUG_4_VALUE 0x8001
  1034. +#define QCA808X_PHY_MMD3_DEBUG_5 0xa106
  1035. +#define QCA808X_MMD3_DEBUG_5_VALUE 0x1111
  1036. +#define QCA808X_PHY_MMD3_DEBUG_6 0xa011
  1037. +#define QCA808X_MMD3_DEBUG_6_VALUE 0x5f85
  1038. +
  1039. +/* master/slave seed config */
  1040. +#define QCA808X_PHY_DEBUG_LOCAL_SEED 9
  1041. +#define QCA808X_MASTER_SLAVE_SEED_ENABLE BIT(1)
  1042. +#define QCA808X_MASTER_SLAVE_SEED_CFG GENMASK(12, 2)
  1043. +#define QCA808X_MASTER_SLAVE_SEED_RANGE 0x32
  1044. +
  1045. +/* Hibernation yields lower power consumpiton in contrast with normal operation mode.
  1046. + * when the copper cable is unplugged, the PHY enters into hibernation mode in about 10s.
  1047. + */
  1048. +#define QCA808X_DBG_AN_TEST 0xb
  1049. +#define QCA808X_HIBERNATION_EN BIT(15)
  1050. +
  1051. +#define QCA808X_CDT_ENABLE_TEST BIT(15)
  1052. +#define QCA808X_CDT_INTER_CHECK_DIS BIT(13)
  1053. +#define QCA808X_CDT_STATUS BIT(11)
  1054. +#define QCA808X_CDT_LENGTH_UNIT BIT(10)
  1055. +
  1056. +#define QCA808X_MMD3_CDT_STATUS 0x8064
  1057. +#define QCA808X_MMD3_CDT_DIAG_PAIR_A 0x8065
  1058. +#define QCA808X_MMD3_CDT_DIAG_PAIR_B 0x8066
  1059. +#define QCA808X_MMD3_CDT_DIAG_PAIR_C 0x8067
  1060. +#define QCA808X_MMD3_CDT_DIAG_PAIR_D 0x8068
  1061. +#define QCA808X_CDT_DIAG_LENGTH_SAME_SHORT GENMASK(15, 8)
  1062. +#define QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT GENMASK(7, 0)
  1063. +
  1064. +#define QCA808X_CDT_CODE_PAIR_A GENMASK(15, 12)
  1065. +#define QCA808X_CDT_CODE_PAIR_B GENMASK(11, 8)
  1066. +#define QCA808X_CDT_CODE_PAIR_C GENMASK(7, 4)
  1067. +#define QCA808X_CDT_CODE_PAIR_D GENMASK(3, 0)
  1068. +
  1069. +#define QCA808X_CDT_STATUS_STAT_TYPE GENMASK(1, 0)
  1070. +#define QCA808X_CDT_STATUS_STAT_FAIL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 0)
  1071. +#define QCA808X_CDT_STATUS_STAT_NORMAL FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 1)
  1072. +#define QCA808X_CDT_STATUS_STAT_SAME_OPEN FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 2)
  1073. +#define QCA808X_CDT_STATUS_STAT_SAME_SHORT FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_TYPE, 3)
  1074. +
  1075. +#define QCA808X_CDT_STATUS_STAT_MDI GENMASK(3, 2)
  1076. +#define QCA808X_CDT_STATUS_STAT_MDI1 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 1)
  1077. +#define QCA808X_CDT_STATUS_STAT_MDI2 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 2)
  1078. +#define QCA808X_CDT_STATUS_STAT_MDI3 FIELD_PREP_CONST(QCA808X_CDT_STATUS_STAT_MDI, 3)
  1079. +
  1080. +/* NORMAL are MDI with type set to 0 */
  1081. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI1
  1082. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  1083. + QCA808X_CDT_STATUS_STAT_MDI1)
  1084. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  1085. + QCA808X_CDT_STATUS_STAT_MDI1)
  1086. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI2
  1087. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  1088. + QCA808X_CDT_STATUS_STAT_MDI2)
  1089. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  1090. + QCA808X_CDT_STATUS_STAT_MDI2)
  1091. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL QCA808X_CDT_STATUS_STAT_MDI3
  1092. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN (QCA808X_CDT_STATUS_STAT_SAME_OPEN |\
  1093. + QCA808X_CDT_STATUS_STAT_MDI3)
  1094. +#define QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT (QCA808X_CDT_STATUS_STAT_SAME_SHORT |\
  1095. + QCA808X_CDT_STATUS_STAT_MDI3)
  1096. +
  1097. +/* Added for reference of existence but should be handled by wait_for_completion already */
  1098. +#define QCA808X_CDT_STATUS_STAT_BUSY (BIT(1) | BIT(3))
  1099. +
  1100. +#define QCA808X_MMD7_LED_GLOBAL 0x8073
  1101. +#define QCA808X_LED_BLINK_1 GENMASK(11, 6)
  1102. +#define QCA808X_LED_BLINK_2 GENMASK(5, 0)
  1103. +/* Values are the same for both BLINK_1 and BLINK_2 */
  1104. +#define QCA808X_LED_BLINK_FREQ_MASK GENMASK(5, 3)
  1105. +#define QCA808X_LED_BLINK_FREQ_2HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x0)
  1106. +#define QCA808X_LED_BLINK_FREQ_4HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x1)
  1107. +#define QCA808X_LED_BLINK_FREQ_8HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x2)
  1108. +#define QCA808X_LED_BLINK_FREQ_16HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x3)
  1109. +#define QCA808X_LED_BLINK_FREQ_32HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x4)
  1110. +#define QCA808X_LED_BLINK_FREQ_64HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x5)
  1111. +#define QCA808X_LED_BLINK_FREQ_128HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x6)
  1112. +#define QCA808X_LED_BLINK_FREQ_256HZ FIELD_PREP(QCA808X_LED_BLINK_FREQ_MASK, 0x7)
  1113. +#define QCA808X_LED_BLINK_DUTY_MASK GENMASK(2, 0)
  1114. +#define QCA808X_LED_BLINK_DUTY_50_50 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x0)
  1115. +#define QCA808X_LED_BLINK_DUTY_75_25 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x1)
  1116. +#define QCA808X_LED_BLINK_DUTY_25_75 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x2)
  1117. +#define QCA808X_LED_BLINK_DUTY_33_67 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x3)
  1118. +#define QCA808X_LED_BLINK_DUTY_67_33 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x4)
  1119. +#define QCA808X_LED_BLINK_DUTY_17_83 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x5)
  1120. +#define QCA808X_LED_BLINK_DUTY_83_17 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x6)
  1121. +#define QCA808X_LED_BLINK_DUTY_8_92 FIELD_PREP(QCA808X_LED_BLINK_DUTY_MASK, 0x7)
  1122. +
  1123. +#define QCA808X_MMD7_LED2_CTRL 0x8074
  1124. +#define QCA808X_MMD7_LED2_FORCE_CTRL 0x8075
  1125. +#define QCA808X_MMD7_LED1_CTRL 0x8076
  1126. +#define QCA808X_MMD7_LED1_FORCE_CTRL 0x8077
  1127. +#define QCA808X_MMD7_LED0_CTRL 0x8078
  1128. +#define QCA808X_MMD7_LED_CTRL(x) (0x8078 - ((x) * 2))
  1129. +
  1130. +/* LED hw control pattern is the same for every LED */
  1131. +#define QCA808X_LED_PATTERN_MASK GENMASK(15, 0)
  1132. +#define QCA808X_LED_SPEED2500_ON BIT(15)
  1133. +#define QCA808X_LED_SPEED2500_BLINK BIT(14)
  1134. +/* Follow blink trigger even if duplex or speed condition doesn't match */
  1135. +#define QCA808X_LED_BLINK_CHECK_BYPASS BIT(13)
  1136. +#define QCA808X_LED_FULL_DUPLEX_ON BIT(12)
  1137. +#define QCA808X_LED_HALF_DUPLEX_ON BIT(11)
  1138. +#define QCA808X_LED_TX_BLINK BIT(10)
  1139. +#define QCA808X_LED_RX_BLINK BIT(9)
  1140. +#define QCA808X_LED_TX_ON_10MS BIT(8)
  1141. +#define QCA808X_LED_RX_ON_10MS BIT(7)
  1142. +#define QCA808X_LED_SPEED1000_ON BIT(6)
  1143. +#define QCA808X_LED_SPEED100_ON BIT(5)
  1144. +#define QCA808X_LED_SPEED10_ON BIT(4)
  1145. +#define QCA808X_LED_COLLISION_BLINK BIT(3)
  1146. +#define QCA808X_LED_SPEED1000_BLINK BIT(2)
  1147. +#define QCA808X_LED_SPEED100_BLINK BIT(1)
  1148. +#define QCA808X_LED_SPEED10_BLINK BIT(0)
  1149. +
  1150. +#define QCA808X_MMD7_LED0_FORCE_CTRL 0x8079
  1151. +#define QCA808X_MMD7_LED_FORCE_CTRL(x) (0x8079 - ((x) * 2))
  1152. +
  1153. +/* LED force ctrl is the same for every LED
  1154. + * No documentation exist for this, not even internal one
  1155. + * with NDA as QCOM gives only info about configuring
  1156. + * hw control pattern rules and doesn't indicate any way
  1157. + * to force the LED to specific mode.
  1158. + * These define comes from reverse and testing and maybe
  1159. + * lack of some info or some info are not entirely correct.
  1160. + * For the basic LED control and hw control these finding
  1161. + * are enough to support LED control in all the required APIs.
  1162. + *
  1163. + * On doing some comparison with implementation with qca807x,
  1164. + * it was found that it's 1:1 equal to it and confirms all the
  1165. + * reverse done. It was also found further specification with the
  1166. + * force mode and the blink modes.
  1167. + */
  1168. +#define QCA808X_LED_FORCE_EN BIT(15)
  1169. +#define QCA808X_LED_FORCE_MODE_MASK GENMASK(14, 13)
  1170. +#define QCA808X_LED_FORCE_BLINK_1 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x3)
  1171. +#define QCA808X_LED_FORCE_BLINK_2 FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x2)
  1172. +#define QCA808X_LED_FORCE_ON FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x1)
  1173. +#define QCA808X_LED_FORCE_OFF FIELD_PREP(QCA808X_LED_FORCE_MODE_MASK, 0x0)
  1174. +
  1175. +#define QCA808X_MMD7_LED_POLARITY_CTRL 0x901a
  1176. +/* QSDK sets by default 0x46 to this reg that sets BIT 6 for
  1177. + * LED to active high. It's not clear what BIT 3 and BIT 4 does.
  1178. + */
  1179. +#define QCA808X_LED_ACTIVE_HIGH BIT(6)
  1180. +
  1181. +/* QCA808X 1G chip type */
  1182. +#define QCA808X_PHY_MMD7_CHIP_TYPE 0x901d
  1183. +#define QCA808X_PHY_CHIP_TYPE_1G BIT(0)
  1184. +
  1185. +#define QCA8081_PHY_SERDES_MMD1_FIFO_CTRL 0x9072
  1186. +#define QCA8081_PHY_FIFO_RSTN BIT(11)
  1187. +
  1188. +#define QCA8081_PHY_ID 0x004dd101
  1189. +
  1190. +MODULE_DESCRIPTION("Qualcomm Atheros QCA808X PHY driver");
  1191. +MODULE_AUTHOR("Matus Ujhelyi");
  1192. +MODULE_LICENSE("GPL");
  1193. +
  1194. +struct qca808x_priv {
  1195. + int led_polarity_mode;
  1196. +};
  1197. +
  1198. +static int qca808x_phy_fast_retrain_config(struct phy_device *phydev)
  1199. +{
  1200. + int ret;
  1201. +
  1202. + /* Enable fast retrain */
  1203. + ret = genphy_c45_fast_retrain(phydev, true);
  1204. + if (ret)
  1205. + return ret;
  1206. +
  1207. + phy_write_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_TOP_OPTION1,
  1208. + QCA808X_TOP_OPTION1_DATA);
  1209. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_20DB,
  1210. + QCA808X_MSE_THRESHOLD_20DB_VALUE);
  1211. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_17DB,
  1212. + QCA808X_MSE_THRESHOLD_17DB_VALUE);
  1213. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_27DB,
  1214. + QCA808X_MSE_THRESHOLD_27DB_VALUE);
  1215. + phy_write_mmd(phydev, MDIO_MMD_PMAPMD, QCA808X_PHY_MMD1_MSE_THRESHOLD_28DB,
  1216. + QCA808X_MSE_THRESHOLD_28DB_VALUE);
  1217. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_1,
  1218. + QCA808X_MMD3_DEBUG_1_VALUE);
  1219. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_4,
  1220. + QCA808X_MMD3_DEBUG_4_VALUE);
  1221. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_5,
  1222. + QCA808X_MMD3_DEBUG_5_VALUE);
  1223. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_3,
  1224. + QCA808X_MMD3_DEBUG_3_VALUE);
  1225. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_6,
  1226. + QCA808X_MMD3_DEBUG_6_VALUE);
  1227. + phy_write_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_DEBUG_2,
  1228. + QCA808X_MMD3_DEBUG_2_VALUE);
  1229. +
  1230. + return 0;
  1231. +}
  1232. +
  1233. +static int qca808x_phy_ms_seed_enable(struct phy_device *phydev, bool enable)
  1234. +{
  1235. + u16 seed_value;
  1236. +
  1237. + if (!enable)
  1238. + return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  1239. + QCA808X_MASTER_SLAVE_SEED_ENABLE, 0);
  1240. +
  1241. + seed_value = get_random_u32_below(QCA808X_MASTER_SLAVE_SEED_RANGE);
  1242. + return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_LOCAL_SEED,
  1243. + QCA808X_MASTER_SLAVE_SEED_CFG | QCA808X_MASTER_SLAVE_SEED_ENABLE,
  1244. + FIELD_PREP(QCA808X_MASTER_SLAVE_SEED_CFG, seed_value) |
  1245. + QCA808X_MASTER_SLAVE_SEED_ENABLE);
  1246. +}
  1247. +
  1248. +static bool qca808x_is_prefer_master(struct phy_device *phydev)
  1249. +{
  1250. + return (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_FORCE) ||
  1251. + (phydev->master_slave_get == MASTER_SLAVE_CFG_MASTER_PREFERRED);
  1252. +}
  1253. +
  1254. +static bool qca808x_has_fast_retrain_or_slave_seed(struct phy_device *phydev)
  1255. +{
  1256. + return linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  1257. +}
  1258. +
  1259. +static int qca808x_probe(struct phy_device *phydev)
  1260. +{
  1261. + struct device *dev = &phydev->mdio.dev;
  1262. + struct qca808x_priv *priv;
  1263. +
  1264. + priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
  1265. + if (!priv)
  1266. + return -ENOMEM;
  1267. +
  1268. + /* Init LED polarity mode to -1 */
  1269. + priv->led_polarity_mode = -1;
  1270. +
  1271. + phydev->priv = priv;
  1272. +
  1273. + return 0;
  1274. +}
  1275. +
  1276. +static int qca808x_config_init(struct phy_device *phydev)
  1277. +{
  1278. + int ret;
  1279. +
  1280. + /* Active adc&vga on 802.3az for the link 1000M and 100M */
  1281. + ret = phy_modify_mmd(phydev, MDIO_MMD_PCS, QCA808X_PHY_MMD3_ADDR_CLD_CTRL7,
  1282. + QCA808X_8023AZ_AFE_CTRL_MASK, QCA808X_8023AZ_AFE_EN);
  1283. + if (ret)
  1284. + return ret;
  1285. +
  1286. + /* Adjust the threshold on 802.3az for the link 1000M */
  1287. + ret = phy_write_mmd(phydev, MDIO_MMD_PCS,
  1288. + QCA808X_PHY_MMD3_AZ_TRAINING_CTRL,
  1289. + QCA808X_MMD3_AZ_TRAINING_VAL);
  1290. + if (ret)
  1291. + return ret;
  1292. +
  1293. + if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  1294. + /* Config the fast retrain for the link 2500M */
  1295. + ret = qca808x_phy_fast_retrain_config(phydev);
  1296. + if (ret)
  1297. + return ret;
  1298. +
  1299. + ret = genphy_read_master_slave(phydev);
  1300. + if (ret < 0)
  1301. + return ret;
  1302. +
  1303. + if (!qca808x_is_prefer_master(phydev)) {
  1304. + /* Enable seed and configure lower ramdom seed to make phy
  1305. + * linked as slave mode.
  1306. + */
  1307. + ret = qca808x_phy_ms_seed_enable(phydev, true);
  1308. + if (ret)
  1309. + return ret;
  1310. + }
  1311. + }
  1312. +
  1313. + /* Configure adc threshold as 100mv for the link 10M */
  1314. + return at803x_debug_reg_mask(phydev, QCA808X_PHY_DEBUG_ADC_THRESHOLD,
  1315. + QCA808X_ADC_THRESHOLD_MASK,
  1316. + QCA808X_ADC_THRESHOLD_100MV);
  1317. +}
  1318. +
  1319. +static int qca808x_read_status(struct phy_device *phydev)
  1320. +{
  1321. + struct at803x_ss_mask ss_mask = { 0 };
  1322. + int ret;
  1323. +
  1324. + ret = phy_read_mmd(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_STAT);
  1325. + if (ret < 0)
  1326. + return ret;
  1327. +
  1328. + linkmode_mod_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->lp_advertising,
  1329. + ret & MDIO_AN_10GBT_STAT_LP2_5G);
  1330. +
  1331. + ret = genphy_read_status(phydev);
  1332. + if (ret)
  1333. + return ret;
  1334. +
  1335. + /* qca8081 takes the different bits for speed value from at803x */
  1336. + ss_mask.speed_mask = QCA808X_SS_SPEED_MASK;
  1337. + ss_mask.speed_shift = __bf_shf(QCA808X_SS_SPEED_MASK);
  1338. + ret = at803x_read_specific_status(phydev, ss_mask);
  1339. + if (ret < 0)
  1340. + return ret;
  1341. +
  1342. + if (phydev->link) {
  1343. + if (phydev->speed == SPEED_2500)
  1344. + phydev->interface = PHY_INTERFACE_MODE_2500BASEX;
  1345. + else
  1346. + phydev->interface = PHY_INTERFACE_MODE_SGMII;
  1347. + } else {
  1348. + /* generate seed as a lower random value to make PHY linked as SLAVE easily,
  1349. + * except for master/slave configuration fault detected or the master mode
  1350. + * preferred.
  1351. + *
  1352. + * the reason for not putting this code into the function link_change_notify is
  1353. + * the corner case where the link partner is also the qca8081 PHY and the seed
  1354. + * value is configured as the same value, the link can't be up and no link change
  1355. + * occurs.
  1356. + */
  1357. + if (qca808x_has_fast_retrain_or_slave_seed(phydev)) {
  1358. + if (phydev->master_slave_state == MASTER_SLAVE_STATE_ERR ||
  1359. + qca808x_is_prefer_master(phydev)) {
  1360. + qca808x_phy_ms_seed_enable(phydev, false);
  1361. + } else {
  1362. + qca808x_phy_ms_seed_enable(phydev, true);
  1363. + }
  1364. + }
  1365. + }
  1366. +
  1367. + return 0;
  1368. +}
  1369. +
  1370. +static int qca808x_soft_reset(struct phy_device *phydev)
  1371. +{
  1372. + int ret;
  1373. +
  1374. + ret = genphy_soft_reset(phydev);
  1375. + if (ret < 0)
  1376. + return ret;
  1377. +
  1378. + if (qca808x_has_fast_retrain_or_slave_seed(phydev))
  1379. + ret = qca808x_phy_ms_seed_enable(phydev, true);
  1380. +
  1381. + return ret;
  1382. +}
  1383. +
  1384. +static bool qca808x_cdt_fault_length_valid(int cdt_code)
  1385. +{
  1386. + switch (cdt_code) {
  1387. + case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  1388. + case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  1389. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  1390. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  1391. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  1392. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  1393. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  1394. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  1395. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  1396. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  1397. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  1398. + return true;
  1399. + default:
  1400. + return false;
  1401. + }
  1402. +}
  1403. +
  1404. +static int qca808x_cable_test_result_trans(int cdt_code)
  1405. +{
  1406. + switch (cdt_code) {
  1407. + case QCA808X_CDT_STATUS_STAT_NORMAL:
  1408. + return ETHTOOL_A_CABLE_RESULT_CODE_OK;
  1409. + case QCA808X_CDT_STATUS_STAT_SAME_SHORT:
  1410. + return ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT;
  1411. + case QCA808X_CDT_STATUS_STAT_SAME_OPEN:
  1412. + return ETHTOOL_A_CABLE_RESULT_CODE_OPEN;
  1413. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_NORMAL:
  1414. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_OPEN:
  1415. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI1_SAME_SHORT:
  1416. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_NORMAL:
  1417. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_OPEN:
  1418. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI2_SAME_SHORT:
  1419. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_NORMAL:
  1420. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_OPEN:
  1421. + case QCA808X_CDT_STATUS_STAT_CROSS_SHORT_WITH_MDI3_SAME_SHORT:
  1422. + return ETHTOOL_A_CABLE_RESULT_CODE_CROSS_SHORT;
  1423. + case QCA808X_CDT_STATUS_STAT_FAIL:
  1424. + default:
  1425. + return ETHTOOL_A_CABLE_RESULT_CODE_UNSPEC;
  1426. + }
  1427. +}
  1428. +
  1429. +static int qca808x_cdt_fault_length(struct phy_device *phydev, int pair,
  1430. + int result)
  1431. +{
  1432. + int val;
  1433. + u32 cdt_length_reg = 0;
  1434. +
  1435. + switch (pair) {
  1436. + case ETHTOOL_A_CABLE_PAIR_A:
  1437. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_A;
  1438. + break;
  1439. + case ETHTOOL_A_CABLE_PAIR_B:
  1440. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_B;
  1441. + break;
  1442. + case ETHTOOL_A_CABLE_PAIR_C:
  1443. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_C;
  1444. + break;
  1445. + case ETHTOOL_A_CABLE_PAIR_D:
  1446. + cdt_length_reg = QCA808X_MMD3_CDT_DIAG_PAIR_D;
  1447. + break;
  1448. + default:
  1449. + return -EINVAL;
  1450. + }
  1451. +
  1452. + val = phy_read_mmd(phydev, MDIO_MMD_PCS, cdt_length_reg);
  1453. + if (val < 0)
  1454. + return val;
  1455. +
  1456. + if (result == ETHTOOL_A_CABLE_RESULT_CODE_SAME_SHORT)
  1457. + val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_SAME_SHORT, val);
  1458. + else
  1459. + val = FIELD_GET(QCA808X_CDT_DIAG_LENGTH_CROSS_SHORT, val);
  1460. +
  1461. + return at803x_cdt_fault_length(val);
  1462. +}
  1463. +
  1464. +static int qca808x_cable_test_start(struct phy_device *phydev)
  1465. +{
  1466. + int ret;
  1467. +
  1468. + /* perform CDT with the following configs:
  1469. + * 1. disable hibernation.
  1470. + * 2. force PHY working in MDI mode.
  1471. + * 3. for PHY working in 1000BaseT.
  1472. + * 4. configure the threshold.
  1473. + */
  1474. +
  1475. + ret = at803x_debug_reg_mask(phydev, QCA808X_DBG_AN_TEST, QCA808X_HIBERNATION_EN, 0);
  1476. + if (ret < 0)
  1477. + return ret;
  1478. +
  1479. + ret = at803x_config_mdix(phydev, ETH_TP_MDI);
  1480. + if (ret < 0)
  1481. + return ret;
  1482. +
  1483. + /* Force 1000base-T needs to configure PMA/PMD and MII_BMCR */
  1484. + phydev->duplex = DUPLEX_FULL;
  1485. + phydev->speed = SPEED_1000;
  1486. + ret = genphy_c45_pma_setup_forced(phydev);
  1487. + if (ret < 0)
  1488. + return ret;
  1489. +
  1490. + ret = genphy_setup_forced(phydev);
  1491. + if (ret < 0)
  1492. + return ret;
  1493. +
  1494. + /* configure the thresholds for open, short, pair ok test */
  1495. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8074, 0xc040);
  1496. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8076, 0xc040);
  1497. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8077, 0xa060);
  1498. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x8078, 0xc050);
  1499. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807a, 0xc060);
  1500. + phy_write_mmd(phydev, MDIO_MMD_PCS, 0x807e, 0xb060);
  1501. +
  1502. + return 0;
  1503. +}
  1504. +
  1505. +static int qca808x_cable_test_get_pair_status(struct phy_device *phydev, u8 pair,
  1506. + u16 status)
  1507. +{
  1508. + int length, result;
  1509. + u16 pair_code;
  1510. +
  1511. + switch (pair) {
  1512. + case ETHTOOL_A_CABLE_PAIR_A:
  1513. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_A, status);
  1514. + break;
  1515. + case ETHTOOL_A_CABLE_PAIR_B:
  1516. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_B, status);
  1517. + break;
  1518. + case ETHTOOL_A_CABLE_PAIR_C:
  1519. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_C, status);
  1520. + break;
  1521. + case ETHTOOL_A_CABLE_PAIR_D:
  1522. + pair_code = FIELD_GET(QCA808X_CDT_CODE_PAIR_D, status);
  1523. + break;
  1524. + default:
  1525. + return -EINVAL;
  1526. + }
  1527. +
  1528. + result = qca808x_cable_test_result_trans(pair_code);
  1529. + ethnl_cable_test_result(phydev, pair, result);
  1530. +
  1531. + if (qca808x_cdt_fault_length_valid(pair_code)) {
  1532. + length = qca808x_cdt_fault_length(phydev, pair, result);
  1533. + ethnl_cable_test_fault_length(phydev, pair, length);
  1534. + }
  1535. +
  1536. + return 0;
  1537. +}
  1538. +
  1539. +static int qca808x_cable_test_get_status(struct phy_device *phydev, bool *finished)
  1540. +{
  1541. + int ret, val;
  1542. +
  1543. + *finished = false;
  1544. +
  1545. + val = QCA808X_CDT_ENABLE_TEST |
  1546. + QCA808X_CDT_LENGTH_UNIT;
  1547. + ret = at803x_cdt_start(phydev, val);
  1548. + if (ret)
  1549. + return ret;
  1550. +
  1551. + ret = at803x_cdt_wait_for_completion(phydev, QCA808X_CDT_ENABLE_TEST);
  1552. + if (ret)
  1553. + return ret;
  1554. +
  1555. + val = phy_read_mmd(phydev, MDIO_MMD_PCS, QCA808X_MMD3_CDT_STATUS);
  1556. + if (val < 0)
  1557. + return val;
  1558. +
  1559. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_A, val);
  1560. + if (ret)
  1561. + return ret;
  1562. +
  1563. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_B, val);
  1564. + if (ret)
  1565. + return ret;
  1566. +
  1567. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_C, val);
  1568. + if (ret)
  1569. + return ret;
  1570. +
  1571. + ret = qca808x_cable_test_get_pair_status(phydev, ETHTOOL_A_CABLE_PAIR_D, val);
  1572. + if (ret)
  1573. + return ret;
  1574. +
  1575. + *finished = true;
  1576. +
  1577. + return 0;
  1578. +}
  1579. +
  1580. +static int qca808x_get_features(struct phy_device *phydev)
  1581. +{
  1582. + int ret;
  1583. +
  1584. + ret = genphy_c45_pma_read_abilities(phydev);
  1585. + if (ret)
  1586. + return ret;
  1587. +
  1588. + /* The autoneg ability is not existed in bit3 of MMD7.1,
  1589. + * but it is supported by qca808x PHY, so we add it here
  1590. + * manually.
  1591. + */
  1592. + linkmode_set_bit(ETHTOOL_LINK_MODE_Autoneg_BIT, phydev->supported);
  1593. +
  1594. + /* As for the qca8081 1G version chip, the 2500baseT ability is also
  1595. + * existed in the bit0 of MMD1.21, we need to remove it manually if
  1596. + * it is the qca8081 1G chip according to the bit0 of MMD7.0x901d.
  1597. + */
  1598. + ret = phy_read_mmd(phydev, MDIO_MMD_AN, QCA808X_PHY_MMD7_CHIP_TYPE);
  1599. + if (ret < 0)
  1600. + return ret;
  1601. +
  1602. + if (QCA808X_PHY_CHIP_TYPE_1G & ret)
  1603. + linkmode_clear_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->supported);
  1604. +
  1605. + return 0;
  1606. +}
  1607. +
  1608. +static int qca808x_config_aneg(struct phy_device *phydev)
  1609. +{
  1610. + int phy_ctrl = 0;
  1611. + int ret;
  1612. +
  1613. + ret = at803x_prepare_config_aneg(phydev);
  1614. + if (ret)
  1615. + return ret;
  1616. +
  1617. + /* The reg MII_BMCR also needs to be configured for force mode, the
  1618. + * genphy_config_aneg is also needed.
  1619. + */
  1620. + if (phydev->autoneg == AUTONEG_DISABLE)
  1621. + genphy_c45_pma_setup_forced(phydev);
  1622. +
  1623. + if (linkmode_test_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, phydev->advertising))
  1624. + phy_ctrl = MDIO_AN_10GBT_CTRL_ADV2_5G;
  1625. +
  1626. + ret = phy_modify_mmd_changed(phydev, MDIO_MMD_AN, MDIO_AN_10GBT_CTRL,
  1627. + MDIO_AN_10GBT_CTRL_ADV2_5G, phy_ctrl);
  1628. + if (ret < 0)
  1629. + return ret;
  1630. +
  1631. + return __genphy_config_aneg(phydev, ret);
  1632. +}
  1633. +
  1634. +static void qca808x_link_change_notify(struct phy_device *phydev)
  1635. +{
  1636. + /* Assert interface sgmii fifo on link down, deassert it on link up,
  1637. + * the interface device address is always phy address added by 1.
  1638. + */
  1639. + mdiobus_c45_modify_changed(phydev->mdio.bus, phydev->mdio.addr + 1,
  1640. + MDIO_MMD_PMAPMD, QCA8081_PHY_SERDES_MMD1_FIFO_CTRL,
  1641. + QCA8081_PHY_FIFO_RSTN,
  1642. + phydev->link ? QCA8081_PHY_FIFO_RSTN : 0);
  1643. +}
  1644. +
  1645. +static int qca808x_led_parse_netdev(struct phy_device *phydev, unsigned long rules,
  1646. + u16 *offload_trigger)
  1647. +{
  1648. + /* Parsing specific to netdev trigger */
  1649. + if (test_bit(TRIGGER_NETDEV_TX, &rules))
  1650. + *offload_trigger |= QCA808X_LED_TX_BLINK;
  1651. + if (test_bit(TRIGGER_NETDEV_RX, &rules))
  1652. + *offload_trigger |= QCA808X_LED_RX_BLINK;
  1653. + if (test_bit(TRIGGER_NETDEV_LINK_10, &rules))
  1654. + *offload_trigger |= QCA808X_LED_SPEED10_ON;
  1655. + if (test_bit(TRIGGER_NETDEV_LINK_100, &rules))
  1656. + *offload_trigger |= QCA808X_LED_SPEED100_ON;
  1657. + if (test_bit(TRIGGER_NETDEV_LINK_1000, &rules))
  1658. + *offload_trigger |= QCA808X_LED_SPEED1000_ON;
  1659. + if (test_bit(TRIGGER_NETDEV_LINK_2500, &rules))
  1660. + *offload_trigger |= QCA808X_LED_SPEED2500_ON;
  1661. + if (test_bit(TRIGGER_NETDEV_HALF_DUPLEX, &rules))
  1662. + *offload_trigger |= QCA808X_LED_HALF_DUPLEX_ON;
  1663. + if (test_bit(TRIGGER_NETDEV_FULL_DUPLEX, &rules))
  1664. + *offload_trigger |= QCA808X_LED_FULL_DUPLEX_ON;
  1665. +
  1666. + if (rules && !*offload_trigger)
  1667. + return -EOPNOTSUPP;
  1668. +
  1669. + /* Enable BLINK_CHECK_BYPASS by default to make the LED
  1670. + * blink even with duplex or speed mode not enabled.
  1671. + */
  1672. + *offload_trigger |= QCA808X_LED_BLINK_CHECK_BYPASS;
  1673. +
  1674. + return 0;
  1675. +}
  1676. +
  1677. +static int qca808x_led_hw_control_enable(struct phy_device *phydev, u8 index)
  1678. +{
  1679. + u16 reg;
  1680. +
  1681. + if (index > 2)
  1682. + return -EINVAL;
  1683. +
  1684. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  1685. +
  1686. + return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  1687. + QCA808X_LED_FORCE_EN);
  1688. +}
  1689. +
  1690. +static int qca808x_led_hw_is_supported(struct phy_device *phydev, u8 index,
  1691. + unsigned long rules)
  1692. +{
  1693. + u16 offload_trigger = 0;
  1694. +
  1695. + if (index > 2)
  1696. + return -EINVAL;
  1697. +
  1698. + return qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  1699. +}
  1700. +
  1701. +static int qca808x_led_hw_control_set(struct phy_device *phydev, u8 index,
  1702. + unsigned long rules)
  1703. +{
  1704. + u16 reg, offload_trigger = 0;
  1705. + int ret;
  1706. +
  1707. + if (index > 2)
  1708. + return -EINVAL;
  1709. +
  1710. + reg = QCA808X_MMD7_LED_CTRL(index);
  1711. +
  1712. + ret = qca808x_led_parse_netdev(phydev, rules, &offload_trigger);
  1713. + if (ret)
  1714. + return ret;
  1715. +
  1716. + ret = qca808x_led_hw_control_enable(phydev, index);
  1717. + if (ret)
  1718. + return ret;
  1719. +
  1720. + return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  1721. + QCA808X_LED_PATTERN_MASK,
  1722. + offload_trigger);
  1723. +}
  1724. +
  1725. +static bool qca808x_led_hw_control_status(struct phy_device *phydev, u8 index)
  1726. +{
  1727. + u16 reg;
  1728. + int val;
  1729. +
  1730. + if (index > 2)
  1731. + return false;
  1732. +
  1733. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  1734. +
  1735. + val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  1736. +
  1737. + return !(val & QCA808X_LED_FORCE_EN);
  1738. +}
  1739. +
  1740. +static int qca808x_led_hw_control_get(struct phy_device *phydev, u8 index,
  1741. + unsigned long *rules)
  1742. +{
  1743. + u16 reg;
  1744. + int val;
  1745. +
  1746. + if (index > 2)
  1747. + return -EINVAL;
  1748. +
  1749. + /* Check if we have hw control enabled */
  1750. + if (qca808x_led_hw_control_status(phydev, index))
  1751. + return -EINVAL;
  1752. +
  1753. + reg = QCA808X_MMD7_LED_CTRL(index);
  1754. +
  1755. + val = phy_read_mmd(phydev, MDIO_MMD_AN, reg);
  1756. + if (val & QCA808X_LED_TX_BLINK)
  1757. + set_bit(TRIGGER_NETDEV_TX, rules);
  1758. + if (val & QCA808X_LED_RX_BLINK)
  1759. + set_bit(TRIGGER_NETDEV_RX, rules);
  1760. + if (val & QCA808X_LED_SPEED10_ON)
  1761. + set_bit(TRIGGER_NETDEV_LINK_10, rules);
  1762. + if (val & QCA808X_LED_SPEED100_ON)
  1763. + set_bit(TRIGGER_NETDEV_LINK_100, rules);
  1764. + if (val & QCA808X_LED_SPEED1000_ON)
  1765. + set_bit(TRIGGER_NETDEV_LINK_1000, rules);
  1766. + if (val & QCA808X_LED_SPEED2500_ON)
  1767. + set_bit(TRIGGER_NETDEV_LINK_2500, rules);
  1768. + if (val & QCA808X_LED_HALF_DUPLEX_ON)
  1769. + set_bit(TRIGGER_NETDEV_HALF_DUPLEX, rules);
  1770. + if (val & QCA808X_LED_FULL_DUPLEX_ON)
  1771. + set_bit(TRIGGER_NETDEV_FULL_DUPLEX, rules);
  1772. +
  1773. + return 0;
  1774. +}
  1775. +
  1776. +static int qca808x_led_hw_control_reset(struct phy_device *phydev, u8 index)
  1777. +{
  1778. + u16 reg;
  1779. +
  1780. + if (index > 2)
  1781. + return -EINVAL;
  1782. +
  1783. + reg = QCA808X_MMD7_LED_CTRL(index);
  1784. +
  1785. + return phy_clear_bits_mmd(phydev, MDIO_MMD_AN, reg,
  1786. + QCA808X_LED_PATTERN_MASK);
  1787. +}
  1788. +
  1789. +static int qca808x_led_brightness_set(struct phy_device *phydev,
  1790. + u8 index, enum led_brightness value)
  1791. +{
  1792. + u16 reg;
  1793. + int ret;
  1794. +
  1795. + if (index > 2)
  1796. + return -EINVAL;
  1797. +
  1798. + if (!value) {
  1799. + ret = qca808x_led_hw_control_reset(phydev, index);
  1800. + if (ret)
  1801. + return ret;
  1802. + }
  1803. +
  1804. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  1805. +
  1806. + return phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  1807. + QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  1808. + QCA808X_LED_FORCE_EN | value ? QCA808X_LED_FORCE_ON :
  1809. + QCA808X_LED_FORCE_OFF);
  1810. +}
  1811. +
  1812. +static int qca808x_led_blink_set(struct phy_device *phydev, u8 index,
  1813. + unsigned long *delay_on,
  1814. + unsigned long *delay_off)
  1815. +{
  1816. + int ret;
  1817. + u16 reg;
  1818. +
  1819. + if (index > 2)
  1820. + return -EINVAL;
  1821. +
  1822. + reg = QCA808X_MMD7_LED_FORCE_CTRL(index);
  1823. +
  1824. + /* Set blink to 50% off, 50% on at 4Hz by default */
  1825. + ret = phy_modify_mmd(phydev, MDIO_MMD_AN, QCA808X_MMD7_LED_GLOBAL,
  1826. + QCA808X_LED_BLINK_FREQ_MASK | QCA808X_LED_BLINK_DUTY_MASK,
  1827. + QCA808X_LED_BLINK_FREQ_4HZ | QCA808X_LED_BLINK_DUTY_50_50);
  1828. + if (ret)
  1829. + return ret;
  1830. +
  1831. + /* We use BLINK_1 for normal blinking */
  1832. + ret = phy_modify_mmd(phydev, MDIO_MMD_AN, reg,
  1833. + QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_MODE_MASK,
  1834. + QCA808X_LED_FORCE_EN | QCA808X_LED_FORCE_BLINK_1);
  1835. + if (ret)
  1836. + return ret;
  1837. +
  1838. + /* We set blink to 4Hz, aka 250ms */
  1839. + *delay_on = 250 / 2;
  1840. + *delay_off = 250 / 2;
  1841. +
  1842. + return 0;
  1843. +}
  1844. +
  1845. +static int qca808x_led_polarity_set(struct phy_device *phydev, int index,
  1846. + unsigned long modes)
  1847. +{
  1848. + struct qca808x_priv *priv = phydev->priv;
  1849. + bool active_low = false;
  1850. + u32 mode;
  1851. +
  1852. + for_each_set_bit(mode, &modes, __PHY_LED_MODES_NUM) {
  1853. + switch (mode) {
  1854. + case PHY_LED_ACTIVE_LOW:
  1855. + active_low = true;
  1856. + break;
  1857. + default:
  1858. + return -EINVAL;
  1859. + }
  1860. + }
  1861. +
  1862. + /* PHY polarity is global and can't be set per LED.
  1863. + * To detect this, check if last requested polarity mode
  1864. + * match the new one.
  1865. + */
  1866. + if (priv->led_polarity_mode >= 0 &&
  1867. + priv->led_polarity_mode != active_low) {
  1868. + phydev_err(phydev, "PHY polarity is global. Mismatched polarity on different LED\n");
  1869. + return -EINVAL;
  1870. + }
  1871. +
  1872. + /* Save the last PHY polarity mode */
  1873. + priv->led_polarity_mode = active_low;
  1874. +
  1875. + return phy_modify_mmd(phydev, MDIO_MMD_AN,
  1876. + QCA808X_MMD7_LED_POLARITY_CTRL,
  1877. + QCA808X_LED_ACTIVE_HIGH,
  1878. + active_low ? 0 : QCA808X_LED_ACTIVE_HIGH);
  1879. +}
  1880. +
  1881. +static struct phy_driver qca808x_driver[] = {
  1882. +{
  1883. + /* Qualcomm QCA8081 */
  1884. + PHY_ID_MATCH_EXACT(QCA8081_PHY_ID),
  1885. + .name = "Qualcomm QCA8081",
  1886. + .flags = PHY_POLL_CABLE_TEST,
  1887. + .probe = qca808x_probe,
  1888. + .config_intr = at803x_config_intr,
  1889. + .handle_interrupt = at803x_handle_interrupt,
  1890. + .get_tunable = at803x_get_tunable,
  1891. + .set_tunable = at803x_set_tunable,
  1892. + .set_wol = at803x_set_wol,
  1893. + .get_wol = at803x_get_wol,
  1894. + .get_features = qca808x_get_features,
  1895. + .config_aneg = qca808x_config_aneg,
  1896. + .suspend = genphy_suspend,
  1897. + .resume = genphy_resume,
  1898. + .read_status = qca808x_read_status,
  1899. + .config_init = qca808x_config_init,
  1900. + .soft_reset = qca808x_soft_reset,
  1901. + .cable_test_start = qca808x_cable_test_start,
  1902. + .cable_test_get_status = qca808x_cable_test_get_status,
  1903. + .link_change_notify = qca808x_link_change_notify,
  1904. + .led_brightness_set = qca808x_led_brightness_set,
  1905. + .led_blink_set = qca808x_led_blink_set,
  1906. + .led_hw_is_supported = qca808x_led_hw_is_supported,
  1907. + .led_hw_control_set = qca808x_led_hw_control_set,
  1908. + .led_hw_control_get = qca808x_led_hw_control_get,
  1909. + .led_polarity_set = qca808x_led_polarity_set,
  1910. +}, };
  1911. +
  1912. +module_phy_driver(qca808x_driver);
  1913. +
  1914. +static struct mdio_device_id __maybe_unused qca808x_tbl[] = {
  1915. + { PHY_ID_MATCH_EXACT(QCA8081_PHY_ID) },
  1916. + { }
  1917. +};
  1918. +
  1919. +MODULE_DEVICE_TABLE(mdio, qca808x_tbl);