| @@ -166,6 +166,258 @@ static const char *phylink_an_mode_str(unsigned int mode) · 165 unmodified lines |
| 166 | 166 | return mode < ARRAY_SIZE(modestr) ? modestr[mode] : "unknown"; |
| 167 | 167 | } |
| 168 | 168 | |
| 169 | +static void phylink_caps_to_linkmodes(unsigned long *linkmodes, |
| 170 | + unsigned long caps) |
| 171 | +{ |
| 172 | + if (caps & MAC_SYM_PAUSE) |
| 173 | + __set_bit(ETHTOOL_LINK_MODE_Pause_BIT, linkmodes); |
| 174 | + |
| 175 | + if (caps & MAC_ASYM_PAUSE) |
| 176 | + __set_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, linkmodes); |
| 177 | + |
| 178 | + if (caps & MAC_10HD) |
| 179 | + __set_bit(ETHTOOL_LINK_MODE_10baseT_Half_BIT, linkmodes); |
| 180 | + |
| 181 | + if (caps & MAC_10FD) |
| 182 | + __set_bit(ETHTOOL_LINK_MODE_10baseT_Full_BIT, linkmodes); |
| 183 | + |
| 184 | + if (caps & MAC_100HD) { |
| 185 | + __set_bit(ETHTOOL_LINK_MODE_100baseT_Half_BIT, linkmodes); |
| 186 | + __set_bit(ETHTOOL_LINK_MODE_100baseFX_Half_BIT, linkmodes); |
| 187 | + } |
| 188 | + |
| 189 | + if (caps & MAC_100FD) { |
| 190 | + __set_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, linkmodes); |
| 191 | + __set_bit(ETHTOOL_LINK_MODE_100baseT1_Full_BIT, linkmodes); |
| 192 | + __set_bit(ETHTOOL_LINK_MODE_100baseFX_Full_BIT, linkmodes); |
| 193 | + } |
| 194 | + |
| 195 | + if (caps & MAC_1000HD) |
| 196 | + __set_bit(ETHTOOL_LINK_MODE_1000baseT_Half_BIT, linkmodes); |
| 197 | + |
| 198 | + if (caps & MAC_1000FD) { |
| 199 | + __set_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, linkmodes); |
| 200 | + __set_bit(ETHTOOL_LINK_MODE_1000baseX_Full_BIT, linkmodes); |
| 201 | + __set_bit(ETHTOOL_LINK_MODE_1000baseT1_Full_BIT, linkmodes); |
| 202 | + } |
| 203 | + |
| 204 | + if (caps & MAC_2500FD) { |
| 205 | + __set_bit(ETHTOOL_LINK_MODE_2500baseT_Full_BIT, linkmodes); |
| 206 | + __set_bit(ETHTOOL_LINK_MODE_2500baseX_Full_BIT, linkmodes); |
| 207 | + } |
| 208 | + |
| 209 | + if (caps & MAC_5000FD) |
| 210 | + __set_bit(ETHTOOL_LINK_MODE_5000baseT_Full_BIT, linkmodes); |
| 211 | + |
| 212 | + if (caps & MAC_10000FD) { |
| 213 | + __set_bit(ETHTOOL_LINK_MODE_10000baseT_Full_BIT, linkmodes); |
| 214 | + __set_bit(ETHTOOL_LINK_MODE_10000baseKX4_Full_BIT, linkmodes); |
| 215 | + __set_bit(ETHTOOL_LINK_MODE_10000baseKR_Full_BIT, linkmodes); |
| 216 | + __set_bit(ETHTOOL_LINK_MODE_10000baseR_FEC_BIT, linkmodes); |
| 217 | + __set_bit(ETHTOOL_LINK_MODE_10000baseCR_Full_BIT, linkmodes); |
| 218 | + __set_bit(ETHTOOL_LINK_MODE_10000baseSR_Full_BIT, linkmodes); |
| 219 | + __set_bit(ETHTOOL_LINK_MODE_10000baseLR_Full_BIT, linkmodes); |
| 220 | + __set_bit(ETHTOOL_LINK_MODE_10000baseLRM_Full_BIT, linkmodes); |
| 221 | + __set_bit(ETHTOOL_LINK_MODE_10000baseER_Full_BIT, linkmodes); |
| 222 | + } |
| 223 | + |
| 224 | + if (caps & MAC_25000FD) { |
| 225 | + __set_bit(ETHTOOL_LINK_MODE_25000baseCR_Full_BIT, linkmodes); |
| 226 | + __set_bit(ETHTOOL_LINK_MODE_25000baseKR_Full_BIT, linkmodes); |
| 227 | + __set_bit(ETHTOOL_LINK_MODE_25000baseSR_Full_BIT, linkmodes); |
| 228 | + } |
| 229 | + |
| 230 | + if (caps & MAC_40000FD) { |
| 231 | + __set_bit(ETHTOOL_LINK_MODE_40000baseKR4_Full_BIT, linkmodes); |
| 232 | + __set_bit(ETHTOOL_LINK_MODE_40000baseCR4_Full_BIT, linkmodes); |
| 233 | + __set_bit(ETHTOOL_LINK_MODE_40000baseSR4_Full_BIT, linkmodes); |
| 234 | + __set_bit(ETHTOOL_LINK_MODE_40000baseLR4_Full_BIT, linkmodes); |
| 235 | + } |
| 236 | + |
| 237 | + if (caps & MAC_50000FD) { |
| 238 | + __set_bit(ETHTOOL_LINK_MODE_50000baseCR2_Full_BIT, linkmodes); |
| 239 | + __set_bit(ETHTOOL_LINK_MODE_50000baseKR2_Full_BIT, linkmodes); |
| 240 | + __set_bit(ETHTOOL_LINK_MODE_50000baseSR2_Full_BIT, linkmodes); |
| 241 | + __set_bit(ETHTOOL_LINK_MODE_50000baseKR_Full_BIT, linkmodes); |
| 242 | + __set_bit(ETHTOOL_LINK_MODE_50000baseSR_Full_BIT, linkmodes); |
| 243 | + __set_bit(ETHTOOL_LINK_MODE_50000baseCR_Full_BIT, linkmodes); |
| 244 | + __set_bit(ETHTOOL_LINK_MODE_50000baseLR_ER_FR_Full_BIT, |
| 245 | + linkmodes); |
| 246 | + __set_bit(ETHTOOL_LINK_MODE_50000baseDR_Full_BIT, linkmodes); |
| 247 | + } |
| 248 | + |
| 249 | + if (caps & MAC_56000FD) { |
| 250 | + __set_bit(ETHTOOL_LINK_MODE_56000baseKR4_Full_BIT, linkmodes); |
| 251 | + __set_bit(ETHTOOL_LINK_MODE_56000baseCR4_Full_BIT, linkmodes); |
| 252 | + __set_bit(ETHTOOL_LINK_MODE_56000baseSR4_Full_BIT, linkmodes); |
| 253 | + __set_bit(ETHTOOL_LINK_MODE_56000baseLR4_Full_BIT, linkmodes); |
| 254 | + } |
| 255 | + |
| 256 | + if (caps & MAC_100000FD) { |
| 257 | + __set_bit(ETHTOOL_LINK_MODE_100000baseKR4_Full_BIT, linkmodes); |
| 258 | + __set_bit(ETHTOOL_LINK_MODE_100000baseSR4_Full_BIT, linkmodes); |
| 259 | + __set_bit(ETHTOOL_LINK_MODE_100000baseCR4_Full_BIT, linkmodes); |
| 260 | + __set_bit(ETHTOOL_LINK_MODE_100000baseLR4_ER4_Full_BIT, |
| 261 | + linkmodes); |
| 262 | + __set_bit(ETHTOOL_LINK_MODE_100000baseKR2_Full_BIT, linkmodes); |
| 263 | + __set_bit(ETHTOOL_LINK_MODE_100000baseSR2_Full_BIT, linkmodes); |
| 264 | + __set_bit(ETHTOOL_LINK_MODE_100000baseCR2_Full_BIT, linkmodes); |
| 265 | + __set_bit(ETHTOOL_LINK_MODE_100000baseLR2_ER2_FR2_Full_BIT, |
| 266 | + linkmodes); |
| 267 | + __set_bit(ETHTOOL_LINK_MODE_100000baseDR2_Full_BIT, linkmodes); |
| 268 | + __set_bit(ETHTOOL_LINK_MODE_100000baseKR_Full_BIT, linkmodes); |
| 269 | + __set_bit(ETHTOOL_LINK_MODE_100000baseSR_Full_BIT, linkmodes); |
| 270 | + __set_bit(ETHTOOL_LINK_MODE_100000baseLR_ER_FR_Full_BIT, |
| 271 | + linkmodes); |
| 272 | + __set_bit(ETHTOOL_LINK_MODE_100000baseCR_Full_BIT, linkmodes); |
| 273 | + __set_bit(ETHTOOL_LINK_MODE_100000baseDR_Full_BIT, linkmodes); |
| 274 | + } |
| 275 | + |
| 276 | + if (caps & MAC_200000FD) { |
| 277 | + __set_bit(ETHTOOL_LINK_MODE_200000baseKR4_Full_BIT, linkmodes); |
| 278 | + __set_bit(ETHTOOL_LINK_MODE_200000baseSR4_Full_BIT, linkmodes); |
| 279 | + __set_bit(ETHTOOL_LINK_MODE_200000baseLR4_ER4_FR4_Full_BIT, |
| 280 | + linkmodes); |
| 281 | + __set_bit(ETHTOOL_LINK_MODE_200000baseDR4_Full_BIT, linkmodes); |
| 282 | + __set_bit(ETHTOOL_LINK_MODE_200000baseCR4_Full_BIT, linkmodes); |
| 283 | + __set_bit(ETHTOOL_LINK_MODE_200000baseKR2_Full_BIT, linkmodes); |
| 284 | + __set_bit(ETHTOOL_LINK_MODE_200000baseSR2_Full_BIT, linkmodes); |
| 285 | + __set_bit(ETHTOOL_LINK_MODE_200000baseLR2_ER2_FR2_Full_BIT, |
| 286 | + linkmodes); |
| 287 | + __set_bit(ETHTOOL_LINK_MODE_200000baseDR2_Full_BIT, linkmodes); |
| 288 | + __set_bit(ETHTOOL_LINK_MODE_200000baseCR2_Full_BIT, linkmodes); |
| 289 | + } |
| 290 | + |
| 291 | + if (caps & MAC_400000FD) { |
| 292 | + __set_bit(ETHTOOL_LINK_MODE_400000baseKR8_Full_BIT, linkmodes); |
| 293 | + __set_bit(ETHTOOL_LINK_MODE_400000baseSR8_Full_BIT, linkmodes); |
| 294 | + __set_bit(ETHTOOL_LINK_MODE_400000baseLR8_ER8_FR8_Full_BIT, |
| 295 | + linkmodes); |
| 296 | + __set_bit(ETHTOOL_LINK_MODE_400000baseDR8_Full_BIT, linkmodes); |
| 297 | + __set_bit(ETHTOOL_LINK_MODE_400000baseCR8_Full_BIT, linkmodes); |
| 298 | + __set_bit(ETHTOOL_LINK_MODE_400000baseKR4_Full_BIT, linkmodes); |
| 299 | + __set_bit(ETHTOOL_LINK_MODE_400000baseSR4_Full_BIT, linkmodes); |
| 300 | + __set_bit(ETHTOOL_LINK_MODE_400000baseLR4_ER4_FR4_Full_BIT, |
| 301 | + linkmodes); |
| 302 | + __set_bit(ETHTOOL_LINK_MODE_400000baseDR4_Full_BIT, linkmodes); |
| 303 | + __set_bit(ETHTOOL_LINK_MODE_400000baseCR4_Full_BIT, linkmodes); |
| 304 | + } |
| 305 | +} |
| 306 | + |
| 307 | +/** |
| 308 | + * phylink_get_linkmodes() - get acceptable link modes |
| 309 | + * @linkmodes: ethtool linkmode mask (must be already initialised) |
| 310 | + * @interface: phy interface mode defined by &typedef phy_interface_t |
| 311 | + * @mac_capabilities: bitmask of MAC capabilities |
| 312 | + * |
| 313 | + * Set all possible pause, speed and duplex linkmodes in @linkmodes that |
| 314 | + * are supported by the @interface mode and @mac_capabilities. @linkmodes |
| 315 | + * must have been initialised previously. |
| 316 | + */ |
| 317 | +void phylink_get_linkmodes(unsigned long *linkmodes, phy_interface_t interface, |
| 318 | + unsigned long mac_capabilities) |
| 319 | +{ |
| 320 | + unsigned long caps = MAC_SYM_PAUSE | MAC_ASYM_PAUSE; |
| 321 | + |
| 322 | + switch (interface) { |
| 323 | + case PHY_INTERFACE_MODE_USXGMII: |
| 324 | + caps |= MAC_10000FD | MAC_5000FD | MAC_2500FD; |
| 325 | + fallthrough; |
| 326 | + |
| 327 | + case PHY_INTERFACE_MODE_RGMII_TXID: |
| 328 | + case PHY_INTERFACE_MODE_RGMII_RXID: |
| 329 | + case PHY_INTERFACE_MODE_RGMII_ID: |
| 330 | + case PHY_INTERFACE_MODE_RGMII: |
| 331 | + case PHY_INTERFACE_MODE_QSGMII: |
| 332 | + case PHY_INTERFACE_MODE_SGMII: |
| 333 | + case PHY_INTERFACE_MODE_GMII: |
| 334 | + caps |= MAC_1000HD | MAC_1000FD; |
| 335 | + fallthrough; |
| 336 | + |
| 337 | + case PHY_INTERFACE_MODE_REVRMII: |
| 338 | + case PHY_INTERFACE_MODE_RMII: |
| 339 | + case PHY_INTERFACE_MODE_REVMII: |
| 340 | + case PHY_INTERFACE_MODE_MII: |
| 341 | + caps |= MAC_10HD | MAC_10FD; |
| 342 | + fallthrough; |
| 343 | + |
| 344 | + case PHY_INTERFACE_MODE_100BASEX: |
| 345 | + caps |= MAC_100HD | MAC_100FD; |
| 346 | + break; |
| 347 | + |
| 348 | + case PHY_INTERFACE_MODE_TBI: |
| 349 | + case PHY_INTERFACE_MODE_MOCA: |
| 350 | + case PHY_INTERFACE_MODE_RTBI: |
| 351 | + case PHY_INTERFACE_MODE_1000BASEX: |
| 352 | + caps |= MAC_1000HD; |
| 353 | + fallthrough; |
| 354 | + case PHY_INTERFACE_MODE_TRGMII: |
| 355 | + caps |= MAC_1000FD; |
| 356 | + break; |
| 357 | + |
| 358 | + case PHY_INTERFACE_MODE_2500BASEX: |
| 359 | + caps |= MAC_2500FD; |
| 360 | + break; |
| 361 | + |
| 362 | + case PHY_INTERFACE_MODE_5GBASER: |
| 363 | + caps |= MAC_5000FD; |
| 364 | + break; |
| 365 | + |
| 366 | + case PHY_INTERFACE_MODE_XGMII: |
| 367 | + case PHY_INTERFACE_MODE_RXAUI: |
| 368 | + case PHY_INTERFACE_MODE_XAUI: |
| 369 | + case PHY_INTERFACE_MODE_10GBASER: |
| 370 | + case PHY_INTERFACE_MODE_10GKR: |
| 371 | + caps |= MAC_10000FD; |
| 372 | + break; |
| 373 | + |
| 374 | + case PHY_INTERFACE_MODE_25GBASER: |
| 375 | + caps |= MAC_25000FD; |
| 376 | + break; |
| 377 | + |
| 378 | + case PHY_INTERFACE_MODE_XLGMII: |
| 379 | + caps |= MAC_40000FD; |
| 380 | + break; |
| 381 | + |
| 382 | + case PHY_INTERFACE_MODE_INTERNAL: |
| 383 | + caps |= ~0; |
| 384 | + break; |
| 385 | + |
| 386 | + case PHY_INTERFACE_MODE_NA: |
| 387 | + case PHY_INTERFACE_MODE_MAX: |
| 388 | + case PHY_INTERFACE_MODE_SMII: |
| 389 | + break; |
| 390 | + } |
| 391 | + |
| 392 | + phylink_caps_to_linkmodes(linkmodes, caps & mac_capabilities); |
| 393 | +} |
| 394 | +EXPORT_SYMBOL_GPL(phylink_get_linkmodes); |
| 395 | + |
| 396 | +/** |
| 397 | + * phylink_generic_validate() - generic validate() callback implementation |
| 398 | + * @config: a pointer to a &struct phylink_config. |
| 399 | + * @supported: ethtool bitmask for supported link modes. |
| 400 | + * @state: a pointer to a &struct phylink_link_state. |
| 401 | + * |
| 402 | + * Generic implementation of the validate() callback that MAC drivers can |
| 403 | + * use when they pass the range of supported interfaces and MAC capabilities. |
| 404 | + * This makes use of phylink_get_linkmodes(). |
| 405 | + */ |
| 406 | +void phylink_generic_validate(struct phylink_config *config, |
| 407 | + unsigned long *supported, |
| 408 | + struct phylink_link_state *state) |
| 409 | +{ |
| 410 | + __ETHTOOL_DECLARE_LINK_MODE_MASK(mask) = { 0, }; |
| 411 | + |
| 412 | + phylink_set_port_modes(mask); |
| 413 | + phylink_set(mask, Autoneg); |
| 414 | + phylink_get_linkmodes(mask, state->interface, config->mac_capabilities); |
| 415 | + |
| 416 | + linkmode_and(supported, supported, mask); |
| 417 | + linkmode_and(state->advertising, state->advertising, mask); |
| 418 | +} |
| 419 | +EXPORT_SYMBOL_GPL(phylink_generic_validate); |
| 420 | + |
| 169 | 421 | static int phylink_validate_any(struct phylink *pl, unsigned long *supported, |
| 170 | 422 | struct phylink_link_state *state) |
| 171 | 423 | { |