1 // SPDX-License-Identifier: GPL-2.0 2 /* Texas Instruments K3 AM65 Ethernet Switch SubSystem Driver ethtool ops 3 * 4 * Copyright (C) 2020 Texas Instruments Incorporated - http://www.ti.com/ 5 * 6 */ 7 8 #include <linux/net_tstamp.h> 9 #include <linux/phy.h> 10 #include <linux/platform_device.h> 11 #include <linux/pm_runtime.h> 12 13 #include "am65-cpsw-nuss.h" 14 #include "cpsw_ale.h" 15 #include "am65-cpts.h" 16 17 #define AM65_CPSW_REGDUMP_VER 0x1 18 19 enum { 20 AM65_CPSW_REGDUMP_MOD_NUSS = 1, 21 AM65_CPSW_REGDUMP_MOD_RGMII_STATUS = 2, 22 AM65_CPSW_REGDUMP_MOD_MDIO = 3, 23 AM65_CPSW_REGDUMP_MOD_CPSW = 4, 24 AM65_CPSW_REGDUMP_MOD_CPSW_P0 = 5, 25 AM65_CPSW_REGDUMP_MOD_CPSW_P1 = 6, 26 AM65_CPSW_REGDUMP_MOD_CPSW_CPTS = 7, 27 AM65_CPSW_REGDUMP_MOD_CPSW_ALE = 8, 28 AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL = 9, 29 AM65_CPSW_REGDUMP_MOD_LAST, 30 }; 31 32 /** 33 * struct am65_cpsw_regdump_hdr - regdump record header 34 * 35 * @module_id: CPSW module ID 36 * @len: CPSW module registers space length in u32 37 */ 38 39 struct am65_cpsw_regdump_hdr { 40 u32 module_id; 41 u32 len; 42 }; 43 44 /** 45 * struct am65_cpsw_regdump_item - regdump module description 46 * 47 * @hdr: CPSW module header 48 * @start_ofs: CPSW module registers start addr 49 * @end_ofs: CPSW module registers end addr 50 * 51 * Registers dump provided in the format: 52 * u32 : module ID 53 * u32 : dump length 54 * u32[..len]: registers values 55 */ 56 struct am65_cpsw_regdump_item { 57 struct am65_cpsw_regdump_hdr hdr; 58 u32 start_ofs; 59 u32 end_ofs; 60 }; 61 62 #define AM65_CPSW_REGDUMP_REC(mod, start, end) { \ 63 .hdr.module_id = (mod), \ 64 .hdr.len = (end + 4 - start) * 2 + \ 65 sizeof(struct am65_cpsw_regdump_hdr), \ 66 .start_ofs = (start), \ 67 .end_ofs = end, \ 68 } 69 70 static const struct am65_cpsw_regdump_item am65_cpsw_regdump[] = { 71 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_NUSS, 0x0, 0x1c), 72 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_RGMII_STATUS, 0x30, 0x4c), 73 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_MDIO, 0xf00, 0xffc), 74 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW, 0x20000, 0x2011c), 75 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_P0, 0x21000, 0x21320), 76 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_P1, 0x22000, 0x223a4), 77 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_CPTS, 78 0x3d000, 0x3d048), 79 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_ALE, 0x3e000, 0x3e13c), 80 AM65_CPSW_REGDUMP_REC(AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL, 0, 0), 81 }; 82 83 struct am65_cpsw_stats_regs { 84 u32 rx_good_frames; 85 u32 rx_broadcast_frames; 86 u32 rx_multicast_frames; 87 u32 rx_pause_frames; /* slave */ 88 u32 rx_crc_errors; 89 u32 rx_align_code_errors; /* slave */ 90 u32 rx_oversized_frames; 91 u32 rx_jabber_frames; /* slave */ 92 u32 rx_undersized_frames; 93 u32 rx_fragments; /* slave */ 94 u32 ale_drop; 95 u32 ale_overrun_drop; 96 u32 rx_octets; 97 u32 tx_good_frames; 98 u32 tx_broadcast_frames; 99 u32 tx_multicast_frames; 100 u32 tx_pause_frames; /* slave */ 101 u32 tx_deferred_frames; /* slave */ 102 u32 tx_collision_frames; /* slave */ 103 u32 tx_single_coll_frames; /* slave */ 104 u32 tx_mult_coll_frames; /* slave */ 105 u32 tx_excessive_collisions; /* slave */ 106 u32 tx_late_collisions; /* slave */ 107 u32 rx_ipg_error; /* slave 10G only */ 108 u32 tx_carrier_sense_errors; /* slave */ 109 u32 tx_octets; 110 u32 tx_64B_frames; 111 u32 tx_65_to_127B_frames; 112 u32 tx_128_to_255B_frames; 113 u32 tx_256_to_511B_frames; 114 u32 tx_512_to_1023B_frames; 115 u32 tx_1024B_frames; 116 u32 net_octets; 117 u32 rx_bottom_fifo_drop; 118 u32 rx_port_mask_drop; 119 u32 rx_top_fifo_drop; 120 u32 ale_rate_limit_drop; 121 u32 ale_vid_ingress_drop; 122 u32 ale_da_eq_sa_drop; 123 u32 ale_block_drop; /* K3 */ 124 u32 ale_secure_drop; /* K3 */ 125 u32 ale_auth_drop; /* K3 */ 126 u32 ale_unknown_ucast; 127 u32 ale_unknown_ucast_bytes; 128 u32 ale_unknown_mcast; 129 u32 ale_unknown_mcast_bytes; 130 u32 ale_unknown_bcast; 131 u32 ale_unknown_bcast_bytes; 132 u32 ale_pol_match; 133 u32 ale_pol_match_red; 134 u32 ale_pol_match_yellow; 135 u32 ale_mcast_sa_drop; /* K3 */ 136 u32 ale_dual_vlan_drop; /* K3 */ 137 u32 ale_len_err_drop; /* K3 */ 138 u32 ale_ip_next_hdr_drop; /* K3 */ 139 u32 ale_ipv4_frag_drop; /* K3 */ 140 u32 __rsvd_1[24]; 141 u32 iet_rx_assembly_err; /* K3 slave */ 142 u32 iet_rx_assembly_ok; /* K3 slave */ 143 u32 iet_rx_smd_err; /* K3 slave */ 144 u32 iet_rx_frag; /* K3 slave */ 145 u32 iet_tx_hold; /* K3 slave */ 146 u32 iet_tx_frag; /* K3 slave */ 147 u32 __rsvd_2[9]; 148 u32 tx_mem_protect_err; 149 /* following NU only */ 150 u32 tx_pri0; 151 u32 tx_pri1; 152 u32 tx_pri2; 153 u32 tx_pri3; 154 u32 tx_pri4; 155 u32 tx_pri5; 156 u32 tx_pri6; 157 u32 tx_pri7; 158 u32 tx_pri0_bcnt; 159 u32 tx_pri1_bcnt; 160 u32 tx_pri2_bcnt; 161 u32 tx_pri3_bcnt; 162 u32 tx_pri4_bcnt; 163 u32 tx_pri5_bcnt; 164 u32 tx_pri6_bcnt; 165 u32 tx_pri7_bcnt; 166 u32 tx_pri0_drop; 167 u32 tx_pri1_drop; 168 u32 tx_pri2_drop; 169 u32 tx_pri3_drop; 170 u32 tx_pri4_drop; 171 u32 tx_pri5_drop; 172 u32 tx_pri6_drop; 173 u32 tx_pri7_drop; 174 u32 tx_pri0_drop_bcnt; 175 u32 tx_pri1_drop_bcnt; 176 u32 tx_pri2_drop_bcnt; 177 u32 tx_pri3_drop_bcnt; 178 u32 tx_pri4_drop_bcnt; 179 u32 tx_pri5_drop_bcnt; 180 u32 tx_pri6_drop_bcnt; 181 u32 tx_pri7_drop_bcnt; 182 }; 183 184 struct am65_cpsw_ethtool_stat { 185 char desc[ETH_GSTRING_LEN]; 186 int offset; 187 }; 188 189 #define AM65_CPSW_STATS(prefix, field) \ 190 { \ 191 #prefix#field, \ 192 offsetof(struct am65_cpsw_stats_regs, field) \ 193 } 194 195 static const struct am65_cpsw_ethtool_stat am65_host_stats[] = { 196 AM65_CPSW_STATS(p0_, rx_good_frames), 197 AM65_CPSW_STATS(p0_, rx_broadcast_frames), 198 AM65_CPSW_STATS(p0_, rx_multicast_frames), 199 AM65_CPSW_STATS(p0_, rx_crc_errors), 200 AM65_CPSW_STATS(p0_, rx_oversized_frames), 201 AM65_CPSW_STATS(p0_, rx_undersized_frames), 202 AM65_CPSW_STATS(p0_, ale_drop), 203 AM65_CPSW_STATS(p0_, ale_overrun_drop), 204 AM65_CPSW_STATS(p0_, rx_octets), 205 AM65_CPSW_STATS(p0_, tx_good_frames), 206 AM65_CPSW_STATS(p0_, tx_broadcast_frames), 207 AM65_CPSW_STATS(p0_, tx_multicast_frames), 208 AM65_CPSW_STATS(p0_, tx_octets), 209 AM65_CPSW_STATS(p0_, tx_64B_frames), 210 AM65_CPSW_STATS(p0_, tx_65_to_127B_frames), 211 AM65_CPSW_STATS(p0_, tx_128_to_255B_frames), 212 AM65_CPSW_STATS(p0_, tx_256_to_511B_frames), 213 AM65_CPSW_STATS(p0_, tx_512_to_1023B_frames), 214 AM65_CPSW_STATS(p0_, tx_1024B_frames), 215 AM65_CPSW_STATS(p0_, net_octets), 216 AM65_CPSW_STATS(p0_, rx_bottom_fifo_drop), 217 AM65_CPSW_STATS(p0_, rx_port_mask_drop), 218 AM65_CPSW_STATS(p0_, rx_top_fifo_drop), 219 AM65_CPSW_STATS(p0_, ale_rate_limit_drop), 220 AM65_CPSW_STATS(p0_, ale_vid_ingress_drop), 221 AM65_CPSW_STATS(p0_, ale_da_eq_sa_drop), 222 AM65_CPSW_STATS(p0_, ale_block_drop), 223 AM65_CPSW_STATS(p0_, ale_secure_drop), 224 AM65_CPSW_STATS(p0_, ale_auth_drop), 225 AM65_CPSW_STATS(p0_, ale_unknown_ucast), 226 AM65_CPSW_STATS(p0_, ale_unknown_ucast_bytes), 227 AM65_CPSW_STATS(p0_, ale_unknown_mcast), 228 AM65_CPSW_STATS(p0_, ale_unknown_mcast_bytes), 229 AM65_CPSW_STATS(p0_, ale_unknown_bcast), 230 AM65_CPSW_STATS(p0_, ale_unknown_bcast_bytes), 231 AM65_CPSW_STATS(p0_, ale_pol_match), 232 AM65_CPSW_STATS(p0_, ale_pol_match_red), 233 AM65_CPSW_STATS(p0_, ale_pol_match_yellow), 234 AM65_CPSW_STATS(p0_, ale_mcast_sa_drop), 235 AM65_CPSW_STATS(p0_, ale_dual_vlan_drop), 236 AM65_CPSW_STATS(p0_, ale_len_err_drop), 237 AM65_CPSW_STATS(p0_, ale_ip_next_hdr_drop), 238 AM65_CPSW_STATS(p0_, ale_ipv4_frag_drop), 239 AM65_CPSW_STATS(p0_, tx_mem_protect_err), 240 AM65_CPSW_STATS(p0_, tx_pri0), 241 AM65_CPSW_STATS(p0_, tx_pri1), 242 AM65_CPSW_STATS(p0_, tx_pri2), 243 AM65_CPSW_STATS(p0_, tx_pri3), 244 AM65_CPSW_STATS(p0_, tx_pri4), 245 AM65_CPSW_STATS(p0_, tx_pri5), 246 AM65_CPSW_STATS(p0_, tx_pri6), 247 AM65_CPSW_STATS(p0_, tx_pri7), 248 AM65_CPSW_STATS(p0_, tx_pri0_bcnt), 249 AM65_CPSW_STATS(p0_, tx_pri1_bcnt), 250 AM65_CPSW_STATS(p0_, tx_pri2_bcnt), 251 AM65_CPSW_STATS(p0_, tx_pri3_bcnt), 252 AM65_CPSW_STATS(p0_, tx_pri4_bcnt), 253 AM65_CPSW_STATS(p0_, tx_pri5_bcnt), 254 AM65_CPSW_STATS(p0_, tx_pri6_bcnt), 255 AM65_CPSW_STATS(p0_, tx_pri7_bcnt), 256 AM65_CPSW_STATS(p0_, tx_pri0_drop), 257 AM65_CPSW_STATS(p0_, tx_pri1_drop), 258 AM65_CPSW_STATS(p0_, tx_pri2_drop), 259 AM65_CPSW_STATS(p0_, tx_pri3_drop), 260 AM65_CPSW_STATS(p0_, tx_pri4_drop), 261 AM65_CPSW_STATS(p0_, tx_pri5_drop), 262 AM65_CPSW_STATS(p0_, tx_pri6_drop), 263 AM65_CPSW_STATS(p0_, tx_pri7_drop), 264 AM65_CPSW_STATS(p0_, tx_pri0_drop_bcnt), 265 AM65_CPSW_STATS(p0_, tx_pri1_drop_bcnt), 266 AM65_CPSW_STATS(p0_, tx_pri2_drop_bcnt), 267 AM65_CPSW_STATS(p0_, tx_pri3_drop_bcnt), 268 AM65_CPSW_STATS(p0_, tx_pri4_drop_bcnt), 269 AM65_CPSW_STATS(p0_, tx_pri5_drop_bcnt), 270 AM65_CPSW_STATS(p0_, tx_pri6_drop_bcnt), 271 AM65_CPSW_STATS(p0_, tx_pri7_drop_bcnt), 272 }; 273 274 static const struct am65_cpsw_ethtool_stat am65_slave_stats[] = { 275 AM65_CPSW_STATS(, rx_good_frames), 276 AM65_CPSW_STATS(, rx_broadcast_frames), 277 AM65_CPSW_STATS(, rx_multicast_frames), 278 AM65_CPSW_STATS(, rx_pause_frames), 279 AM65_CPSW_STATS(, rx_crc_errors), 280 AM65_CPSW_STATS(, rx_align_code_errors), 281 AM65_CPSW_STATS(, rx_oversized_frames), 282 AM65_CPSW_STATS(, rx_jabber_frames), 283 AM65_CPSW_STATS(, rx_undersized_frames), 284 AM65_CPSW_STATS(, rx_fragments), 285 AM65_CPSW_STATS(, ale_drop), 286 AM65_CPSW_STATS(, ale_overrun_drop), 287 AM65_CPSW_STATS(, rx_octets), 288 AM65_CPSW_STATS(, tx_good_frames), 289 AM65_CPSW_STATS(, tx_broadcast_frames), 290 AM65_CPSW_STATS(, tx_multicast_frames), 291 AM65_CPSW_STATS(, tx_pause_frames), 292 AM65_CPSW_STATS(, tx_deferred_frames), 293 AM65_CPSW_STATS(, tx_collision_frames), 294 AM65_CPSW_STATS(, tx_single_coll_frames), 295 AM65_CPSW_STATS(, tx_mult_coll_frames), 296 AM65_CPSW_STATS(, tx_excessive_collisions), 297 AM65_CPSW_STATS(, tx_late_collisions), 298 AM65_CPSW_STATS(, rx_ipg_error), 299 AM65_CPSW_STATS(, tx_carrier_sense_errors), 300 AM65_CPSW_STATS(, tx_octets), 301 AM65_CPSW_STATS(, tx_64B_frames), 302 AM65_CPSW_STATS(, tx_65_to_127B_frames), 303 AM65_CPSW_STATS(, tx_128_to_255B_frames), 304 AM65_CPSW_STATS(, tx_256_to_511B_frames), 305 AM65_CPSW_STATS(, tx_512_to_1023B_frames), 306 AM65_CPSW_STATS(, tx_1024B_frames), 307 AM65_CPSW_STATS(, net_octets), 308 AM65_CPSW_STATS(, rx_bottom_fifo_drop), 309 AM65_CPSW_STATS(, rx_port_mask_drop), 310 AM65_CPSW_STATS(, rx_top_fifo_drop), 311 AM65_CPSW_STATS(, ale_rate_limit_drop), 312 AM65_CPSW_STATS(, ale_vid_ingress_drop), 313 AM65_CPSW_STATS(, ale_da_eq_sa_drop), 314 AM65_CPSW_STATS(, ale_block_drop), 315 AM65_CPSW_STATS(, ale_secure_drop), 316 AM65_CPSW_STATS(, ale_auth_drop), 317 AM65_CPSW_STATS(, ale_unknown_ucast), 318 AM65_CPSW_STATS(, ale_unknown_ucast_bytes), 319 AM65_CPSW_STATS(, ale_unknown_mcast), 320 AM65_CPSW_STATS(, ale_unknown_mcast_bytes), 321 AM65_CPSW_STATS(, ale_unknown_bcast), 322 AM65_CPSW_STATS(, ale_unknown_bcast_bytes), 323 AM65_CPSW_STATS(, ale_pol_match), 324 AM65_CPSW_STATS(, ale_pol_match_red), 325 AM65_CPSW_STATS(, ale_pol_match_yellow), 326 AM65_CPSW_STATS(, ale_mcast_sa_drop), 327 AM65_CPSW_STATS(, ale_dual_vlan_drop), 328 AM65_CPSW_STATS(, ale_len_err_drop), 329 AM65_CPSW_STATS(, ale_ip_next_hdr_drop), 330 AM65_CPSW_STATS(, ale_ipv4_frag_drop), 331 AM65_CPSW_STATS(, iet_rx_assembly_err), 332 AM65_CPSW_STATS(, iet_rx_assembly_ok), 333 AM65_CPSW_STATS(, iet_rx_smd_err), 334 AM65_CPSW_STATS(, iet_rx_frag), 335 AM65_CPSW_STATS(, iet_tx_hold), 336 AM65_CPSW_STATS(, iet_tx_frag), 337 AM65_CPSW_STATS(, tx_mem_protect_err), 338 AM65_CPSW_STATS(, tx_pri0), 339 AM65_CPSW_STATS(, tx_pri1), 340 AM65_CPSW_STATS(, tx_pri2), 341 AM65_CPSW_STATS(, tx_pri3), 342 AM65_CPSW_STATS(, tx_pri4), 343 AM65_CPSW_STATS(, tx_pri5), 344 AM65_CPSW_STATS(, tx_pri6), 345 AM65_CPSW_STATS(, tx_pri7), 346 AM65_CPSW_STATS(, tx_pri0_bcnt), 347 AM65_CPSW_STATS(, tx_pri1_bcnt), 348 AM65_CPSW_STATS(, tx_pri2_bcnt), 349 AM65_CPSW_STATS(, tx_pri3_bcnt), 350 AM65_CPSW_STATS(, tx_pri4_bcnt), 351 AM65_CPSW_STATS(, tx_pri5_bcnt), 352 AM65_CPSW_STATS(, tx_pri6_bcnt), 353 AM65_CPSW_STATS(, tx_pri7_bcnt), 354 AM65_CPSW_STATS(, tx_pri0_drop), 355 AM65_CPSW_STATS(, tx_pri1_drop), 356 AM65_CPSW_STATS(, tx_pri2_drop), 357 AM65_CPSW_STATS(, tx_pri3_drop), 358 AM65_CPSW_STATS(, tx_pri4_drop), 359 AM65_CPSW_STATS(, tx_pri5_drop), 360 AM65_CPSW_STATS(, tx_pri6_drop), 361 AM65_CPSW_STATS(, tx_pri7_drop), 362 AM65_CPSW_STATS(, tx_pri0_drop_bcnt), 363 AM65_CPSW_STATS(, tx_pri1_drop_bcnt), 364 AM65_CPSW_STATS(, tx_pri2_drop_bcnt), 365 AM65_CPSW_STATS(, tx_pri3_drop_bcnt), 366 AM65_CPSW_STATS(, tx_pri4_drop_bcnt), 367 AM65_CPSW_STATS(, tx_pri5_drop_bcnt), 368 AM65_CPSW_STATS(, tx_pri6_drop_bcnt), 369 AM65_CPSW_STATS(, tx_pri7_drop_bcnt), 370 }; 371 372 /* Ethtool priv_flags */ 373 static const char am65_cpsw_ethtool_priv_flags[][ETH_GSTRING_LEN] = { 374 #define AM65_CPSW_PRIV_P0_RX_PTYPE_RROBIN BIT(0) 375 "p0-rx-ptype-rrobin", 376 }; 377 378 static int am65_cpsw_ethtool_op_begin(struct net_device *ndev) 379 { 380 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 381 int ret; 382 383 ret = pm_runtime_get_sync(common->dev); 384 if (ret < 0) { 385 dev_err(common->dev, "ethtool begin failed %d\n", ret); 386 pm_runtime_put_noidle(common->dev); 387 } 388 389 return ret; 390 } 391 392 static void am65_cpsw_ethtool_op_complete(struct net_device *ndev) 393 { 394 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 395 int ret; 396 397 ret = pm_runtime_put(common->dev); 398 if (ret < 0 && ret != -EBUSY) 399 dev_err(common->dev, "ethtool complete failed %d\n", ret); 400 } 401 402 static void am65_cpsw_get_drvinfo(struct net_device *ndev, 403 struct ethtool_drvinfo *info) 404 { 405 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 406 407 strlcpy(info->driver, dev_driver_string(common->dev), 408 sizeof(info->driver)); 409 strlcpy(info->bus_info, dev_name(common->dev), sizeof(info->bus_info)); 410 } 411 412 static u32 am65_cpsw_get_msglevel(struct net_device *ndev) 413 { 414 struct am65_cpsw_ndev_priv *priv = am65_ndev_to_priv(ndev); 415 416 return priv->msg_enable; 417 } 418 419 static void am65_cpsw_set_msglevel(struct net_device *ndev, u32 value) 420 { 421 struct am65_cpsw_ndev_priv *priv = am65_ndev_to_priv(ndev); 422 423 priv->msg_enable = value; 424 } 425 426 static void am65_cpsw_get_channels(struct net_device *ndev, 427 struct ethtool_channels *ch) 428 { 429 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 430 431 ch->max_rx = AM65_CPSW_MAX_RX_QUEUES; 432 ch->max_tx = AM65_CPSW_MAX_TX_QUEUES; 433 ch->rx_count = AM65_CPSW_MAX_RX_QUEUES; 434 ch->tx_count = common->tx_ch_num; 435 } 436 437 static int am65_cpsw_set_channels(struct net_device *ndev, 438 struct ethtool_channels *chs) 439 { 440 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 441 442 if (!chs->rx_count || !chs->tx_count) 443 return -EINVAL; 444 445 /* Check if interface is up. Can change the num queues when 446 * the interface is down. 447 */ 448 if (common->usage_count) 449 return -EBUSY; 450 451 am65_cpsw_nuss_remove_tx_chns(common); 452 453 return am65_cpsw_nuss_update_tx_chns(common, chs->tx_count); 454 } 455 456 static void 457 am65_cpsw_get_ringparam(struct net_device *ndev, 458 struct ethtool_ringparam *ering, 459 struct kernel_ethtool_ringparam *kernel_ering, 460 struct netlink_ext_ack *extack) 461 { 462 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 463 464 /* not supported */ 465 ering->tx_pending = common->tx_chns[0].descs_num; 466 ering->rx_pending = common->rx_chns.descs_num; 467 } 468 469 static void am65_cpsw_get_pauseparam(struct net_device *ndev, 470 struct ethtool_pauseparam *pause) 471 { 472 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 473 474 pause->autoneg = AUTONEG_DISABLE; 475 pause->rx_pause = salve->rx_pause ? true : false; 476 pause->tx_pause = salve->tx_pause ? true : false; 477 } 478 479 static int am65_cpsw_set_pauseparam(struct net_device *ndev, 480 struct ethtool_pauseparam *pause) 481 { 482 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 483 484 if (!salve->phy) 485 return -EINVAL; 486 487 if (!phy_validate_pause(salve->phy, pause)) 488 return -EINVAL; 489 490 salve->rx_pause = pause->rx_pause ? true : false; 491 salve->tx_pause = pause->tx_pause ? true : false; 492 493 phy_set_asym_pause(salve->phy, salve->rx_pause, salve->tx_pause); 494 495 return 0; 496 } 497 498 static void am65_cpsw_get_wol(struct net_device *ndev, 499 struct ethtool_wolinfo *wol) 500 { 501 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 502 503 wol->supported = 0; 504 wol->wolopts = 0; 505 506 if (salve->phy) 507 phy_ethtool_get_wol(salve->phy, wol); 508 } 509 510 static int am65_cpsw_set_wol(struct net_device *ndev, 511 struct ethtool_wolinfo *wol) 512 { 513 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 514 515 if (!salve->phy) 516 return -EOPNOTSUPP; 517 518 return phy_ethtool_set_wol(salve->phy, wol); 519 } 520 521 static int am65_cpsw_get_link_ksettings(struct net_device *ndev, 522 struct ethtool_link_ksettings *ecmd) 523 { 524 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 525 526 if (!salve->phy) 527 return -EOPNOTSUPP; 528 529 phy_ethtool_ksettings_get(salve->phy, ecmd); 530 return 0; 531 } 532 533 static int 534 am65_cpsw_set_link_ksettings(struct net_device *ndev, 535 const struct ethtool_link_ksettings *ecmd) 536 { 537 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 538 539 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy)) 540 return -EOPNOTSUPP; 541 542 return phy_ethtool_ksettings_set(salve->phy, ecmd); 543 } 544 545 static int am65_cpsw_get_eee(struct net_device *ndev, struct ethtool_eee *edata) 546 { 547 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 548 549 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy)) 550 return -EOPNOTSUPP; 551 552 return phy_ethtool_get_eee(salve->phy, edata); 553 } 554 555 static int am65_cpsw_set_eee(struct net_device *ndev, struct ethtool_eee *edata) 556 { 557 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 558 559 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy)) 560 return -EOPNOTSUPP; 561 562 return phy_ethtool_set_eee(salve->phy, edata); 563 } 564 565 static int am65_cpsw_nway_reset(struct net_device *ndev) 566 { 567 struct am65_cpsw_slave_data *salve = am65_ndev_to_slave(ndev); 568 569 if (!salve->phy || phy_is_pseudo_fixed_link(salve->phy)) 570 return -EOPNOTSUPP; 571 572 return phy_restart_aneg(salve->phy); 573 } 574 575 static int am65_cpsw_get_regs_len(struct net_device *ndev) 576 { 577 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 578 u32 ale_entries, i, regdump_len = 0; 579 580 ale_entries = cpsw_ale_get_num_entries(common->ale); 581 for (i = 0; i < ARRAY_SIZE(am65_cpsw_regdump); i++) { 582 if (am65_cpsw_regdump[i].hdr.module_id == 583 AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL) { 584 regdump_len += sizeof(struct am65_cpsw_regdump_hdr); 585 regdump_len += ale_entries * 586 ALE_ENTRY_WORDS * sizeof(u32); 587 continue; 588 } 589 regdump_len += am65_cpsw_regdump[i].hdr.len; 590 } 591 592 return regdump_len; 593 } 594 595 static void am65_cpsw_get_regs(struct net_device *ndev, 596 struct ethtool_regs *regs, void *p) 597 { 598 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 599 u32 ale_entries, i, j, pos, *reg = p; 600 601 /* update CPSW IP version */ 602 regs->version = AM65_CPSW_REGDUMP_VER; 603 ale_entries = cpsw_ale_get_num_entries(common->ale); 604 605 pos = 0; 606 for (i = 0; i < ARRAY_SIZE(am65_cpsw_regdump); i++) { 607 reg[pos++] = am65_cpsw_regdump[i].hdr.module_id; 608 609 if (am65_cpsw_regdump[i].hdr.module_id == 610 AM65_CPSW_REGDUMP_MOD_CPSW_ALE_TBL) { 611 u32 ale_tbl_len = ale_entries * 612 ALE_ENTRY_WORDS * sizeof(u32) + 613 sizeof(struct am65_cpsw_regdump_hdr); 614 reg[pos++] = ale_tbl_len; 615 cpsw_ale_dump(common->ale, ®[pos]); 616 pos += ale_tbl_len; 617 continue; 618 } 619 620 reg[pos++] = am65_cpsw_regdump[i].hdr.len; 621 622 j = am65_cpsw_regdump[i].start_ofs; 623 do { 624 reg[pos++] = j; 625 reg[pos++] = readl_relaxed(common->ss_base + j); 626 j += sizeof(u32); 627 } while (j <= am65_cpsw_regdump[i].end_ofs); 628 } 629 } 630 631 static int am65_cpsw_get_sset_count(struct net_device *ndev, int sset) 632 { 633 switch (sset) { 634 case ETH_SS_STATS: 635 return ARRAY_SIZE(am65_host_stats) + 636 ARRAY_SIZE(am65_slave_stats); 637 case ETH_SS_PRIV_FLAGS: 638 return ARRAY_SIZE(am65_cpsw_ethtool_priv_flags); 639 default: 640 return -EOPNOTSUPP; 641 } 642 } 643 644 static void am65_cpsw_get_strings(struct net_device *ndev, 645 u32 stringset, u8 *data) 646 { 647 const struct am65_cpsw_ethtool_stat *hw_stats; 648 u32 i, num_stats; 649 u8 *p = data; 650 651 switch (stringset) { 652 case ETH_SS_STATS: 653 num_stats = ARRAY_SIZE(am65_host_stats); 654 hw_stats = am65_host_stats; 655 for (i = 0; i < num_stats; i++) { 656 memcpy(p, hw_stats[i].desc, ETH_GSTRING_LEN); 657 p += ETH_GSTRING_LEN; 658 } 659 660 num_stats = ARRAY_SIZE(am65_slave_stats); 661 hw_stats = am65_slave_stats; 662 for (i = 0; i < num_stats; i++) { 663 memcpy(p, hw_stats[i].desc, ETH_GSTRING_LEN); 664 p += ETH_GSTRING_LEN; 665 } 666 break; 667 case ETH_SS_PRIV_FLAGS: 668 num_stats = ARRAY_SIZE(am65_cpsw_ethtool_priv_flags); 669 670 for (i = 0; i < num_stats; i++) { 671 memcpy(p, am65_cpsw_ethtool_priv_flags[i], 672 ETH_GSTRING_LEN); 673 p += ETH_GSTRING_LEN; 674 } 675 break; 676 } 677 } 678 679 static void am65_cpsw_get_ethtool_stats(struct net_device *ndev, 680 struct ethtool_stats *stats, u64 *data) 681 { 682 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 683 const struct am65_cpsw_ethtool_stat *hw_stats; 684 struct am65_cpsw_host *host_p; 685 struct am65_cpsw_port *port; 686 u32 i, num_stats; 687 688 host_p = am65_common_get_host(common); 689 port = am65_ndev_to_port(ndev); 690 num_stats = ARRAY_SIZE(am65_host_stats); 691 hw_stats = am65_host_stats; 692 for (i = 0; i < num_stats; i++) 693 *data++ = readl_relaxed(host_p->stat_base + 694 hw_stats[i].offset); 695 696 num_stats = ARRAY_SIZE(am65_slave_stats); 697 hw_stats = am65_slave_stats; 698 for (i = 0; i < num_stats; i++) 699 *data++ = readl_relaxed(port->stat_base + 700 hw_stats[i].offset); 701 } 702 703 static int am65_cpsw_get_ethtool_ts_info(struct net_device *ndev, 704 struct ethtool_ts_info *info) 705 { 706 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 707 708 if (!IS_ENABLED(CONFIG_TI_K3_AM65_CPTS)) 709 return ethtool_op_get_ts_info(ndev, info); 710 711 info->so_timestamping = 712 SOF_TIMESTAMPING_TX_HARDWARE | 713 SOF_TIMESTAMPING_TX_SOFTWARE | 714 SOF_TIMESTAMPING_RX_HARDWARE | 715 SOF_TIMESTAMPING_RX_SOFTWARE | 716 SOF_TIMESTAMPING_SOFTWARE | 717 SOF_TIMESTAMPING_RAW_HARDWARE; 718 info->phc_index = am65_cpts_phc_index(common->cpts); 719 info->tx_types = BIT(HWTSTAMP_TX_OFF) | BIT(HWTSTAMP_TX_ON); 720 info->rx_filters = BIT(HWTSTAMP_FILTER_NONE) | BIT(HWTSTAMP_FILTER_ALL); 721 return 0; 722 } 723 724 static u32 am65_cpsw_get_ethtool_priv_flags(struct net_device *ndev) 725 { 726 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 727 u32 priv_flags = 0; 728 729 if (common->pf_p0_rx_ptype_rrobin) 730 priv_flags |= AM65_CPSW_PRIV_P0_RX_PTYPE_RROBIN; 731 732 return priv_flags; 733 } 734 735 static int am65_cpsw_set_ethtool_priv_flags(struct net_device *ndev, u32 flags) 736 { 737 struct am65_cpsw_common *common = am65_ndev_to_common(ndev); 738 int rrobin; 739 740 rrobin = !!(flags & AM65_CPSW_PRIV_P0_RX_PTYPE_RROBIN); 741 742 if (common->usage_count) 743 return -EBUSY; 744 745 if (common->est_enabled && rrobin) { 746 netdev_err(ndev, 747 "p0-rx-ptype-rrobin flag conflicts with QOS\n"); 748 return -EINVAL; 749 } 750 751 common->pf_p0_rx_ptype_rrobin = rrobin; 752 753 return 0; 754 } 755 756 const struct ethtool_ops am65_cpsw_ethtool_ops_slave = { 757 .begin = am65_cpsw_ethtool_op_begin, 758 .complete = am65_cpsw_ethtool_op_complete, 759 .get_drvinfo = am65_cpsw_get_drvinfo, 760 .get_msglevel = am65_cpsw_get_msglevel, 761 .set_msglevel = am65_cpsw_set_msglevel, 762 .get_channels = am65_cpsw_get_channels, 763 .set_channels = am65_cpsw_set_channels, 764 .get_ringparam = am65_cpsw_get_ringparam, 765 .get_regs_len = am65_cpsw_get_regs_len, 766 .get_regs = am65_cpsw_get_regs, 767 .get_sset_count = am65_cpsw_get_sset_count, 768 .get_strings = am65_cpsw_get_strings, 769 .get_ethtool_stats = am65_cpsw_get_ethtool_stats, 770 .get_ts_info = am65_cpsw_get_ethtool_ts_info, 771 .get_priv_flags = am65_cpsw_get_ethtool_priv_flags, 772 .set_priv_flags = am65_cpsw_set_ethtool_priv_flags, 773 774 .get_link = ethtool_op_get_link, 775 .get_link_ksettings = am65_cpsw_get_link_ksettings, 776 .set_link_ksettings = am65_cpsw_set_link_ksettings, 777 .get_pauseparam = am65_cpsw_get_pauseparam, 778 .set_pauseparam = am65_cpsw_set_pauseparam, 779 .get_wol = am65_cpsw_get_wol, 780 .set_wol = am65_cpsw_set_wol, 781 .get_eee = am65_cpsw_get_eee, 782 .set_eee = am65_cpsw_set_eee, 783 .nway_reset = am65_cpsw_nway_reset, 784 }; 785