^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) #include <linux/acpi.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) #include <linux/ctype.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) #include <linux/gpio/consumer.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/hwmon.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/jiffies.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/mdio/mdio-i2c.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/phy.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/rtnetlink.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/workqueue.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include "sfp.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include "swphy.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) GPIO_MODDEF0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) GPIO_LOS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) GPIO_TX_FAULT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) GPIO_TX_DISABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) GPIO_RATE_SELECT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) GPIO_MAX,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) SFP_F_PRESENT = BIT(GPIO_MODDEF0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) SFP_F_LOS = BIT(GPIO_LOS),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) SFP_F_TX_FAULT = BIT(GPIO_TX_FAULT),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) SFP_F_TX_DISABLE = BIT(GPIO_TX_DISABLE),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) SFP_F_RATE_SELECT = BIT(GPIO_RATE_SELECT),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) SFP_E_INSERT = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) SFP_E_REMOVE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) SFP_E_DEV_ATTACH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) SFP_E_DEV_DETACH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) SFP_E_DEV_DOWN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) SFP_E_DEV_UP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) SFP_E_TX_FAULT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) SFP_E_TX_CLEAR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) SFP_E_LOS_HIGH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) SFP_E_LOS_LOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) SFP_E_TIMEOUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) SFP_MOD_EMPTY = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) SFP_MOD_ERROR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) SFP_MOD_PROBE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) SFP_MOD_WAITDEV,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) SFP_MOD_HPOWER,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) SFP_MOD_WAITPWR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) SFP_MOD_PRESENT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) SFP_DEV_DETACHED = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) SFP_DEV_DOWN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) SFP_DEV_UP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) SFP_S_DOWN = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) SFP_S_FAIL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) SFP_S_WAIT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) SFP_S_INIT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) SFP_S_INIT_PHY,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) SFP_S_INIT_TX_FAULT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) SFP_S_WAIT_LOS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) SFP_S_LINK_UP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) SFP_S_TX_FAULT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) SFP_S_REINIT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) SFP_S_TX_DISABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static const char * const mod_state_strings[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) [SFP_MOD_EMPTY] = "empty",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) [SFP_MOD_ERROR] = "error",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) [SFP_MOD_PROBE] = "probe",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) [SFP_MOD_WAITDEV] = "waitdev",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) [SFP_MOD_HPOWER] = "hpower",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) [SFP_MOD_WAITPWR] = "waitpwr",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) [SFP_MOD_PRESENT] = "present",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) static const char *mod_state_to_str(unsigned short mod_state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) if (mod_state >= ARRAY_SIZE(mod_state_strings))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) return "Unknown module state";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) return mod_state_strings[mod_state];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) static const char * const dev_state_strings[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) [SFP_DEV_DETACHED] = "detached",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) [SFP_DEV_DOWN] = "down",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) [SFP_DEV_UP] = "up",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) static const char *dev_state_to_str(unsigned short dev_state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) if (dev_state >= ARRAY_SIZE(dev_state_strings))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) return "Unknown device state";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) return dev_state_strings[dev_state];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) static const char * const event_strings[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) [SFP_E_INSERT] = "insert",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) [SFP_E_REMOVE] = "remove",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) [SFP_E_DEV_ATTACH] = "dev_attach",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) [SFP_E_DEV_DETACH] = "dev_detach",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) [SFP_E_DEV_DOWN] = "dev_down",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) [SFP_E_DEV_UP] = "dev_up",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) [SFP_E_TX_FAULT] = "tx_fault",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) [SFP_E_TX_CLEAR] = "tx_clear",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) [SFP_E_LOS_HIGH] = "los_high",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) [SFP_E_LOS_LOW] = "los_low",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) [SFP_E_TIMEOUT] = "timeout",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) static const char *event_to_str(unsigned short event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) if (event >= ARRAY_SIZE(event_strings))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) return "Unknown event";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) return event_strings[event];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static const char * const sm_state_strings[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) [SFP_S_DOWN] = "down",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) [SFP_S_FAIL] = "fail",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) [SFP_S_WAIT] = "wait",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) [SFP_S_INIT] = "init",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) [SFP_S_INIT_PHY] = "init_phy",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) [SFP_S_INIT_TX_FAULT] = "init_tx_fault",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) [SFP_S_WAIT_LOS] = "wait_los",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) [SFP_S_LINK_UP] = "link_up",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) [SFP_S_TX_FAULT] = "tx_fault",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) [SFP_S_REINIT] = "reinit",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) [SFP_S_TX_DISABLE] = "tx_disable",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) static const char *sm_state_to_str(unsigned short sm_state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) if (sm_state >= ARRAY_SIZE(sm_state_strings))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) return "Unknown state";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) return sm_state_strings[sm_state];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static const char *gpio_of_names[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) "mod-def0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) "los",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) "tx-fault",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) "tx-disable",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) "rate-select0",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) static const enum gpiod_flags gpio_flags[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) GPIOD_IN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) GPIOD_IN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) GPIOD_IN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) GPIOD_ASIS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) GPIOD_ASIS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) /* t_start_up (SFF-8431) or t_init (SFF-8472) is the time required for a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) * non-cooled module to initialise its laser safety circuitry. We wait
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) * an initial T_WAIT period before we check the tx fault to give any PHY
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) * on board (for a copper SFP) time to initialise.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) #define T_WAIT msecs_to_jiffies(50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) #define T_START_UP msecs_to_jiffies(300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) #define T_START_UP_BAD_GPON msecs_to_jiffies(60000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) /* t_reset is the time required to assert the TX_DISABLE signal to reset
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) * an indicated TX_FAULT.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) #define T_RESET_US 10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) #define T_FAULT_RECOVER msecs_to_jiffies(1000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) /* N_FAULT_INIT is the number of recovery attempts at module initialisation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) * time. If the TX_FAULT signal is not deasserted after this number of
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) * attempts at clearing it, we decide that the module is faulty.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) * N_FAULT is the same but after the module has initialised.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) #define N_FAULT_INIT 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) #define N_FAULT 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) /* T_PHY_RETRY is the time interval between attempts to probe the PHY.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) * R_PHY_RETRY is the number of attempts.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) #define T_PHY_RETRY msecs_to_jiffies(50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) #define R_PHY_RETRY 12
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) /* SFP module presence detection is poor: the three MOD DEF signals are
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) * the same length on the PCB, which means it's possible for MOD DEF 0 to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) * connect before the I2C bus on MOD DEF 1/2.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) * The SFF-8472 specifies t_serial ("Time from power on until module is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) * ready for data transmission over the two wire serial bus.") as 300ms.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) #define T_SERIAL msecs_to_jiffies(300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) #define T_HPOWER_LEVEL msecs_to_jiffies(300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) #define T_PROBE_RETRY_INIT msecs_to_jiffies(100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) #define R_PROBE_RETRY_INIT 10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) #define T_PROBE_RETRY_SLOW msecs_to_jiffies(5000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) #define R_PROBE_RETRY_SLOW 12
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) /* SFP modules appear to always have their PHY configured for bus address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) * 0x56 (which with mdio-i2c, translates to a PHY address of 22).
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) #define SFP_PHY_ADDR 22
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) struct sff_data {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) unsigned int gpios;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) bool (*module_supported)(const struct sfp_eeprom_id *id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) struct sfp {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) struct i2c_adapter *i2c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) struct mii_bus *i2c_mii;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) struct sfp_bus *sfp_bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) struct phy_device *mod_phy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) const struct sff_data *type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) size_t i2c_block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) u32 max_power_mW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) unsigned int (*get_state)(struct sfp *);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) void (*set_state)(struct sfp *, unsigned int);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) int (*read)(struct sfp *, bool, u8, void *, size_t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) int (*write)(struct sfp *, bool, u8, void *, size_t);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) struct gpio_desc *gpio[GPIO_MAX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) int gpio_irq[GPIO_MAX];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) bool need_poll;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) struct mutex st_mutex; /* Protects state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) unsigned int state_soft_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) unsigned int state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) struct delayed_work poll;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) struct delayed_work timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) struct mutex sm_mutex; /* Protects state machine */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) unsigned char sm_mod_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) unsigned char sm_mod_tries_init;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) unsigned char sm_mod_tries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) unsigned char sm_dev_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) unsigned short sm_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) unsigned char sm_fault_retries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) unsigned char sm_phy_retries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) struct sfp_eeprom_id id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) unsigned int module_power_mW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) unsigned int module_t_start_up;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) #if IS_ENABLED(CONFIG_HWMON)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) struct sfp_diag diag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) struct delayed_work hwmon_probe;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) unsigned int hwmon_tries;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) struct device *hwmon_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) char *hwmon_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) static bool sff_module_supported(const struct sfp_eeprom_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) return id->base.phys_id == SFF8024_ID_SFF_8472 &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) id->base.phys_ext_id == SFP_PHYS_EXT_ID_SFP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) static const struct sff_data sff_data = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) .gpios = SFP_F_LOS | SFP_F_TX_FAULT | SFP_F_TX_DISABLE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) .module_supported = sff_module_supported,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) static bool sfp_module_supported(const struct sfp_eeprom_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) if (id->base.phys_id == SFF8024_ID_SFP &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) id->base.phys_ext_id == SFP_PHYS_EXT_ID_SFP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) /* SFP GPON module Ubiquiti U-Fiber Instant has in its EEPROM stored
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) * phys id SFF instead of SFP. Therefore mark this module explicitly
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) * as supported based on vendor name and pn match.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) if (id->base.phys_id == SFF8024_ID_SFF_8472 &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) id->base.phys_ext_id == SFP_PHYS_EXT_ID_SFP &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) !memcmp(id->base.vendor_name, "UBNT ", 16) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) !memcmp(id->base.vendor_pn, "UF-INSTANT ", 16))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) static const struct sff_data sfp_data = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) .gpios = SFP_F_PRESENT | SFP_F_LOS | SFP_F_TX_FAULT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) SFP_F_TX_DISABLE | SFP_F_RATE_SELECT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) .module_supported = sfp_module_supported,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) static const struct of_device_id sfp_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) { .compatible = "sff,sff", .data = &sff_data, },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) { .compatible = "sff,sfp", .data = &sfp_data, },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) { },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) MODULE_DEVICE_TABLE(of, sfp_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) static unsigned long poll_jiffies;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) static unsigned int sfp_gpio_get_state(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) unsigned int i, state, v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) for (i = state = 0; i < GPIO_MAX; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) if (gpio_flags[i] != GPIOD_IN || !sfp->gpio[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) v = gpiod_get_value_cansleep(sfp->gpio[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) if (v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) state |= BIT(i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) return state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) static unsigned int sff_gpio_get_state(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) return sfp_gpio_get_state(sfp) | SFP_F_PRESENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) static void sfp_gpio_set_state(struct sfp *sfp, unsigned int state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) if (state & SFP_F_PRESENT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) /* If the module is present, drive the signals */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) if (sfp->gpio[GPIO_TX_DISABLE])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) gpiod_direction_output(sfp->gpio[GPIO_TX_DISABLE],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) state & SFP_F_TX_DISABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) if (state & SFP_F_RATE_SELECT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) gpiod_direction_output(sfp->gpio[GPIO_RATE_SELECT],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) state & SFP_F_RATE_SELECT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) /* Otherwise, let them float to the pull-ups */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) if (sfp->gpio[GPIO_TX_DISABLE])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) gpiod_direction_input(sfp->gpio[GPIO_TX_DISABLE]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) if (state & SFP_F_RATE_SELECT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) gpiod_direction_input(sfp->gpio[GPIO_RATE_SELECT]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) static int sfp_i2c_read(struct sfp *sfp, bool a2, u8 dev_addr, void *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) struct i2c_msg msgs[2];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) u8 bus_addr = a2 ? 0x51 : 0x50;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) size_t block_size = sfp->i2c_block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) size_t this_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) msgs[0].addr = bus_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) msgs[0].flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) msgs[0].len = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) msgs[0].buf = &dev_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) msgs[1].addr = bus_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) msgs[1].flags = I2C_M_RD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) msgs[1].len = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) msgs[1].buf = buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) while (len) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) this_len = len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) if (this_len > block_size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) this_len = block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) msgs[1].len = this_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) ret = i2c_transfer(sfp->i2c, msgs, ARRAY_SIZE(msgs));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) if (ret != ARRAY_SIZE(msgs))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) msgs[1].buf += this_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) dev_addr += this_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) len -= this_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) return msgs[1].buf - (u8 *)buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) static int sfp_i2c_write(struct sfp *sfp, bool a2, u8 dev_addr, void *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) struct i2c_msg msgs[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) u8 bus_addr = a2 ? 0x51 : 0x50;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) msgs[0].addr = bus_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) msgs[0].flags = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) msgs[0].len = 1 + len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) msgs[0].buf = kmalloc(1 + len, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) if (!msgs[0].buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) msgs[0].buf[0] = dev_addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) memcpy(&msgs[0].buf[1], buf, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) ret = i2c_transfer(sfp->i2c, msgs, ARRAY_SIZE(msgs));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) kfree(msgs[0].buf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) return ret == ARRAY_SIZE(msgs) ? len : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) static int sfp_i2c_configure(struct sfp *sfp, struct i2c_adapter *i2c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) struct mii_bus *i2c_mii;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) if (!i2c_check_functionality(i2c, I2C_FUNC_I2C))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) sfp->i2c = i2c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) sfp->read = sfp_i2c_read;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) sfp->write = sfp_i2c_write;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) i2c_mii = mdio_i2c_alloc(sfp->dev, i2c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) if (IS_ERR(i2c_mii))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) return PTR_ERR(i2c_mii);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) i2c_mii->name = "SFP I2C Bus";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) i2c_mii->phy_mask = ~0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) ret = mdiobus_register(i2c_mii);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) mdiobus_free(i2c_mii);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) sfp->i2c_mii = i2c_mii;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) /* Interface */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) static int sfp_read(struct sfp *sfp, bool a2, u8 addr, void *buf, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) return sfp->read(sfp, a2, addr, buf, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) static int sfp_write(struct sfp *sfp, bool a2, u8 addr, void *buf, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) return sfp->write(sfp, a2, addr, buf, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) static unsigned int sfp_soft_get_state(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) unsigned int state = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) ret = sfp_read(sfp, true, SFP_STATUS, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) if (ret == sizeof(status)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) if (status & SFP_STATUS_RX_LOS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) state |= SFP_F_LOS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) if (status & SFP_STATUS_TX_FAULT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) state |= SFP_F_TX_FAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) dev_err_ratelimited(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) "failed to read SFP soft status: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) /* Preserve the current state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) state = sfp->state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) return state & sfp->state_soft_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) static void sfp_soft_set_state(struct sfp *sfp, unsigned int state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) if (sfp_read(sfp, true, SFP_STATUS, &status, sizeof(status)) ==
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) sizeof(status)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) if (state & SFP_F_TX_DISABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) status |= SFP_STATUS_TX_DISABLE_FORCE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) status &= ~SFP_STATUS_TX_DISABLE_FORCE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) sfp_write(sfp, true, SFP_STATUS, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) static void sfp_soft_start_poll(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) const struct sfp_eeprom_id *id = &sfp->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) sfp->state_soft_mask = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) if (id->ext.enhopts & SFP_ENHOPTS_SOFT_TX_DISABLE &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) !sfp->gpio[GPIO_TX_DISABLE])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) sfp->state_soft_mask |= SFP_F_TX_DISABLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) if (id->ext.enhopts & SFP_ENHOPTS_SOFT_TX_FAULT &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) !sfp->gpio[GPIO_TX_FAULT])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) sfp->state_soft_mask |= SFP_F_TX_FAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) if (id->ext.enhopts & SFP_ENHOPTS_SOFT_RX_LOS &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) !sfp->gpio[GPIO_LOS])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) sfp->state_soft_mask |= SFP_F_LOS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) if (sfp->state_soft_mask & (SFP_F_LOS | SFP_F_TX_FAULT) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) !sfp->need_poll)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) mod_delayed_work(system_wq, &sfp->poll, poll_jiffies);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) static void sfp_soft_stop_poll(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) sfp->state_soft_mask = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) static unsigned int sfp_get_state(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) unsigned int state = sfp->get_state(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) if (state & SFP_F_PRESENT &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) sfp->state_soft_mask & (SFP_F_LOS | SFP_F_TX_FAULT))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) state |= sfp_soft_get_state(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) return state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) static void sfp_set_state(struct sfp *sfp, unsigned int state)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) sfp->set_state(sfp, state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) if (state & SFP_F_PRESENT &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) sfp->state_soft_mask & SFP_F_TX_DISABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) sfp_soft_set_state(sfp, state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) static unsigned int sfp_check(void *buf, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) u8 *p, check;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) for (p = buf, check = 0; len; p++, len--)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) check += *p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) return check;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) /* hwmon */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) #if IS_ENABLED(CONFIG_HWMON)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) static umode_t sfp_hwmon_is_visible(const void *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) enum hwmon_sensor_types type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) u32 attr, int channel)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) const struct sfp *sfp = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) case hwmon_temp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) case hwmon_temp_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) case hwmon_temp_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) case hwmon_temp_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) case hwmon_temp_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) case hwmon_temp_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) case hwmon_temp_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) case hwmon_temp_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) case hwmon_temp_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) if (!(sfp->id.ext.enhopts & SFP_ENHOPTS_ALARMWARN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) case hwmon_temp_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) case hwmon_temp_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) return 0444;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) case hwmon_in:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) case hwmon_in_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) case hwmon_in_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) case hwmon_in_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) case hwmon_in_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) case hwmon_in_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) case hwmon_in_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) case hwmon_in_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) case hwmon_in_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) if (!(sfp->id.ext.enhopts & SFP_ENHOPTS_ALARMWARN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) case hwmon_in_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) case hwmon_in_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) return 0444;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) case hwmon_curr:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) case hwmon_curr_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) case hwmon_curr_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) case hwmon_curr_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) case hwmon_curr_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) case hwmon_curr_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) case hwmon_curr_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) case hwmon_curr_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) case hwmon_curr_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) if (!(sfp->id.ext.enhopts & SFP_ENHOPTS_ALARMWARN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) case hwmon_curr_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) case hwmon_curr_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) return 0444;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) case hwmon_power:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) /* External calibration of receive power requires
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) * floating point arithmetic. Doing that in the kernel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) * is not easy, so just skip it. If the module does
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) * not require external calibration, we can however
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) * show receiver power, since FP is then not needed.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) if (sfp->id.ext.diagmon & SFP_DIAGMON_EXT_CAL &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) channel == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) case hwmon_power_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) case hwmon_power_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) case hwmon_power_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) case hwmon_power_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) case hwmon_power_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) case hwmon_power_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) case hwmon_power_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) case hwmon_power_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) if (!(sfp->id.ext.enhopts & SFP_ENHOPTS_ALARMWARN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) case hwmon_power_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) case hwmon_power_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) return 0444;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) static int sfp_hwmon_read_sensor(struct sfp *sfp, int reg, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) __be16 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) err = sfp_read(sfp, true, reg, &val, sizeof(val));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) *value = be16_to_cpu(val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) static void sfp_hwmon_to_rx_power(long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) *value = DIV_ROUND_CLOSEST(*value, 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) static void sfp_hwmon_calibrate(struct sfp *sfp, unsigned int slope, int offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) if (sfp->id.ext.diagmon & SFP_DIAGMON_EXT_CAL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) *value = DIV_ROUND_CLOSEST(*value * slope, 256) + offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) static void sfp_hwmon_calibrate_temp(struct sfp *sfp, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) sfp_hwmon_calibrate(sfp, be16_to_cpu(sfp->diag.cal_t_slope),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) be16_to_cpu(sfp->diag.cal_t_offset), value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) if (*value >= 0x8000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) *value -= 0x10000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) *value = DIV_ROUND_CLOSEST(*value * 1000, 256);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) static void sfp_hwmon_calibrate_vcc(struct sfp *sfp, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) sfp_hwmon_calibrate(sfp, be16_to_cpu(sfp->diag.cal_v_slope),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) be16_to_cpu(sfp->diag.cal_v_offset), value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) *value = DIV_ROUND_CLOSEST(*value, 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) static void sfp_hwmon_calibrate_bias(struct sfp *sfp, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) sfp_hwmon_calibrate(sfp, be16_to_cpu(sfp->diag.cal_txi_slope),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) be16_to_cpu(sfp->diag.cal_txi_offset), value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) *value = DIV_ROUND_CLOSEST(*value, 500);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) static void sfp_hwmon_calibrate_tx_power(struct sfp *sfp, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) sfp_hwmon_calibrate(sfp, be16_to_cpu(sfp->diag.cal_txpwr_slope),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) be16_to_cpu(sfp->diag.cal_txpwr_offset), value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) *value = DIV_ROUND_CLOSEST(*value, 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) static int sfp_hwmon_read_temp(struct sfp *sfp, int reg, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) err = sfp_hwmon_read_sensor(sfp, reg, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) sfp_hwmon_calibrate_temp(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) static int sfp_hwmon_read_vcc(struct sfp *sfp, int reg, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) err = sfp_hwmon_read_sensor(sfp, reg, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) sfp_hwmon_calibrate_vcc(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) static int sfp_hwmon_read_bias(struct sfp *sfp, int reg, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) err = sfp_hwmon_read_sensor(sfp, reg, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) sfp_hwmon_calibrate_bias(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) static int sfp_hwmon_read_tx_power(struct sfp *sfp, int reg, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) err = sfp_hwmon_read_sensor(sfp, reg, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) sfp_hwmon_calibrate_tx_power(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) static int sfp_hwmon_read_rx_power(struct sfp *sfp, int reg, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) err = sfp_hwmon_read_sensor(sfp, reg, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) sfp_hwmon_to_rx_power(value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) static int sfp_hwmon_temp(struct sfp *sfp, u32 attr, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) case hwmon_temp_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) return sfp_hwmon_read_temp(sfp, SFP_TEMP, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) case hwmon_temp_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) *value = be16_to_cpu(sfp->diag.temp_low_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) sfp_hwmon_calibrate_temp(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) case hwmon_temp_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) *value = be16_to_cpu(sfp->diag.temp_low_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) sfp_hwmon_calibrate_temp(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) case hwmon_temp_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) *value = be16_to_cpu(sfp->diag.temp_high_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) sfp_hwmon_calibrate_temp(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) case hwmon_temp_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) *value = be16_to_cpu(sfp->diag.temp_high_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) sfp_hwmon_calibrate_temp(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) case hwmon_temp_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) *value = !!(status & SFP_ALARM0_TEMP_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) case hwmon_temp_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) *value = !!(status & SFP_WARN0_TEMP_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) case hwmon_temp_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) *value = !!(status & SFP_WARN0_TEMP_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826) case hwmon_temp_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) *value = !!(status & SFP_ALARM0_TEMP_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) static int sfp_hwmon_vcc(struct sfp *sfp, u32 attr, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846) case hwmon_in_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) return sfp_hwmon_read_vcc(sfp, SFP_VCC, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) case hwmon_in_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) *value = be16_to_cpu(sfp->diag.volt_low_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) sfp_hwmon_calibrate_vcc(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) case hwmon_in_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) *value = be16_to_cpu(sfp->diag.volt_low_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) sfp_hwmon_calibrate_vcc(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) case hwmon_in_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) *value = be16_to_cpu(sfp->diag.volt_high_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) sfp_hwmon_calibrate_vcc(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) case hwmon_in_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) *value = be16_to_cpu(sfp->diag.volt_high_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) sfp_hwmon_calibrate_vcc(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) case hwmon_in_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) *value = !!(status & SFP_ALARM0_VCC_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) case hwmon_in_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) *value = !!(status & SFP_WARN0_VCC_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) case hwmon_in_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) *value = !!(status & SFP_WARN0_VCC_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) case hwmon_in_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 896) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 897)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 898) *value = !!(status & SFP_ALARM0_VCC_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 899) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 900) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 901) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 902) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 903)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 904) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 905) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 906)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 907) static int sfp_hwmon_bias(struct sfp *sfp, u32 attr, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 908) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 909) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 910) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 911)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 912) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 913) case hwmon_curr_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 914) return sfp_hwmon_read_bias(sfp, SFP_TX_BIAS, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 915)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 916) case hwmon_curr_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 917) *value = be16_to_cpu(sfp->diag.bias_low_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 918) sfp_hwmon_calibrate_bias(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 919) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 920)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 921) case hwmon_curr_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 922) *value = be16_to_cpu(sfp->diag.bias_low_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 923) sfp_hwmon_calibrate_bias(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 924) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 925)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 926) case hwmon_curr_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 927) *value = be16_to_cpu(sfp->diag.bias_high_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 928) sfp_hwmon_calibrate_bias(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 929) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 930)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 931) case hwmon_curr_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 932) *value = be16_to_cpu(sfp->diag.bias_high_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 933) sfp_hwmon_calibrate_bias(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 934) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 935)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 936) case hwmon_curr_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 937) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 938) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 939) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 940)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 941) *value = !!(status & SFP_ALARM0_TX_BIAS_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 942) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 943)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 944) case hwmon_curr_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 945) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 946) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 947) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 948)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 949) *value = !!(status & SFP_WARN0_TX_BIAS_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 950) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 951)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 952) case hwmon_curr_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 953) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 954) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 955) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 956)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 957) *value = !!(status & SFP_WARN0_TX_BIAS_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 958) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 959)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 960) case hwmon_curr_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 961) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 962) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 963) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 964)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 965) *value = !!(status & SFP_ALARM0_TX_BIAS_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 966) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 967) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 968) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 969) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 970)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 971) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 972) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 973)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 974) static int sfp_hwmon_tx_power(struct sfp *sfp, u32 attr, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 975) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 976) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 977) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 978)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 979) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 980) case hwmon_power_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 981) return sfp_hwmon_read_tx_power(sfp, SFP_TX_POWER, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 982)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 983) case hwmon_power_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 984) *value = be16_to_cpu(sfp->diag.txpwr_low_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 985) sfp_hwmon_calibrate_tx_power(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 986) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 987)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 988) case hwmon_power_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 989) *value = be16_to_cpu(sfp->diag.txpwr_low_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 990) sfp_hwmon_calibrate_tx_power(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 991) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 992)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 993) case hwmon_power_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 994) *value = be16_to_cpu(sfp->diag.txpwr_high_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 995) sfp_hwmon_calibrate_tx_power(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 996) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 997)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 998) case hwmon_power_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 999) *value = be16_to_cpu(sfp->diag.txpwr_high_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1000) sfp_hwmon_calibrate_tx_power(sfp, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1001) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1002)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1003) case hwmon_power_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1004) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1005) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1006) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1007)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1008) *value = !!(status & SFP_ALARM0_TXPWR_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1009) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1010)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1011) case hwmon_power_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1012) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1013) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1014) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1015)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1016) *value = !!(status & SFP_WARN0_TXPWR_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1017) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1018)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1019) case hwmon_power_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1020) err = sfp_read(sfp, true, SFP_WARN0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1021) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1022) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1023)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1024) *value = !!(status & SFP_WARN0_TXPWR_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1025) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1026)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1027) case hwmon_power_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1028) err = sfp_read(sfp, true, SFP_ALARM0, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1029) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1030) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1031)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1032) *value = !!(status & SFP_ALARM0_TXPWR_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1033) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1034) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1035) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1036) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1037)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1038) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1039) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1040)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1041) static int sfp_hwmon_rx_power(struct sfp *sfp, u32 attr, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1042) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1043) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1044) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1045)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1046) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1047) case hwmon_power_input:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1048) return sfp_hwmon_read_rx_power(sfp, SFP_RX_POWER, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1049)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1050) case hwmon_power_lcrit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1051) *value = be16_to_cpu(sfp->diag.rxpwr_low_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1052) sfp_hwmon_to_rx_power(value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1053) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1054)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1055) case hwmon_power_min:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1056) *value = be16_to_cpu(sfp->diag.rxpwr_low_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1057) sfp_hwmon_to_rx_power(value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1058) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1059)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1060) case hwmon_power_max:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1061) *value = be16_to_cpu(sfp->diag.rxpwr_high_warn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1062) sfp_hwmon_to_rx_power(value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1063) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1064)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1065) case hwmon_power_crit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1066) *value = be16_to_cpu(sfp->diag.rxpwr_high_alarm);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1067) sfp_hwmon_to_rx_power(value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1068) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1069)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1070) case hwmon_power_lcrit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1071) err = sfp_read(sfp, true, SFP_ALARM1, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1072) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1073) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1074)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1075) *value = !!(status & SFP_ALARM1_RXPWR_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1076) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1077)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1078) case hwmon_power_min_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1079) err = sfp_read(sfp, true, SFP_WARN1, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1080) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1081) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1082)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1083) *value = !!(status & SFP_WARN1_RXPWR_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1084) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1085)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1086) case hwmon_power_max_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1087) err = sfp_read(sfp, true, SFP_WARN1, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1088) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1089) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1090)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1091) *value = !!(status & SFP_WARN1_RXPWR_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1092) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1093)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1094) case hwmon_power_crit_alarm:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1095) err = sfp_read(sfp, true, SFP_ALARM1, &status, sizeof(status));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1096) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1097) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1098)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1099) *value = !!(status & SFP_ALARM1_RXPWR_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1100) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1101) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1102) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1105) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1107)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1108) static int sfp_hwmon_read(struct device *dev, enum hwmon_sensor_types type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1109) u32 attr, int channel, long *value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1110) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1111) struct sfp *sfp = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1113) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1114) case hwmon_temp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1115) return sfp_hwmon_temp(sfp, attr, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1116) case hwmon_in:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1117) return sfp_hwmon_vcc(sfp, attr, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1118) case hwmon_curr:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1119) return sfp_hwmon_bias(sfp, attr, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1120) case hwmon_power:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1121) switch (channel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1122) case 0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1123) return sfp_hwmon_tx_power(sfp, attr, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1124) case 1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1125) return sfp_hwmon_rx_power(sfp, attr, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1126) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1127) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1129) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1130) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1131) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1132) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1134) static const char *const sfp_hwmon_power_labels[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1135) "TX_power",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1136) "RX_power",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1137) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1139) static int sfp_hwmon_read_string(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1140) enum hwmon_sensor_types type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1141) u32 attr, int channel, const char **str)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1142) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1143) switch (type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1144) case hwmon_curr:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1145) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1146) case hwmon_curr_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1147) *str = "bias";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1148) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1149) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1150) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1151) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1152) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1153) case hwmon_temp:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1154) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1155) case hwmon_temp_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1156) *str = "temperature";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1157) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1158) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1159) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1160) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1161) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1162) case hwmon_in:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1163) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1164) case hwmon_in_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1165) *str = "VCC";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1166) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1167) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1168) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1169) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1170) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1171) case hwmon_power:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1172) switch (attr) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1173) case hwmon_power_label:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1174) *str = sfp_hwmon_power_labels[channel];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1175) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1176) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1177) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1178) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1179) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1180) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1181) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1184) return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1187) static const struct hwmon_ops sfp_hwmon_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1188) .is_visible = sfp_hwmon_is_visible,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1189) .read = sfp_hwmon_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1190) .read_string = sfp_hwmon_read_string,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1191) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1193) static u32 sfp_hwmon_chip_config[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1194) HWMON_C_REGISTER_TZ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1195) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1196) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1198) static const struct hwmon_channel_info sfp_hwmon_chip = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1199) .type = hwmon_chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1200) .config = sfp_hwmon_chip_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1201) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1203) static u32 sfp_hwmon_temp_config[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1204) HWMON_T_INPUT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1205) HWMON_T_MAX | HWMON_T_MIN |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1206) HWMON_T_MAX_ALARM | HWMON_T_MIN_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1207) HWMON_T_CRIT | HWMON_T_LCRIT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1208) HWMON_T_CRIT_ALARM | HWMON_T_LCRIT_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1209) HWMON_T_LABEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1210) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1211) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1213) static const struct hwmon_channel_info sfp_hwmon_temp_channel_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1214) .type = hwmon_temp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1215) .config = sfp_hwmon_temp_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1216) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1217)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1218) static u32 sfp_hwmon_vcc_config[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1219) HWMON_I_INPUT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1220) HWMON_I_MAX | HWMON_I_MIN |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1221) HWMON_I_MAX_ALARM | HWMON_I_MIN_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1222) HWMON_I_CRIT | HWMON_I_LCRIT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1223) HWMON_I_CRIT_ALARM | HWMON_I_LCRIT_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1224) HWMON_I_LABEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1225) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1226) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1227)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1228) static const struct hwmon_channel_info sfp_hwmon_vcc_channel_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1229) .type = hwmon_in,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1230) .config = sfp_hwmon_vcc_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1231) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1233) static u32 sfp_hwmon_bias_config[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1234) HWMON_C_INPUT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1235) HWMON_C_MAX | HWMON_C_MIN |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1236) HWMON_C_MAX_ALARM | HWMON_C_MIN_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1237) HWMON_C_CRIT | HWMON_C_LCRIT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1238) HWMON_C_CRIT_ALARM | HWMON_C_LCRIT_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1239) HWMON_C_LABEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1240) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1241) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1242)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1243) static const struct hwmon_channel_info sfp_hwmon_bias_channel_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1244) .type = hwmon_curr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1245) .config = sfp_hwmon_bias_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1246) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1248) static u32 sfp_hwmon_power_config[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1249) /* Transmit power */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1250) HWMON_P_INPUT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1251) HWMON_P_MAX | HWMON_P_MIN |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1252) HWMON_P_MAX_ALARM | HWMON_P_MIN_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1253) HWMON_P_CRIT | HWMON_P_LCRIT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1254) HWMON_P_CRIT_ALARM | HWMON_P_LCRIT_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1255) HWMON_P_LABEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1256) /* Receive power */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1257) HWMON_P_INPUT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1258) HWMON_P_MAX | HWMON_P_MIN |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1259) HWMON_P_MAX_ALARM | HWMON_P_MIN_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1260) HWMON_P_CRIT | HWMON_P_LCRIT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1261) HWMON_P_CRIT_ALARM | HWMON_P_LCRIT_ALARM |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1262) HWMON_P_LABEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1263) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1264) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1265)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1266) static const struct hwmon_channel_info sfp_hwmon_power_channel_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1267) .type = hwmon_power,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1268) .config = sfp_hwmon_power_config,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1269) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1270)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1271) static const struct hwmon_channel_info *sfp_hwmon_info[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1272) &sfp_hwmon_chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1273) &sfp_hwmon_vcc_channel_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1274) &sfp_hwmon_temp_channel_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1275) &sfp_hwmon_bias_channel_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1276) &sfp_hwmon_power_channel_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1277) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1278) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1280) static const struct hwmon_chip_info sfp_hwmon_chip_info = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1281) .ops = &sfp_hwmon_ops,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1282) .info = sfp_hwmon_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1283) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1284)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1285) static void sfp_hwmon_probe(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1286) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1287) struct sfp *sfp = container_of(work, struct sfp, hwmon_probe.work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1288) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1290) /* hwmon interface needs to access 16bit registers in atomic way to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1291) * guarantee coherency of the diagnostic monitoring data. If it is not
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1292) * possible to guarantee coherency because EEPROM is broken in such way
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1293) * that does not support atomic 16bit read operation then we have to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1294) * skip registration of hwmon device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1295) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1296) if (sfp->i2c_block_size < 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1297) dev_info(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1298) "skipping hwmon device registration due to broken EEPROM\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1299) dev_info(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1300) "diagnostic EEPROM area cannot be read atomically to guarantee data coherency\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1301) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1302) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1304) err = sfp_read(sfp, true, 0, &sfp->diag, sizeof(sfp->diag));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1305) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1306) if (sfp->hwmon_tries--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1307) mod_delayed_work(system_wq, &sfp->hwmon_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1308) T_PROBE_RETRY_SLOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1309) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1310) dev_warn(sfp->dev, "hwmon probe failed: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1311) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1312) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1315) sfp->hwmon_name = kstrdup(dev_name(sfp->dev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1316) if (!sfp->hwmon_name) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1317) dev_err(sfp->dev, "out of memory for hwmon name\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1318) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1319) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1321) for (i = 0; sfp->hwmon_name[i]; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1322) if (hwmon_is_bad_char(sfp->hwmon_name[i]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1323) sfp->hwmon_name[i] = '_';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1325) sfp->hwmon_dev = hwmon_device_register_with_info(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1326) sfp->hwmon_name, sfp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1327) &sfp_hwmon_chip_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1328) NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1329) if (IS_ERR(sfp->hwmon_dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1330) dev_err(sfp->dev, "failed to register hwmon device: %ld\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1331) PTR_ERR(sfp->hwmon_dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1334) static int sfp_hwmon_insert(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1335) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1336) if (sfp->id.ext.sff8472_compliance == SFP_SFF8472_COMPLIANCE_NONE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1337) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1339) if (!(sfp->id.ext.diagmon & SFP_DIAGMON_DDM))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1340) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1341)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1342) if (sfp->id.ext.diagmon & SFP_DIAGMON_ADDRMODE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1343) /* This driver in general does not support address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1344) * change.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1345) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1346) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1348) mod_delayed_work(system_wq, &sfp->hwmon_probe, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1349) sfp->hwmon_tries = R_PROBE_RETRY_SLOW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1351) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1352) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1354) static void sfp_hwmon_remove(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1355) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1356) cancel_delayed_work_sync(&sfp->hwmon_probe);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1357) if (!IS_ERR_OR_NULL(sfp->hwmon_dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1358) hwmon_device_unregister(sfp->hwmon_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1359) sfp->hwmon_dev = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1360) kfree(sfp->hwmon_name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1361) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1362) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1364) static int sfp_hwmon_init(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1365) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1366) INIT_DELAYED_WORK(&sfp->hwmon_probe, sfp_hwmon_probe);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1368) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1369) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1370)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1371) static void sfp_hwmon_exit(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1372) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1373) cancel_delayed_work_sync(&sfp->hwmon_probe);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1374) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1375) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1376) static int sfp_hwmon_insert(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1377) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1378) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1379) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1381) static void sfp_hwmon_remove(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1382) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1385) static int sfp_hwmon_init(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1386) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1387) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1388) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1390) static void sfp_hwmon_exit(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1391) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1392) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1393) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1395) /* Helpers */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1396) static void sfp_module_tx_disable(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1397) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1398) dev_dbg(sfp->dev, "tx disable %u -> %u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1399) sfp->state & SFP_F_TX_DISABLE ? 1 : 0, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1400) sfp->state |= SFP_F_TX_DISABLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1401) sfp_set_state(sfp, sfp->state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1402) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1403)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1404) static void sfp_module_tx_enable(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1405) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1406) dev_dbg(sfp->dev, "tx disable %u -> %u\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1407) sfp->state & SFP_F_TX_DISABLE ? 1 : 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1408) sfp->state &= ~SFP_F_TX_DISABLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1409) sfp_set_state(sfp, sfp->state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1410) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1411)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1412) static void sfp_module_tx_fault_reset(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1413) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1414) unsigned int state = sfp->state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1415)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1416) if (state & SFP_F_TX_DISABLE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1417) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1419) sfp_set_state(sfp, state | SFP_F_TX_DISABLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1420)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1421) udelay(T_RESET_US);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1423) sfp_set_state(sfp, state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1424) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1426) /* SFP state machine */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1427) static void sfp_sm_set_timer(struct sfp *sfp, unsigned int timeout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1428) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1429) if (timeout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1430) mod_delayed_work(system_power_efficient_wq, &sfp->timeout,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1431) timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1432) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1433) cancel_delayed_work(&sfp->timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1434) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1436) static void sfp_sm_next(struct sfp *sfp, unsigned int state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1437) unsigned int timeout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1438) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1439) sfp->sm_state = state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1440) sfp_sm_set_timer(sfp, timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1441) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1443) static void sfp_sm_mod_next(struct sfp *sfp, unsigned int state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1444) unsigned int timeout)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1445) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1446) sfp->sm_mod_state = state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1447) sfp_sm_set_timer(sfp, timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1448) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1449)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1450) static void sfp_sm_phy_detach(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1451) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1452) sfp_remove_phy(sfp->sfp_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1453) phy_device_remove(sfp->mod_phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1454) phy_device_free(sfp->mod_phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1455) sfp->mod_phy = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1456) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1458) static int sfp_sm_probe_phy(struct sfp *sfp, bool is_c45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1459) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1460) struct phy_device *phy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1461) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1463) phy = get_phy_device(sfp->i2c_mii, SFP_PHY_ADDR, is_c45);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1464) if (phy == ERR_PTR(-ENODEV))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1465) return PTR_ERR(phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1466) if (IS_ERR(phy)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1467) dev_err(sfp->dev, "mdiobus scan returned %ld\n", PTR_ERR(phy));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1468) return PTR_ERR(phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1469) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1471) err = phy_device_register(phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1472) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1473) phy_device_free(phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1474) dev_err(sfp->dev, "phy_device_register failed: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1475) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1476) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1477)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1478) err = sfp_add_phy(sfp->sfp_bus, phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1479) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1480) phy_device_remove(phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1481) phy_device_free(phy);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1482) dev_err(sfp->dev, "sfp_add_phy failed: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1483) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1484) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1486) sfp->mod_phy = phy;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1488) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1489) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1490)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1491) static void sfp_sm_link_up(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1492) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1493) sfp_link_up(sfp->sfp_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1494) sfp_sm_next(sfp, SFP_S_LINK_UP, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1495) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1497) static void sfp_sm_link_down(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1498) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1499) sfp_link_down(sfp->sfp_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1500) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1501)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1502) static void sfp_sm_link_check_los(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1503) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1504) const __be16 los_inverted = cpu_to_be16(SFP_OPTIONS_LOS_INVERTED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1505) const __be16 los_normal = cpu_to_be16(SFP_OPTIONS_LOS_NORMAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1506) __be16 los_options = sfp->id.ext.options & (los_inverted | los_normal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1507) bool los = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1508)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1509) /* If neither SFP_OPTIONS_LOS_INVERTED nor SFP_OPTIONS_LOS_NORMAL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1510) * are set, we assume that no LOS signal is available. If both are
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1511) * set, we assume LOS is not implemented (and is meaningless.)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1512) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1513) if (los_options == los_inverted)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1514) los = !(sfp->state & SFP_F_LOS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1515) else if (los_options == los_normal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1516) los = !!(sfp->state & SFP_F_LOS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1517)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1518) if (los)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1519) sfp_sm_next(sfp, SFP_S_WAIT_LOS, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1520) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1521) sfp_sm_link_up(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1522) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1523)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1524) static bool sfp_los_event_active(struct sfp *sfp, unsigned int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1525) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1526) const __be16 los_inverted = cpu_to_be16(SFP_OPTIONS_LOS_INVERTED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1527) const __be16 los_normal = cpu_to_be16(SFP_OPTIONS_LOS_NORMAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1528) __be16 los_options = sfp->id.ext.options & (los_inverted | los_normal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1529)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1530) return (los_options == los_inverted && event == SFP_E_LOS_LOW) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1531) (los_options == los_normal && event == SFP_E_LOS_HIGH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1532) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1534) static bool sfp_los_event_inactive(struct sfp *sfp, unsigned int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1535) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1536) const __be16 los_inverted = cpu_to_be16(SFP_OPTIONS_LOS_INVERTED);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1537) const __be16 los_normal = cpu_to_be16(SFP_OPTIONS_LOS_NORMAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1538) __be16 los_options = sfp->id.ext.options & (los_inverted | los_normal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1539)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1540) return (los_options == los_inverted && event == SFP_E_LOS_HIGH) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1541) (los_options == los_normal && event == SFP_E_LOS_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1542) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1544) static void sfp_sm_fault(struct sfp *sfp, unsigned int next_state, bool warn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1545) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1546) if (sfp->sm_fault_retries && !--sfp->sm_fault_retries) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1547) dev_err(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1548) "module persistently indicates fault, disabling\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1549) sfp_sm_next(sfp, SFP_S_TX_DISABLE, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1550) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1551) if (warn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1552) dev_err(sfp->dev, "module transmit fault indicated\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1553)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1554) sfp_sm_next(sfp, next_state, T_FAULT_RECOVER);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1555) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1558) /* Probe a SFP for a PHY device if the module supports copper - the PHY
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1559) * normally sits at I2C bus address 0x56, and may either be a clause 22
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1560) * or clause 45 PHY.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1561) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1562) * Clause 22 copper SFP modules normally operate in Cisco SGMII mode with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1563) * negotiation enabled, but some may be in 1000base-X - which is for the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1564) * PHY driver to determine.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1565) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1566) * Clause 45 copper SFP+ modules (10G) appear to switch their interface
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1567) * mode according to the negotiated line speed.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1568) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1569) static int sfp_sm_probe_for_phy(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1570) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1571) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1572)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1573) switch (sfp->id.base.extended_cc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1574) case SFF8024_ECC_10GBASE_T_SFI:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1575) case SFF8024_ECC_10GBASE_T_SR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1576) case SFF8024_ECC_5GBASE_T:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1577) case SFF8024_ECC_2_5GBASE_T:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1578) err = sfp_sm_probe_phy(sfp, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1579) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1580)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1581) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1582) if (sfp->id.base.e1000_base_t)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1583) err = sfp_sm_probe_phy(sfp, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1584) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1585) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1586) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1587) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1588)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1589) static int sfp_module_parse_power(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1590) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1591) u32 power_mW = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1592) bool supports_a2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1593)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1594) if (sfp->id.ext.options & cpu_to_be16(SFP_OPTIONS_POWER_DECL))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1595) power_mW = 1500;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1596) if (sfp->id.ext.options & cpu_to_be16(SFP_OPTIONS_HIGH_POWER_LEVEL))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1597) power_mW = 2000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1599) supports_a2 = sfp->id.ext.sff8472_compliance !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1600) SFP_SFF8472_COMPLIANCE_NONE ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1601) sfp->id.ext.diagmon & SFP_DIAGMON_DDM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1603) if (power_mW > sfp->max_power_mW) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1604) /* Module power specification exceeds the allowed maximum. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1605) if (!supports_a2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1606) /* The module appears not to implement bus address
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1607) * 0xa2, so assume that the module powers up in the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1608) * indicated mode.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1609) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1610) dev_err(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1611) "Host does not support %u.%uW modules\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1612) power_mW / 1000, (power_mW / 100) % 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1613) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1614) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1615) dev_warn(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1616) "Host does not support %u.%uW modules, module left in power mode 1\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1617) power_mW / 1000, (power_mW / 100) % 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1618) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1619) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1620) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1622) if (power_mW <= 1000) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1623) /* Modules below 1W do not require a power change sequence */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1624) sfp->module_power_mW = power_mW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1625) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1626) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1627)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1628) if (!supports_a2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1629) /* The module power level is below the host maximum and the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1630) * module appears not to implement bus address 0xa2, so assume
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1631) * that the module powers up in the indicated mode.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1632) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1633) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1634) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1635)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1636) /* If the module requires a higher power mode, but also requires
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1637) * an address change sequence, warn the user that the module may
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1638) * not be functional.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1639) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1640) if (sfp->id.ext.diagmon & SFP_DIAGMON_ADDRMODE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1641) dev_warn(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1642) "Address Change Sequence not supported but module requires %u.%uW, module may not be functional\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1643) power_mW / 1000, (power_mW / 100) % 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1644) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1645) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1646)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1647) sfp->module_power_mW = power_mW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1648)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1649) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1650) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1651)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1652) static int sfp_sm_mod_hpower(struct sfp *sfp, bool enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1653) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1654) u8 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1655) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1656)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1657) err = sfp_read(sfp, true, SFP_EXT_STATUS, &val, sizeof(val));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1658) if (err != sizeof(val)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1659) dev_err(sfp->dev, "Failed to read EEPROM: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1660) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1661) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1662)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1663) /* DM7052 reports as a high power module, responds to reads (with
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1664) * all bytes 0xff) at 0x51 but does not accept writes. In any case,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1665) * if the bit is already set, we're already in high power mode.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1666) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1667) if (!!(val & BIT(0)) == enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1668) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1669)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1670) if (enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1671) val |= BIT(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1672) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1673) val &= ~BIT(0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1674)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1675) err = sfp_write(sfp, true, SFP_EXT_STATUS, &val, sizeof(val));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1676) if (err != sizeof(val)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1677) dev_err(sfp->dev, "Failed to write EEPROM: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1678) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1679) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1680)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1681) if (enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1682) dev_info(sfp->dev, "Module switched to %u.%uW power level\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1683) sfp->module_power_mW / 1000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1684) (sfp->module_power_mW / 100) % 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1685)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1686) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1687) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1688)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1689) /* GPON modules based on Realtek RTL8672 and RTL9601C chips (e.g. V-SOL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1690) * V2801F, CarlitoxxPro CPGOS03-0490, Ubiquiti U-Fiber Instant, ...) do
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1691) * not support multibyte reads from the EEPROM. Each multi-byte read
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1692) * operation returns just one byte of EEPROM followed by zeros. There is
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1693) * no way to identify which modules are using Realtek RTL8672 and RTL9601C
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1694) * chips. Moreover every OEM of V-SOL V2801F module puts its own vendor
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1695) * name and vendor id into EEPROM, so there is even no way to detect if
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1696) * module is V-SOL V2801F. Therefore check for those zeros in the read
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1697) * data and then based on check switch to reading EEPROM to one byte
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1698) * at a time.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1699) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1700) static bool sfp_id_needs_byte_io(struct sfp *sfp, void *buf, size_t len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1701) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1702) size_t i, block_size = sfp->i2c_block_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1703)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1704) /* Already using byte IO */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1705) if (block_size == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1706) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1707)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1708) for (i = 1; i < len; i += block_size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1709) if (memchr_inv(buf + i, '\0', min(block_size - 1, len - i)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1710) return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1711) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1712) return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1713) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1714)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1715) static int sfp_cotsworks_fixup_check(struct sfp *sfp, struct sfp_eeprom_id *id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1716) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1717) u8 check;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1718) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1719)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1720) if (id->base.phys_id != SFF8024_ID_SFF_8472 ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1721) id->base.phys_ext_id != SFP_PHYS_EXT_ID_SFP ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1722) id->base.connector != SFF8024_CONNECTOR_LC) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1723) dev_warn(sfp->dev, "Rewriting fiber module EEPROM with corrected values\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1724) id->base.phys_id = SFF8024_ID_SFF_8472;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1725) id->base.phys_ext_id = SFP_PHYS_EXT_ID_SFP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1726) id->base.connector = SFF8024_CONNECTOR_LC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1727) err = sfp_write(sfp, false, SFP_PHYS_ID, &id->base, 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1728) if (err != 3) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1729) dev_err(sfp->dev, "Failed to rewrite module EEPROM: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1730) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1731) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1732)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1733) /* Cotsworks modules have been found to require a delay between write operations. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1734) mdelay(50);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1735)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1736) /* Update base structure checksum */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1737) check = sfp_check(&id->base, sizeof(id->base) - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1738) err = sfp_write(sfp, false, SFP_CC_BASE, &check, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1739) if (err != 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1740) dev_err(sfp->dev, "Failed to update base structure checksum in fiber module EEPROM: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1741) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1742) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1743) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1744) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1745) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1746)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1747) static int sfp_sm_mod_probe(struct sfp *sfp, bool report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1748) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1749) /* SFP module inserted - read I2C data */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1750) struct sfp_eeprom_id id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1751) bool cotsworks_sfbg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1752) bool cotsworks;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1753) u8 check;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1754) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1755)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1756) /* Some SFP modules and also some Linux I2C drivers do not like reads
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1757) * longer than 16 bytes, so read the EEPROM in chunks of 16 bytes at
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1758) * a time.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1759) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1760) sfp->i2c_block_size = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1761)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1762) ret = sfp_read(sfp, false, 0, &id.base, sizeof(id.base));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1763) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1764) if (report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1765) dev_err(sfp->dev, "failed to read EEPROM: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1766) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1767) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1769) if (ret != sizeof(id.base)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1770) dev_err(sfp->dev, "EEPROM short read: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1771) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1772) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1773)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1774) /* Some SFP modules (e.g. Nokia 3FE46541AA) lock up if read from
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1775) * address 0x51 is just one byte at a time. Also SFF-8472 requires
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1776) * that EEPROM supports atomic 16bit read operation for diagnostic
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1777) * fields, so do not switch to one byte reading at a time unless it
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1778) * is really required and we have no other option.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1779) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1780) if (sfp_id_needs_byte_io(sfp, &id.base, sizeof(id.base))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1781) dev_info(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1782) "Detected broken RTL8672/RTL9601C emulated EEPROM\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1783) dev_info(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1784) "Switching to reading EEPROM to one byte at a time\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1785) sfp->i2c_block_size = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1786)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1787) ret = sfp_read(sfp, false, 0, &id.base, sizeof(id.base));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1788) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1789) if (report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1790) dev_err(sfp->dev, "failed to read EEPROM: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1791) ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1792) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1793) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1794)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1795) if (ret != sizeof(id.base)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1796) dev_err(sfp->dev, "EEPROM short read: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1797) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1798) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1799) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1800)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1801) /* Cotsworks do not seem to update the checksums when they
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1802) * do the final programming with the final module part number,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1803) * serial number and date code.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1804) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1805) cotsworks = !memcmp(id.base.vendor_name, "COTSWORKS ", 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1806) cotsworks_sfbg = !memcmp(id.base.vendor_pn, "SFBG", 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1807)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1808) /* Cotsworks SFF module EEPROM do not always have valid phys_id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1809) * phys_ext_id, and connector bytes. Rewrite SFF EEPROM bytes if
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1810) * Cotsworks PN matches and bytes are not correct.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1811) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1812) if (cotsworks && cotsworks_sfbg) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1813) ret = sfp_cotsworks_fixup_check(sfp, &id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1814) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1815) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1816) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1817)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1818) /* Validate the checksum over the base structure */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1819) check = sfp_check(&id.base, sizeof(id.base) - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1820) if (check != id.base.cc_base) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1821) if (cotsworks) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1822) dev_warn(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1823) "EEPROM base structure checksum failure (0x%02x != 0x%02x)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1824) check, id.base.cc_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1825) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1826) dev_err(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1827) "EEPROM base structure checksum failure: 0x%02x != 0x%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1828) check, id.base.cc_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1829) print_hex_dump(KERN_ERR, "sfp EE: ", DUMP_PREFIX_OFFSET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1830) 16, 1, &id, sizeof(id), true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1831) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1832) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1833) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1834)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1835) ret = sfp_read(sfp, false, SFP_CC_BASE + 1, &id.ext, sizeof(id.ext));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1836) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1837) if (report)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1838) dev_err(sfp->dev, "failed to read EEPROM: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1839) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1840) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1841)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1842) if (ret != sizeof(id.ext)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1843) dev_err(sfp->dev, "EEPROM short read: %d\n", ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1844) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1845) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1846)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1847) check = sfp_check(&id.ext, sizeof(id.ext) - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1848) if (check != id.ext.cc_ext) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1849) if (cotsworks) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1850) dev_warn(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1851) "EEPROM extended structure checksum failure (0x%02x != 0x%02x)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1852) check, id.ext.cc_ext);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1853) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1854) dev_err(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1855) "EEPROM extended structure checksum failure: 0x%02x != 0x%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1856) check, id.ext.cc_ext);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1857) print_hex_dump(KERN_ERR, "sfp EE: ", DUMP_PREFIX_OFFSET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1858) 16, 1, &id, sizeof(id), true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1859) memset(&id.ext, 0, sizeof(id.ext));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1860) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1861) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1862)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1863) sfp->id = id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1864)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1865) dev_info(sfp->dev, "module %.*s %.*s rev %.*s sn %.*s dc %.*s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1866) (int)sizeof(id.base.vendor_name), id.base.vendor_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1867) (int)sizeof(id.base.vendor_pn), id.base.vendor_pn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1868) (int)sizeof(id.base.vendor_rev), id.base.vendor_rev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1869) (int)sizeof(id.ext.vendor_sn), id.ext.vendor_sn,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1870) (int)sizeof(id.ext.datecode), id.ext.datecode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1871)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1872) /* Check whether we support this module */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1873) if (!sfp->type->module_supported(&id)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1874) dev_err(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1875) "module is not supported - phys id 0x%02x 0x%02x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1876) sfp->id.base.phys_id, sfp->id.base.phys_ext_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1877) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1878) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1879)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1880) /* If the module requires address swap mode, warn about it */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1881) if (sfp->id.ext.diagmon & SFP_DIAGMON_ADDRMODE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1882) dev_warn(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1883) "module address swap to access page 0xA2 is not supported.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1884)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1885) /* Parse the module power requirement */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1886) ret = sfp_module_parse_power(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1887) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1888) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1889)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1890) if (!memcmp(id.base.vendor_name, "ALCATELLUCENT ", 16) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1891) !memcmp(id.base.vendor_pn, "3FE46541AA ", 16))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1892) sfp->module_t_start_up = T_START_UP_BAD_GPON;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1893) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1894) sfp->module_t_start_up = T_START_UP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1895)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1896) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1897) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1898)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1899) static void sfp_sm_mod_remove(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1900) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1901) if (sfp->sm_mod_state > SFP_MOD_WAITDEV)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1902) sfp_module_remove(sfp->sfp_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1903)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1904) sfp_hwmon_remove(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1905)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1906) memset(&sfp->id, 0, sizeof(sfp->id));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1907) sfp->module_power_mW = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1908)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1909) dev_info(sfp->dev, "module removed\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1910) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1911)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1912) /* This state machine tracks the upstream's state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1913) static void sfp_sm_device(struct sfp *sfp, unsigned int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1914) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1915) switch (sfp->sm_dev_state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1916) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1917) if (event == SFP_E_DEV_ATTACH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1918) sfp->sm_dev_state = SFP_DEV_DOWN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1919) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1920)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1921) case SFP_DEV_DOWN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1922) if (event == SFP_E_DEV_DETACH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1923) sfp->sm_dev_state = SFP_DEV_DETACHED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1924) else if (event == SFP_E_DEV_UP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1925) sfp->sm_dev_state = SFP_DEV_UP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1926) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1927)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1928) case SFP_DEV_UP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1929) if (event == SFP_E_DEV_DETACH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1930) sfp->sm_dev_state = SFP_DEV_DETACHED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1931) else if (event == SFP_E_DEV_DOWN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1932) sfp->sm_dev_state = SFP_DEV_DOWN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1933) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1934) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1935) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1936)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1937) /* This state machine tracks the insert/remove state of the module, probes
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1938) * the on-board EEPROM, and sets up the power level.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1939) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1940) static void sfp_sm_module(struct sfp *sfp, unsigned int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1941) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1942) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1943)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1944) /* Handle remove event globally, it resets this state machine */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1945) if (event == SFP_E_REMOVE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1946) if (sfp->sm_mod_state > SFP_MOD_PROBE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1947) sfp_sm_mod_remove(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1948) sfp_sm_mod_next(sfp, SFP_MOD_EMPTY, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1949) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1950) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1951)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1952) /* Handle device detach globally */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1953) if (sfp->sm_dev_state < SFP_DEV_DOWN &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1954) sfp->sm_mod_state > SFP_MOD_WAITDEV) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1955) if (sfp->module_power_mW > 1000 &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1956) sfp->sm_mod_state > SFP_MOD_HPOWER)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1957) sfp_sm_mod_hpower(sfp, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1958) sfp_sm_mod_next(sfp, SFP_MOD_WAITDEV, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1959) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1960) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1961)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1962) switch (sfp->sm_mod_state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1963) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1964) if (event == SFP_E_INSERT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1965) sfp_sm_mod_next(sfp, SFP_MOD_PROBE, T_SERIAL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1966) sfp->sm_mod_tries_init = R_PROBE_RETRY_INIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1967) sfp->sm_mod_tries = R_PROBE_RETRY_SLOW;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1968) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1969) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1970)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1971) case SFP_MOD_PROBE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1972) /* Wait for T_PROBE_INIT to time out */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1973) if (event != SFP_E_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1974) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1975)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1976) err = sfp_sm_mod_probe(sfp, sfp->sm_mod_tries == 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1977) if (err == -EAGAIN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1978) if (sfp->sm_mod_tries_init &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1979) --sfp->sm_mod_tries_init) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1980) sfp_sm_set_timer(sfp, T_PROBE_RETRY_INIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1981) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1982) } else if (sfp->sm_mod_tries && --sfp->sm_mod_tries) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1983) if (sfp->sm_mod_tries == R_PROBE_RETRY_SLOW - 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1984) dev_warn(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1985) "please wait, module slow to respond\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1986) sfp_sm_set_timer(sfp, T_PROBE_RETRY_SLOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1987) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1988) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1989) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1990) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1991) sfp_sm_mod_next(sfp, SFP_MOD_ERROR, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1992) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1993) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1994)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1995) err = sfp_hwmon_insert(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1996) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1997) dev_warn(sfp->dev, "hwmon probe failed: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1998)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1999) sfp_sm_mod_next(sfp, SFP_MOD_WAITDEV, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2000) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2001) case SFP_MOD_WAITDEV:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2002) /* Ensure that the device is attached before proceeding */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2003) if (sfp->sm_dev_state < SFP_DEV_DOWN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2004) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2005)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2006) /* Report the module insertion to the upstream device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2007) err = sfp_module_insert(sfp->sfp_bus, &sfp->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2008) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2009) sfp_sm_mod_next(sfp, SFP_MOD_ERROR, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2010) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2011) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2012)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2013) /* If this is a power level 1 module, we are done */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2014) if (sfp->module_power_mW <= 1000)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2015) goto insert;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2016)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2017) sfp_sm_mod_next(sfp, SFP_MOD_HPOWER, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2018) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2019) case SFP_MOD_HPOWER:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2020) /* Enable high power mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2021) err = sfp_sm_mod_hpower(sfp, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2022) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2023) if (err != -EAGAIN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2024) sfp_module_remove(sfp->sfp_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2025) sfp_sm_mod_next(sfp, SFP_MOD_ERROR, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2026) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2027) sfp_sm_set_timer(sfp, T_PROBE_RETRY_INIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2028) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2029) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2030) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2031)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2032) sfp_sm_mod_next(sfp, SFP_MOD_WAITPWR, T_HPOWER_LEVEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2033) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2034)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2035) case SFP_MOD_WAITPWR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2036) /* Wait for T_HPOWER_LEVEL to time out */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2037) if (event != SFP_E_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2038) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2039)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2040) insert:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2041) sfp_sm_mod_next(sfp, SFP_MOD_PRESENT, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2042) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2043)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2044) case SFP_MOD_PRESENT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2045) case SFP_MOD_ERROR:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2046) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2047) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2048) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2049)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2050) static void sfp_sm_main(struct sfp *sfp, unsigned int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2051) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2052) unsigned long timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2053) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2054)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2055) /* Some events are global */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2056) if (sfp->sm_state != SFP_S_DOWN &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2057) (sfp->sm_mod_state != SFP_MOD_PRESENT ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2058) sfp->sm_dev_state != SFP_DEV_UP)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2059) if (sfp->sm_state == SFP_S_LINK_UP &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2060) sfp->sm_dev_state == SFP_DEV_UP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2061) sfp_sm_link_down(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2062) if (sfp->sm_state > SFP_S_INIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2063) sfp_module_stop(sfp->sfp_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2064) if (sfp->mod_phy)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2065) sfp_sm_phy_detach(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2066) sfp_module_tx_disable(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2067) sfp_soft_stop_poll(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2068) sfp_sm_next(sfp, SFP_S_DOWN, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2069) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2070) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2071)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2072) /* The main state machine */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2073) switch (sfp->sm_state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2074) case SFP_S_DOWN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2075) if (sfp->sm_mod_state != SFP_MOD_PRESENT ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2076) sfp->sm_dev_state != SFP_DEV_UP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2077) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2078)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2079) if (!(sfp->id.ext.diagmon & SFP_DIAGMON_ADDRMODE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2080) sfp_soft_start_poll(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2081)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2082) sfp_module_tx_enable(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2083)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2084) /* Initialise the fault clearance retries */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2085) sfp->sm_fault_retries = N_FAULT_INIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2086)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2087) /* We need to check the TX_FAULT state, which is not defined
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2088) * while TX_DISABLE is asserted. The earliest we want to do
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2089) * anything (such as probe for a PHY) is 50ms.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2090) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2091) sfp_sm_next(sfp, SFP_S_WAIT, T_WAIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2092) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2093)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2094) case SFP_S_WAIT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2095) if (event != SFP_E_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2096) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2097)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2098) if (sfp->state & SFP_F_TX_FAULT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2099) /* Wait up to t_init (SFF-8472) or t_start_up (SFF-8431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2100) * from the TX_DISABLE deassertion for the module to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2101) * initialise, which is indicated by TX_FAULT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2102) * deasserting.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2103) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2104) timeout = sfp->module_t_start_up;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2105) if (timeout > T_WAIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2106) timeout -= T_WAIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2107) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2108) timeout = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2110) sfp_sm_next(sfp, SFP_S_INIT, timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2111) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2112) /* TX_FAULT is not asserted, assume the module has
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2113) * finished initialising.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2114) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2115) goto init_done;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2116) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2117) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2118)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2119) case SFP_S_INIT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2120) if (event == SFP_E_TIMEOUT && sfp->state & SFP_F_TX_FAULT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2121) /* TX_FAULT is still asserted after t_init or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2122) * or t_start_up, so assume there is a fault.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2123) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2124) sfp_sm_fault(sfp, SFP_S_INIT_TX_FAULT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2125) sfp->sm_fault_retries == N_FAULT_INIT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2126) } else if (event == SFP_E_TIMEOUT || event == SFP_E_TX_CLEAR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2127) init_done:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2128) sfp->sm_phy_retries = R_PHY_RETRY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2129) goto phy_probe;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2131) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2133) case SFP_S_INIT_PHY:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2134) if (event != SFP_E_TIMEOUT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2135) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2136) phy_probe:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2137) /* TX_FAULT deasserted or we timed out with TX_FAULT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2138) * clear. Probe for the PHY and check the LOS state.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2139) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2140) ret = sfp_sm_probe_for_phy(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2141) if (ret == -ENODEV) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2142) if (--sfp->sm_phy_retries) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2143) sfp_sm_next(sfp, SFP_S_INIT_PHY, T_PHY_RETRY);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2144) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2145) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2146) dev_info(sfp->dev, "no PHY detected\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2147) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2148) } else if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2149) sfp_sm_next(sfp, SFP_S_FAIL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2150) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2151) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2152) if (sfp_module_start(sfp->sfp_bus)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2153) sfp_sm_next(sfp, SFP_S_FAIL, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2154) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2155) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2156) sfp_sm_link_check_los(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2158) /* Reset the fault retry count */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2159) sfp->sm_fault_retries = N_FAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2160) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2161)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2162) case SFP_S_INIT_TX_FAULT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2163) if (event == SFP_E_TIMEOUT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2164) sfp_module_tx_fault_reset(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2165) sfp_sm_next(sfp, SFP_S_INIT, sfp->module_t_start_up);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2166) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2167) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2169) case SFP_S_WAIT_LOS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2170) if (event == SFP_E_TX_FAULT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2171) sfp_sm_fault(sfp, SFP_S_TX_FAULT, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2172) else if (sfp_los_event_inactive(sfp, event))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2173) sfp_sm_link_up(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2174) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2176) case SFP_S_LINK_UP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2177) if (event == SFP_E_TX_FAULT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2178) sfp_sm_link_down(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2179) sfp_sm_fault(sfp, SFP_S_TX_FAULT, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2180) } else if (sfp_los_event_active(sfp, event)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2181) sfp_sm_link_down(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2182) sfp_sm_next(sfp, SFP_S_WAIT_LOS, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2183) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2184) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2185)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2186) case SFP_S_TX_FAULT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2187) if (event == SFP_E_TIMEOUT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2188) sfp_module_tx_fault_reset(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2189) sfp_sm_next(sfp, SFP_S_REINIT, sfp->module_t_start_up);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2190) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2191) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2193) case SFP_S_REINIT:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2194) if (event == SFP_E_TIMEOUT && sfp->state & SFP_F_TX_FAULT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2195) sfp_sm_fault(sfp, SFP_S_TX_FAULT, false);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2196) } else if (event == SFP_E_TIMEOUT || event == SFP_E_TX_CLEAR) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2197) dev_info(sfp->dev, "module transmit fault recovered\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2198) sfp_sm_link_check_los(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2199) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2200) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2202) case SFP_S_TX_DISABLE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2203) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2204) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2205) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2207) static void sfp_sm_event(struct sfp *sfp, unsigned int event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2208) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2209) mutex_lock(&sfp->sm_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2211) dev_dbg(sfp->dev, "SM: enter %s:%s:%s event %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2212) mod_state_to_str(sfp->sm_mod_state),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2213) dev_state_to_str(sfp->sm_dev_state),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2214) sm_state_to_str(sfp->sm_state),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2215) event_to_str(event));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2217) sfp_sm_device(sfp, event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2218) sfp_sm_module(sfp, event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2219) sfp_sm_main(sfp, event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2221) dev_dbg(sfp->dev, "SM: exit %s:%s:%s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2222) mod_state_to_str(sfp->sm_mod_state),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2223) dev_state_to_str(sfp->sm_dev_state),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2224) sm_state_to_str(sfp->sm_state));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2225)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2226) mutex_unlock(&sfp->sm_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2228)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2229) static void sfp_attach(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2230) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2231) sfp_sm_event(sfp, SFP_E_DEV_ATTACH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2232) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2234) static void sfp_detach(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2235) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2236) sfp_sm_event(sfp, SFP_E_DEV_DETACH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2237) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2239) static void sfp_start(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2240) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2241) sfp_sm_event(sfp, SFP_E_DEV_UP);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2242) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2244) static void sfp_stop(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2245) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2246) sfp_sm_event(sfp, SFP_E_DEV_DOWN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2247) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2248)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2249) static int sfp_module_info(struct sfp *sfp, struct ethtool_modinfo *modinfo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2250) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2251) /* locking... and check module is present */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2252)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2253) if (sfp->id.ext.sff8472_compliance &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2254) !(sfp->id.ext.diagmon & SFP_DIAGMON_ADDRMODE)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2255) modinfo->type = ETH_MODULE_SFF_8472;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2256) modinfo->eeprom_len = ETH_MODULE_SFF_8472_LEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2257) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2258) modinfo->type = ETH_MODULE_SFF_8079;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2259) modinfo->eeprom_len = ETH_MODULE_SFF_8079_LEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2261) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2262) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2264) static int sfp_module_eeprom(struct sfp *sfp, struct ethtool_eeprom *ee,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2265) u8 *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2266) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2267) unsigned int first, last, len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2268) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2269)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2270) if (ee->len == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2271) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2272)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2273) first = ee->offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2274) last = ee->offset + ee->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2275) if (first < ETH_MODULE_SFF_8079_LEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2276) len = min_t(unsigned int, last, ETH_MODULE_SFF_8079_LEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2277) len -= first;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2278)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2279) ret = sfp_read(sfp, false, first, data, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2280) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2281) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2282)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2283) first += len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2284) data += len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2285) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2286) if (first < ETH_MODULE_SFF_8472_LEN && last > ETH_MODULE_SFF_8079_LEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2287) len = min_t(unsigned int, last, ETH_MODULE_SFF_8472_LEN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2288) len -= first;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2289) first -= ETH_MODULE_SFF_8079_LEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2290)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2291) ret = sfp_read(sfp, true, first, data, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2292) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2293) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2294) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2295) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2296) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2298) static const struct sfp_socket_ops sfp_module_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2299) .attach = sfp_attach,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2300) .detach = sfp_detach,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2301) .start = sfp_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2302) .stop = sfp_stop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2303) .module_info = sfp_module_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2304) .module_eeprom = sfp_module_eeprom,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2305) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2306)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2307) static void sfp_timeout(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2308) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2309) struct sfp *sfp = container_of(work, struct sfp, timeout.work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2311) rtnl_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2312) sfp_sm_event(sfp, SFP_E_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2313) rtnl_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2314) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2316) static void sfp_check_state(struct sfp *sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2317) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2318) unsigned int state, i, changed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2319)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2320) mutex_lock(&sfp->st_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2321) state = sfp_get_state(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2322) changed = state ^ sfp->state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2323) changed &= SFP_F_PRESENT | SFP_F_LOS | SFP_F_TX_FAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2325) for (i = 0; i < GPIO_MAX; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2326) if (changed & BIT(i))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2327) dev_dbg(sfp->dev, "%s %u -> %u\n", gpio_of_names[i],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2328) !!(sfp->state & BIT(i)), !!(state & BIT(i)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2330) state |= sfp->state & (SFP_F_TX_DISABLE | SFP_F_RATE_SELECT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2331) sfp->state = state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2332)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2333) rtnl_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2334) if (changed & SFP_F_PRESENT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2335) sfp_sm_event(sfp, state & SFP_F_PRESENT ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2336) SFP_E_INSERT : SFP_E_REMOVE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2338) if (changed & SFP_F_TX_FAULT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2339) sfp_sm_event(sfp, state & SFP_F_TX_FAULT ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2340) SFP_E_TX_FAULT : SFP_E_TX_CLEAR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2341)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2342) if (changed & SFP_F_LOS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2343) sfp_sm_event(sfp, state & SFP_F_LOS ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2344) SFP_E_LOS_HIGH : SFP_E_LOS_LOW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2345) rtnl_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2346) mutex_unlock(&sfp->st_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2349) static irqreturn_t sfp_irq(int irq, void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2350) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2351) struct sfp *sfp = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2353) sfp_check_state(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2355) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2356) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2358) static void sfp_poll(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2359) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2360) struct sfp *sfp = container_of(work, struct sfp, poll.work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2362) sfp_check_state(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2364) if (sfp->state_soft_mask & (SFP_F_LOS | SFP_F_TX_FAULT) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2365) sfp->need_poll)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2366) mod_delayed_work(system_wq, &sfp->poll, poll_jiffies);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2369) static struct sfp *sfp_alloc(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2370) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2371) struct sfp *sfp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2373) sfp = kzalloc(sizeof(*sfp), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2374) if (!sfp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2375) return ERR_PTR(-ENOMEM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2376)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2377) sfp->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2379) mutex_init(&sfp->sm_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2380) mutex_init(&sfp->st_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2381) INIT_DELAYED_WORK(&sfp->poll, sfp_poll);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2382) INIT_DELAYED_WORK(&sfp->timeout, sfp_timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2383)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2384) sfp_hwmon_init(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2386) return sfp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2387) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2388)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2389) static void sfp_cleanup(void *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2390) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2391) struct sfp *sfp = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2393) sfp_hwmon_exit(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2395) cancel_delayed_work_sync(&sfp->poll);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2396) cancel_delayed_work_sync(&sfp->timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2397) if (sfp->i2c_mii) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2398) mdiobus_unregister(sfp->i2c_mii);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2399) mdiobus_free(sfp->i2c_mii);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2400) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2401) if (sfp->i2c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2402) i2c_put_adapter(sfp->i2c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2403) kfree(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2404) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2405)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2406) static int sfp_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2407) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2408) const struct sff_data *sff;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2409) struct i2c_adapter *i2c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2410) char *sfp_irq_name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2411) struct sfp *sfp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2412) int err, i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2414) sfp = sfp_alloc(&pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2415) if (IS_ERR(sfp))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2416) return PTR_ERR(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2418) platform_set_drvdata(pdev, sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2420) err = devm_add_action(sfp->dev, sfp_cleanup, sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2421) if (err < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2422) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2423)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2424) sff = sfp->type = &sfp_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2426) if (pdev->dev.of_node) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2427) struct device_node *node = pdev->dev.of_node;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2428) const struct of_device_id *id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2429) struct device_node *np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2431) id = of_match_node(sfp_of_match, node);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2432) if (WARN_ON(!id))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2433) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2435) sff = sfp->type = id->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2437) np = of_parse_phandle(node, "i2c-bus", 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2438) if (!np) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2439) dev_err(sfp->dev, "missing 'i2c-bus' property\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2440) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2441) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2442)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2443) i2c = of_find_i2c_adapter_by_node(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2444) of_node_put(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2445) } else if (has_acpi_companion(&pdev->dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2446) struct acpi_device *adev = ACPI_COMPANION(&pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2447) struct fwnode_handle *fw = acpi_fwnode_handle(adev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2448) struct fwnode_reference_args args;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2449) struct acpi_handle *acpi_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2450) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2451)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2452) ret = acpi_node_get_property_reference(fw, "i2c-bus", 0, &args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2453) if (ret || !is_acpi_device_node(args.fwnode)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2454) dev_err(&pdev->dev, "missing 'i2c-bus' property\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2455) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2456) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2458) acpi_handle = ACPI_HANDLE_FWNODE(args.fwnode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2459) i2c = i2c_acpi_find_adapter_by_handle(acpi_handle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2460) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2461) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2462) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2464) if (!i2c)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2465) return -EPROBE_DEFER;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2467) err = sfp_i2c_configure(sfp, i2c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2468) if (err < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2469) i2c_put_adapter(i2c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2470) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2471) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2472)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2473) for (i = 0; i < GPIO_MAX; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2474) if (sff->gpios & BIT(i)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2475) sfp->gpio[i] = devm_gpiod_get_optional(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2476) gpio_of_names[i], gpio_flags[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2477) if (IS_ERR(sfp->gpio[i]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2478) return PTR_ERR(sfp->gpio[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2479) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2480)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2481) sfp->get_state = sfp_gpio_get_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2482) sfp->set_state = sfp_gpio_set_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2483)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2484) /* Modules that have no detect signal are always present */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2485) if (!(sfp->gpio[GPIO_MODDEF0]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2486) sfp->get_state = sff_gpio_get_state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2487)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2488) device_property_read_u32(&pdev->dev, "maximum-power-milliwatt",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2489) &sfp->max_power_mW);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2490) if (!sfp->max_power_mW)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2491) sfp->max_power_mW = 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2492)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2493) dev_info(sfp->dev, "Host maximum power %u.%uW\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2494) sfp->max_power_mW / 1000, (sfp->max_power_mW / 100) % 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2495)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2496) /* Get the initial state, and always signal TX disable,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2497) * since the network interface will not be up.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2498) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2499) sfp->state = sfp_get_state(sfp) | SFP_F_TX_DISABLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2500)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2501) if (sfp->gpio[GPIO_RATE_SELECT] &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2502) gpiod_get_value_cansleep(sfp->gpio[GPIO_RATE_SELECT]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2503) sfp->state |= SFP_F_RATE_SELECT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2504) sfp_set_state(sfp, sfp->state);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2505) sfp_module_tx_disable(sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2506) if (sfp->state & SFP_F_PRESENT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2507) rtnl_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2508) sfp_sm_event(sfp, SFP_E_INSERT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2509) rtnl_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2510) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2511)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2512) for (i = 0; i < GPIO_MAX; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2513) if (gpio_flags[i] != GPIOD_IN || !sfp->gpio[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2514) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2516) sfp->gpio_irq[i] = gpiod_to_irq(sfp->gpio[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2517) if (sfp->gpio_irq[i] < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2518) sfp->gpio_irq[i] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2519) sfp->need_poll = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2520) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2521) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2522)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2523) sfp_irq_name = devm_kasprintf(sfp->dev, GFP_KERNEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2524) "%s-%s", dev_name(sfp->dev),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2525) gpio_of_names[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2526)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2527) if (!sfp_irq_name)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2528) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2529)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2530) err = devm_request_threaded_irq(sfp->dev, sfp->gpio_irq[i],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2531) NULL, sfp_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2532) IRQF_ONESHOT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2533) IRQF_TRIGGER_RISING |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2534) IRQF_TRIGGER_FALLING,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2535) sfp_irq_name, sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2536) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2537) sfp->gpio_irq[i] = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2538) sfp->need_poll = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2539) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2540) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2541)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2542) if (sfp->need_poll)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2543) mod_delayed_work(system_wq, &sfp->poll, poll_jiffies);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2544)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2545) /* We could have an issue in cases no Tx disable pin is available or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2546) * wired as modules using a laser as their light source will continue to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2547) * be active when the fiber is removed. This could be a safety issue and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2548) * we should at least warn the user about that.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2549) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2550) if (!sfp->gpio[GPIO_TX_DISABLE])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2551) dev_warn(sfp->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2552) "No tx_disable pin: SFP modules will always be emitting.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2553)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2554) sfp->sfp_bus = sfp_register_socket(sfp->dev, sfp, &sfp_module_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2555) if (!sfp->sfp_bus)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2556) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2558) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2559) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2560)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2561) static int sfp_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2562) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2563) struct sfp *sfp = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2564)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2565) sfp_unregister_socket(sfp->sfp_bus);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2566)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2567) rtnl_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2568) sfp_sm_event(sfp, SFP_E_REMOVE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2569) rtnl_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2570)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2571) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2572) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2573)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2574) static void sfp_shutdown(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2575) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2576) struct sfp *sfp = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2577) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2578)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2579) for (i = 0; i < GPIO_MAX; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2580) if (!sfp->gpio_irq[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2581) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2582)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2583) devm_free_irq(sfp->dev, sfp->gpio_irq[i], sfp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2584) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2585)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2586) cancel_delayed_work_sync(&sfp->poll);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2587) cancel_delayed_work_sync(&sfp->timeout);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2588) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2589)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2590) static struct platform_driver sfp_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2591) .probe = sfp_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2592) .remove = sfp_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2593) .shutdown = sfp_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2594) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2595) .name = "sfp",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2596) .of_match_table = sfp_of_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2597) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2598) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2599)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2600) static int sfp_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2601) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2602) poll_jiffies = msecs_to_jiffies(100);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2603)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2604) return platform_driver_register(&sfp_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2605) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2606) module_init(sfp_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2608) static void sfp_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2609) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2610) platform_driver_unregister(&sfp_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2611) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2612) module_exit(sfp_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2613)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2614) MODULE_ALIAS("platform:sfp");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2615) MODULE_AUTHOR("Russell King");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2616) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags