lio_ethtool.c 76 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632
  1. /**********************************************************************
  2. * Author: Cavium, Inc.
  3. *
  4. * Contact: support@cavium.com
  5. * Please include "LiquidIO" in the subject.
  6. *
  7. * Copyright (c) 2003-2016 Cavium, Inc.
  8. *
  9. * This file is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License, Version 2, as
  11. * published by the Free Software Foundation.
  12. *
  13. * This file is distributed in the hope that it will be useful, but
  14. * AS-IS and WITHOUT ANY WARRANTY; without even the implied warranty
  15. * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE, TITLE, or
  16. * NONINFRINGEMENT. See the GNU General Public License for more details.
  17. ***********************************************************************/
  18. #include <linux/netdevice.h>
  19. #include <linux/net_tstamp.h>
  20. #include <linux/pci.h>
  21. #include "liquidio_common.h"
  22. #include "octeon_droq.h"
  23. #include "octeon_iq.h"
  24. #include "response_manager.h"
  25. #include "octeon_device.h"
  26. #include "octeon_nic.h"
  27. #include "octeon_main.h"
  28. #include "octeon_network.h"
  29. #include "cn66xx_regs.h"
  30. #include "cn66xx_device.h"
  31. #include "cn23xx_pf_device.h"
  32. #include "cn23xx_vf_device.h"
  33. static int octnet_get_link_stats(struct net_device *netdev);
  34. struct oct_intrmod_context {
  35. int octeon_id;
  36. wait_queue_head_t wc;
  37. int cond;
  38. int status;
  39. };
  40. struct oct_intrmod_resp {
  41. u64 rh;
  42. struct oct_intrmod_cfg intrmod;
  43. u64 status;
  44. };
  45. struct oct_mdio_cmd_context {
  46. int octeon_id;
  47. wait_queue_head_t wc;
  48. int cond;
  49. };
  50. struct oct_mdio_cmd_resp {
  51. u64 rh;
  52. struct oct_mdio_cmd resp;
  53. u64 status;
  54. };
  55. #define OCT_MDIO45_RESP_SIZE (sizeof(struct oct_mdio_cmd_resp))
  56. /* Octeon's interface mode of operation */
  57. enum {
  58. INTERFACE_MODE_DISABLED,
  59. INTERFACE_MODE_RGMII,
  60. INTERFACE_MODE_GMII,
  61. INTERFACE_MODE_SPI,
  62. INTERFACE_MODE_PCIE,
  63. INTERFACE_MODE_XAUI,
  64. INTERFACE_MODE_SGMII,
  65. INTERFACE_MODE_PICMG,
  66. INTERFACE_MODE_NPI,
  67. INTERFACE_MODE_LOOP,
  68. INTERFACE_MODE_SRIO,
  69. INTERFACE_MODE_ILK,
  70. INTERFACE_MODE_RXAUI,
  71. INTERFACE_MODE_QSGMII,
  72. INTERFACE_MODE_AGL,
  73. INTERFACE_MODE_XLAUI,
  74. INTERFACE_MODE_XFI,
  75. INTERFACE_MODE_10G_KR,
  76. INTERFACE_MODE_40G_KR4,
  77. INTERFACE_MODE_MIXED,
  78. };
  79. #define OCT_ETHTOOL_REGDUMP_LEN 4096
  80. #define OCT_ETHTOOL_REGDUMP_LEN_23XX (4096 * 11)
  81. #define OCT_ETHTOOL_REGDUMP_LEN_23XX_VF (4096 * 2)
  82. #define OCT_ETHTOOL_REGSVER 1
  83. /* statistics of PF */
  84. static const char oct_stats_strings[][ETH_GSTRING_LEN] = {
  85. "rx_packets",
  86. "tx_packets",
  87. "rx_bytes",
  88. "tx_bytes",
  89. "rx_errors", /*jabber_err+l2_err+frame_err */
  90. "tx_errors", /*fw_err_pko+fw_err_link+fw_err_drop */
  91. "rx_dropped", /*st->fromwire.total_rcvd - st->fromwire.fw_total_rcvd +
  92. *st->fromwire.dmac_drop + st->fromwire.fw_err_drop
  93. */
  94. "tx_dropped",
  95. "tx_total_sent",
  96. "tx_total_fwd",
  97. "tx_err_pko",
  98. "tx_err_link",
  99. "tx_err_drop",
  100. "tx_tso",
  101. "tx_tso_packets",
  102. "tx_tso_err",
  103. "tx_vxlan",
  104. "mac_tx_total_pkts",
  105. "mac_tx_total_bytes",
  106. "mac_tx_mcast_pkts",
  107. "mac_tx_bcast_pkts",
  108. "mac_tx_ctl_packets", /*oct->link_stats.fromhost.ctl_sent */
  109. "mac_tx_total_collisions",
  110. "mac_tx_one_collision",
  111. "mac_tx_multi_collison",
  112. "mac_tx_max_collision_fail",
  113. "mac_tx_max_deferal_fail",
  114. "mac_tx_fifo_err",
  115. "mac_tx_runts",
  116. "rx_total_rcvd",
  117. "rx_total_fwd",
  118. "rx_jabber_err",
  119. "rx_l2_err",
  120. "rx_frame_err",
  121. "rx_err_pko",
  122. "rx_err_link",
  123. "rx_err_drop",
  124. "rx_vxlan",
  125. "rx_vxlan_err",
  126. "rx_lro_pkts",
  127. "rx_lro_bytes",
  128. "rx_total_lro",
  129. "rx_lro_aborts",
  130. "rx_lro_aborts_port",
  131. "rx_lro_aborts_seq",
  132. "rx_lro_aborts_tsval",
  133. "rx_lro_aborts_timer",
  134. "rx_fwd_rate",
  135. "mac_rx_total_rcvd",
  136. "mac_rx_bytes",
  137. "mac_rx_total_bcst",
  138. "mac_rx_total_mcst",
  139. "mac_rx_runts",
  140. "mac_rx_ctl_packets",
  141. "mac_rx_fifo_err",
  142. "mac_rx_dma_drop",
  143. "mac_rx_fcs_err",
  144. "link_state_changes",
  145. };
  146. /* statistics of VF */
  147. static const char oct_vf_stats_strings[][ETH_GSTRING_LEN] = {
  148. "rx_packets",
  149. "tx_packets",
  150. "rx_bytes",
  151. "tx_bytes",
  152. "rx_errors", /* jabber_err + l2_err+frame_err */
  153. "tx_errors", /* fw_err_pko + fw_err_link+fw_err_drop */
  154. "rx_dropped", /* total_rcvd - fw_total_rcvd + dmac_drop + fw_err_drop */
  155. "tx_dropped",
  156. "link_state_changes",
  157. };
  158. /* statistics of host tx queue */
  159. static const char oct_iq_stats_strings[][ETH_GSTRING_LEN] = {
  160. "packets", /*oct->instr_queue[iq_no]->stats.tx_done*/
  161. "bytes", /*oct->instr_queue[iq_no]->stats.tx_tot_bytes*/
  162. "dropped",
  163. "iq_busy",
  164. "sgentry_sent",
  165. "fw_instr_posted",
  166. "fw_instr_processed",
  167. "fw_instr_dropped",
  168. "fw_bytes_sent",
  169. "tso",
  170. "vxlan",
  171. "txq_restart",
  172. };
  173. /* statistics of host rx queue */
  174. static const char oct_droq_stats_strings[][ETH_GSTRING_LEN] = {
  175. "packets", /*oct->droq[oq_no]->stats.rx_pkts_received */
  176. "bytes", /*oct->droq[oq_no]->stats.rx_bytes_received */
  177. "dropped", /*oct->droq[oq_no]->stats.rx_dropped+
  178. *oct->droq[oq_no]->stats.dropped_nodispatch+
  179. *oct->droq[oq_no]->stats.dropped_toomany+
  180. *oct->droq[oq_no]->stats.dropped_nomem
  181. */
  182. "dropped_nomem",
  183. "dropped_toomany",
  184. "fw_dropped",
  185. "fw_pkts_received",
  186. "fw_bytes_received",
  187. "fw_dropped_nodispatch",
  188. "vxlan",
  189. "buffer_alloc_failure",
  190. };
  191. /* LiquidIO driver private flags */
  192. static const char oct_priv_flags_strings[][ETH_GSTRING_LEN] = {
  193. };
  194. #define OCTNIC_NCMD_AUTONEG_ON 0x1
  195. #define OCTNIC_NCMD_PHY_ON 0x2
  196. static int lio_get_link_ksettings(struct net_device *netdev,
  197. struct ethtool_link_ksettings *ecmd)
  198. {
  199. struct lio *lio = GET_LIO(netdev);
  200. struct octeon_device *oct = lio->oct_dev;
  201. struct oct_link_info *linfo;
  202. u32 supported = 0, advertising = 0;
  203. linfo = &lio->linfo;
  204. if (linfo->link.s.if_mode == INTERFACE_MODE_XAUI ||
  205. linfo->link.s.if_mode == INTERFACE_MODE_RXAUI ||
  206. linfo->link.s.if_mode == INTERFACE_MODE_XLAUI ||
  207. linfo->link.s.if_mode == INTERFACE_MODE_XFI) {
  208. ecmd->base.port = PORT_FIBRE;
  209. if (linfo->link.s.speed == SPEED_10000) {
  210. supported = SUPPORTED_10000baseT_Full;
  211. advertising = ADVERTISED_10000baseT_Full;
  212. }
  213. supported |= SUPPORTED_FIBRE | SUPPORTED_Pause;
  214. advertising |= ADVERTISED_Pause;
  215. ethtool_convert_legacy_u32_to_link_mode(
  216. ecmd->link_modes.supported, supported);
  217. ethtool_convert_legacy_u32_to_link_mode(
  218. ecmd->link_modes.advertising, advertising);
  219. ecmd->base.autoneg = AUTONEG_DISABLE;
  220. } else {
  221. dev_err(&oct->pci_dev->dev, "Unknown link interface reported %d\n",
  222. linfo->link.s.if_mode);
  223. }
  224. if (linfo->link.s.link_up) {
  225. ecmd->base.speed = linfo->link.s.speed;
  226. ecmd->base.duplex = linfo->link.s.duplex;
  227. } else {
  228. ecmd->base.speed = SPEED_UNKNOWN;
  229. ecmd->base.duplex = DUPLEX_UNKNOWN;
  230. }
  231. return 0;
  232. }
  233. static void
  234. lio_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *drvinfo)
  235. {
  236. struct lio *lio;
  237. struct octeon_device *oct;
  238. lio = GET_LIO(netdev);
  239. oct = lio->oct_dev;
  240. memset(drvinfo, 0, sizeof(struct ethtool_drvinfo));
  241. strcpy(drvinfo->driver, "liquidio");
  242. strcpy(drvinfo->version, LIQUIDIO_VERSION);
  243. strncpy(drvinfo->fw_version, oct->fw_info.liquidio_firmware_version,
  244. ETHTOOL_FWVERS_LEN);
  245. strncpy(drvinfo->bus_info, pci_name(oct->pci_dev), 32);
  246. }
  247. static void
  248. lio_get_vf_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *drvinfo)
  249. {
  250. struct octeon_device *oct;
  251. struct lio *lio;
  252. lio = GET_LIO(netdev);
  253. oct = lio->oct_dev;
  254. memset(drvinfo, 0, sizeof(struct ethtool_drvinfo));
  255. strcpy(drvinfo->driver, "liquidio_vf");
  256. strcpy(drvinfo->version, LIQUIDIO_VERSION);
  257. strncpy(drvinfo->fw_version, oct->fw_info.liquidio_firmware_version,
  258. ETHTOOL_FWVERS_LEN);
  259. strncpy(drvinfo->bus_info, pci_name(oct->pci_dev), 32);
  260. }
  261. static void
  262. lio_ethtool_get_channels(struct net_device *dev,
  263. struct ethtool_channels *channel)
  264. {
  265. struct lio *lio = GET_LIO(dev);
  266. struct octeon_device *oct = lio->oct_dev;
  267. u32 max_rx = 0, max_tx = 0, tx_count = 0, rx_count = 0;
  268. if (OCTEON_CN6XXX(oct)) {
  269. struct octeon_config *conf6x = CHIP_CONF(oct, cn6xxx);
  270. max_rx = CFG_GET_OQ_MAX_Q(conf6x);
  271. max_tx = CFG_GET_IQ_MAX_Q(conf6x);
  272. rx_count = CFG_GET_NUM_RXQS_NIC_IF(conf6x, lio->ifidx);
  273. tx_count = CFG_GET_NUM_TXQS_NIC_IF(conf6x, lio->ifidx);
  274. } else if (OCTEON_CN23XX_PF(oct)) {
  275. max_rx = oct->sriov_info.num_pf_rings;
  276. max_tx = oct->sriov_info.num_pf_rings;
  277. rx_count = lio->linfo.num_rxpciq;
  278. tx_count = lio->linfo.num_txpciq;
  279. } else if (OCTEON_CN23XX_VF(oct)) {
  280. max_tx = oct->sriov_info.rings_per_vf;
  281. max_rx = oct->sriov_info.rings_per_vf;
  282. rx_count = lio->linfo.num_rxpciq;
  283. tx_count = lio->linfo.num_txpciq;
  284. }
  285. channel->max_rx = max_rx;
  286. channel->max_tx = max_tx;
  287. channel->rx_count = rx_count;
  288. channel->tx_count = tx_count;
  289. }
  290. static int lio_get_eeprom_len(struct net_device *netdev)
  291. {
  292. u8 buf[128];
  293. struct lio *lio = GET_LIO(netdev);
  294. struct octeon_device *oct_dev = lio->oct_dev;
  295. struct octeon_board_info *board_info;
  296. int len;
  297. board_info = (struct octeon_board_info *)(&oct_dev->boardinfo);
  298. len = sprintf(buf, "boardname:%s serialnum:%s maj:%lld min:%lld\n",
  299. board_info->name, board_info->serial_number,
  300. board_info->major, board_info->minor);
  301. return len;
  302. }
  303. static int
  304. lio_get_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom,
  305. u8 *bytes)
  306. {
  307. struct lio *lio = GET_LIO(netdev);
  308. struct octeon_device *oct_dev = lio->oct_dev;
  309. struct octeon_board_info *board_info;
  310. if (eeprom->offset)
  311. return -EINVAL;
  312. eeprom->magic = oct_dev->pci_dev->vendor;
  313. board_info = (struct octeon_board_info *)(&oct_dev->boardinfo);
  314. sprintf((char *)bytes,
  315. "boardname:%s serialnum:%s maj:%lld min:%lld\n",
  316. board_info->name, board_info->serial_number,
  317. board_info->major, board_info->minor);
  318. return 0;
  319. }
  320. static int octnet_gpio_access(struct net_device *netdev, int addr, int val)
  321. {
  322. struct lio *lio = GET_LIO(netdev);
  323. struct octeon_device *oct = lio->oct_dev;
  324. struct octnic_ctrl_pkt nctrl;
  325. int ret = 0;
  326. memset(&nctrl, 0, sizeof(struct octnic_ctrl_pkt));
  327. nctrl.ncmd.u64 = 0;
  328. nctrl.ncmd.s.cmd = OCTNET_CMD_GPIO_ACCESS;
  329. nctrl.ncmd.s.param1 = addr;
  330. nctrl.ncmd.s.param2 = val;
  331. nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
  332. nctrl.wait_time = 100;
  333. nctrl.netpndev = (u64)netdev;
  334. nctrl.cb_fn = liquidio_link_ctrl_cmd_completion;
  335. ret = octnet_send_nic_ctrl_pkt(lio->oct_dev, &nctrl);
  336. if (ret < 0) {
  337. dev_err(&oct->pci_dev->dev, "Failed to configure gpio value\n");
  338. return -EINVAL;
  339. }
  340. return 0;
  341. }
  342. static int octnet_id_active(struct net_device *netdev, int val)
  343. {
  344. struct lio *lio = GET_LIO(netdev);
  345. struct octeon_device *oct = lio->oct_dev;
  346. struct octnic_ctrl_pkt nctrl;
  347. int ret = 0;
  348. memset(&nctrl, 0, sizeof(struct octnic_ctrl_pkt));
  349. nctrl.ncmd.u64 = 0;
  350. nctrl.ncmd.s.cmd = OCTNET_CMD_ID_ACTIVE;
  351. nctrl.ncmd.s.param1 = val;
  352. nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
  353. nctrl.wait_time = 100;
  354. nctrl.netpndev = (u64)netdev;
  355. nctrl.cb_fn = liquidio_link_ctrl_cmd_completion;
  356. ret = octnet_send_nic_ctrl_pkt(lio->oct_dev, &nctrl);
  357. if (ret < 0) {
  358. dev_err(&oct->pci_dev->dev, "Failed to configure gpio value\n");
  359. return -EINVAL;
  360. }
  361. return 0;
  362. }
  363. /* Callback for when mdio command response arrives
  364. */
  365. static void octnet_mdio_resp_callback(struct octeon_device *oct,
  366. u32 status,
  367. void *buf)
  368. {
  369. struct oct_mdio_cmd_context *mdio_cmd_ctx;
  370. struct octeon_soft_command *sc = (struct octeon_soft_command *)buf;
  371. mdio_cmd_ctx = (struct oct_mdio_cmd_context *)sc->ctxptr;
  372. oct = lio_get_device(mdio_cmd_ctx->octeon_id);
  373. if (status) {
  374. dev_err(&oct->pci_dev->dev, "MIDO instruction failed. Status: %llx\n",
  375. CVM_CAST64(status));
  376. WRITE_ONCE(mdio_cmd_ctx->cond, -1);
  377. } else {
  378. WRITE_ONCE(mdio_cmd_ctx->cond, 1);
  379. }
  380. wake_up_interruptible(&mdio_cmd_ctx->wc);
  381. }
  382. /* This routine provides PHY access routines for
  383. * mdio clause45 .
  384. */
  385. static int
  386. octnet_mdio45_access(struct lio *lio, int op, int loc, int *value)
  387. {
  388. struct octeon_device *oct_dev = lio->oct_dev;
  389. struct octeon_soft_command *sc;
  390. struct oct_mdio_cmd_resp *mdio_cmd_rsp;
  391. struct oct_mdio_cmd_context *mdio_cmd_ctx;
  392. struct oct_mdio_cmd *mdio_cmd;
  393. int retval = 0;
  394. sc = (struct octeon_soft_command *)
  395. octeon_alloc_soft_command(oct_dev,
  396. sizeof(struct oct_mdio_cmd),
  397. sizeof(struct oct_mdio_cmd_resp),
  398. sizeof(struct oct_mdio_cmd_context));
  399. if (!sc)
  400. return -ENOMEM;
  401. mdio_cmd_ctx = (struct oct_mdio_cmd_context *)sc->ctxptr;
  402. mdio_cmd_rsp = (struct oct_mdio_cmd_resp *)sc->virtrptr;
  403. mdio_cmd = (struct oct_mdio_cmd *)sc->virtdptr;
  404. WRITE_ONCE(mdio_cmd_ctx->cond, 0);
  405. mdio_cmd_ctx->octeon_id = lio_get_device_id(oct_dev);
  406. mdio_cmd->op = op;
  407. mdio_cmd->mdio_addr = loc;
  408. if (op)
  409. mdio_cmd->value1 = *value;
  410. octeon_swap_8B_data((u64 *)mdio_cmd, sizeof(struct oct_mdio_cmd) / 8);
  411. sc->iq_no = lio->linfo.txpciq[0].s.q_no;
  412. octeon_prepare_soft_command(oct_dev, sc, OPCODE_NIC, OPCODE_NIC_MDIO45,
  413. 0, 0, 0);
  414. sc->wait_time = 1000;
  415. sc->callback = octnet_mdio_resp_callback;
  416. sc->callback_arg = sc;
  417. init_waitqueue_head(&mdio_cmd_ctx->wc);
  418. retval = octeon_send_soft_command(oct_dev, sc);
  419. if (retval == IQ_SEND_FAILED) {
  420. dev_err(&oct_dev->pci_dev->dev,
  421. "octnet_mdio45_access instruction failed status: %x\n",
  422. retval);
  423. retval = -EBUSY;
  424. } else {
  425. /* Sleep on a wait queue till the cond flag indicates that the
  426. * response arrived
  427. */
  428. sleep_cond(&mdio_cmd_ctx->wc, &mdio_cmd_ctx->cond);
  429. retval = mdio_cmd_rsp->status;
  430. if (retval) {
  431. dev_err(&oct_dev->pci_dev->dev, "octnet mdio45 access failed\n");
  432. retval = -EBUSY;
  433. } else {
  434. octeon_swap_8B_data((u64 *)(&mdio_cmd_rsp->resp),
  435. sizeof(struct oct_mdio_cmd) / 8);
  436. if (READ_ONCE(mdio_cmd_ctx->cond) == 1) {
  437. if (!op)
  438. *value = mdio_cmd_rsp->resp.value1;
  439. } else {
  440. retval = -EINVAL;
  441. }
  442. }
  443. }
  444. octeon_free_soft_command(oct_dev, sc);
  445. return retval;
  446. }
  447. static int lio_set_phys_id(struct net_device *netdev,
  448. enum ethtool_phys_id_state state)
  449. {
  450. struct lio *lio = GET_LIO(netdev);
  451. struct octeon_device *oct = lio->oct_dev;
  452. int value, ret;
  453. switch (state) {
  454. case ETHTOOL_ID_ACTIVE:
  455. if (oct->chip_id == OCTEON_CN66XX) {
  456. octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
  457. VITESSE_PHY_GPIO_DRIVEON);
  458. return 2;
  459. } else if (oct->chip_id == OCTEON_CN68XX) {
  460. /* Save the current LED settings */
  461. ret = octnet_mdio45_access(lio, 0,
  462. LIO68XX_LED_BEACON_ADDR,
  463. &lio->phy_beacon_val);
  464. if (ret)
  465. return ret;
  466. ret = octnet_mdio45_access(lio, 0,
  467. LIO68XX_LED_CTRL_ADDR,
  468. &lio->led_ctrl_val);
  469. if (ret)
  470. return ret;
  471. /* Configure Beacon values */
  472. value = LIO68XX_LED_BEACON_CFGON;
  473. ret = octnet_mdio45_access(lio, 1,
  474. LIO68XX_LED_BEACON_ADDR,
  475. &value);
  476. if (ret)
  477. return ret;
  478. value = LIO68XX_LED_CTRL_CFGON;
  479. ret = octnet_mdio45_access(lio, 1,
  480. LIO68XX_LED_CTRL_ADDR,
  481. &value);
  482. if (ret)
  483. return ret;
  484. } else if (oct->chip_id == OCTEON_CN23XX_PF_VID) {
  485. octnet_id_active(netdev, LED_IDENTIFICATION_ON);
  486. /* returns 0 since updates are asynchronous */
  487. return 0;
  488. } else {
  489. return -EINVAL;
  490. }
  491. break;
  492. case ETHTOOL_ID_ON:
  493. if (oct->chip_id == OCTEON_CN66XX) {
  494. octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
  495. VITESSE_PHY_GPIO_HIGH);
  496. } else if (oct->chip_id == OCTEON_CN68XX) {
  497. return -EINVAL;
  498. } else {
  499. return -EINVAL;
  500. }
  501. break;
  502. case ETHTOOL_ID_OFF:
  503. if (oct->chip_id == OCTEON_CN66XX)
  504. octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
  505. VITESSE_PHY_GPIO_LOW);
  506. else if (oct->chip_id == OCTEON_CN68XX)
  507. return -EINVAL;
  508. else
  509. return -EINVAL;
  510. break;
  511. case ETHTOOL_ID_INACTIVE:
  512. if (oct->chip_id == OCTEON_CN66XX) {
  513. octnet_gpio_access(netdev, VITESSE_PHY_GPIO_CFG,
  514. VITESSE_PHY_GPIO_DRIVEOFF);
  515. } else if (oct->chip_id == OCTEON_CN68XX) {
  516. /* Restore LED settings */
  517. ret = octnet_mdio45_access(lio, 1,
  518. LIO68XX_LED_CTRL_ADDR,
  519. &lio->led_ctrl_val);
  520. if (ret)
  521. return ret;
  522. ret = octnet_mdio45_access(lio, 1,
  523. LIO68XX_LED_BEACON_ADDR,
  524. &lio->phy_beacon_val);
  525. if (ret)
  526. return ret;
  527. } else if (oct->chip_id == OCTEON_CN23XX_PF_VID) {
  528. octnet_id_active(netdev, LED_IDENTIFICATION_OFF);
  529. return 0;
  530. } else {
  531. return -EINVAL;
  532. }
  533. break;
  534. default:
  535. return -EINVAL;
  536. }
  537. return 0;
  538. }
  539. static void
  540. lio_ethtool_get_ringparam(struct net_device *netdev,
  541. struct ethtool_ringparam *ering)
  542. {
  543. struct lio *lio = GET_LIO(netdev);
  544. struct octeon_device *oct = lio->oct_dev;
  545. u32 tx_max_pending = 0, rx_max_pending = 0, tx_pending = 0,
  546. rx_pending = 0;
  547. if (OCTEON_CN6XXX(oct)) {
  548. struct octeon_config *conf6x = CHIP_CONF(oct, cn6xxx);
  549. tx_max_pending = CN6XXX_MAX_IQ_DESCRIPTORS;
  550. rx_max_pending = CN6XXX_MAX_OQ_DESCRIPTORS;
  551. rx_pending = CFG_GET_NUM_RX_DESCS_NIC_IF(conf6x, lio->ifidx);
  552. tx_pending = CFG_GET_NUM_TX_DESCS_NIC_IF(conf6x, lio->ifidx);
  553. } else if (OCTEON_CN23XX_PF(oct)) {
  554. struct octeon_config *conf23 = CHIP_CONF(oct, cn23xx_pf);
  555. tx_max_pending = CN23XX_MAX_IQ_DESCRIPTORS;
  556. rx_max_pending = CN23XX_MAX_OQ_DESCRIPTORS;
  557. rx_pending = CFG_GET_NUM_RX_DESCS_NIC_IF(conf23, lio->ifidx);
  558. tx_pending = CFG_GET_NUM_TX_DESCS_NIC_IF(conf23, lio->ifidx);
  559. }
  560. if (lio->mtu > OCTNET_DEFAULT_FRM_SIZE - OCTNET_FRM_HEADER_SIZE) {
  561. ering->rx_pending = 0;
  562. ering->rx_max_pending = 0;
  563. ering->rx_mini_pending = 0;
  564. ering->rx_jumbo_pending = rx_pending;
  565. ering->rx_mini_max_pending = 0;
  566. ering->rx_jumbo_max_pending = rx_max_pending;
  567. } else {
  568. ering->rx_pending = rx_pending;
  569. ering->rx_max_pending = rx_max_pending;
  570. ering->rx_mini_pending = 0;
  571. ering->rx_jumbo_pending = 0;
  572. ering->rx_mini_max_pending = 0;
  573. ering->rx_jumbo_max_pending = 0;
  574. }
  575. ering->tx_pending = tx_pending;
  576. ering->tx_max_pending = tx_max_pending;
  577. }
  578. static u32 lio_get_msglevel(struct net_device *netdev)
  579. {
  580. struct lio *lio = GET_LIO(netdev);
  581. return lio->msg_enable;
  582. }
  583. static void lio_set_msglevel(struct net_device *netdev, u32 msglvl)
  584. {
  585. struct lio *lio = GET_LIO(netdev);
  586. if ((msglvl ^ lio->msg_enable) & NETIF_MSG_HW) {
  587. if (msglvl & NETIF_MSG_HW)
  588. liquidio_set_feature(netdev,
  589. OCTNET_CMD_VERBOSE_ENABLE, 0);
  590. else
  591. liquidio_set_feature(netdev,
  592. OCTNET_CMD_VERBOSE_DISABLE, 0);
  593. }
  594. lio->msg_enable = msglvl;
  595. }
  596. static void
  597. lio_get_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause)
  598. {
  599. /* Notes: Not supporting any auto negotiation in these
  600. * drivers. Just report pause frame support.
  601. */
  602. struct lio *lio = GET_LIO(netdev);
  603. struct octeon_device *oct = lio->oct_dev;
  604. pause->autoneg = 0;
  605. pause->tx_pause = oct->tx_pause;
  606. pause->rx_pause = oct->rx_pause;
  607. }
  608. static int
  609. lio_set_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *pause)
  610. {
  611. /* Notes: Not supporting any auto negotiation in these
  612. * drivers.
  613. */
  614. struct lio *lio = GET_LIO(netdev);
  615. struct octeon_device *oct = lio->oct_dev;
  616. struct octnic_ctrl_pkt nctrl;
  617. struct oct_link_info *linfo = &lio->linfo;
  618. int ret = 0;
  619. if (oct->chip_id != OCTEON_CN23XX_PF_VID)
  620. return -EINVAL;
  621. if (linfo->link.s.duplex == 0) {
  622. /*no flow control for half duplex*/
  623. if (pause->rx_pause || pause->tx_pause)
  624. return -EINVAL;
  625. }
  626. /*do not support autoneg of link flow control*/
  627. if (pause->autoneg == AUTONEG_ENABLE)
  628. return -EINVAL;
  629. memset(&nctrl, 0, sizeof(struct octnic_ctrl_pkt));
  630. nctrl.ncmd.u64 = 0;
  631. nctrl.ncmd.s.cmd = OCTNET_CMD_SET_FLOW_CTL;
  632. nctrl.iq_no = lio->linfo.txpciq[0].s.q_no;
  633. nctrl.wait_time = 100;
  634. nctrl.netpndev = (u64)netdev;
  635. nctrl.cb_fn = liquidio_link_ctrl_cmd_completion;
  636. if (pause->rx_pause) {
  637. /*enable rx pause*/
  638. nctrl.ncmd.s.param1 = 1;
  639. } else {
  640. /*disable rx pause*/
  641. nctrl.ncmd.s.param1 = 0;
  642. }
  643. if (pause->tx_pause) {
  644. /*enable tx pause*/
  645. nctrl.ncmd.s.param2 = 1;
  646. } else {
  647. /*disable tx pause*/
  648. nctrl.ncmd.s.param2 = 0;
  649. }
  650. ret = octnet_send_nic_ctrl_pkt(lio->oct_dev, &nctrl);
  651. if (ret < 0) {
  652. dev_err(&oct->pci_dev->dev, "Failed to set pause parameter\n");
  653. return -EINVAL;
  654. }
  655. oct->rx_pause = pause->rx_pause;
  656. oct->tx_pause = pause->tx_pause;
  657. return 0;
  658. }
  659. static void
  660. lio_get_ethtool_stats(struct net_device *netdev,
  661. struct ethtool_stats *stats __attribute__((unused)),
  662. u64 *data)
  663. {
  664. struct lio *lio = GET_LIO(netdev);
  665. struct octeon_device *oct_dev = lio->oct_dev;
  666. struct net_device_stats *netstats = &netdev->stats;
  667. int i = 0, j;
  668. netdev->netdev_ops->ndo_get_stats(netdev);
  669. octnet_get_link_stats(netdev);
  670. /*sum of oct->droq[oq_no]->stats->rx_pkts_received */
  671. data[i++] = CVM_CAST64(netstats->rx_packets);
  672. /*sum of oct->instr_queue[iq_no]->stats.tx_done */
  673. data[i++] = CVM_CAST64(netstats->tx_packets);
  674. /*sum of oct->droq[oq_no]->stats->rx_bytes_received */
  675. data[i++] = CVM_CAST64(netstats->rx_bytes);
  676. /*sum of oct->instr_queue[iq_no]->stats.tx_tot_bytes */
  677. data[i++] = CVM_CAST64(netstats->tx_bytes);
  678. data[i++] = CVM_CAST64(netstats->rx_errors);
  679. data[i++] = CVM_CAST64(netstats->tx_errors);
  680. /*sum of oct->droq[oq_no]->stats->rx_dropped +
  681. *oct->droq[oq_no]->stats->dropped_nodispatch +
  682. *oct->droq[oq_no]->stats->dropped_toomany +
  683. *oct->droq[oq_no]->stats->dropped_nomem
  684. */
  685. data[i++] = CVM_CAST64(netstats->rx_dropped);
  686. /*sum of oct->instr_queue[iq_no]->stats.tx_dropped */
  687. data[i++] = CVM_CAST64(netstats->tx_dropped);
  688. /* firmware tx stats */
  689. /*per_core_stats[cvmx_get_core_num()].link_stats[mdata->from_ifidx].
  690. *fromhost.fw_total_sent
  691. */
  692. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_total_sent);
  693. /*per_core_stats[i].link_stats[port].fromwire.fw_total_fwd */
  694. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_total_fwd);
  695. /*per_core_stats[j].link_stats[i].fromhost.fw_err_pko */
  696. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_pko);
  697. /*per_core_stats[j].link_stats[i].fromhost.fw_err_link */
  698. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_link);
  699. /*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
  700. *fw_err_drop
  701. */
  702. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_drop);
  703. /*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.fw_tso */
  704. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_tso);
  705. /*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
  706. *fw_tso_fwd
  707. */
  708. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_tso_fwd);
  709. /*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
  710. *fw_err_tso
  711. */
  712. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_err_tso);
  713. /*per_core_stats[cvmx_get_core_num()].link_stats[idx].fromhost.
  714. *fw_tx_vxlan
  715. */
  716. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fw_tx_vxlan);
  717. /* mac tx statistics */
  718. /*CVMX_BGXX_CMRX_TX_STAT5 */
  719. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.total_pkts_sent);
  720. /*CVMX_BGXX_CMRX_TX_STAT4 */
  721. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.total_bytes_sent);
  722. /*CVMX_BGXX_CMRX_TX_STAT15 */
  723. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.mcast_pkts_sent);
  724. /*CVMX_BGXX_CMRX_TX_STAT14 */
  725. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.bcast_pkts_sent);
  726. /*CVMX_BGXX_CMRX_TX_STAT17 */
  727. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.ctl_sent);
  728. /*CVMX_BGXX_CMRX_TX_STAT0 */
  729. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.total_collisions);
  730. /*CVMX_BGXX_CMRX_TX_STAT3 */
  731. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.one_collision_sent);
  732. /*CVMX_BGXX_CMRX_TX_STAT2 */
  733. data[i++] =
  734. CVM_CAST64(oct_dev->link_stats.fromhost.multi_collision_sent);
  735. /*CVMX_BGXX_CMRX_TX_STAT0 */
  736. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.max_collision_fail);
  737. /*CVMX_BGXX_CMRX_TX_STAT1 */
  738. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.max_deferral_fail);
  739. /*CVMX_BGXX_CMRX_TX_STAT16 */
  740. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.fifo_err);
  741. /*CVMX_BGXX_CMRX_TX_STAT6 */
  742. data[i++] = CVM_CAST64(oct_dev->link_stats.fromhost.runts);
  743. /* RX firmware stats */
  744. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  745. *fw_total_rcvd
  746. */
  747. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_total_rcvd);
  748. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  749. *fw_total_fwd
  750. */
  751. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_total_fwd);
  752. /*per_core_stats[core_id].link_stats[ifidx].fromwire.jabber_err */
  753. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.jabber_err);
  754. /*per_core_stats[core_id].link_stats[ifidx].fromwire.l2_err */
  755. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.l2_err);
  756. /*per_core_stats[core_id].link_stats[ifidx].fromwire.frame_err */
  757. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.frame_err);
  758. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  759. *fw_err_pko
  760. */
  761. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_err_pko);
  762. /*per_core_stats[j].link_stats[i].fromwire.fw_err_link */
  763. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_err_link);
  764. /*per_core_stats[cvmx_get_core_num()].link_stats[lro_ctx->ifidx].
  765. *fromwire.fw_err_drop
  766. */
  767. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_err_drop);
  768. /*per_core_stats[cvmx_get_core_num()].link_stats[lro_ctx->ifidx].
  769. *fromwire.fw_rx_vxlan
  770. */
  771. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_rx_vxlan);
  772. /*per_core_stats[cvmx_get_core_num()].link_stats[lro_ctx->ifidx].
  773. *fromwire.fw_rx_vxlan_err
  774. */
  775. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_rx_vxlan_err);
  776. /* LRO */
  777. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  778. *fw_lro_pkts
  779. */
  780. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_pkts);
  781. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  782. *fw_lro_octs
  783. */
  784. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_octs);
  785. /*per_core_stats[j].link_stats[i].fromwire.fw_total_lro */
  786. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_total_lro);
  787. /*per_core_stats[j].link_stats[i].fromwire.fw_lro_aborts */
  788. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts);
  789. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  790. *fw_lro_aborts_port
  791. */
  792. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_port);
  793. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  794. *fw_lro_aborts_seq
  795. */
  796. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_seq);
  797. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  798. *fw_lro_aborts_tsval
  799. */
  800. data[i++] =
  801. CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_tsval);
  802. /*per_core_stats[cvmx_get_core_num()].link_stats[ifidx].fromwire.
  803. *fw_lro_aborts_timer
  804. */
  805. /* intrmod: packet forward rate */
  806. data[i++] =
  807. CVM_CAST64(oct_dev->link_stats.fromwire.fw_lro_aborts_timer);
  808. /*per_core_stats[j].link_stats[i].fromwire.fw_lro_aborts */
  809. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fwd_rate);
  810. /* mac: link-level stats */
  811. /*CVMX_BGXX_CMRX_RX_STAT0 */
  812. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.total_rcvd);
  813. /*CVMX_BGXX_CMRX_RX_STAT1 */
  814. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.bytes_rcvd);
  815. /*CVMX_PKI_STATX_STAT5 */
  816. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.total_bcst);
  817. /*CVMX_PKI_STATX_STAT5 */
  818. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.total_mcst);
  819. /*wqe->word2.err_code or wqe->word2.err_level */
  820. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.runts);
  821. /*CVMX_BGXX_CMRX_RX_STAT2 */
  822. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.ctl_rcvd);
  823. /*CVMX_BGXX_CMRX_RX_STAT6 */
  824. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fifo_err);
  825. /*CVMX_BGXX_CMRX_RX_STAT4 */
  826. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.dmac_drop);
  827. /*wqe->word2.err_code or wqe->word2.err_level */
  828. data[i++] = CVM_CAST64(oct_dev->link_stats.fromwire.fcs_err);
  829. /*lio->link_changes*/
  830. data[i++] = CVM_CAST64(lio->link_changes);
  831. for (j = 0; j < MAX_OCTEON_INSTR_QUEUES(oct_dev); j++) {
  832. if (!(oct_dev->io_qmask.iq & BIT_ULL(j)))
  833. continue;
  834. /*packets to network port*/
  835. /*# of packets tx to network */
  836. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_done);
  837. /*# of bytes tx to network */
  838. data[i++] =
  839. CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_tot_bytes);
  840. /*# of packets dropped */
  841. data[i++] =
  842. CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_dropped);
  843. /*# of tx fails due to queue full */
  844. data[i++] =
  845. CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_iq_busy);
  846. /*XXX gather entries sent */
  847. data[i++] =
  848. CVM_CAST64(oct_dev->instr_queue[j]->stats.sgentry_sent);
  849. /*instruction to firmware: data and control */
  850. /*# of instructions to the queue */
  851. data[i++] =
  852. CVM_CAST64(oct_dev->instr_queue[j]->stats.instr_posted);
  853. /*# of instructions processed */
  854. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->
  855. stats.instr_processed);
  856. /*# of instructions could not be processed */
  857. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->
  858. stats.instr_dropped);
  859. /*bytes sent through the queue */
  860. data[i++] =
  861. CVM_CAST64(oct_dev->instr_queue[j]->stats.bytes_sent);
  862. /*tso request*/
  863. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_gso);
  864. /*vxlan request*/
  865. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_vxlan);
  866. /*txq restart*/
  867. data[i++] =
  868. CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_restart);
  869. }
  870. /* RX */
  871. for (j = 0; j < MAX_OCTEON_OUTPUT_QUEUES(oct_dev); j++) {
  872. if (!(oct_dev->io_qmask.oq & BIT_ULL(j)))
  873. continue;
  874. /*packets send to TCP/IP network stack */
  875. /*# of packets to network stack */
  876. data[i++] =
  877. CVM_CAST64(oct_dev->droq[j]->stats.rx_pkts_received);
  878. /*# of bytes to network stack */
  879. data[i++] =
  880. CVM_CAST64(oct_dev->droq[j]->stats.rx_bytes_received);
  881. /*# of packets dropped */
  882. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem +
  883. oct_dev->droq[j]->stats.dropped_toomany +
  884. oct_dev->droq[j]->stats.rx_dropped);
  885. data[i++] =
  886. CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem);
  887. data[i++] =
  888. CVM_CAST64(oct_dev->droq[j]->stats.dropped_toomany);
  889. data[i++] =
  890. CVM_CAST64(oct_dev->droq[j]->stats.rx_dropped);
  891. /*control and data path*/
  892. data[i++] =
  893. CVM_CAST64(oct_dev->droq[j]->stats.pkts_received);
  894. data[i++] =
  895. CVM_CAST64(oct_dev->droq[j]->stats.bytes_received);
  896. data[i++] =
  897. CVM_CAST64(oct_dev->droq[j]->stats.dropped_nodispatch);
  898. data[i++] =
  899. CVM_CAST64(oct_dev->droq[j]->stats.rx_vxlan);
  900. data[i++] =
  901. CVM_CAST64(oct_dev->droq[j]->stats.rx_alloc_failure);
  902. }
  903. }
  904. static void lio_vf_get_ethtool_stats(struct net_device *netdev,
  905. struct ethtool_stats *stats
  906. __attribute__((unused)),
  907. u64 *data)
  908. {
  909. struct net_device_stats *netstats = &netdev->stats;
  910. struct lio *lio = GET_LIO(netdev);
  911. struct octeon_device *oct_dev = lio->oct_dev;
  912. int i = 0, j, vj;
  913. netdev->netdev_ops->ndo_get_stats(netdev);
  914. /* sum of oct->droq[oq_no]->stats->rx_pkts_received */
  915. data[i++] = CVM_CAST64(netstats->rx_packets);
  916. /* sum of oct->instr_queue[iq_no]->stats.tx_done */
  917. data[i++] = CVM_CAST64(netstats->tx_packets);
  918. /* sum of oct->droq[oq_no]->stats->rx_bytes_received */
  919. data[i++] = CVM_CAST64(netstats->rx_bytes);
  920. /* sum of oct->instr_queue[iq_no]->stats.tx_tot_bytes */
  921. data[i++] = CVM_CAST64(netstats->tx_bytes);
  922. data[i++] = CVM_CAST64(netstats->rx_errors);
  923. data[i++] = CVM_CAST64(netstats->tx_errors);
  924. /* sum of oct->droq[oq_no]->stats->rx_dropped +
  925. * oct->droq[oq_no]->stats->dropped_nodispatch +
  926. * oct->droq[oq_no]->stats->dropped_toomany +
  927. * oct->droq[oq_no]->stats->dropped_nomem
  928. */
  929. data[i++] = CVM_CAST64(netstats->rx_dropped);
  930. /* sum of oct->instr_queue[iq_no]->stats.tx_dropped */
  931. data[i++] = CVM_CAST64(netstats->tx_dropped);
  932. /* lio->link_changes */
  933. data[i++] = CVM_CAST64(lio->link_changes);
  934. for (vj = 0; vj < lio->linfo.num_txpciq; vj++) {
  935. j = lio->linfo.txpciq[vj].s.q_no;
  936. /* packets to network port */
  937. /* # of packets tx to network */
  938. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_done);
  939. /* # of bytes tx to network */
  940. data[i++] = CVM_CAST64(
  941. oct_dev->instr_queue[j]->stats.tx_tot_bytes);
  942. /* # of packets dropped */
  943. data[i++] = CVM_CAST64(
  944. oct_dev->instr_queue[j]->stats.tx_dropped);
  945. /* # of tx fails due to queue full */
  946. data[i++] = CVM_CAST64(
  947. oct_dev->instr_queue[j]->stats.tx_iq_busy);
  948. /* XXX gather entries sent */
  949. data[i++] = CVM_CAST64(
  950. oct_dev->instr_queue[j]->stats.sgentry_sent);
  951. /* instruction to firmware: data and control */
  952. /* # of instructions to the queue */
  953. data[i++] = CVM_CAST64(
  954. oct_dev->instr_queue[j]->stats.instr_posted);
  955. /* # of instructions processed */
  956. data[i++] =
  957. CVM_CAST64(oct_dev->instr_queue[j]->stats.instr_processed);
  958. /* # of instructions could not be processed */
  959. data[i++] =
  960. CVM_CAST64(oct_dev->instr_queue[j]->stats.instr_dropped);
  961. /* bytes sent through the queue */
  962. data[i++] = CVM_CAST64(
  963. oct_dev->instr_queue[j]->stats.bytes_sent);
  964. /* tso request */
  965. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_gso);
  966. /* vxlan request */
  967. data[i++] = CVM_CAST64(oct_dev->instr_queue[j]->stats.tx_vxlan);
  968. /* txq restart */
  969. data[i++] = CVM_CAST64(
  970. oct_dev->instr_queue[j]->stats.tx_restart);
  971. }
  972. /* RX */
  973. for (vj = 0; vj < lio->linfo.num_rxpciq; vj++) {
  974. j = lio->linfo.rxpciq[vj].s.q_no;
  975. /* packets send to TCP/IP network stack */
  976. /* # of packets to network stack */
  977. data[i++] = CVM_CAST64(
  978. oct_dev->droq[j]->stats.rx_pkts_received);
  979. /* # of bytes to network stack */
  980. data[i++] = CVM_CAST64(
  981. oct_dev->droq[j]->stats.rx_bytes_received);
  982. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem +
  983. oct_dev->droq[j]->stats.dropped_toomany +
  984. oct_dev->droq[j]->stats.rx_dropped);
  985. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_nomem);
  986. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.dropped_toomany);
  987. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.rx_dropped);
  988. /* control and data path */
  989. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.pkts_received);
  990. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.bytes_received);
  991. data[i++] =
  992. CVM_CAST64(oct_dev->droq[j]->stats.dropped_nodispatch);
  993. data[i++] = CVM_CAST64(oct_dev->droq[j]->stats.rx_vxlan);
  994. data[i++] =
  995. CVM_CAST64(oct_dev->droq[j]->stats.rx_alloc_failure);
  996. }
  997. }
  998. static void lio_get_priv_flags_strings(struct lio *lio, u8 *data)
  999. {
  1000. struct octeon_device *oct_dev = lio->oct_dev;
  1001. int i;
  1002. switch (oct_dev->chip_id) {
  1003. case OCTEON_CN23XX_PF_VID:
  1004. case OCTEON_CN23XX_VF_VID:
  1005. for (i = 0; i < ARRAY_SIZE(oct_priv_flags_strings); i++) {
  1006. sprintf(data, "%s", oct_priv_flags_strings[i]);
  1007. data += ETH_GSTRING_LEN;
  1008. }
  1009. break;
  1010. case OCTEON_CN68XX:
  1011. case OCTEON_CN66XX:
  1012. break;
  1013. default:
  1014. netif_info(lio, drv, lio->netdev, "Unknown Chip !!\n");
  1015. break;
  1016. }
  1017. }
  1018. static void lio_get_strings(struct net_device *netdev, u32 stringset, u8 *data)
  1019. {
  1020. struct lio *lio = GET_LIO(netdev);
  1021. struct octeon_device *oct_dev = lio->oct_dev;
  1022. int num_iq_stats, num_oq_stats, i, j;
  1023. int num_stats;
  1024. switch (stringset) {
  1025. case ETH_SS_STATS:
  1026. num_stats = ARRAY_SIZE(oct_stats_strings);
  1027. for (j = 0; j < num_stats; j++) {
  1028. sprintf(data, "%s", oct_stats_strings[j]);
  1029. data += ETH_GSTRING_LEN;
  1030. }
  1031. num_iq_stats = ARRAY_SIZE(oct_iq_stats_strings);
  1032. for (i = 0; i < MAX_OCTEON_INSTR_QUEUES(oct_dev); i++) {
  1033. if (!(oct_dev->io_qmask.iq & BIT_ULL(i)))
  1034. continue;
  1035. for (j = 0; j < num_iq_stats; j++) {
  1036. sprintf(data, "tx-%d-%s", i,
  1037. oct_iq_stats_strings[j]);
  1038. data += ETH_GSTRING_LEN;
  1039. }
  1040. }
  1041. num_oq_stats = ARRAY_SIZE(oct_droq_stats_strings);
  1042. for (i = 0; i < MAX_OCTEON_OUTPUT_QUEUES(oct_dev); i++) {
  1043. if (!(oct_dev->io_qmask.oq & BIT_ULL(i)))
  1044. continue;
  1045. for (j = 0; j < num_oq_stats; j++) {
  1046. sprintf(data, "rx-%d-%s", i,
  1047. oct_droq_stats_strings[j]);
  1048. data += ETH_GSTRING_LEN;
  1049. }
  1050. }
  1051. break;
  1052. case ETH_SS_PRIV_FLAGS:
  1053. lio_get_priv_flags_strings(lio, data);
  1054. break;
  1055. default:
  1056. netif_info(lio, drv, lio->netdev, "Unknown Stringset !!\n");
  1057. break;
  1058. }
  1059. }
  1060. static void lio_vf_get_strings(struct net_device *netdev, u32 stringset,
  1061. u8 *data)
  1062. {
  1063. int num_iq_stats, num_oq_stats, i, j;
  1064. struct lio *lio = GET_LIO(netdev);
  1065. struct octeon_device *oct_dev = lio->oct_dev;
  1066. int num_stats;
  1067. switch (stringset) {
  1068. case ETH_SS_STATS:
  1069. num_stats = ARRAY_SIZE(oct_vf_stats_strings);
  1070. for (j = 0; j < num_stats; j++) {
  1071. sprintf(data, "%s", oct_vf_stats_strings[j]);
  1072. data += ETH_GSTRING_LEN;
  1073. }
  1074. num_iq_stats = ARRAY_SIZE(oct_iq_stats_strings);
  1075. for (i = 0; i < MAX_OCTEON_INSTR_QUEUES(oct_dev); i++) {
  1076. if (!(oct_dev->io_qmask.iq & BIT_ULL(i)))
  1077. continue;
  1078. for (j = 0; j < num_iq_stats; j++) {
  1079. sprintf(data, "tx-%d-%s", i,
  1080. oct_iq_stats_strings[j]);
  1081. data += ETH_GSTRING_LEN;
  1082. }
  1083. }
  1084. num_oq_stats = ARRAY_SIZE(oct_droq_stats_strings);
  1085. for (i = 0; i < MAX_OCTEON_OUTPUT_QUEUES(oct_dev); i++) {
  1086. if (!(oct_dev->io_qmask.oq & BIT_ULL(i)))
  1087. continue;
  1088. for (j = 0; j < num_oq_stats; j++) {
  1089. sprintf(data, "rx-%d-%s", i,
  1090. oct_droq_stats_strings[j]);
  1091. data += ETH_GSTRING_LEN;
  1092. }
  1093. }
  1094. break;
  1095. case ETH_SS_PRIV_FLAGS:
  1096. lio_get_priv_flags_strings(lio, data);
  1097. break;
  1098. default:
  1099. netif_info(lio, drv, lio->netdev, "Unknown Stringset !!\n");
  1100. break;
  1101. }
  1102. }
  1103. static int lio_get_priv_flags_ss_count(struct lio *lio)
  1104. {
  1105. struct octeon_device *oct_dev = lio->oct_dev;
  1106. switch (oct_dev->chip_id) {
  1107. case OCTEON_CN23XX_PF_VID:
  1108. case OCTEON_CN23XX_VF_VID:
  1109. return ARRAY_SIZE(oct_priv_flags_strings);
  1110. case OCTEON_CN68XX:
  1111. case OCTEON_CN66XX:
  1112. return -EOPNOTSUPP;
  1113. default:
  1114. netif_info(lio, drv, lio->netdev, "Unknown Chip !!\n");
  1115. return -EOPNOTSUPP;
  1116. }
  1117. }
  1118. static int lio_get_sset_count(struct net_device *netdev, int sset)
  1119. {
  1120. struct lio *lio = GET_LIO(netdev);
  1121. struct octeon_device *oct_dev = lio->oct_dev;
  1122. switch (sset) {
  1123. case ETH_SS_STATS:
  1124. return (ARRAY_SIZE(oct_stats_strings) +
  1125. ARRAY_SIZE(oct_iq_stats_strings) * oct_dev->num_iqs +
  1126. ARRAY_SIZE(oct_droq_stats_strings) * oct_dev->num_oqs);
  1127. case ETH_SS_PRIV_FLAGS:
  1128. return lio_get_priv_flags_ss_count(lio);
  1129. default:
  1130. return -EOPNOTSUPP;
  1131. }
  1132. }
  1133. static int lio_vf_get_sset_count(struct net_device *netdev, int sset)
  1134. {
  1135. struct lio *lio = GET_LIO(netdev);
  1136. struct octeon_device *oct_dev = lio->oct_dev;
  1137. switch (sset) {
  1138. case ETH_SS_STATS:
  1139. return (ARRAY_SIZE(oct_vf_stats_strings) +
  1140. ARRAY_SIZE(oct_iq_stats_strings) * oct_dev->num_iqs +
  1141. ARRAY_SIZE(oct_droq_stats_strings) * oct_dev->num_oqs);
  1142. case ETH_SS_PRIV_FLAGS:
  1143. return lio_get_priv_flags_ss_count(lio);
  1144. default:
  1145. return -EOPNOTSUPP;
  1146. }
  1147. }
  1148. /* Callback function for intrmod */
  1149. static void octnet_intrmod_callback(struct octeon_device *oct_dev,
  1150. u32 status,
  1151. void *ptr)
  1152. {
  1153. struct octeon_soft_command *sc = (struct octeon_soft_command *)ptr;
  1154. struct oct_intrmod_context *ctx;
  1155. ctx = (struct oct_intrmod_context *)sc->ctxptr;
  1156. ctx->status = status;
  1157. WRITE_ONCE(ctx->cond, 1);
  1158. /* This barrier is required to be sure that the response has been
  1159. * written fully before waking up the handler
  1160. */
  1161. wmb();
  1162. wake_up_interruptible(&ctx->wc);
  1163. }
  1164. /* get interrupt moderation parameters */
  1165. static int octnet_get_intrmod_cfg(struct lio *lio,
  1166. struct oct_intrmod_cfg *intr_cfg)
  1167. {
  1168. struct octeon_soft_command *sc;
  1169. struct oct_intrmod_context *ctx;
  1170. struct oct_intrmod_resp *resp;
  1171. int retval;
  1172. struct octeon_device *oct_dev = lio->oct_dev;
  1173. /* Alloc soft command */
  1174. sc = (struct octeon_soft_command *)
  1175. octeon_alloc_soft_command(oct_dev,
  1176. 0,
  1177. sizeof(struct oct_intrmod_resp),
  1178. sizeof(struct oct_intrmod_context));
  1179. if (!sc)
  1180. return -ENOMEM;
  1181. resp = (struct oct_intrmod_resp *)sc->virtrptr;
  1182. memset(resp, 0, sizeof(struct oct_intrmod_resp));
  1183. ctx = (struct oct_intrmod_context *)sc->ctxptr;
  1184. memset(ctx, 0, sizeof(struct oct_intrmod_context));
  1185. WRITE_ONCE(ctx->cond, 0);
  1186. ctx->octeon_id = lio_get_device_id(oct_dev);
  1187. init_waitqueue_head(&ctx->wc);
  1188. sc->iq_no = lio->linfo.txpciq[0].s.q_no;
  1189. octeon_prepare_soft_command(oct_dev, sc, OPCODE_NIC,
  1190. OPCODE_NIC_INTRMOD_PARAMS, 0, 0, 0);
  1191. sc->callback = octnet_intrmod_callback;
  1192. sc->callback_arg = sc;
  1193. sc->wait_time = 1000;
  1194. retval = octeon_send_soft_command(oct_dev, sc);
  1195. if (retval == IQ_SEND_FAILED) {
  1196. octeon_free_soft_command(oct_dev, sc);
  1197. return -EINVAL;
  1198. }
  1199. /* Sleep on a wait queue till the cond flag indicates that the
  1200. * response arrived or timed-out.
  1201. */
  1202. if (sleep_cond(&ctx->wc, &ctx->cond) == -EINTR) {
  1203. dev_err(&oct_dev->pci_dev->dev, "Wait interrupted\n");
  1204. goto intrmod_info_wait_intr;
  1205. }
  1206. retval = ctx->status || resp->status;
  1207. if (retval) {
  1208. dev_err(&oct_dev->pci_dev->dev,
  1209. "Get interrupt moderation parameters failed\n");
  1210. goto intrmod_info_wait_fail;
  1211. }
  1212. octeon_swap_8B_data((u64 *)&resp->intrmod,
  1213. (sizeof(struct oct_intrmod_cfg)) / 8);
  1214. memcpy(intr_cfg, &resp->intrmod, sizeof(struct oct_intrmod_cfg));
  1215. octeon_free_soft_command(oct_dev, sc);
  1216. return 0;
  1217. intrmod_info_wait_fail:
  1218. octeon_free_soft_command(oct_dev, sc);
  1219. intrmod_info_wait_intr:
  1220. return -ENODEV;
  1221. }
  1222. /* Configure interrupt moderation parameters */
  1223. static int octnet_set_intrmod_cfg(struct lio *lio,
  1224. struct oct_intrmod_cfg *intr_cfg)
  1225. {
  1226. struct octeon_soft_command *sc;
  1227. struct oct_intrmod_context *ctx;
  1228. struct oct_intrmod_cfg *cfg;
  1229. int retval;
  1230. struct octeon_device *oct_dev = lio->oct_dev;
  1231. /* Alloc soft command */
  1232. sc = (struct octeon_soft_command *)
  1233. octeon_alloc_soft_command(oct_dev,
  1234. sizeof(struct oct_intrmod_cfg),
  1235. 0,
  1236. sizeof(struct oct_intrmod_context));
  1237. if (!sc)
  1238. return -ENOMEM;
  1239. ctx = (struct oct_intrmod_context *)sc->ctxptr;
  1240. WRITE_ONCE(ctx->cond, 0);
  1241. ctx->octeon_id = lio_get_device_id(oct_dev);
  1242. init_waitqueue_head(&ctx->wc);
  1243. cfg = (struct oct_intrmod_cfg *)sc->virtdptr;
  1244. memcpy(cfg, intr_cfg, sizeof(struct oct_intrmod_cfg));
  1245. octeon_swap_8B_data((u64 *)cfg, (sizeof(struct oct_intrmod_cfg)) / 8);
  1246. sc->iq_no = lio->linfo.txpciq[0].s.q_no;
  1247. octeon_prepare_soft_command(oct_dev, sc, OPCODE_NIC,
  1248. OPCODE_NIC_INTRMOD_CFG, 0, 0, 0);
  1249. sc->callback = octnet_intrmod_callback;
  1250. sc->callback_arg = sc;
  1251. sc->wait_time = 1000;
  1252. retval = octeon_send_soft_command(oct_dev, sc);
  1253. if (retval == IQ_SEND_FAILED) {
  1254. octeon_free_soft_command(oct_dev, sc);
  1255. return -EINVAL;
  1256. }
  1257. /* Sleep on a wait queue till the cond flag indicates that the
  1258. * response arrived or timed-out.
  1259. */
  1260. if (sleep_cond(&ctx->wc, &ctx->cond) != -EINTR) {
  1261. retval = ctx->status;
  1262. if (retval)
  1263. dev_err(&oct_dev->pci_dev->dev,
  1264. "intrmod config failed. Status: %llx\n",
  1265. CVM_CAST64(retval));
  1266. else
  1267. dev_info(&oct_dev->pci_dev->dev,
  1268. "Rx-Adaptive Interrupt moderation %s\n",
  1269. (intr_cfg->rx_enable) ?
  1270. "enabled" : "disabled");
  1271. octeon_free_soft_command(oct_dev, sc);
  1272. return ((retval) ? -ENODEV : 0);
  1273. }
  1274. dev_err(&oct_dev->pci_dev->dev, "iq/oq config failed\n");
  1275. return -EINTR;
  1276. }
  1277. static void
  1278. octnet_nic_stats_callback(struct octeon_device *oct_dev,
  1279. u32 status, void *ptr)
  1280. {
  1281. struct octeon_soft_command *sc = (struct octeon_soft_command *)ptr;
  1282. struct oct_nic_stats_resp *resp =
  1283. (struct oct_nic_stats_resp *)sc->virtrptr;
  1284. struct oct_nic_stats_ctrl *ctrl =
  1285. (struct oct_nic_stats_ctrl *)sc->ctxptr;
  1286. struct nic_rx_stats *rsp_rstats = &resp->stats.fromwire;
  1287. struct nic_tx_stats *rsp_tstats = &resp->stats.fromhost;
  1288. struct nic_rx_stats *rstats = &oct_dev->link_stats.fromwire;
  1289. struct nic_tx_stats *tstats = &oct_dev->link_stats.fromhost;
  1290. if ((status != OCTEON_REQUEST_TIMEOUT) && !resp->status) {
  1291. octeon_swap_8B_data((u64 *)&resp->stats,
  1292. (sizeof(struct oct_link_stats)) >> 3);
  1293. /* RX link-level stats */
  1294. rstats->total_rcvd = rsp_rstats->total_rcvd;
  1295. rstats->bytes_rcvd = rsp_rstats->bytes_rcvd;
  1296. rstats->total_bcst = rsp_rstats->total_bcst;
  1297. rstats->total_mcst = rsp_rstats->total_mcst;
  1298. rstats->runts = rsp_rstats->runts;
  1299. rstats->ctl_rcvd = rsp_rstats->ctl_rcvd;
  1300. /* Accounts for over/under-run of buffers */
  1301. rstats->fifo_err = rsp_rstats->fifo_err;
  1302. rstats->dmac_drop = rsp_rstats->dmac_drop;
  1303. rstats->fcs_err = rsp_rstats->fcs_err;
  1304. rstats->jabber_err = rsp_rstats->jabber_err;
  1305. rstats->l2_err = rsp_rstats->l2_err;
  1306. rstats->frame_err = rsp_rstats->frame_err;
  1307. /* RX firmware stats */
  1308. rstats->fw_total_rcvd = rsp_rstats->fw_total_rcvd;
  1309. rstats->fw_total_fwd = rsp_rstats->fw_total_fwd;
  1310. rstats->fw_err_pko = rsp_rstats->fw_err_pko;
  1311. rstats->fw_err_link = rsp_rstats->fw_err_link;
  1312. rstats->fw_err_drop = rsp_rstats->fw_err_drop;
  1313. rstats->fw_rx_vxlan = rsp_rstats->fw_rx_vxlan;
  1314. rstats->fw_rx_vxlan_err = rsp_rstats->fw_rx_vxlan_err;
  1315. /* Number of packets that are LROed */
  1316. rstats->fw_lro_pkts = rsp_rstats->fw_lro_pkts;
  1317. /* Number of octets that are LROed */
  1318. rstats->fw_lro_octs = rsp_rstats->fw_lro_octs;
  1319. /* Number of LRO packets formed */
  1320. rstats->fw_total_lro = rsp_rstats->fw_total_lro;
  1321. /* Number of times lRO of packet aborted */
  1322. rstats->fw_lro_aborts = rsp_rstats->fw_lro_aborts;
  1323. rstats->fw_lro_aborts_port = rsp_rstats->fw_lro_aborts_port;
  1324. rstats->fw_lro_aborts_seq = rsp_rstats->fw_lro_aborts_seq;
  1325. rstats->fw_lro_aborts_tsval = rsp_rstats->fw_lro_aborts_tsval;
  1326. rstats->fw_lro_aborts_timer = rsp_rstats->fw_lro_aborts_timer;
  1327. /* intrmod: packet forward rate */
  1328. rstats->fwd_rate = rsp_rstats->fwd_rate;
  1329. /* TX link-level stats */
  1330. tstats->total_pkts_sent = rsp_tstats->total_pkts_sent;
  1331. tstats->total_bytes_sent = rsp_tstats->total_bytes_sent;
  1332. tstats->mcast_pkts_sent = rsp_tstats->mcast_pkts_sent;
  1333. tstats->bcast_pkts_sent = rsp_tstats->bcast_pkts_sent;
  1334. tstats->ctl_sent = rsp_tstats->ctl_sent;
  1335. /* Packets sent after one collision*/
  1336. tstats->one_collision_sent = rsp_tstats->one_collision_sent;
  1337. /* Packets sent after multiple collision*/
  1338. tstats->multi_collision_sent = rsp_tstats->multi_collision_sent;
  1339. /* Packets not sent due to max collisions */
  1340. tstats->max_collision_fail = rsp_tstats->max_collision_fail;
  1341. /* Packets not sent due to max deferrals */
  1342. tstats->max_deferral_fail = rsp_tstats->max_deferral_fail;
  1343. /* Accounts for over/under-run of buffers */
  1344. tstats->fifo_err = rsp_tstats->fifo_err;
  1345. tstats->runts = rsp_tstats->runts;
  1346. /* Total number of collisions detected */
  1347. tstats->total_collisions = rsp_tstats->total_collisions;
  1348. /* firmware stats */
  1349. tstats->fw_total_sent = rsp_tstats->fw_total_sent;
  1350. tstats->fw_total_fwd = rsp_tstats->fw_total_fwd;
  1351. tstats->fw_err_pko = rsp_tstats->fw_err_pko;
  1352. tstats->fw_err_link = rsp_tstats->fw_err_link;
  1353. tstats->fw_err_drop = rsp_tstats->fw_err_drop;
  1354. tstats->fw_tso = rsp_tstats->fw_tso;
  1355. tstats->fw_tso_fwd = rsp_tstats->fw_tso_fwd;
  1356. tstats->fw_err_tso = rsp_tstats->fw_err_tso;
  1357. tstats->fw_tx_vxlan = rsp_tstats->fw_tx_vxlan;
  1358. resp->status = 1;
  1359. } else {
  1360. resp->status = -1;
  1361. }
  1362. complete(&ctrl->complete);
  1363. }
  1364. /* Configure interrupt moderation parameters */
  1365. static int octnet_get_link_stats(struct net_device *netdev)
  1366. {
  1367. struct lio *lio = GET_LIO(netdev);
  1368. struct octeon_device *oct_dev = lio->oct_dev;
  1369. struct octeon_soft_command *sc;
  1370. struct oct_nic_stats_ctrl *ctrl;
  1371. struct oct_nic_stats_resp *resp;
  1372. int retval;
  1373. /* Alloc soft command */
  1374. sc = (struct octeon_soft_command *)
  1375. octeon_alloc_soft_command(oct_dev,
  1376. 0,
  1377. sizeof(struct oct_nic_stats_resp),
  1378. sizeof(struct octnic_ctrl_pkt));
  1379. if (!sc)
  1380. return -ENOMEM;
  1381. resp = (struct oct_nic_stats_resp *)sc->virtrptr;
  1382. memset(resp, 0, sizeof(struct oct_nic_stats_resp));
  1383. ctrl = (struct oct_nic_stats_ctrl *)sc->ctxptr;
  1384. memset(ctrl, 0, sizeof(struct oct_nic_stats_ctrl));
  1385. ctrl->netdev = netdev;
  1386. init_completion(&ctrl->complete);
  1387. sc->iq_no = lio->linfo.txpciq[0].s.q_no;
  1388. octeon_prepare_soft_command(oct_dev, sc, OPCODE_NIC,
  1389. OPCODE_NIC_PORT_STATS, 0, 0, 0);
  1390. sc->callback = octnet_nic_stats_callback;
  1391. sc->callback_arg = sc;
  1392. sc->wait_time = 500; /*in milli seconds*/
  1393. retval = octeon_send_soft_command(oct_dev, sc);
  1394. if (retval == IQ_SEND_FAILED) {
  1395. octeon_free_soft_command(oct_dev, sc);
  1396. return -EINVAL;
  1397. }
  1398. wait_for_completion_timeout(&ctrl->complete, msecs_to_jiffies(1000));
  1399. if (resp->status != 1) {
  1400. octeon_free_soft_command(oct_dev, sc);
  1401. return -EINVAL;
  1402. }
  1403. octeon_free_soft_command(oct_dev, sc);
  1404. return 0;
  1405. }
  1406. static int lio_get_intr_coalesce(struct net_device *netdev,
  1407. struct ethtool_coalesce *intr_coal)
  1408. {
  1409. struct lio *lio = GET_LIO(netdev);
  1410. struct octeon_device *oct = lio->oct_dev;
  1411. struct octeon_instr_queue *iq;
  1412. struct oct_intrmod_cfg intrmod_cfg;
  1413. if (octnet_get_intrmod_cfg(lio, &intrmod_cfg))
  1414. return -ENODEV;
  1415. switch (oct->chip_id) {
  1416. case OCTEON_CN23XX_PF_VID:
  1417. case OCTEON_CN23XX_VF_VID: {
  1418. if (!intrmod_cfg.rx_enable) {
  1419. intr_coal->rx_coalesce_usecs = oct->rx_coalesce_usecs;
  1420. intr_coal->rx_max_coalesced_frames =
  1421. oct->rx_max_coalesced_frames;
  1422. }
  1423. if (!intrmod_cfg.tx_enable)
  1424. intr_coal->tx_max_coalesced_frames =
  1425. oct->tx_max_coalesced_frames;
  1426. break;
  1427. }
  1428. case OCTEON_CN68XX:
  1429. case OCTEON_CN66XX: {
  1430. struct octeon_cn6xxx *cn6xxx =
  1431. (struct octeon_cn6xxx *)oct->chip;
  1432. if (!intrmod_cfg.rx_enable) {
  1433. intr_coal->rx_coalesce_usecs =
  1434. CFG_GET_OQ_INTR_TIME(cn6xxx->conf);
  1435. intr_coal->rx_max_coalesced_frames =
  1436. CFG_GET_OQ_INTR_PKT(cn6xxx->conf);
  1437. }
  1438. iq = oct->instr_queue[lio->linfo.txpciq[0].s.q_no];
  1439. intr_coal->tx_max_coalesced_frames = iq->fill_threshold;
  1440. break;
  1441. }
  1442. default:
  1443. netif_info(lio, drv, lio->netdev, "Unknown Chip !!\n");
  1444. return -EINVAL;
  1445. }
  1446. if (intrmod_cfg.rx_enable) {
  1447. intr_coal->use_adaptive_rx_coalesce =
  1448. intrmod_cfg.rx_enable;
  1449. intr_coal->rate_sample_interval =
  1450. intrmod_cfg.check_intrvl;
  1451. intr_coal->pkt_rate_high =
  1452. intrmod_cfg.maxpkt_ratethr;
  1453. intr_coal->pkt_rate_low =
  1454. intrmod_cfg.minpkt_ratethr;
  1455. intr_coal->rx_max_coalesced_frames_high =
  1456. intrmod_cfg.rx_maxcnt_trigger;
  1457. intr_coal->rx_coalesce_usecs_high =
  1458. intrmod_cfg.rx_maxtmr_trigger;
  1459. intr_coal->rx_coalesce_usecs_low =
  1460. intrmod_cfg.rx_mintmr_trigger;
  1461. intr_coal->rx_max_coalesced_frames_low =
  1462. intrmod_cfg.rx_mincnt_trigger;
  1463. }
  1464. if ((OCTEON_CN23XX_PF(oct) || OCTEON_CN23XX_VF(oct)) &&
  1465. (intrmod_cfg.tx_enable)) {
  1466. intr_coal->use_adaptive_tx_coalesce =
  1467. intrmod_cfg.tx_enable;
  1468. intr_coal->tx_max_coalesced_frames_high =
  1469. intrmod_cfg.tx_maxcnt_trigger;
  1470. intr_coal->tx_max_coalesced_frames_low =
  1471. intrmod_cfg.tx_mincnt_trigger;
  1472. }
  1473. return 0;
  1474. }
  1475. /* Enable/Disable auto interrupt Moderation */
  1476. static int oct_cfg_adaptive_intr(struct lio *lio,
  1477. struct oct_intrmod_cfg *intrmod_cfg,
  1478. struct ethtool_coalesce *intr_coal)
  1479. {
  1480. int ret = 0;
  1481. if (intrmod_cfg->rx_enable || intrmod_cfg->tx_enable) {
  1482. intrmod_cfg->check_intrvl = intr_coal->rate_sample_interval;
  1483. intrmod_cfg->maxpkt_ratethr = intr_coal->pkt_rate_high;
  1484. intrmod_cfg->minpkt_ratethr = intr_coal->pkt_rate_low;
  1485. }
  1486. if (intrmod_cfg->rx_enable) {
  1487. intrmod_cfg->rx_maxcnt_trigger =
  1488. intr_coal->rx_max_coalesced_frames_high;
  1489. intrmod_cfg->rx_maxtmr_trigger =
  1490. intr_coal->rx_coalesce_usecs_high;
  1491. intrmod_cfg->rx_mintmr_trigger =
  1492. intr_coal->rx_coalesce_usecs_low;
  1493. intrmod_cfg->rx_mincnt_trigger =
  1494. intr_coal->rx_max_coalesced_frames_low;
  1495. }
  1496. if (intrmod_cfg->tx_enable) {
  1497. intrmod_cfg->tx_maxcnt_trigger =
  1498. intr_coal->tx_max_coalesced_frames_high;
  1499. intrmod_cfg->tx_mincnt_trigger =
  1500. intr_coal->tx_max_coalesced_frames_low;
  1501. }
  1502. ret = octnet_set_intrmod_cfg(lio, intrmod_cfg);
  1503. return ret;
  1504. }
  1505. static int
  1506. oct_cfg_rx_intrcnt(struct lio *lio,
  1507. struct oct_intrmod_cfg *intrmod,
  1508. struct ethtool_coalesce *intr_coal)
  1509. {
  1510. struct octeon_device *oct = lio->oct_dev;
  1511. u32 rx_max_coalesced_frames;
  1512. /* Config Cnt based interrupt values */
  1513. switch (oct->chip_id) {
  1514. case OCTEON_CN68XX:
  1515. case OCTEON_CN66XX: {
  1516. struct octeon_cn6xxx *cn6xxx =
  1517. (struct octeon_cn6xxx *)oct->chip;
  1518. if (!intr_coal->rx_max_coalesced_frames)
  1519. rx_max_coalesced_frames = CN6XXX_OQ_INTR_PKT;
  1520. else
  1521. rx_max_coalesced_frames =
  1522. intr_coal->rx_max_coalesced_frames;
  1523. octeon_write_csr(oct, CN6XXX_SLI_OQ_INT_LEVEL_PKTS,
  1524. rx_max_coalesced_frames);
  1525. CFG_SET_OQ_INTR_PKT(cn6xxx->conf, rx_max_coalesced_frames);
  1526. break;
  1527. }
  1528. case OCTEON_CN23XX_PF_VID: {
  1529. int q_no;
  1530. if (!intr_coal->rx_max_coalesced_frames)
  1531. rx_max_coalesced_frames = intrmod->rx_frames;
  1532. else
  1533. rx_max_coalesced_frames =
  1534. intr_coal->rx_max_coalesced_frames;
  1535. for (q_no = 0; q_no < oct->num_oqs; q_no++) {
  1536. q_no += oct->sriov_info.pf_srn;
  1537. octeon_write_csr64(
  1538. oct, CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no),
  1539. (octeon_read_csr64(
  1540. oct, CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no)) &
  1541. (0x3fffff00000000UL)) |
  1542. (rx_max_coalesced_frames - 1));
  1543. /*consider setting resend bit*/
  1544. }
  1545. intrmod->rx_frames = rx_max_coalesced_frames;
  1546. oct->rx_max_coalesced_frames = rx_max_coalesced_frames;
  1547. break;
  1548. }
  1549. case OCTEON_CN23XX_VF_VID: {
  1550. int q_no;
  1551. if (!intr_coal->rx_max_coalesced_frames)
  1552. rx_max_coalesced_frames = intrmod->rx_frames;
  1553. else
  1554. rx_max_coalesced_frames =
  1555. intr_coal->rx_max_coalesced_frames;
  1556. for (q_no = 0; q_no < oct->num_oqs; q_no++) {
  1557. octeon_write_csr64(
  1558. oct, CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(q_no),
  1559. (octeon_read_csr64(
  1560. oct, CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(q_no)) &
  1561. (0x3fffff00000000UL)) |
  1562. rx_max_coalesced_frames);
  1563. /*consider writing to resend bit here*/
  1564. }
  1565. intrmod->rx_frames = rx_max_coalesced_frames;
  1566. oct->rx_max_coalesced_frames = rx_max_coalesced_frames;
  1567. break;
  1568. }
  1569. default:
  1570. return -EINVAL;
  1571. }
  1572. return 0;
  1573. }
  1574. static int oct_cfg_rx_intrtime(struct lio *lio,
  1575. struct oct_intrmod_cfg *intrmod,
  1576. struct ethtool_coalesce *intr_coal)
  1577. {
  1578. struct octeon_device *oct = lio->oct_dev;
  1579. u32 time_threshold, rx_coalesce_usecs;
  1580. /* Config Time based interrupt values */
  1581. switch (oct->chip_id) {
  1582. case OCTEON_CN68XX:
  1583. case OCTEON_CN66XX: {
  1584. struct octeon_cn6xxx *cn6xxx =
  1585. (struct octeon_cn6xxx *)oct->chip;
  1586. if (!intr_coal->rx_coalesce_usecs)
  1587. rx_coalesce_usecs = CN6XXX_OQ_INTR_TIME;
  1588. else
  1589. rx_coalesce_usecs = intr_coal->rx_coalesce_usecs;
  1590. time_threshold = lio_cn6xxx_get_oq_ticks(oct,
  1591. rx_coalesce_usecs);
  1592. octeon_write_csr(oct,
  1593. CN6XXX_SLI_OQ_INT_LEVEL_TIME,
  1594. time_threshold);
  1595. CFG_SET_OQ_INTR_TIME(cn6xxx->conf, rx_coalesce_usecs);
  1596. break;
  1597. }
  1598. case OCTEON_CN23XX_PF_VID: {
  1599. u64 time_threshold;
  1600. int q_no;
  1601. if (!intr_coal->rx_coalesce_usecs)
  1602. rx_coalesce_usecs = intrmod->rx_usecs;
  1603. else
  1604. rx_coalesce_usecs = intr_coal->rx_coalesce_usecs;
  1605. time_threshold =
  1606. cn23xx_pf_get_oq_ticks(oct, (u32)rx_coalesce_usecs);
  1607. for (q_no = 0; q_no < oct->num_oqs; q_no++) {
  1608. q_no += oct->sriov_info.pf_srn;
  1609. octeon_write_csr64(oct,
  1610. CN23XX_SLI_OQ_PKT_INT_LEVELS(q_no),
  1611. (intrmod->rx_frames |
  1612. ((u64)time_threshold << 32)));
  1613. /*consider writing to resend bit here*/
  1614. }
  1615. intrmod->rx_usecs = rx_coalesce_usecs;
  1616. oct->rx_coalesce_usecs = rx_coalesce_usecs;
  1617. break;
  1618. }
  1619. case OCTEON_CN23XX_VF_VID: {
  1620. u64 time_threshold;
  1621. int q_no;
  1622. if (!intr_coal->rx_coalesce_usecs)
  1623. rx_coalesce_usecs = intrmod->rx_usecs;
  1624. else
  1625. rx_coalesce_usecs = intr_coal->rx_coalesce_usecs;
  1626. time_threshold =
  1627. cn23xx_vf_get_oq_ticks(oct, (u32)rx_coalesce_usecs);
  1628. for (q_no = 0; q_no < oct->num_oqs; q_no++) {
  1629. octeon_write_csr64(
  1630. oct, CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(q_no),
  1631. (intrmod->rx_frames |
  1632. ((u64)time_threshold << 32)));
  1633. /*consider setting resend bit*/
  1634. }
  1635. intrmod->rx_usecs = rx_coalesce_usecs;
  1636. oct->rx_coalesce_usecs = rx_coalesce_usecs;
  1637. break;
  1638. }
  1639. default:
  1640. return -EINVAL;
  1641. }
  1642. return 0;
  1643. }
  1644. static int
  1645. oct_cfg_tx_intrcnt(struct lio *lio,
  1646. struct oct_intrmod_cfg *intrmod,
  1647. struct ethtool_coalesce *intr_coal)
  1648. {
  1649. struct octeon_device *oct = lio->oct_dev;
  1650. u32 iq_intr_pkt;
  1651. void __iomem *inst_cnt_reg;
  1652. u64 val;
  1653. /* Config Cnt based interrupt values */
  1654. switch (oct->chip_id) {
  1655. case OCTEON_CN68XX:
  1656. case OCTEON_CN66XX:
  1657. break;
  1658. case OCTEON_CN23XX_VF_VID:
  1659. case OCTEON_CN23XX_PF_VID: {
  1660. int q_no;
  1661. if (!intr_coal->tx_max_coalesced_frames)
  1662. iq_intr_pkt = CN23XX_DEF_IQ_INTR_THRESHOLD &
  1663. CN23XX_PKT_IN_DONE_WMARK_MASK;
  1664. else
  1665. iq_intr_pkt = intr_coal->tx_max_coalesced_frames &
  1666. CN23XX_PKT_IN_DONE_WMARK_MASK;
  1667. for (q_no = 0; q_no < oct->num_iqs; q_no++) {
  1668. inst_cnt_reg = (oct->instr_queue[q_no])->inst_cnt_reg;
  1669. val = readq(inst_cnt_reg);
  1670. /*clear wmark and count.dont want to write count back*/
  1671. val = (val & 0xFFFF000000000000ULL) |
  1672. ((u64)(iq_intr_pkt - 1)
  1673. << CN23XX_PKT_IN_DONE_WMARK_BIT_POS);
  1674. writeq(val, inst_cnt_reg);
  1675. /*consider setting resend bit*/
  1676. }
  1677. intrmod->tx_frames = iq_intr_pkt;
  1678. oct->tx_max_coalesced_frames = iq_intr_pkt;
  1679. break;
  1680. }
  1681. default:
  1682. return -EINVAL;
  1683. }
  1684. return 0;
  1685. }
  1686. static int lio_set_intr_coalesce(struct net_device *netdev,
  1687. struct ethtool_coalesce *intr_coal)
  1688. {
  1689. struct lio *lio = GET_LIO(netdev);
  1690. int ret;
  1691. struct octeon_device *oct = lio->oct_dev;
  1692. struct oct_intrmod_cfg intrmod = {0};
  1693. u32 j, q_no;
  1694. int db_max, db_min;
  1695. switch (oct->chip_id) {
  1696. case OCTEON_CN68XX:
  1697. case OCTEON_CN66XX:
  1698. db_min = CN6XXX_DB_MIN;
  1699. db_max = CN6XXX_DB_MAX;
  1700. if ((intr_coal->tx_max_coalesced_frames >= db_min) &&
  1701. (intr_coal->tx_max_coalesced_frames <= db_max)) {
  1702. for (j = 0; j < lio->linfo.num_txpciq; j++) {
  1703. q_no = lio->linfo.txpciq[j].s.q_no;
  1704. oct->instr_queue[q_no]->fill_threshold =
  1705. intr_coal->tx_max_coalesced_frames;
  1706. }
  1707. } else {
  1708. dev_err(&oct->pci_dev->dev,
  1709. "LIQUIDIO: Invalid tx-frames:%d. Range is min:%d max:%d\n",
  1710. intr_coal->tx_max_coalesced_frames,
  1711. db_min, db_max);
  1712. return -EINVAL;
  1713. }
  1714. break;
  1715. case OCTEON_CN23XX_PF_VID:
  1716. case OCTEON_CN23XX_VF_VID:
  1717. break;
  1718. default:
  1719. return -EINVAL;
  1720. }
  1721. intrmod.rx_enable = intr_coal->use_adaptive_rx_coalesce ? 1 : 0;
  1722. intrmod.tx_enable = intr_coal->use_adaptive_tx_coalesce ? 1 : 0;
  1723. intrmod.rx_frames = CFG_GET_OQ_INTR_PKT(octeon_get_conf(oct));
  1724. intrmod.rx_usecs = CFG_GET_OQ_INTR_TIME(octeon_get_conf(oct));
  1725. intrmod.tx_frames = CFG_GET_IQ_INTR_PKT(octeon_get_conf(oct));
  1726. ret = oct_cfg_adaptive_intr(lio, &intrmod, intr_coal);
  1727. if (!intr_coal->use_adaptive_rx_coalesce) {
  1728. ret = oct_cfg_rx_intrtime(lio, &intrmod, intr_coal);
  1729. if (ret)
  1730. goto ret_intrmod;
  1731. ret = oct_cfg_rx_intrcnt(lio, &intrmod, intr_coal);
  1732. if (ret)
  1733. goto ret_intrmod;
  1734. } else {
  1735. oct->rx_coalesce_usecs =
  1736. CFG_GET_OQ_INTR_TIME(octeon_get_conf(oct));
  1737. oct->rx_max_coalesced_frames =
  1738. CFG_GET_OQ_INTR_PKT(octeon_get_conf(oct));
  1739. }
  1740. if (!intr_coal->use_adaptive_tx_coalesce) {
  1741. ret = oct_cfg_tx_intrcnt(lio, &intrmod, intr_coal);
  1742. if (ret)
  1743. goto ret_intrmod;
  1744. } else {
  1745. oct->tx_max_coalesced_frames =
  1746. CFG_GET_IQ_INTR_PKT(octeon_get_conf(oct));
  1747. }
  1748. return 0;
  1749. ret_intrmod:
  1750. return ret;
  1751. }
  1752. static int lio_get_ts_info(struct net_device *netdev,
  1753. struct ethtool_ts_info *info)
  1754. {
  1755. struct lio *lio = GET_LIO(netdev);
  1756. info->so_timestamping =
  1757. #ifdef PTP_HARDWARE_TIMESTAMPING
  1758. SOF_TIMESTAMPING_TX_HARDWARE |
  1759. SOF_TIMESTAMPING_RX_HARDWARE |
  1760. SOF_TIMESTAMPING_RAW_HARDWARE |
  1761. SOF_TIMESTAMPING_TX_SOFTWARE |
  1762. #endif
  1763. SOF_TIMESTAMPING_RX_SOFTWARE |
  1764. SOF_TIMESTAMPING_SOFTWARE;
  1765. if (lio->ptp_clock)
  1766. info->phc_index = ptp_clock_index(lio->ptp_clock);
  1767. else
  1768. info->phc_index = -1;
  1769. #ifdef PTP_HARDWARE_TIMESTAMPING
  1770. info->tx_types = (1 << HWTSTAMP_TX_OFF) | (1 << HWTSTAMP_TX_ON);
  1771. info->rx_filters = (1 << HWTSTAMP_FILTER_NONE) |
  1772. (1 << HWTSTAMP_FILTER_PTP_V1_L4_EVENT) |
  1773. (1 << HWTSTAMP_FILTER_PTP_V2_L2_EVENT) |
  1774. (1 << HWTSTAMP_FILTER_PTP_V2_L4_EVENT);
  1775. #endif
  1776. return 0;
  1777. }
  1778. /* Return register dump len. */
  1779. static int lio_get_regs_len(struct net_device *dev)
  1780. {
  1781. struct lio *lio = GET_LIO(dev);
  1782. struct octeon_device *oct = lio->oct_dev;
  1783. switch (oct->chip_id) {
  1784. case OCTEON_CN23XX_PF_VID:
  1785. return OCT_ETHTOOL_REGDUMP_LEN_23XX;
  1786. case OCTEON_CN23XX_VF_VID:
  1787. return OCT_ETHTOOL_REGDUMP_LEN_23XX_VF;
  1788. default:
  1789. return OCT_ETHTOOL_REGDUMP_LEN;
  1790. }
  1791. }
  1792. static int cn23xx_read_csr_reg(char *s, struct octeon_device *oct)
  1793. {
  1794. u32 reg;
  1795. u8 pf_num = oct->pf_num;
  1796. int len = 0;
  1797. int i;
  1798. /* PCI Window Registers */
  1799. len += sprintf(s + len, "\n\t Octeon CSR Registers\n\n");
  1800. /*0x29030 or 0x29040*/
  1801. reg = CN23XX_SLI_PKT_MAC_RINFO64(oct->pcie_port, oct->pf_num);
  1802. len += sprintf(s + len,
  1803. "\n[%08x] (SLI_PKT_MAC%d_PF%d_RINFO): %016llx\n",
  1804. reg, oct->pcie_port, oct->pf_num,
  1805. (u64)octeon_read_csr64(oct, reg));
  1806. /*0x27080 or 0x27090*/
  1807. reg = CN23XX_SLI_MAC_PF_INT_ENB64(oct->pcie_port, oct->pf_num);
  1808. len +=
  1809. sprintf(s + len, "\n[%08x] (SLI_MAC%d_PF%d_INT_ENB): %016llx\n",
  1810. reg, oct->pcie_port, oct->pf_num,
  1811. (u64)octeon_read_csr64(oct, reg));
  1812. /*0x27000 or 0x27010*/
  1813. reg = CN23XX_SLI_MAC_PF_INT_SUM64(oct->pcie_port, oct->pf_num);
  1814. len +=
  1815. sprintf(s + len, "\n[%08x] (SLI_MAC%d_PF%d_INT_SUM): %016llx\n",
  1816. reg, oct->pcie_port, oct->pf_num,
  1817. (u64)octeon_read_csr64(oct, reg));
  1818. /*0x29120*/
  1819. reg = 0x29120;
  1820. len += sprintf(s + len, "\n[%08x] (SLI_PKT_MEM_CTL): %016llx\n", reg,
  1821. (u64)octeon_read_csr64(oct, reg));
  1822. /*0x27300*/
  1823. reg = 0x27300 + oct->pcie_port * CN23XX_MAC_INT_OFFSET +
  1824. (oct->pf_num) * CN23XX_PF_INT_OFFSET;
  1825. len += sprintf(
  1826. s + len, "\n[%08x] (SLI_MAC%d_PF%d_PKT_VF_INT): %016llx\n", reg,
  1827. oct->pcie_port, oct->pf_num, (u64)octeon_read_csr64(oct, reg));
  1828. /*0x27200*/
  1829. reg = 0x27200 + oct->pcie_port * CN23XX_MAC_INT_OFFSET +
  1830. (oct->pf_num) * CN23XX_PF_INT_OFFSET;
  1831. len += sprintf(s + len,
  1832. "\n[%08x] (SLI_MAC%d_PF%d_PP_VF_INT): %016llx\n",
  1833. reg, oct->pcie_port, oct->pf_num,
  1834. (u64)octeon_read_csr64(oct, reg));
  1835. /*29130*/
  1836. reg = CN23XX_SLI_PKT_CNT_INT;
  1837. len += sprintf(s + len, "\n[%08x] (SLI_PKT_CNT_INT): %016llx\n", reg,
  1838. (u64)octeon_read_csr64(oct, reg));
  1839. /*0x29140*/
  1840. reg = CN23XX_SLI_PKT_TIME_INT;
  1841. len += sprintf(s + len, "\n[%08x] (SLI_PKT_TIME_INT): %016llx\n", reg,
  1842. (u64)octeon_read_csr64(oct, reg));
  1843. /*0x29160*/
  1844. reg = 0x29160;
  1845. len += sprintf(s + len, "\n[%08x] (SLI_PKT_INT): %016llx\n", reg,
  1846. (u64)octeon_read_csr64(oct, reg));
  1847. /*0x29180*/
  1848. reg = CN23XX_SLI_OQ_WMARK;
  1849. len += sprintf(s + len, "\n[%08x] (SLI_PKT_OUTPUT_WMARK): %016llx\n",
  1850. reg, (u64)octeon_read_csr64(oct, reg));
  1851. /*0x291E0*/
  1852. reg = CN23XX_SLI_PKT_IOQ_RING_RST;
  1853. len += sprintf(s + len, "\n[%08x] (SLI_PKT_RING_RST): %016llx\n", reg,
  1854. (u64)octeon_read_csr64(oct, reg));
  1855. /*0x29210*/
  1856. reg = CN23XX_SLI_GBL_CONTROL;
  1857. len += sprintf(s + len,
  1858. "\n[%08x] (SLI_PKT_GBL_CONTROL): %016llx\n", reg,
  1859. (u64)octeon_read_csr64(oct, reg));
  1860. /*0x29220*/
  1861. reg = 0x29220;
  1862. len += sprintf(s + len, "\n[%08x] (SLI_PKT_BIST_STATUS): %016llx\n",
  1863. reg, (u64)octeon_read_csr64(oct, reg));
  1864. /*PF only*/
  1865. if (pf_num == 0) {
  1866. /*0x29260*/
  1867. reg = CN23XX_SLI_OUT_BP_EN_W1S;
  1868. len += sprintf(s + len,
  1869. "\n[%08x] (SLI_PKT_OUT_BP_EN_W1S): %016llx\n",
  1870. reg, (u64)octeon_read_csr64(oct, reg));
  1871. } else if (pf_num == 1) {
  1872. /*0x29270*/
  1873. reg = CN23XX_SLI_OUT_BP_EN2_W1S;
  1874. len += sprintf(s + len,
  1875. "\n[%08x] (SLI_PKT_OUT_BP_EN2_W1S): %016llx\n",
  1876. reg, (u64)octeon_read_csr64(oct, reg));
  1877. }
  1878. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1879. reg = CN23XX_SLI_OQ_BUFF_INFO_SIZE(i);
  1880. len +=
  1881. sprintf(s + len, "\n[%08x] (SLI_PKT%d_OUT_SIZE): %016llx\n",
  1882. reg, i, (u64)octeon_read_csr64(oct, reg));
  1883. }
  1884. /*0x10040*/
  1885. for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
  1886. reg = CN23XX_SLI_IQ_INSTR_COUNT64(i);
  1887. len += sprintf(s + len,
  1888. "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
  1889. reg, i, (u64)octeon_read_csr64(oct, reg));
  1890. }
  1891. /*0x10080*/
  1892. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1893. reg = CN23XX_SLI_OQ_PKTS_CREDIT(i);
  1894. len += sprintf(s + len,
  1895. "\n[%08x] (SLI_PKT%d_SLIST_BAOFF_DBELL): %016llx\n",
  1896. reg, i, (u64)octeon_read_csr64(oct, reg));
  1897. }
  1898. /*0x10090*/
  1899. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1900. reg = CN23XX_SLI_OQ_SIZE(i);
  1901. len += sprintf(
  1902. s + len, "\n[%08x] (SLI_PKT%d_SLIST_FIFO_RSIZE): %016llx\n",
  1903. reg, i, (u64)octeon_read_csr64(oct, reg));
  1904. }
  1905. /*0x10050*/
  1906. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1907. reg = CN23XX_SLI_OQ_PKT_CONTROL(i);
  1908. len += sprintf(
  1909. s + len,
  1910. "\n[%08x] (SLI_PKT%d__OUTPUT_CONTROL): %016llx\n",
  1911. reg, i, (u64)octeon_read_csr64(oct, reg));
  1912. }
  1913. /*0x10070*/
  1914. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1915. reg = CN23XX_SLI_OQ_BASE_ADDR64(i);
  1916. len += sprintf(s + len,
  1917. "\n[%08x] (SLI_PKT%d_SLIST_BADDR): %016llx\n",
  1918. reg, i, (u64)octeon_read_csr64(oct, reg));
  1919. }
  1920. /*0x100a0*/
  1921. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1922. reg = CN23XX_SLI_OQ_PKT_INT_LEVELS(i);
  1923. len += sprintf(s + len,
  1924. "\n[%08x] (SLI_PKT%d_INT_LEVELS): %016llx\n",
  1925. reg, i, (u64)octeon_read_csr64(oct, reg));
  1926. }
  1927. /*0x100b0*/
  1928. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1929. reg = CN23XX_SLI_OQ_PKTS_SENT(i);
  1930. len += sprintf(s + len, "\n[%08x] (SLI_PKT%d_CNTS): %016llx\n",
  1931. reg, i, (u64)octeon_read_csr64(oct, reg));
  1932. }
  1933. /*0x100c0*/
  1934. for (i = 0; i < CN23XX_MAX_OUTPUT_QUEUES; i++) {
  1935. reg = 0x100c0 + i * CN23XX_OQ_OFFSET;
  1936. len += sprintf(s + len,
  1937. "\n[%08x] (SLI_PKT%d_ERROR_INFO): %016llx\n",
  1938. reg, i, (u64)octeon_read_csr64(oct, reg));
  1939. /*0x10000*/
  1940. for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
  1941. reg = CN23XX_SLI_IQ_PKT_CONTROL64(i);
  1942. len += sprintf(
  1943. s + len,
  1944. "\n[%08x] (SLI_PKT%d_INPUT_CONTROL): %016llx\n",
  1945. reg, i, (u64)octeon_read_csr64(oct, reg));
  1946. }
  1947. /*0x10010*/
  1948. for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
  1949. reg = CN23XX_SLI_IQ_BASE_ADDR64(i);
  1950. len += sprintf(
  1951. s + len,
  1952. "\n[%08x] (SLI_PKT%d_INSTR_BADDR): %016llx\n", reg,
  1953. i, (u64)octeon_read_csr64(oct, reg));
  1954. }
  1955. /*0x10020*/
  1956. for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
  1957. reg = CN23XX_SLI_IQ_DOORBELL(i);
  1958. len += sprintf(
  1959. s + len,
  1960. "\n[%08x] (SLI_PKT%d_INSTR_BAOFF_DBELL): %016llx\n",
  1961. reg, i, (u64)octeon_read_csr64(oct, reg));
  1962. }
  1963. /*0x10030*/
  1964. for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++) {
  1965. reg = CN23XX_SLI_IQ_SIZE(i);
  1966. len += sprintf(
  1967. s + len,
  1968. "\n[%08x] (SLI_PKT%d_INSTR_FIFO_RSIZE): %016llx\n",
  1969. reg, i, (u64)octeon_read_csr64(oct, reg));
  1970. }
  1971. /*0x10040*/
  1972. for (i = 0; i < CN23XX_MAX_INPUT_QUEUES; i++)
  1973. reg = CN23XX_SLI_IQ_INSTR_COUNT64(i);
  1974. len += sprintf(s + len,
  1975. "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
  1976. reg, i, (u64)octeon_read_csr64(oct, reg));
  1977. }
  1978. return len;
  1979. }
  1980. static int cn23xx_vf_read_csr_reg(char *s, struct octeon_device *oct)
  1981. {
  1982. int len = 0;
  1983. u32 reg;
  1984. int i;
  1985. /* PCI Window Registers */
  1986. len += sprintf(s + len, "\n\t Octeon CSR Registers\n\n");
  1987. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  1988. reg = CN23XX_VF_SLI_OQ_BUFF_INFO_SIZE(i);
  1989. len += sprintf(s + len,
  1990. "\n[%08x] (SLI_PKT%d_OUT_SIZE): %016llx\n",
  1991. reg, i, (u64)octeon_read_csr64(oct, reg));
  1992. }
  1993. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  1994. reg = CN23XX_VF_SLI_IQ_INSTR_COUNT64(i);
  1995. len += sprintf(s + len,
  1996. "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
  1997. reg, i, (u64)octeon_read_csr64(oct, reg));
  1998. }
  1999. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2000. reg = CN23XX_VF_SLI_OQ_PKTS_CREDIT(i);
  2001. len += sprintf(s + len,
  2002. "\n[%08x] (SLI_PKT%d_SLIST_BAOFF_DBELL): %016llx\n",
  2003. reg, i, (u64)octeon_read_csr64(oct, reg));
  2004. }
  2005. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2006. reg = CN23XX_VF_SLI_OQ_SIZE(i);
  2007. len += sprintf(s + len,
  2008. "\n[%08x] (SLI_PKT%d_SLIST_FIFO_RSIZE): %016llx\n",
  2009. reg, i, (u64)octeon_read_csr64(oct, reg));
  2010. }
  2011. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2012. reg = CN23XX_VF_SLI_OQ_PKT_CONTROL(i);
  2013. len += sprintf(s + len,
  2014. "\n[%08x] (SLI_PKT%d__OUTPUT_CONTROL): %016llx\n",
  2015. reg, i, (u64)octeon_read_csr64(oct, reg));
  2016. }
  2017. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2018. reg = CN23XX_VF_SLI_OQ_BASE_ADDR64(i);
  2019. len += sprintf(s + len,
  2020. "\n[%08x] (SLI_PKT%d_SLIST_BADDR): %016llx\n",
  2021. reg, i, (u64)octeon_read_csr64(oct, reg));
  2022. }
  2023. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2024. reg = CN23XX_VF_SLI_OQ_PKT_INT_LEVELS(i);
  2025. len += sprintf(s + len,
  2026. "\n[%08x] (SLI_PKT%d_INT_LEVELS): %016llx\n",
  2027. reg, i, (u64)octeon_read_csr64(oct, reg));
  2028. }
  2029. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2030. reg = CN23XX_VF_SLI_OQ_PKTS_SENT(i);
  2031. len += sprintf(s + len, "\n[%08x] (SLI_PKT%d_CNTS): %016llx\n",
  2032. reg, i, (u64)octeon_read_csr64(oct, reg));
  2033. }
  2034. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2035. reg = 0x100c0 + i * CN23XX_VF_OQ_OFFSET;
  2036. len += sprintf(s + len,
  2037. "\n[%08x] (SLI_PKT%d_ERROR_INFO): %016llx\n",
  2038. reg, i, (u64)octeon_read_csr64(oct, reg));
  2039. }
  2040. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2041. reg = 0x100d0 + i * CN23XX_VF_IQ_OFFSET;
  2042. len += sprintf(s + len,
  2043. "\n[%08x] (SLI_PKT%d_VF_INT_SUM): %016llx\n",
  2044. reg, i, (u64)octeon_read_csr64(oct, reg));
  2045. }
  2046. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2047. reg = CN23XX_VF_SLI_IQ_PKT_CONTROL64(i);
  2048. len += sprintf(s + len,
  2049. "\n[%08x] (SLI_PKT%d_INPUT_CONTROL): %016llx\n",
  2050. reg, i, (u64)octeon_read_csr64(oct, reg));
  2051. }
  2052. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2053. reg = CN23XX_VF_SLI_IQ_BASE_ADDR64(i);
  2054. len += sprintf(s + len,
  2055. "\n[%08x] (SLI_PKT%d_INSTR_BADDR): %016llx\n",
  2056. reg, i, (u64)octeon_read_csr64(oct, reg));
  2057. }
  2058. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2059. reg = CN23XX_VF_SLI_IQ_DOORBELL(i);
  2060. len += sprintf(s + len,
  2061. "\n[%08x] (SLI_PKT%d_INSTR_BAOFF_DBELL): %016llx\n",
  2062. reg, i, (u64)octeon_read_csr64(oct, reg));
  2063. }
  2064. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2065. reg = CN23XX_VF_SLI_IQ_SIZE(i);
  2066. len += sprintf(s + len,
  2067. "\n[%08x] (SLI_PKT%d_INSTR_FIFO_RSIZE): %016llx\n",
  2068. reg, i, (u64)octeon_read_csr64(oct, reg));
  2069. }
  2070. for (i = 0; i < (oct->sriov_info.rings_per_vf); i++) {
  2071. reg = CN23XX_VF_SLI_IQ_INSTR_COUNT64(i);
  2072. len += sprintf(s + len,
  2073. "\n[%08x] (SLI_PKT_IN_DONE%d_CNTS): %016llx\n",
  2074. reg, i, (u64)octeon_read_csr64(oct, reg));
  2075. }
  2076. return len;
  2077. }
  2078. static int cn6xxx_read_csr_reg(char *s, struct octeon_device *oct)
  2079. {
  2080. u32 reg;
  2081. int i, len = 0;
  2082. /* PCI Window Registers */
  2083. len += sprintf(s + len, "\n\t Octeon CSR Registers\n\n");
  2084. reg = CN6XXX_WIN_WR_ADDR_LO;
  2085. len += sprintf(s + len, "\n[%02x] (WIN_WR_ADDR_LO): %08x\n",
  2086. CN6XXX_WIN_WR_ADDR_LO, octeon_read_csr(oct, reg));
  2087. reg = CN6XXX_WIN_WR_ADDR_HI;
  2088. len += sprintf(s + len, "[%02x] (WIN_WR_ADDR_HI): %08x\n",
  2089. CN6XXX_WIN_WR_ADDR_HI, octeon_read_csr(oct, reg));
  2090. reg = CN6XXX_WIN_RD_ADDR_LO;
  2091. len += sprintf(s + len, "[%02x] (WIN_RD_ADDR_LO): %08x\n",
  2092. CN6XXX_WIN_RD_ADDR_LO, octeon_read_csr(oct, reg));
  2093. reg = CN6XXX_WIN_RD_ADDR_HI;
  2094. len += sprintf(s + len, "[%02x] (WIN_RD_ADDR_HI): %08x\n",
  2095. CN6XXX_WIN_RD_ADDR_HI, octeon_read_csr(oct, reg));
  2096. reg = CN6XXX_WIN_WR_DATA_LO;
  2097. len += sprintf(s + len, "[%02x] (WIN_WR_DATA_LO): %08x\n",
  2098. CN6XXX_WIN_WR_DATA_LO, octeon_read_csr(oct, reg));
  2099. reg = CN6XXX_WIN_WR_DATA_HI;
  2100. len += sprintf(s + len, "[%02x] (WIN_WR_DATA_HI): %08x\n",
  2101. CN6XXX_WIN_WR_DATA_HI, octeon_read_csr(oct, reg));
  2102. len += sprintf(s + len, "[%02x] (WIN_WR_MASK_REG): %08x\n",
  2103. CN6XXX_WIN_WR_MASK_REG,
  2104. octeon_read_csr(oct, CN6XXX_WIN_WR_MASK_REG));
  2105. /* PCI Interrupt Register */
  2106. len += sprintf(s + len, "\n[%x] (INT_ENABLE PORT 0): %08x\n",
  2107. CN6XXX_SLI_INT_ENB64_PORT0, octeon_read_csr(oct,
  2108. CN6XXX_SLI_INT_ENB64_PORT0));
  2109. len += sprintf(s + len, "\n[%x] (INT_ENABLE PORT 1): %08x\n",
  2110. CN6XXX_SLI_INT_ENB64_PORT1,
  2111. octeon_read_csr(oct, CN6XXX_SLI_INT_ENB64_PORT1));
  2112. len += sprintf(s + len, "[%x] (INT_SUM): %08x\n", CN6XXX_SLI_INT_SUM64,
  2113. octeon_read_csr(oct, CN6XXX_SLI_INT_SUM64));
  2114. /* PCI Output queue registers */
  2115. for (i = 0; i < oct->num_oqs; i++) {
  2116. reg = CN6XXX_SLI_OQ_PKTS_SENT(i);
  2117. len += sprintf(s + len, "\n[%x] (PKTS_SENT_%d): %08x\n",
  2118. reg, i, octeon_read_csr(oct, reg));
  2119. reg = CN6XXX_SLI_OQ_PKTS_CREDIT(i);
  2120. len += sprintf(s + len, "[%x] (PKT_CREDITS_%d): %08x\n",
  2121. reg, i, octeon_read_csr(oct, reg));
  2122. }
  2123. reg = CN6XXX_SLI_OQ_INT_LEVEL_PKTS;
  2124. len += sprintf(s + len, "\n[%x] (PKTS_SENT_INT_LEVEL): %08x\n",
  2125. reg, octeon_read_csr(oct, reg));
  2126. reg = CN6XXX_SLI_OQ_INT_LEVEL_TIME;
  2127. len += sprintf(s + len, "[%x] (PKTS_SENT_TIME): %08x\n",
  2128. reg, octeon_read_csr(oct, reg));
  2129. /* PCI Input queue registers */
  2130. for (i = 0; i <= 3; i++) {
  2131. u32 reg;
  2132. reg = CN6XXX_SLI_IQ_DOORBELL(i);
  2133. len += sprintf(s + len, "\n[%x] (INSTR_DOORBELL_%d): %08x\n",
  2134. reg, i, octeon_read_csr(oct, reg));
  2135. reg = CN6XXX_SLI_IQ_INSTR_COUNT(i);
  2136. len += sprintf(s + len, "[%x] (INSTR_COUNT_%d): %08x\n",
  2137. reg, i, octeon_read_csr(oct, reg));
  2138. }
  2139. /* PCI DMA registers */
  2140. len += sprintf(s + len, "\n[%x] (DMA_CNT_0): %08x\n",
  2141. CN6XXX_DMA_CNT(0),
  2142. octeon_read_csr(oct, CN6XXX_DMA_CNT(0)));
  2143. reg = CN6XXX_DMA_PKT_INT_LEVEL(0);
  2144. len += sprintf(s + len, "[%x] (DMA_INT_LEV_0): %08x\n",
  2145. CN6XXX_DMA_PKT_INT_LEVEL(0), octeon_read_csr(oct, reg));
  2146. reg = CN6XXX_DMA_TIME_INT_LEVEL(0);
  2147. len += sprintf(s + len, "[%x] (DMA_TIME_0): %08x\n",
  2148. CN6XXX_DMA_TIME_INT_LEVEL(0),
  2149. octeon_read_csr(oct, reg));
  2150. len += sprintf(s + len, "\n[%x] (DMA_CNT_1): %08x\n",
  2151. CN6XXX_DMA_CNT(1),
  2152. octeon_read_csr(oct, CN6XXX_DMA_CNT(1)));
  2153. reg = CN6XXX_DMA_PKT_INT_LEVEL(1);
  2154. len += sprintf(s + len, "[%x] (DMA_INT_LEV_1): %08x\n",
  2155. CN6XXX_DMA_PKT_INT_LEVEL(1),
  2156. octeon_read_csr(oct, reg));
  2157. reg = CN6XXX_DMA_PKT_INT_LEVEL(1);
  2158. len += sprintf(s + len, "[%x] (DMA_TIME_1): %08x\n",
  2159. CN6XXX_DMA_TIME_INT_LEVEL(1),
  2160. octeon_read_csr(oct, reg));
  2161. /* PCI Index registers */
  2162. len += sprintf(s + len, "\n");
  2163. for (i = 0; i < 16; i++) {
  2164. reg = lio_pci_readq(oct, CN6XXX_BAR1_REG(i, oct->pcie_port));
  2165. len += sprintf(s + len, "[%llx] (BAR1_INDEX_%02d): %08x\n",
  2166. CN6XXX_BAR1_REG(i, oct->pcie_port), i, reg);
  2167. }
  2168. return len;
  2169. }
  2170. static int cn6xxx_read_config_reg(char *s, struct octeon_device *oct)
  2171. {
  2172. u32 val;
  2173. int i, len = 0;
  2174. /* PCI CONFIG Registers */
  2175. len += sprintf(s + len,
  2176. "\n\t Octeon Config space Registers\n\n");
  2177. for (i = 0; i <= 13; i++) {
  2178. pci_read_config_dword(oct->pci_dev, (i * 4), &val);
  2179. len += sprintf(s + len, "[0x%x] (Config[%d]): 0x%08x\n",
  2180. (i * 4), i, val);
  2181. }
  2182. for (i = 30; i <= 34; i++) {
  2183. pci_read_config_dword(oct->pci_dev, (i * 4), &val);
  2184. len += sprintf(s + len, "[0x%x] (Config[%d]): 0x%08x\n",
  2185. (i * 4), i, val);
  2186. }
  2187. return len;
  2188. }
  2189. /* Return register dump user app. */
  2190. static void lio_get_regs(struct net_device *dev,
  2191. struct ethtool_regs *regs, void *regbuf)
  2192. {
  2193. struct lio *lio = GET_LIO(dev);
  2194. int len = 0;
  2195. struct octeon_device *oct = lio->oct_dev;
  2196. regs->version = OCT_ETHTOOL_REGSVER;
  2197. switch (oct->chip_id) {
  2198. case OCTEON_CN23XX_PF_VID:
  2199. memset(regbuf, 0, OCT_ETHTOOL_REGDUMP_LEN_23XX);
  2200. len += cn23xx_read_csr_reg(regbuf + len, oct);
  2201. break;
  2202. case OCTEON_CN23XX_VF_VID:
  2203. memset(regbuf, 0, OCT_ETHTOOL_REGDUMP_LEN_23XX_VF);
  2204. len += cn23xx_vf_read_csr_reg(regbuf + len, oct);
  2205. break;
  2206. case OCTEON_CN68XX:
  2207. case OCTEON_CN66XX:
  2208. memset(regbuf, 0, OCT_ETHTOOL_REGDUMP_LEN);
  2209. len += cn6xxx_read_csr_reg(regbuf + len, oct);
  2210. len += cn6xxx_read_config_reg(regbuf + len, oct);
  2211. break;
  2212. default:
  2213. dev_err(&oct->pci_dev->dev, "%s Unknown chipid: %d\n",
  2214. __func__, oct->chip_id);
  2215. }
  2216. }
  2217. static u32 lio_get_priv_flags(struct net_device *netdev)
  2218. {
  2219. struct lio *lio = GET_LIO(netdev);
  2220. return lio->oct_dev->priv_flags;
  2221. }
  2222. static int lio_set_priv_flags(struct net_device *netdev, u32 flags)
  2223. {
  2224. struct lio *lio = GET_LIO(netdev);
  2225. bool intr_by_tx_bytes = !!(flags & (0x1 << OCT_PRIV_FLAG_TX_BYTES));
  2226. lio_set_priv_flag(lio->oct_dev, OCT_PRIV_FLAG_TX_BYTES,
  2227. intr_by_tx_bytes);
  2228. return 0;
  2229. }
  2230. static const struct ethtool_ops lio_ethtool_ops = {
  2231. .get_link_ksettings = lio_get_link_ksettings,
  2232. .get_link = ethtool_op_get_link,
  2233. .get_drvinfo = lio_get_drvinfo,
  2234. .get_ringparam = lio_ethtool_get_ringparam,
  2235. .get_channels = lio_ethtool_get_channels,
  2236. .set_phys_id = lio_set_phys_id,
  2237. .get_eeprom_len = lio_get_eeprom_len,
  2238. .get_eeprom = lio_get_eeprom,
  2239. .get_strings = lio_get_strings,
  2240. .get_ethtool_stats = lio_get_ethtool_stats,
  2241. .get_pauseparam = lio_get_pauseparam,
  2242. .set_pauseparam = lio_set_pauseparam,
  2243. .get_regs_len = lio_get_regs_len,
  2244. .get_regs = lio_get_regs,
  2245. .get_msglevel = lio_get_msglevel,
  2246. .set_msglevel = lio_set_msglevel,
  2247. .get_sset_count = lio_get_sset_count,
  2248. .get_coalesce = lio_get_intr_coalesce,
  2249. .set_coalesce = lio_set_intr_coalesce,
  2250. .get_priv_flags = lio_get_priv_flags,
  2251. .set_priv_flags = lio_set_priv_flags,
  2252. .get_ts_info = lio_get_ts_info,
  2253. };
  2254. static const struct ethtool_ops lio_vf_ethtool_ops = {
  2255. .get_link_ksettings = lio_get_link_ksettings,
  2256. .get_link = ethtool_op_get_link,
  2257. .get_drvinfo = lio_get_vf_drvinfo,
  2258. .get_ringparam = lio_ethtool_get_ringparam,
  2259. .get_channels = lio_ethtool_get_channels,
  2260. .get_strings = lio_vf_get_strings,
  2261. .get_ethtool_stats = lio_vf_get_ethtool_stats,
  2262. .get_regs_len = lio_get_regs_len,
  2263. .get_regs = lio_get_regs,
  2264. .get_msglevel = lio_get_msglevel,
  2265. .set_msglevel = lio_set_msglevel,
  2266. .get_sset_count = lio_vf_get_sset_count,
  2267. .get_coalesce = lio_get_intr_coalesce,
  2268. .set_coalesce = lio_set_intr_coalesce,
  2269. .get_priv_flags = lio_get_priv_flags,
  2270. .set_priv_flags = lio_set_priv_flags,
  2271. .get_ts_info = lio_get_ts_info,
  2272. };
  2273. void liquidio_set_ethtool_ops(struct net_device *netdev)
  2274. {
  2275. struct lio *lio = GET_LIO(netdev);
  2276. struct octeon_device *oct = lio->oct_dev;
  2277. if (OCTEON_CN23XX_VF(oct))
  2278. netdev->ethtool_ops = &lio_vf_ethtool_ops;
  2279. else
  2280. netdev->ethtool_ops = &lio_ethtool_ops;
  2281. }