1a7e1abadSJonathan Lemon // SPDX-License-Identifier: GPL-2.0-only 2a7e1abadSJonathan Lemon /* Copyright (c) 2020 Facebook */ 3a7e1abadSJonathan Lemon 4a7e1abadSJonathan Lemon #include <linux/err.h> 5a7e1abadSJonathan Lemon #include <linux/kernel.h> 6a7e1abadSJonathan Lemon #include <linux/module.h> 7a7e1abadSJonathan Lemon #include <linux/init.h> 8a7e1abadSJonathan Lemon #include <linux/pci.h> 9773bda96SJonathan Lemon #include <linux/serial_8250.h> 10773bda96SJonathan Lemon #include <linux/clkdev.h> 11773bda96SJonathan Lemon #include <linux/clk-provider.h> 12773bda96SJonathan Lemon #include <linux/platform_device.h> 13a7e1abadSJonathan Lemon #include <linux/ptp_clock_kernel.h> 14773bda96SJonathan Lemon #include <linux/spi/spi.h> 15773bda96SJonathan Lemon #include <linux/spi/xilinx_spi.h> 16773bda96SJonathan Lemon #include <net/devlink.h> 17773bda96SJonathan Lemon #include <linux/i2c.h> 18773bda96SJonathan Lemon #include <linux/mtd/mtd.h> 19a7e1abadSJonathan Lemon 20773bda96SJonathan Lemon #ifndef PCI_VENDOR_ID_FACEBOOK 21773bda96SJonathan Lemon #define PCI_VENDOR_ID_FACEBOOK 0x1d9b 22773bda96SJonathan Lemon #endif 23773bda96SJonathan Lemon 24773bda96SJonathan Lemon #ifndef PCI_DEVICE_ID_FACEBOOK_TIMECARD 25773bda96SJonathan Lemon #define PCI_DEVICE_ID_FACEBOOK_TIMECARD 0x0400 26773bda96SJonathan Lemon #endif 27773bda96SJonathan Lemon 28773bda96SJonathan Lemon static struct class timecard_class = { 29773bda96SJonathan Lemon .owner = THIS_MODULE, 30773bda96SJonathan Lemon .name = "timecard", 31a7e1abadSJonathan Lemon }; 32a7e1abadSJonathan Lemon 33a7e1abadSJonathan Lemon struct ocp_reg { 34a7e1abadSJonathan Lemon u32 ctrl; 35a7e1abadSJonathan Lemon u32 status; 36a7e1abadSJonathan Lemon u32 select; 37a7e1abadSJonathan Lemon u32 version; 38a7e1abadSJonathan Lemon u32 time_ns; 39a7e1abadSJonathan Lemon u32 time_sec; 40a7e1abadSJonathan Lemon u32 __pad0[2]; 41a7e1abadSJonathan Lemon u32 adjust_ns; 42a7e1abadSJonathan Lemon u32 adjust_sec; 43a7e1abadSJonathan Lemon u32 __pad1[2]; 44a7e1abadSJonathan Lemon u32 offset_ns; 45a7e1abadSJonathan Lemon u32 offset_window_ns; 46773bda96SJonathan Lemon u32 __pad2[2]; 47773bda96SJonathan Lemon u32 drift_ns; 48773bda96SJonathan Lemon u32 drift_window_ns; 49773bda96SJonathan Lemon u32 __pad3[6]; 50773bda96SJonathan Lemon u32 servo_offset_p; 51773bda96SJonathan Lemon u32 servo_offset_i; 52773bda96SJonathan Lemon u32 servo_drift_p; 53773bda96SJonathan Lemon u32 servo_drift_i; 54a7e1abadSJonathan Lemon }; 55a7e1abadSJonathan Lemon 56a7e1abadSJonathan Lemon #define OCP_CTRL_ENABLE BIT(0) 57a7e1abadSJonathan Lemon #define OCP_CTRL_ADJUST_TIME BIT(1) 58a7e1abadSJonathan Lemon #define OCP_CTRL_ADJUST_OFFSET BIT(2) 59773bda96SJonathan Lemon #define OCP_CTRL_ADJUST_DRIFT BIT(3) 60773bda96SJonathan Lemon #define OCP_CTRL_ADJUST_SERVO BIT(8) 61a7e1abadSJonathan Lemon #define OCP_CTRL_READ_TIME_REQ BIT(30) 62a7e1abadSJonathan Lemon #define OCP_CTRL_READ_TIME_DONE BIT(31) 63a7e1abadSJonathan Lemon 64a7e1abadSJonathan Lemon #define OCP_STATUS_IN_SYNC BIT(0) 65773bda96SJonathan Lemon #define OCP_STATUS_IN_HOLDOVER BIT(1) 66a7e1abadSJonathan Lemon 67a7e1abadSJonathan Lemon #define OCP_SELECT_CLK_NONE 0 68773bda96SJonathan Lemon #define OCP_SELECT_CLK_REG 0xfe 69a7e1abadSJonathan Lemon 70a7e1abadSJonathan Lemon struct tod_reg { 71a7e1abadSJonathan Lemon u32 ctrl; 72a7e1abadSJonathan Lemon u32 status; 73a7e1abadSJonathan Lemon u32 uart_polarity; 74a7e1abadSJonathan Lemon u32 version; 75a7e1abadSJonathan Lemon u32 correction_sec; 76a7e1abadSJonathan Lemon u32 __pad0[3]; 77a7e1abadSJonathan Lemon u32 uart_baud; 78a7e1abadSJonathan Lemon u32 __pad1[3]; 79a7e1abadSJonathan Lemon u32 utc_status; 80a7e1abadSJonathan Lemon u32 leap; 81a7e1abadSJonathan Lemon }; 82a7e1abadSJonathan Lemon 83a7e1abadSJonathan Lemon #define TOD_CTRL_PROTOCOL BIT(28) 84a7e1abadSJonathan Lemon #define TOD_CTRL_DISABLE_FMT_A BIT(17) 85a7e1abadSJonathan Lemon #define TOD_CTRL_DISABLE_FMT_B BIT(16) 86a7e1abadSJonathan Lemon #define TOD_CTRL_ENABLE BIT(0) 87a7e1abadSJonathan Lemon #define TOD_CTRL_GNSS_MASK ((1U << 4) - 1) 88a7e1abadSJonathan Lemon #define TOD_CTRL_GNSS_SHIFT 24 89a7e1abadSJonathan Lemon 90a7e1abadSJonathan Lemon #define TOD_STATUS_UTC_MASK 0xff 91a7e1abadSJonathan Lemon #define TOD_STATUS_UTC_VALID BIT(8) 92a7e1abadSJonathan Lemon #define TOD_STATUS_LEAP_VALID BIT(16) 93a7e1abadSJonathan Lemon 94773bda96SJonathan Lemon struct ts_reg { 95773bda96SJonathan Lemon u32 enable; 96773bda96SJonathan Lemon u32 error; 97773bda96SJonathan Lemon u32 polarity; 98773bda96SJonathan Lemon u32 version; 99773bda96SJonathan Lemon u32 __pad0[4]; 100773bda96SJonathan Lemon u32 cable_delay; 101773bda96SJonathan Lemon u32 __pad1[3]; 102773bda96SJonathan Lemon u32 intr; 103773bda96SJonathan Lemon u32 intr_mask; 104773bda96SJonathan Lemon u32 event_count; 105773bda96SJonathan Lemon u32 __pad2[1]; 106773bda96SJonathan Lemon u32 ts_count; 107773bda96SJonathan Lemon u32 time_ns; 108773bda96SJonathan Lemon u32 time_sec; 109773bda96SJonathan Lemon u32 data_width; 110773bda96SJonathan Lemon u32 data; 111773bda96SJonathan Lemon }; 112773bda96SJonathan Lemon 113773bda96SJonathan Lemon struct pps_reg { 114773bda96SJonathan Lemon u32 ctrl; 115773bda96SJonathan Lemon u32 status; 1160d43d4f2SJonathan Lemon u32 __pad0[6]; 1170d43d4f2SJonathan Lemon u32 cable_delay; 118773bda96SJonathan Lemon }; 119773bda96SJonathan Lemon 120773bda96SJonathan Lemon #define PPS_STATUS_FILTER_ERR BIT(0) 121773bda96SJonathan Lemon #define PPS_STATUS_SUPERV_ERR BIT(1) 122773bda96SJonathan Lemon 123773bda96SJonathan Lemon struct img_reg { 124773bda96SJonathan Lemon u32 version; 125773bda96SJonathan Lemon }; 126773bda96SJonathan Lemon 127773bda96SJonathan Lemon struct ptp_ocp_flash_info { 128773bda96SJonathan Lemon const char *name; 129773bda96SJonathan Lemon int pci_offset; 130773bda96SJonathan Lemon int data_size; 131773bda96SJonathan Lemon void *data; 132773bda96SJonathan Lemon }; 133773bda96SJonathan Lemon 1341618df6aSJonathan Lemon struct ptp_ocp_i2c_info { 1351618df6aSJonathan Lemon const char *name; 1361618df6aSJonathan Lemon unsigned long fixed_rate; 1371618df6aSJonathan Lemon size_t data_size; 1381618df6aSJonathan Lemon void *data; 1391618df6aSJonathan Lemon }; 1401618df6aSJonathan Lemon 141773bda96SJonathan Lemon struct ptp_ocp_ext_info { 142773bda96SJonathan Lemon const char *name; 143773bda96SJonathan Lemon int index; 144773bda96SJonathan Lemon irqreturn_t (*irq_fcn)(int irq, void *priv); 145773bda96SJonathan Lemon int (*enable)(void *priv, bool enable); 146773bda96SJonathan Lemon }; 147773bda96SJonathan Lemon 148773bda96SJonathan Lemon struct ptp_ocp_ext_src { 149773bda96SJonathan Lemon void __iomem *mem; 150773bda96SJonathan Lemon struct ptp_ocp *bp; 151773bda96SJonathan Lemon struct ptp_ocp_ext_info *info; 152773bda96SJonathan Lemon int irq_vec; 153773bda96SJonathan Lemon }; 154773bda96SJonathan Lemon 155a7e1abadSJonathan Lemon struct ptp_ocp { 156a7e1abadSJonathan Lemon struct pci_dev *pdev; 157773bda96SJonathan Lemon struct device dev; 158a7e1abadSJonathan Lemon spinlock_t lock; 159a7e1abadSJonathan Lemon struct ocp_reg __iomem *reg; 160a7e1abadSJonathan Lemon struct tod_reg __iomem *tod; 1610d43d4f2SJonathan Lemon struct pps_reg __iomem *pps_to_ext; 1620d43d4f2SJonathan Lemon struct pps_reg __iomem *pps_to_clk; 163773bda96SJonathan Lemon struct ptp_ocp_ext_src *pps; 164773bda96SJonathan Lemon struct ptp_ocp_ext_src *ts0; 165773bda96SJonathan Lemon struct ptp_ocp_ext_src *ts1; 166773bda96SJonathan Lemon struct img_reg __iomem *image; 167a7e1abadSJonathan Lemon struct ptp_clock *ptp; 168a7e1abadSJonathan Lemon struct ptp_clock_info ptp_info; 169773bda96SJonathan Lemon struct platform_device *i2c_ctrl; 170773bda96SJonathan Lemon struct platform_device *spi_flash; 171773bda96SJonathan Lemon struct clk_hw *i2c_clk; 172773bda96SJonathan Lemon struct timer_list watchdog; 173ef0cfb34SJonathan Lemon time64_t gnss_lost; 174773bda96SJonathan Lemon int id; 175773bda96SJonathan Lemon int n_irqs; 176ef0cfb34SJonathan Lemon int gnss_port; 177773bda96SJonathan Lemon int mac_port; /* miniature atomic clock */ 178773bda96SJonathan Lemon u8 serial[6]; 179773bda96SJonathan Lemon int flash_start; 180773bda96SJonathan Lemon bool has_serial; 181a7e1abadSJonathan Lemon }; 182a7e1abadSJonathan Lemon 183773bda96SJonathan Lemon struct ocp_resource { 184773bda96SJonathan Lemon unsigned long offset; 185773bda96SJonathan Lemon int size; 186773bda96SJonathan Lemon int irq_vec; 187773bda96SJonathan Lemon int (*setup)(struct ptp_ocp *bp, struct ocp_resource *r); 188773bda96SJonathan Lemon void *extra; 189773bda96SJonathan Lemon unsigned long bp_offset; 190773bda96SJonathan Lemon }; 191773bda96SJonathan Lemon 192773bda96SJonathan Lemon static int ptp_ocp_register_mem(struct ptp_ocp *bp, struct ocp_resource *r); 193773bda96SJonathan Lemon static int ptp_ocp_register_i2c(struct ptp_ocp *bp, struct ocp_resource *r); 194773bda96SJonathan Lemon static int ptp_ocp_register_spi(struct ptp_ocp *bp, struct ocp_resource *r); 195773bda96SJonathan Lemon static int ptp_ocp_register_serial(struct ptp_ocp *bp, struct ocp_resource *r); 196773bda96SJonathan Lemon static int ptp_ocp_register_ext(struct ptp_ocp *bp, struct ocp_resource *r); 197773bda96SJonathan Lemon static int ptp_ocp_fb_board_init(struct ptp_ocp *bp, struct ocp_resource *r); 198773bda96SJonathan Lemon static irqreturn_t ptp_ocp_ts_irq(int irq, void *priv); 199773bda96SJonathan Lemon static int ptp_ocp_ts_enable(void *priv, bool enable); 200773bda96SJonathan Lemon 201773bda96SJonathan Lemon #define bp_assign_entry(bp, res, val) ({ \ 202773bda96SJonathan Lemon uintptr_t addr = (uintptr_t)(bp) + (res)->bp_offset; \ 203773bda96SJonathan Lemon *(typeof(val) *)addr = val; \ 204773bda96SJonathan Lemon }) 205773bda96SJonathan Lemon 206773bda96SJonathan Lemon #define OCP_RES_LOCATION(member) \ 207773bda96SJonathan Lemon .bp_offset = offsetof(struct ptp_ocp, member) 208773bda96SJonathan Lemon 209773bda96SJonathan Lemon #define OCP_MEM_RESOURCE(member) \ 210773bda96SJonathan Lemon OCP_RES_LOCATION(member), .setup = ptp_ocp_register_mem 211773bda96SJonathan Lemon 212773bda96SJonathan Lemon #define OCP_SERIAL_RESOURCE(member) \ 213773bda96SJonathan Lemon OCP_RES_LOCATION(member), .setup = ptp_ocp_register_serial 214773bda96SJonathan Lemon 215773bda96SJonathan Lemon #define OCP_I2C_RESOURCE(member) \ 216773bda96SJonathan Lemon OCP_RES_LOCATION(member), .setup = ptp_ocp_register_i2c 217773bda96SJonathan Lemon 218773bda96SJonathan Lemon #define OCP_SPI_RESOURCE(member) \ 219773bda96SJonathan Lemon OCP_RES_LOCATION(member), .setup = ptp_ocp_register_spi 220773bda96SJonathan Lemon 221773bda96SJonathan Lemon #define OCP_EXT_RESOURCE(member) \ 222773bda96SJonathan Lemon OCP_RES_LOCATION(member), .setup = ptp_ocp_register_ext 223773bda96SJonathan Lemon 224773bda96SJonathan Lemon /* This is the MSI vector mapping used. 225773bda96SJonathan Lemon * 0: N/C 226773bda96SJonathan Lemon * 1: TS0 227773bda96SJonathan Lemon * 2: TS1 228773bda96SJonathan Lemon * 3: GPS 229773bda96SJonathan Lemon * 4: GPS2 (n/c) 230773bda96SJonathan Lemon * 5: MAC 231*1447149dSJonathan Lemon * 6: N/C 232*1447149dSJonathan Lemon * 7: I2C controller 233773bda96SJonathan Lemon * 8: HWICAP 234773bda96SJonathan Lemon * 9: SPI Flash 235773bda96SJonathan Lemon */ 236773bda96SJonathan Lemon 237773bda96SJonathan Lemon static struct ocp_resource ocp_fb_resource[] = { 238773bda96SJonathan Lemon { 239773bda96SJonathan Lemon OCP_MEM_RESOURCE(reg), 240773bda96SJonathan Lemon .offset = 0x01000000, .size = 0x10000, 241773bda96SJonathan Lemon }, 242773bda96SJonathan Lemon { 243773bda96SJonathan Lemon OCP_EXT_RESOURCE(ts0), 244773bda96SJonathan Lemon .offset = 0x01010000, .size = 0x10000, .irq_vec = 1, 245773bda96SJonathan Lemon .extra = &(struct ptp_ocp_ext_info) { 246773bda96SJonathan Lemon .name = "ts0", .index = 0, 247773bda96SJonathan Lemon .irq_fcn = ptp_ocp_ts_irq, 248773bda96SJonathan Lemon .enable = ptp_ocp_ts_enable, 249773bda96SJonathan Lemon }, 250773bda96SJonathan Lemon }, 251773bda96SJonathan Lemon { 252773bda96SJonathan Lemon OCP_EXT_RESOURCE(ts1), 253773bda96SJonathan Lemon .offset = 0x01020000, .size = 0x10000, .irq_vec = 2, 254773bda96SJonathan Lemon .extra = &(struct ptp_ocp_ext_info) { 255773bda96SJonathan Lemon .name = "ts1", .index = 1, 256773bda96SJonathan Lemon .irq_fcn = ptp_ocp_ts_irq, 257773bda96SJonathan Lemon .enable = ptp_ocp_ts_enable, 258773bda96SJonathan Lemon }, 259773bda96SJonathan Lemon }, 260773bda96SJonathan Lemon { 2610d43d4f2SJonathan Lemon OCP_MEM_RESOURCE(pps_to_ext), 2620d43d4f2SJonathan Lemon .offset = 0x01030000, .size = 0x10000, 2630d43d4f2SJonathan Lemon }, 2640d43d4f2SJonathan Lemon { 2650d43d4f2SJonathan Lemon OCP_MEM_RESOURCE(pps_to_clk), 266773bda96SJonathan Lemon .offset = 0x01040000, .size = 0x10000, 267773bda96SJonathan Lemon }, 268773bda96SJonathan Lemon { 269773bda96SJonathan Lemon OCP_MEM_RESOURCE(tod), 270773bda96SJonathan Lemon .offset = 0x01050000, .size = 0x10000, 271773bda96SJonathan Lemon }, 272773bda96SJonathan Lemon { 273773bda96SJonathan Lemon OCP_MEM_RESOURCE(image), 274773bda96SJonathan Lemon .offset = 0x00020000, .size = 0x1000, 275773bda96SJonathan Lemon }, 276773bda96SJonathan Lemon { 277773bda96SJonathan Lemon OCP_I2C_RESOURCE(i2c_ctrl), 278773bda96SJonathan Lemon .offset = 0x00150000, .size = 0x10000, .irq_vec = 7, 2791618df6aSJonathan Lemon .extra = &(struct ptp_ocp_i2c_info) { 2801618df6aSJonathan Lemon .name = "xiic-i2c", 2811618df6aSJonathan Lemon .fixed_rate = 50000000, 2821618df6aSJonathan Lemon }, 283773bda96SJonathan Lemon }, 284773bda96SJonathan Lemon { 285ef0cfb34SJonathan Lemon OCP_SERIAL_RESOURCE(gnss_port), 286773bda96SJonathan Lemon .offset = 0x00160000 + 0x1000, .irq_vec = 3, 287773bda96SJonathan Lemon }, 288773bda96SJonathan Lemon { 289773bda96SJonathan Lemon OCP_SERIAL_RESOURCE(mac_port), 290773bda96SJonathan Lemon .offset = 0x00180000 + 0x1000, .irq_vec = 5, 291773bda96SJonathan Lemon }, 292773bda96SJonathan Lemon { 293773bda96SJonathan Lemon OCP_SPI_RESOURCE(spi_flash), 294773bda96SJonathan Lemon .offset = 0x00310000, .size = 0x10000, .irq_vec = 9, 295773bda96SJonathan Lemon .extra = &(struct ptp_ocp_flash_info) { 296773bda96SJonathan Lemon .name = "xilinx_spi", .pci_offset = 0, 297773bda96SJonathan Lemon .data_size = sizeof(struct xspi_platform_data), 298773bda96SJonathan Lemon .data = &(struct xspi_platform_data) { 299773bda96SJonathan Lemon .num_chipselect = 1, 300773bda96SJonathan Lemon .bits_per_word = 8, 301773bda96SJonathan Lemon .num_devices = 1, 302773bda96SJonathan Lemon .devices = &(struct spi_board_info) { 303773bda96SJonathan Lemon .modalias = "spi-nor", 304773bda96SJonathan Lemon }, 305773bda96SJonathan Lemon }, 306773bda96SJonathan Lemon }, 307773bda96SJonathan Lemon }, 308773bda96SJonathan Lemon { 309773bda96SJonathan Lemon .setup = ptp_ocp_fb_board_init, 310773bda96SJonathan Lemon }, 311773bda96SJonathan Lemon { } 312773bda96SJonathan Lemon }; 313773bda96SJonathan Lemon 314773bda96SJonathan Lemon static const struct pci_device_id ptp_ocp_pcidev_id[] = { 315773bda96SJonathan Lemon { PCI_DEVICE_DATA(FACEBOOK, TIMECARD, &ocp_fb_resource) }, 316773bda96SJonathan Lemon { 0 } 317773bda96SJonathan Lemon }; 318773bda96SJonathan Lemon MODULE_DEVICE_TABLE(pci, ptp_ocp_pcidev_id); 319773bda96SJonathan Lemon 320773bda96SJonathan Lemon static DEFINE_MUTEX(ptp_ocp_lock); 321773bda96SJonathan Lemon static DEFINE_IDR(ptp_ocp_idr); 322773bda96SJonathan Lemon 323773bda96SJonathan Lemon static struct { 324773bda96SJonathan Lemon const char *name; 325773bda96SJonathan Lemon int value; 326773bda96SJonathan Lemon } ptp_ocp_clock[] = { 327773bda96SJonathan Lemon { .name = "NONE", .value = 0 }, 328773bda96SJonathan Lemon { .name = "TOD", .value = 1 }, 329773bda96SJonathan Lemon { .name = "IRIG", .value = 2 }, 330773bda96SJonathan Lemon { .name = "PPS", .value = 3 }, 331773bda96SJonathan Lemon { .name = "PTP", .value = 4 }, 332773bda96SJonathan Lemon { .name = "RTC", .value = 5 }, 333773bda96SJonathan Lemon { .name = "DCF", .value = 6 }, 334773bda96SJonathan Lemon { .name = "REGS", .value = 0xfe }, 335773bda96SJonathan Lemon { .name = "EXT", .value = 0xff }, 336773bda96SJonathan Lemon }; 337773bda96SJonathan Lemon 338773bda96SJonathan Lemon static const char * 339773bda96SJonathan Lemon ptp_ocp_clock_name_from_val(int val) 340773bda96SJonathan Lemon { 341773bda96SJonathan Lemon int i; 342773bda96SJonathan Lemon 343773bda96SJonathan Lemon for (i = 0; i < ARRAY_SIZE(ptp_ocp_clock); i++) 344773bda96SJonathan Lemon if (ptp_ocp_clock[i].value == val) 345773bda96SJonathan Lemon return ptp_ocp_clock[i].name; 346773bda96SJonathan Lemon return NULL; 347773bda96SJonathan Lemon } 348773bda96SJonathan Lemon 349773bda96SJonathan Lemon static int 350773bda96SJonathan Lemon ptp_ocp_clock_val_from_name(const char *name) 351773bda96SJonathan Lemon { 352773bda96SJonathan Lemon const char *clk; 353773bda96SJonathan Lemon int i; 354773bda96SJonathan Lemon 355773bda96SJonathan Lemon for (i = 0; i < ARRAY_SIZE(ptp_ocp_clock); i++) { 356773bda96SJonathan Lemon clk = ptp_ocp_clock[i].name; 357773bda96SJonathan Lemon if (!strncasecmp(name, clk, strlen(clk))) 358773bda96SJonathan Lemon return ptp_ocp_clock[i].value; 359773bda96SJonathan Lemon } 360773bda96SJonathan Lemon return -EINVAL; 361773bda96SJonathan Lemon } 362773bda96SJonathan Lemon 363a7e1abadSJonathan Lemon static int 364a7e1abadSJonathan Lemon __ptp_ocp_gettime_locked(struct ptp_ocp *bp, struct timespec64 *ts, 365a7e1abadSJonathan Lemon struct ptp_system_timestamp *sts) 366a7e1abadSJonathan Lemon { 367a7e1abadSJonathan Lemon u32 ctrl, time_sec, time_ns; 368a7e1abadSJonathan Lemon int i; 369a7e1abadSJonathan Lemon 370a7e1abadSJonathan Lemon ctrl = ioread32(&bp->reg->ctrl); 371a7e1abadSJonathan Lemon ctrl |= OCP_CTRL_READ_TIME_REQ; 372a7e1abadSJonathan Lemon 373a7e1abadSJonathan Lemon ptp_read_system_prets(sts); 374a7e1abadSJonathan Lemon iowrite32(ctrl, &bp->reg->ctrl); 375a7e1abadSJonathan Lemon 376a7e1abadSJonathan Lemon for (i = 0; i < 100; i++) { 377a7e1abadSJonathan Lemon ctrl = ioread32(&bp->reg->ctrl); 378a7e1abadSJonathan Lemon if (ctrl & OCP_CTRL_READ_TIME_DONE) 379a7e1abadSJonathan Lemon break; 380a7e1abadSJonathan Lemon } 381a7e1abadSJonathan Lemon ptp_read_system_postts(sts); 382a7e1abadSJonathan Lemon 383a7e1abadSJonathan Lemon time_ns = ioread32(&bp->reg->time_ns); 384a7e1abadSJonathan Lemon time_sec = ioread32(&bp->reg->time_sec); 385a7e1abadSJonathan Lemon 386a7e1abadSJonathan Lemon ts->tv_sec = time_sec; 387a7e1abadSJonathan Lemon ts->tv_nsec = time_ns; 388a7e1abadSJonathan Lemon 389a7e1abadSJonathan Lemon return ctrl & OCP_CTRL_READ_TIME_DONE ? 0 : -ETIMEDOUT; 390a7e1abadSJonathan Lemon } 391a7e1abadSJonathan Lemon 392a7e1abadSJonathan Lemon static int 393a7e1abadSJonathan Lemon ptp_ocp_gettimex(struct ptp_clock_info *ptp_info, struct timespec64 *ts, 394a7e1abadSJonathan Lemon struct ptp_system_timestamp *sts) 395a7e1abadSJonathan Lemon { 396a7e1abadSJonathan Lemon struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info); 397a7e1abadSJonathan Lemon unsigned long flags; 398a7e1abadSJonathan Lemon int err; 399a7e1abadSJonathan Lemon 400a7e1abadSJonathan Lemon spin_lock_irqsave(&bp->lock, flags); 401a7e1abadSJonathan Lemon err = __ptp_ocp_gettime_locked(bp, ts, sts); 402a7e1abadSJonathan Lemon spin_unlock_irqrestore(&bp->lock, flags); 403a7e1abadSJonathan Lemon 404a7e1abadSJonathan Lemon return err; 405a7e1abadSJonathan Lemon } 406a7e1abadSJonathan Lemon 407a7e1abadSJonathan Lemon static void 408a7e1abadSJonathan Lemon __ptp_ocp_settime_locked(struct ptp_ocp *bp, const struct timespec64 *ts) 409a7e1abadSJonathan Lemon { 410a7e1abadSJonathan Lemon u32 ctrl, time_sec, time_ns; 411a7e1abadSJonathan Lemon u32 select; 412a7e1abadSJonathan Lemon 413a7e1abadSJonathan Lemon time_ns = ts->tv_nsec; 414a7e1abadSJonathan Lemon time_sec = ts->tv_sec; 415a7e1abadSJonathan Lemon 416a7e1abadSJonathan Lemon select = ioread32(&bp->reg->select); 417a7e1abadSJonathan Lemon iowrite32(OCP_SELECT_CLK_REG, &bp->reg->select); 418a7e1abadSJonathan Lemon 419a7e1abadSJonathan Lemon iowrite32(time_ns, &bp->reg->adjust_ns); 420a7e1abadSJonathan Lemon iowrite32(time_sec, &bp->reg->adjust_sec); 421a7e1abadSJonathan Lemon 422a7e1abadSJonathan Lemon ctrl = ioread32(&bp->reg->ctrl); 423a7e1abadSJonathan Lemon ctrl |= OCP_CTRL_ADJUST_TIME; 424a7e1abadSJonathan Lemon iowrite32(ctrl, &bp->reg->ctrl); 425a7e1abadSJonathan Lemon 426a7e1abadSJonathan Lemon /* restore clock selection */ 427a7e1abadSJonathan Lemon iowrite32(select >> 16, &bp->reg->select); 428a7e1abadSJonathan Lemon } 429a7e1abadSJonathan Lemon 430a7e1abadSJonathan Lemon static int 431a7e1abadSJonathan Lemon ptp_ocp_settime(struct ptp_clock_info *ptp_info, const struct timespec64 *ts) 432a7e1abadSJonathan Lemon { 433a7e1abadSJonathan Lemon struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info); 434a7e1abadSJonathan Lemon unsigned long flags; 435a7e1abadSJonathan Lemon 436a7e1abadSJonathan Lemon if (ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC) 437a7e1abadSJonathan Lemon return 0; 438a7e1abadSJonathan Lemon 439a7e1abadSJonathan Lemon spin_lock_irqsave(&bp->lock, flags); 440a7e1abadSJonathan Lemon __ptp_ocp_settime_locked(bp, ts); 441a7e1abadSJonathan Lemon spin_unlock_irqrestore(&bp->lock, flags); 442a7e1abadSJonathan Lemon 443a7e1abadSJonathan Lemon return 0; 444a7e1abadSJonathan Lemon } 445a7e1abadSJonathan Lemon 446a7e1abadSJonathan Lemon static int 447a7e1abadSJonathan Lemon ptp_ocp_adjtime(struct ptp_clock_info *ptp_info, s64 delta_ns) 448a7e1abadSJonathan Lemon { 449a7e1abadSJonathan Lemon struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info); 450a7e1abadSJonathan Lemon struct timespec64 ts; 451a7e1abadSJonathan Lemon unsigned long flags; 452a7e1abadSJonathan Lemon int err; 453a7e1abadSJonathan Lemon 454a7e1abadSJonathan Lemon if (ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC) 455a7e1abadSJonathan Lemon return 0; 456a7e1abadSJonathan Lemon 457a7e1abadSJonathan Lemon spin_lock_irqsave(&bp->lock, flags); 458a7e1abadSJonathan Lemon err = __ptp_ocp_gettime_locked(bp, &ts, NULL); 459a7e1abadSJonathan Lemon if (likely(!err)) { 460a7e1abadSJonathan Lemon timespec64_add_ns(&ts, delta_ns); 461a7e1abadSJonathan Lemon __ptp_ocp_settime_locked(bp, &ts); 462a7e1abadSJonathan Lemon } 463a7e1abadSJonathan Lemon spin_unlock_irqrestore(&bp->lock, flags); 464a7e1abadSJonathan Lemon 465a7e1abadSJonathan Lemon return err; 466a7e1abadSJonathan Lemon } 467a7e1abadSJonathan Lemon 468a7e1abadSJonathan Lemon static int 469a7e1abadSJonathan Lemon ptp_ocp_null_adjfine(struct ptp_clock_info *ptp_info, long scaled_ppm) 470a7e1abadSJonathan Lemon { 471a7e1abadSJonathan Lemon if (scaled_ppm == 0) 472a7e1abadSJonathan Lemon return 0; 473a7e1abadSJonathan Lemon 474a7e1abadSJonathan Lemon return -EOPNOTSUPP; 475a7e1abadSJonathan Lemon } 476a7e1abadSJonathan Lemon 477773bda96SJonathan Lemon static int 478773bda96SJonathan Lemon ptp_ocp_adjphase(struct ptp_clock_info *ptp_info, s32 phase_ns) 479773bda96SJonathan Lemon { 480773bda96SJonathan Lemon return -EOPNOTSUPP; 481773bda96SJonathan Lemon } 482773bda96SJonathan Lemon 483773bda96SJonathan Lemon static int 484773bda96SJonathan Lemon ptp_ocp_enable(struct ptp_clock_info *ptp_info, struct ptp_clock_request *rq, 485773bda96SJonathan Lemon int on) 486773bda96SJonathan Lemon { 487773bda96SJonathan Lemon struct ptp_ocp *bp = container_of(ptp_info, struct ptp_ocp, ptp_info); 488773bda96SJonathan Lemon struct ptp_ocp_ext_src *ext = NULL; 489773bda96SJonathan Lemon int err; 490773bda96SJonathan Lemon 491773bda96SJonathan Lemon switch (rq->type) { 492773bda96SJonathan Lemon case PTP_CLK_REQ_EXTTS: 493773bda96SJonathan Lemon switch (rq->extts.index) { 494773bda96SJonathan Lemon case 0: 495773bda96SJonathan Lemon ext = bp->ts0; 496773bda96SJonathan Lemon break; 497773bda96SJonathan Lemon case 1: 498773bda96SJonathan Lemon ext = bp->ts1; 499773bda96SJonathan Lemon break; 500773bda96SJonathan Lemon } 501773bda96SJonathan Lemon break; 502773bda96SJonathan Lemon case PTP_CLK_REQ_PPS: 503773bda96SJonathan Lemon ext = bp->pps; 504773bda96SJonathan Lemon break; 505773bda96SJonathan Lemon default: 506773bda96SJonathan Lemon return -EOPNOTSUPP; 507773bda96SJonathan Lemon } 508773bda96SJonathan Lemon 509773bda96SJonathan Lemon err = -ENXIO; 510773bda96SJonathan Lemon if (ext) 511773bda96SJonathan Lemon err = ext->info->enable(ext, on); 512773bda96SJonathan Lemon 513773bda96SJonathan Lemon return err; 514773bda96SJonathan Lemon } 515773bda96SJonathan Lemon 516a7e1abadSJonathan Lemon static const struct ptp_clock_info ptp_ocp_clock_info = { 517a7e1abadSJonathan Lemon .owner = THIS_MODULE, 518a7e1abadSJonathan Lemon .name = KBUILD_MODNAME, 519a7e1abadSJonathan Lemon .max_adj = 100000000, 520a7e1abadSJonathan Lemon .gettimex64 = ptp_ocp_gettimex, 521a7e1abadSJonathan Lemon .settime64 = ptp_ocp_settime, 522a7e1abadSJonathan Lemon .adjtime = ptp_ocp_adjtime, 523a7e1abadSJonathan Lemon .adjfine = ptp_ocp_null_adjfine, 524773bda96SJonathan Lemon .adjphase = ptp_ocp_adjphase, 525773bda96SJonathan Lemon .enable = ptp_ocp_enable, 526773bda96SJonathan Lemon .pps = true, 527773bda96SJonathan Lemon .n_ext_ts = 2, 528a7e1abadSJonathan Lemon }; 529a7e1abadSJonathan Lemon 530773bda96SJonathan Lemon static void 531773bda96SJonathan Lemon __ptp_ocp_clear_drift_locked(struct ptp_ocp *bp) 532773bda96SJonathan Lemon { 533773bda96SJonathan Lemon u32 ctrl, select; 534773bda96SJonathan Lemon 535773bda96SJonathan Lemon select = ioread32(&bp->reg->select); 536773bda96SJonathan Lemon iowrite32(OCP_SELECT_CLK_REG, &bp->reg->select); 537773bda96SJonathan Lemon 538773bda96SJonathan Lemon iowrite32(0, &bp->reg->drift_ns); 539773bda96SJonathan Lemon 540773bda96SJonathan Lemon ctrl = ioread32(&bp->reg->ctrl); 541773bda96SJonathan Lemon ctrl |= OCP_CTRL_ADJUST_DRIFT; 542773bda96SJonathan Lemon iowrite32(ctrl, &bp->reg->ctrl); 543773bda96SJonathan Lemon 544773bda96SJonathan Lemon /* restore clock selection */ 545773bda96SJonathan Lemon iowrite32(select >> 16, &bp->reg->select); 546773bda96SJonathan Lemon } 547773bda96SJonathan Lemon 548773bda96SJonathan Lemon static void 549773bda96SJonathan Lemon ptp_ocp_watchdog(struct timer_list *t) 550773bda96SJonathan Lemon { 551773bda96SJonathan Lemon struct ptp_ocp *bp = from_timer(bp, t, watchdog); 552773bda96SJonathan Lemon unsigned long flags; 553773bda96SJonathan Lemon u32 status; 554773bda96SJonathan Lemon 5550d43d4f2SJonathan Lemon status = ioread32(&bp->pps_to_clk->status); 556773bda96SJonathan Lemon 557773bda96SJonathan Lemon if (status & PPS_STATUS_SUPERV_ERR) { 5580d43d4f2SJonathan Lemon iowrite32(status, &bp->pps_to_clk->status); 559ef0cfb34SJonathan Lemon if (!bp->gnss_lost) { 560773bda96SJonathan Lemon spin_lock_irqsave(&bp->lock, flags); 561773bda96SJonathan Lemon __ptp_ocp_clear_drift_locked(bp); 562773bda96SJonathan Lemon spin_unlock_irqrestore(&bp->lock, flags); 563ef0cfb34SJonathan Lemon bp->gnss_lost = ktime_get_real_seconds(); 564773bda96SJonathan Lemon } 565773bda96SJonathan Lemon 566ef0cfb34SJonathan Lemon } else if (bp->gnss_lost) { 567ef0cfb34SJonathan Lemon bp->gnss_lost = 0; 568773bda96SJonathan Lemon } 569773bda96SJonathan Lemon 570773bda96SJonathan Lemon mod_timer(&bp->watchdog, jiffies + HZ); 571773bda96SJonathan Lemon } 572773bda96SJonathan Lemon 573a7e1abadSJonathan Lemon static int 574773bda96SJonathan Lemon ptp_ocp_init_clock(struct ptp_ocp *bp) 575a7e1abadSJonathan Lemon { 576a7e1abadSJonathan Lemon struct timespec64 ts; 577a7e1abadSJonathan Lemon bool sync; 578a7e1abadSJonathan Lemon u32 ctrl; 579a7e1abadSJonathan Lemon 580a7e1abadSJonathan Lemon /* make sure clock is enabled */ 581a7e1abadSJonathan Lemon ctrl = ioread32(&bp->reg->ctrl); 582a7e1abadSJonathan Lemon ctrl |= OCP_CTRL_ENABLE; 583a7e1abadSJonathan Lemon iowrite32(ctrl, &bp->reg->ctrl); 584a7e1abadSJonathan Lemon 585773bda96SJonathan Lemon /* NO DRIFT Correction */ 586773bda96SJonathan Lemon /* offset_p:i 1/8, offset_i: 1/16, drift_p: 0, drift_i: 0 */ 587773bda96SJonathan Lemon iowrite32(0x2000, &bp->reg->servo_offset_p); 588773bda96SJonathan Lemon iowrite32(0x1000, &bp->reg->servo_offset_i); 589773bda96SJonathan Lemon iowrite32(0, &bp->reg->servo_drift_p); 590773bda96SJonathan Lemon iowrite32(0, &bp->reg->servo_drift_i); 591773bda96SJonathan Lemon 592773bda96SJonathan Lemon /* latch servo values */ 593773bda96SJonathan Lemon ctrl |= OCP_CTRL_ADJUST_SERVO; 594773bda96SJonathan Lemon iowrite32(ctrl, &bp->reg->ctrl); 595773bda96SJonathan Lemon 596a7e1abadSJonathan Lemon if ((ioread32(&bp->reg->ctrl) & OCP_CTRL_ENABLE) == 0) { 597a7e1abadSJonathan Lemon dev_err(&bp->pdev->dev, "clock not enabled\n"); 598a7e1abadSJonathan Lemon return -ENODEV; 599a7e1abadSJonathan Lemon } 600a7e1abadSJonathan Lemon 601a7e1abadSJonathan Lemon sync = ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC; 602a7e1abadSJonathan Lemon if (!sync) { 603a7e1abadSJonathan Lemon ktime_get_real_ts64(&ts); 604a7e1abadSJonathan Lemon ptp_ocp_settime(&bp->ptp_info, &ts); 605a7e1abadSJonathan Lemon } 606a7e1abadSJonathan Lemon if (!ptp_ocp_gettimex(&bp->ptp_info, &ts, NULL)) 607a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "Time: %lld.%ld, %s\n", 608a7e1abadSJonathan Lemon ts.tv_sec, ts.tv_nsec, 609a7e1abadSJonathan Lemon sync ? "in-sync" : "UNSYNCED"); 610a7e1abadSJonathan Lemon 611773bda96SJonathan Lemon timer_setup(&bp->watchdog, ptp_ocp_watchdog, 0); 612773bda96SJonathan Lemon mod_timer(&bp->watchdog, jiffies + HZ); 613773bda96SJonathan Lemon 614a7e1abadSJonathan Lemon return 0; 615a7e1abadSJonathan Lemon } 616a7e1abadSJonathan Lemon 617a7e1abadSJonathan Lemon static void 618a7e1abadSJonathan Lemon ptp_ocp_tod_info(struct ptp_ocp *bp) 619a7e1abadSJonathan Lemon { 620a7e1abadSJonathan Lemon static const char * const proto_name[] = { 621a7e1abadSJonathan Lemon "NMEA", "NMEA_ZDA", "NMEA_RMC", "NMEA_none", 622a7e1abadSJonathan Lemon "UBX", "UBX_UTC", "UBX_LS", "UBX_none" 623a7e1abadSJonathan Lemon }; 624a7e1abadSJonathan Lemon static const char * const gnss_name[] = { 625a7e1abadSJonathan Lemon "ALL", "COMBINED", "GPS", "GLONASS", "GALILEO", "BEIDOU", 626a7e1abadSJonathan Lemon }; 627a7e1abadSJonathan Lemon u32 version, ctrl, reg; 628a7e1abadSJonathan Lemon int idx; 629a7e1abadSJonathan Lemon 630a7e1abadSJonathan Lemon version = ioread32(&bp->tod->version); 631a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "TOD Version %d.%d.%d\n", 632a7e1abadSJonathan Lemon version >> 24, (version >> 16) & 0xff, version & 0xffff); 633a7e1abadSJonathan Lemon 634a7e1abadSJonathan Lemon ctrl = ioread32(&bp->tod->ctrl); 635a7e1abadSJonathan Lemon ctrl |= TOD_CTRL_PROTOCOL | TOD_CTRL_ENABLE; 636a7e1abadSJonathan Lemon ctrl &= ~(TOD_CTRL_DISABLE_FMT_A | TOD_CTRL_DISABLE_FMT_B); 637a7e1abadSJonathan Lemon iowrite32(ctrl, &bp->tod->ctrl); 638a7e1abadSJonathan Lemon 639a7e1abadSJonathan Lemon ctrl = ioread32(&bp->tod->ctrl); 640a7e1abadSJonathan Lemon idx = ctrl & TOD_CTRL_PROTOCOL ? 4 : 0; 641a7e1abadSJonathan Lemon idx += (ctrl >> 16) & 3; 642a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "control: %x\n", ctrl); 643a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "TOD Protocol %s %s\n", proto_name[idx], 644a7e1abadSJonathan Lemon ctrl & TOD_CTRL_ENABLE ? "enabled" : ""); 645a7e1abadSJonathan Lemon 646a7e1abadSJonathan Lemon idx = (ctrl >> TOD_CTRL_GNSS_SHIFT) & TOD_CTRL_GNSS_MASK; 647a7e1abadSJonathan Lemon if (idx < ARRAY_SIZE(gnss_name)) 648a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "GNSS %s\n", gnss_name[idx]); 649a7e1abadSJonathan Lemon 650a7e1abadSJonathan Lemon reg = ioread32(&bp->tod->status); 651a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "status: %x\n", reg); 652a7e1abadSJonathan Lemon 653a7e1abadSJonathan Lemon reg = ioread32(&bp->tod->correction_sec); 654a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "correction: %d\n", reg); 655a7e1abadSJonathan Lemon 656a7e1abadSJonathan Lemon reg = ioread32(&bp->tod->utc_status); 657a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "utc_status: %x\n", reg); 658a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "utc_offset: %d valid:%d leap_valid:%d\n", 659a7e1abadSJonathan Lemon reg & TOD_STATUS_UTC_MASK, reg & TOD_STATUS_UTC_VALID ? 1 : 0, 660a7e1abadSJonathan Lemon reg & TOD_STATUS_LEAP_VALID ? 1 : 0); 661a7e1abadSJonathan Lemon } 662a7e1abadSJonathan Lemon 663773bda96SJonathan Lemon static int 664773bda96SJonathan Lemon ptp_ocp_firstchild(struct device *dev, void *data) 665773bda96SJonathan Lemon { 666773bda96SJonathan Lemon return 1; 667773bda96SJonathan Lemon } 668773bda96SJonathan Lemon 669773bda96SJonathan Lemon static int 670773bda96SJonathan Lemon ptp_ocp_read_i2c(struct i2c_adapter *adap, u8 addr, u8 reg, u8 sz, u8 *data) 671773bda96SJonathan Lemon { 672773bda96SJonathan Lemon struct i2c_msg msgs[2] = { 673773bda96SJonathan Lemon { 674773bda96SJonathan Lemon .addr = addr, 675773bda96SJonathan Lemon .len = 1, 676773bda96SJonathan Lemon .buf = ®, 677773bda96SJonathan Lemon }, 678773bda96SJonathan Lemon { 679773bda96SJonathan Lemon .addr = addr, 680773bda96SJonathan Lemon .flags = I2C_M_RD, 681773bda96SJonathan Lemon .len = 2, 682773bda96SJonathan Lemon .buf = data, 683773bda96SJonathan Lemon }, 684773bda96SJonathan Lemon }; 685773bda96SJonathan Lemon int err; 686773bda96SJonathan Lemon u8 len; 687773bda96SJonathan Lemon 688773bda96SJonathan Lemon /* xiic-i2c for some stupid reason only does 2 byte reads. */ 689773bda96SJonathan Lemon while (sz) { 690773bda96SJonathan Lemon len = min_t(u8, sz, 2); 691773bda96SJonathan Lemon msgs[1].len = len; 692773bda96SJonathan Lemon err = i2c_transfer(adap, msgs, 2); 693773bda96SJonathan Lemon if (err != msgs[1].len) 694773bda96SJonathan Lemon return err; 695773bda96SJonathan Lemon msgs[1].buf += len; 696773bda96SJonathan Lemon reg += len; 697773bda96SJonathan Lemon sz -= len; 698773bda96SJonathan Lemon } 699773bda96SJonathan Lemon return 0; 700773bda96SJonathan Lemon } 701773bda96SJonathan Lemon 702773bda96SJonathan Lemon static void 703773bda96SJonathan Lemon ptp_ocp_get_serial_number(struct ptp_ocp *bp) 704773bda96SJonathan Lemon { 705773bda96SJonathan Lemon struct i2c_adapter *adap; 706773bda96SJonathan Lemon struct device *dev; 707773bda96SJonathan Lemon int err; 708773bda96SJonathan Lemon 709*1447149dSJonathan Lemon if (!bp->i2c_ctrl) 710*1447149dSJonathan Lemon return; 711*1447149dSJonathan Lemon 712773bda96SJonathan Lemon dev = device_find_child(&bp->i2c_ctrl->dev, NULL, ptp_ocp_firstchild); 713773bda96SJonathan Lemon if (!dev) { 714773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "Can't find I2C adapter\n"); 715773bda96SJonathan Lemon return; 716773bda96SJonathan Lemon } 717773bda96SJonathan Lemon 718773bda96SJonathan Lemon adap = i2c_verify_adapter(dev); 719773bda96SJonathan Lemon if (!adap) { 720773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "device '%s' isn't an I2C adapter\n", 721773bda96SJonathan Lemon dev_name(dev)); 722773bda96SJonathan Lemon goto out; 723773bda96SJonathan Lemon } 724773bda96SJonathan Lemon 725773bda96SJonathan Lemon err = ptp_ocp_read_i2c(adap, 0x58, 0x9A, 6, bp->serial); 726773bda96SJonathan Lemon if (err) { 727773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "could not read eeprom: %d\n", err); 728773bda96SJonathan Lemon goto out; 729773bda96SJonathan Lemon } 730773bda96SJonathan Lemon 731773bda96SJonathan Lemon bp->has_serial = true; 732773bda96SJonathan Lemon 733773bda96SJonathan Lemon out: 734773bda96SJonathan Lemon put_device(dev); 735773bda96SJonathan Lemon } 736773bda96SJonathan Lemon 737a7e1abadSJonathan Lemon static void 738a7e1abadSJonathan Lemon ptp_ocp_info(struct ptp_ocp *bp) 739a7e1abadSJonathan Lemon { 740a7e1abadSJonathan Lemon u32 version, select; 741a7e1abadSJonathan Lemon 742a7e1abadSJonathan Lemon version = ioread32(&bp->reg->version); 743a7e1abadSJonathan Lemon select = ioread32(&bp->reg->select); 744a7e1abadSJonathan Lemon dev_info(&bp->pdev->dev, "Version %d.%d.%d, clock %s, device ptp%d\n", 745a7e1abadSJonathan Lemon version >> 24, (version >> 16) & 0xff, version & 0xffff, 746773bda96SJonathan Lemon ptp_ocp_clock_name_from_val(select >> 16), 747a7e1abadSJonathan Lemon ptp_clock_index(bp->ptp)); 748a7e1abadSJonathan Lemon 749498ad3f4SJonathan Lemon if (bp->tod) 750a7e1abadSJonathan Lemon ptp_ocp_tod_info(bp); 751a7e1abadSJonathan Lemon } 752a7e1abadSJonathan Lemon 753773bda96SJonathan Lemon static struct device * 754773bda96SJonathan Lemon ptp_ocp_find_flash(struct ptp_ocp *bp) 755773bda96SJonathan Lemon { 756773bda96SJonathan Lemon struct device *dev, *last; 757773bda96SJonathan Lemon 758773bda96SJonathan Lemon last = NULL; 759773bda96SJonathan Lemon dev = &bp->spi_flash->dev; 760773bda96SJonathan Lemon 761773bda96SJonathan Lemon while ((dev = device_find_child(dev, NULL, ptp_ocp_firstchild))) { 762773bda96SJonathan Lemon if (!strcmp("mtd", dev_bus_name(dev))) 763773bda96SJonathan Lemon break; 764773bda96SJonathan Lemon put_device(last); 765773bda96SJonathan Lemon last = dev; 766773bda96SJonathan Lemon } 767773bda96SJonathan Lemon put_device(last); 768773bda96SJonathan Lemon 769773bda96SJonathan Lemon return dev; 770773bda96SJonathan Lemon } 771773bda96SJonathan Lemon 772773bda96SJonathan Lemon static int 773773bda96SJonathan Lemon ptp_ocp_devlink_flash(struct devlink *devlink, struct device *dev, 774773bda96SJonathan Lemon const struct firmware *fw) 775773bda96SJonathan Lemon { 776773bda96SJonathan Lemon struct mtd_info *mtd = dev_get_drvdata(dev); 777773bda96SJonathan Lemon struct ptp_ocp *bp = devlink_priv(devlink); 778773bda96SJonathan Lemon size_t off, len, resid, wrote; 779773bda96SJonathan Lemon struct erase_info erase; 780773bda96SJonathan Lemon size_t base, blksz; 7817c807572SJonathan Lemon int err = 0; 782773bda96SJonathan Lemon 783773bda96SJonathan Lemon off = 0; 784773bda96SJonathan Lemon base = bp->flash_start; 785773bda96SJonathan Lemon blksz = 4096; 786773bda96SJonathan Lemon resid = fw->size; 787773bda96SJonathan Lemon 788773bda96SJonathan Lemon while (resid) { 789773bda96SJonathan Lemon devlink_flash_update_status_notify(devlink, "Flashing", 790773bda96SJonathan Lemon NULL, off, fw->size); 791773bda96SJonathan Lemon 792773bda96SJonathan Lemon len = min_t(size_t, resid, blksz); 793773bda96SJonathan Lemon erase.addr = base + off; 794773bda96SJonathan Lemon erase.len = blksz; 795773bda96SJonathan Lemon 796773bda96SJonathan Lemon err = mtd_erase(mtd, &erase); 797773bda96SJonathan Lemon if (err) 798773bda96SJonathan Lemon goto out; 799773bda96SJonathan Lemon 800773bda96SJonathan Lemon err = mtd_write(mtd, base + off, len, &wrote, &fw->data[off]); 801773bda96SJonathan Lemon if (err) 802773bda96SJonathan Lemon goto out; 803773bda96SJonathan Lemon 804773bda96SJonathan Lemon off += blksz; 805773bda96SJonathan Lemon resid -= len; 806773bda96SJonathan Lemon } 807773bda96SJonathan Lemon out: 808773bda96SJonathan Lemon return err; 809773bda96SJonathan Lemon } 810773bda96SJonathan Lemon 811773bda96SJonathan Lemon static int 812773bda96SJonathan Lemon ptp_ocp_devlink_flash_update(struct devlink *devlink, 813773bda96SJonathan Lemon struct devlink_flash_update_params *params, 814773bda96SJonathan Lemon struct netlink_ext_ack *extack) 815773bda96SJonathan Lemon { 816773bda96SJonathan Lemon struct ptp_ocp *bp = devlink_priv(devlink); 817773bda96SJonathan Lemon struct device *dev; 818773bda96SJonathan Lemon const char *msg; 819773bda96SJonathan Lemon int err; 820773bda96SJonathan Lemon 821773bda96SJonathan Lemon dev = ptp_ocp_find_flash(bp); 822773bda96SJonathan Lemon if (!dev) { 823773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "Can't find Flash SPI adapter\n"); 824773bda96SJonathan Lemon return -ENODEV; 825773bda96SJonathan Lemon } 826773bda96SJonathan Lemon 827773bda96SJonathan Lemon devlink_flash_update_status_notify(devlink, "Preparing to flash", 828773bda96SJonathan Lemon NULL, 0, 0); 829773bda96SJonathan Lemon 830773bda96SJonathan Lemon err = ptp_ocp_devlink_flash(devlink, dev, params->fw); 831773bda96SJonathan Lemon 832773bda96SJonathan Lemon msg = err ? "Flash error" : "Flash complete"; 833773bda96SJonathan Lemon devlink_flash_update_status_notify(devlink, msg, NULL, 0, 0); 834773bda96SJonathan Lemon 835773bda96SJonathan Lemon put_device(dev); 836773bda96SJonathan Lemon return err; 837773bda96SJonathan Lemon } 838773bda96SJonathan Lemon 839773bda96SJonathan Lemon static int 840773bda96SJonathan Lemon ptp_ocp_devlink_info_get(struct devlink *devlink, struct devlink_info_req *req, 841773bda96SJonathan Lemon struct netlink_ext_ack *extack) 842773bda96SJonathan Lemon { 843773bda96SJonathan Lemon struct ptp_ocp *bp = devlink_priv(devlink); 844773bda96SJonathan Lemon char buf[32]; 845773bda96SJonathan Lemon int err; 846773bda96SJonathan Lemon 847773bda96SJonathan Lemon err = devlink_info_driver_name_put(req, KBUILD_MODNAME); 848773bda96SJonathan Lemon if (err) 849773bda96SJonathan Lemon return err; 850773bda96SJonathan Lemon 851773bda96SJonathan Lemon if (bp->image) { 852773bda96SJonathan Lemon u32 ver = ioread32(&bp->image->version); 853773bda96SJonathan Lemon 854773bda96SJonathan Lemon if (ver & 0xffff) { 855773bda96SJonathan Lemon sprintf(buf, "%d", ver); 856773bda96SJonathan Lemon err = devlink_info_version_running_put(req, 8571a052da9SJonathan Lemon "fw", 858773bda96SJonathan Lemon buf); 859773bda96SJonathan Lemon } else { 860773bda96SJonathan Lemon sprintf(buf, "%d", ver >> 16); 861773bda96SJonathan Lemon err = devlink_info_version_running_put(req, 8621a052da9SJonathan Lemon "loader", 863773bda96SJonathan Lemon buf); 864773bda96SJonathan Lemon } 865773bda96SJonathan Lemon if (err) 866773bda96SJonathan Lemon return err; 867773bda96SJonathan Lemon } 868773bda96SJonathan Lemon 869773bda96SJonathan Lemon if (!bp->has_serial) 870773bda96SJonathan Lemon ptp_ocp_get_serial_number(bp); 871773bda96SJonathan Lemon 872773bda96SJonathan Lemon if (bp->has_serial) { 873773bda96SJonathan Lemon sprintf(buf, "%pM", bp->serial); 874773bda96SJonathan Lemon err = devlink_info_serial_number_put(req, buf); 875773bda96SJonathan Lemon if (err) 876773bda96SJonathan Lemon return err; 877773bda96SJonathan Lemon } 878773bda96SJonathan Lemon 879773bda96SJonathan Lemon return 0; 880773bda96SJonathan Lemon } 881773bda96SJonathan Lemon 882773bda96SJonathan Lemon static const struct devlink_ops ptp_ocp_devlink_ops = { 883773bda96SJonathan Lemon .flash_update = ptp_ocp_devlink_flash_update, 884773bda96SJonathan Lemon .info_get = ptp_ocp_devlink_info_get, 885773bda96SJonathan Lemon }; 886773bda96SJonathan Lemon 887773bda96SJonathan Lemon static void __iomem * 888773bda96SJonathan Lemon __ptp_ocp_get_mem(struct ptp_ocp *bp, unsigned long start, int size) 889773bda96SJonathan Lemon { 890773bda96SJonathan Lemon struct resource res = DEFINE_RES_MEM_NAMED(start, size, "ptp_ocp"); 891773bda96SJonathan Lemon 892773bda96SJonathan Lemon return devm_ioremap_resource(&bp->pdev->dev, &res); 893773bda96SJonathan Lemon } 894773bda96SJonathan Lemon 895773bda96SJonathan Lemon static void __iomem * 896773bda96SJonathan Lemon ptp_ocp_get_mem(struct ptp_ocp *bp, struct ocp_resource *r) 897773bda96SJonathan Lemon { 898773bda96SJonathan Lemon unsigned long start; 899773bda96SJonathan Lemon 900773bda96SJonathan Lemon start = pci_resource_start(bp->pdev, 0) + r->offset; 901773bda96SJonathan Lemon return __ptp_ocp_get_mem(bp, start, r->size); 902773bda96SJonathan Lemon } 903773bda96SJonathan Lemon 904773bda96SJonathan Lemon static void 905773bda96SJonathan Lemon ptp_ocp_set_irq_resource(struct resource *res, int irq) 906773bda96SJonathan Lemon { 907773bda96SJonathan Lemon struct resource r = DEFINE_RES_IRQ(irq); 908773bda96SJonathan Lemon *res = r; 909773bda96SJonathan Lemon } 910773bda96SJonathan Lemon 911773bda96SJonathan Lemon static void 912773bda96SJonathan Lemon ptp_ocp_set_mem_resource(struct resource *res, unsigned long start, int size) 913773bda96SJonathan Lemon { 914773bda96SJonathan Lemon struct resource r = DEFINE_RES_MEM(start, size); 915773bda96SJonathan Lemon *res = r; 916773bda96SJonathan Lemon } 917773bda96SJonathan Lemon 918773bda96SJonathan Lemon static int 919773bda96SJonathan Lemon ptp_ocp_register_spi(struct ptp_ocp *bp, struct ocp_resource *r) 920773bda96SJonathan Lemon { 921773bda96SJonathan Lemon struct ptp_ocp_flash_info *info; 922773bda96SJonathan Lemon struct pci_dev *pdev = bp->pdev; 923773bda96SJonathan Lemon struct platform_device *p; 924773bda96SJonathan Lemon struct resource res[2]; 925773bda96SJonathan Lemon unsigned long start; 926773bda96SJonathan Lemon int id; 927773bda96SJonathan Lemon 928773bda96SJonathan Lemon /* XXX hack to work around old FPGA */ 929773bda96SJonathan Lemon if (bp->n_irqs < 10) { 930773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "FPGA does not have SPI devices\n"); 931773bda96SJonathan Lemon return 0; 932773bda96SJonathan Lemon } 933773bda96SJonathan Lemon 934773bda96SJonathan Lemon if (r->irq_vec > bp->n_irqs) { 935773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "spi device irq %d out of range\n", 936773bda96SJonathan Lemon r->irq_vec); 937773bda96SJonathan Lemon return 0; 938773bda96SJonathan Lemon } 939773bda96SJonathan Lemon 940773bda96SJonathan Lemon start = pci_resource_start(pdev, 0) + r->offset; 941773bda96SJonathan Lemon ptp_ocp_set_mem_resource(&res[0], start, r->size); 942773bda96SJonathan Lemon ptp_ocp_set_irq_resource(&res[1], pci_irq_vector(pdev, r->irq_vec)); 943773bda96SJonathan Lemon 944773bda96SJonathan Lemon info = r->extra; 945773bda96SJonathan Lemon id = pci_dev_id(pdev) << 1; 946773bda96SJonathan Lemon id += info->pci_offset; 947773bda96SJonathan Lemon 948773bda96SJonathan Lemon p = platform_device_register_resndata(&pdev->dev, info->name, id, 949773bda96SJonathan Lemon res, 2, info->data, 950773bda96SJonathan Lemon info->data_size); 951773bda96SJonathan Lemon if (IS_ERR(p)) 952773bda96SJonathan Lemon return PTR_ERR(p); 953773bda96SJonathan Lemon 954773bda96SJonathan Lemon bp_assign_entry(bp, r, p); 955773bda96SJonathan Lemon 956773bda96SJonathan Lemon return 0; 957773bda96SJonathan Lemon } 958773bda96SJonathan Lemon 959773bda96SJonathan Lemon static struct platform_device * 960773bda96SJonathan Lemon ptp_ocp_i2c_bus(struct pci_dev *pdev, struct ocp_resource *r, int id) 961773bda96SJonathan Lemon { 9621618df6aSJonathan Lemon struct ptp_ocp_i2c_info *info; 963773bda96SJonathan Lemon struct resource res[2]; 964773bda96SJonathan Lemon unsigned long start; 965773bda96SJonathan Lemon 9661618df6aSJonathan Lemon info = r->extra; 967773bda96SJonathan Lemon start = pci_resource_start(pdev, 0) + r->offset; 968773bda96SJonathan Lemon ptp_ocp_set_mem_resource(&res[0], start, r->size); 969773bda96SJonathan Lemon ptp_ocp_set_irq_resource(&res[1], pci_irq_vector(pdev, r->irq_vec)); 970773bda96SJonathan Lemon 9711618df6aSJonathan Lemon return platform_device_register_resndata(&pdev->dev, info->name, 9721618df6aSJonathan Lemon id, res, 2, 9731618df6aSJonathan Lemon info->data, info->data_size); 974773bda96SJonathan Lemon } 975773bda96SJonathan Lemon 976773bda96SJonathan Lemon static int 977773bda96SJonathan Lemon ptp_ocp_register_i2c(struct ptp_ocp *bp, struct ocp_resource *r) 978773bda96SJonathan Lemon { 979773bda96SJonathan Lemon struct pci_dev *pdev = bp->pdev; 9801618df6aSJonathan Lemon struct ptp_ocp_i2c_info *info; 981773bda96SJonathan Lemon struct platform_device *p; 982773bda96SJonathan Lemon struct clk_hw *clk; 983773bda96SJonathan Lemon char buf[32]; 984773bda96SJonathan Lemon int id; 985773bda96SJonathan Lemon 986773bda96SJonathan Lemon if (r->irq_vec > bp->n_irqs) { 987773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "i2c device irq %d out of range\n", 988773bda96SJonathan Lemon r->irq_vec); 989773bda96SJonathan Lemon return 0; 990773bda96SJonathan Lemon } 991773bda96SJonathan Lemon 9921618df6aSJonathan Lemon info = r->extra; 993773bda96SJonathan Lemon id = pci_dev_id(bp->pdev); 994773bda96SJonathan Lemon 995773bda96SJonathan Lemon sprintf(buf, "AXI.%d", id); 9961618df6aSJonathan Lemon clk = clk_hw_register_fixed_rate(&pdev->dev, buf, NULL, 0, 9971618df6aSJonathan Lemon info->fixed_rate); 998773bda96SJonathan Lemon if (IS_ERR(clk)) 999773bda96SJonathan Lemon return PTR_ERR(clk); 1000773bda96SJonathan Lemon bp->i2c_clk = clk; 1001773bda96SJonathan Lemon 10021618df6aSJonathan Lemon sprintf(buf, "%s.%d", info->name, id); 1003773bda96SJonathan Lemon devm_clk_hw_register_clkdev(&pdev->dev, clk, NULL, buf); 1004773bda96SJonathan Lemon p = ptp_ocp_i2c_bus(bp->pdev, r, id); 1005773bda96SJonathan Lemon if (IS_ERR(p)) 1006773bda96SJonathan Lemon return PTR_ERR(p); 1007773bda96SJonathan Lemon 1008773bda96SJonathan Lemon bp_assign_entry(bp, r, p); 1009773bda96SJonathan Lemon 1010773bda96SJonathan Lemon return 0; 1011773bda96SJonathan Lemon } 1012773bda96SJonathan Lemon 1013773bda96SJonathan Lemon static irqreturn_t 1014773bda96SJonathan Lemon ptp_ocp_ts_irq(int irq, void *priv) 1015773bda96SJonathan Lemon { 1016773bda96SJonathan Lemon struct ptp_ocp_ext_src *ext = priv; 1017773bda96SJonathan Lemon struct ts_reg __iomem *reg = ext->mem; 1018773bda96SJonathan Lemon struct ptp_clock_event ev; 1019773bda96SJonathan Lemon u32 sec, nsec; 1020773bda96SJonathan Lemon 1021773bda96SJonathan Lemon /* XXX should fix API - this converts s/ns -> ts -> s/ns */ 1022773bda96SJonathan Lemon sec = ioread32(®->time_sec); 1023773bda96SJonathan Lemon nsec = ioread32(®->time_ns); 1024773bda96SJonathan Lemon 1025773bda96SJonathan Lemon ev.type = PTP_CLOCK_EXTTS; 1026773bda96SJonathan Lemon ev.index = ext->info->index; 1027773bda96SJonathan Lemon ev.timestamp = sec * 1000000000ULL + nsec; 1028773bda96SJonathan Lemon 1029773bda96SJonathan Lemon ptp_clock_event(ext->bp->ptp, &ev); 1030773bda96SJonathan Lemon 1031773bda96SJonathan Lemon iowrite32(1, ®->intr); /* write 1 to ack */ 1032773bda96SJonathan Lemon 1033773bda96SJonathan Lemon return IRQ_HANDLED; 1034773bda96SJonathan Lemon } 1035773bda96SJonathan Lemon 1036773bda96SJonathan Lemon static int 1037773bda96SJonathan Lemon ptp_ocp_ts_enable(void *priv, bool enable) 1038773bda96SJonathan Lemon { 1039773bda96SJonathan Lemon struct ptp_ocp_ext_src *ext = priv; 1040773bda96SJonathan Lemon struct ts_reg __iomem *reg = ext->mem; 1041773bda96SJonathan Lemon 1042773bda96SJonathan Lemon if (enable) { 1043773bda96SJonathan Lemon iowrite32(1, ®->enable); 1044773bda96SJonathan Lemon iowrite32(1, ®->intr_mask); 1045773bda96SJonathan Lemon iowrite32(1, ®->intr); 1046773bda96SJonathan Lemon } else { 1047773bda96SJonathan Lemon iowrite32(0, ®->intr_mask); 1048773bda96SJonathan Lemon iowrite32(0, ®->enable); 1049773bda96SJonathan Lemon } 1050773bda96SJonathan Lemon 1051773bda96SJonathan Lemon return 0; 1052773bda96SJonathan Lemon } 1053773bda96SJonathan Lemon 1054773bda96SJonathan Lemon static void 1055773bda96SJonathan Lemon ptp_ocp_unregister_ext(struct ptp_ocp_ext_src *ext) 1056773bda96SJonathan Lemon { 1057773bda96SJonathan Lemon ext->info->enable(ext, false); 1058773bda96SJonathan Lemon pci_free_irq(ext->bp->pdev, ext->irq_vec, ext); 1059773bda96SJonathan Lemon kfree(ext); 1060773bda96SJonathan Lemon } 1061773bda96SJonathan Lemon 1062773bda96SJonathan Lemon static int 1063773bda96SJonathan Lemon ptp_ocp_register_ext(struct ptp_ocp *bp, struct ocp_resource *r) 1064773bda96SJonathan Lemon { 1065773bda96SJonathan Lemon struct pci_dev *pdev = bp->pdev; 1066773bda96SJonathan Lemon struct ptp_ocp_ext_src *ext; 1067773bda96SJonathan Lemon int err; 1068773bda96SJonathan Lemon 1069773bda96SJonathan Lemon ext = kzalloc(sizeof(*ext), GFP_KERNEL); 1070773bda96SJonathan Lemon if (!ext) 1071773bda96SJonathan Lemon return -ENOMEM; 1072773bda96SJonathan Lemon 1073773bda96SJonathan Lemon err = -EINVAL; 1074773bda96SJonathan Lemon ext->mem = ptp_ocp_get_mem(bp, r); 1075773bda96SJonathan Lemon if (!ext->mem) 1076773bda96SJonathan Lemon goto out; 1077773bda96SJonathan Lemon 1078773bda96SJonathan Lemon ext->bp = bp; 1079773bda96SJonathan Lemon ext->info = r->extra; 1080773bda96SJonathan Lemon ext->irq_vec = r->irq_vec; 1081773bda96SJonathan Lemon 1082773bda96SJonathan Lemon err = pci_request_irq(pdev, r->irq_vec, ext->info->irq_fcn, NULL, 1083773bda96SJonathan Lemon ext, "ocp%d.%s", bp->id, ext->info->name); 1084773bda96SJonathan Lemon if (err) { 1085773bda96SJonathan Lemon dev_err(&pdev->dev, "Could not get irq %d\n", r->irq_vec); 1086773bda96SJonathan Lemon goto out; 1087773bda96SJonathan Lemon } 1088773bda96SJonathan Lemon 1089773bda96SJonathan Lemon bp_assign_entry(bp, r, ext); 1090773bda96SJonathan Lemon 1091773bda96SJonathan Lemon return 0; 1092773bda96SJonathan Lemon 1093773bda96SJonathan Lemon out: 1094773bda96SJonathan Lemon kfree(ext); 1095773bda96SJonathan Lemon return err; 1096773bda96SJonathan Lemon } 1097773bda96SJonathan Lemon 1098773bda96SJonathan Lemon static int 1099773bda96SJonathan Lemon ptp_ocp_serial_line(struct ptp_ocp *bp, struct ocp_resource *r) 1100773bda96SJonathan Lemon { 1101773bda96SJonathan Lemon struct pci_dev *pdev = bp->pdev; 1102773bda96SJonathan Lemon struct uart_8250_port uart; 1103773bda96SJonathan Lemon 1104773bda96SJonathan Lemon /* Setting UPF_IOREMAP and leaving port.membase unspecified lets 1105773bda96SJonathan Lemon * the serial port device claim and release the pci resource. 1106773bda96SJonathan Lemon */ 1107773bda96SJonathan Lemon memset(&uart, 0, sizeof(uart)); 1108773bda96SJonathan Lemon uart.port.dev = &pdev->dev; 1109773bda96SJonathan Lemon uart.port.iotype = UPIO_MEM; 1110773bda96SJonathan Lemon uart.port.regshift = 2; 1111773bda96SJonathan Lemon uart.port.mapbase = pci_resource_start(pdev, 0) + r->offset; 1112773bda96SJonathan Lemon uart.port.irq = pci_irq_vector(pdev, r->irq_vec); 1113773bda96SJonathan Lemon uart.port.uartclk = 50000000; 1114773bda96SJonathan Lemon uart.port.flags = UPF_FIXED_TYPE | UPF_IOREMAP; 1115773bda96SJonathan Lemon uart.port.type = PORT_16550A; 1116773bda96SJonathan Lemon 1117773bda96SJonathan Lemon return serial8250_register_8250_port(&uart); 1118773bda96SJonathan Lemon } 1119773bda96SJonathan Lemon 1120773bda96SJonathan Lemon static int 1121773bda96SJonathan Lemon ptp_ocp_register_serial(struct ptp_ocp *bp, struct ocp_resource *r) 1122773bda96SJonathan Lemon { 1123773bda96SJonathan Lemon int port; 1124773bda96SJonathan Lemon 1125773bda96SJonathan Lemon if (r->irq_vec > bp->n_irqs) { 1126773bda96SJonathan Lemon dev_err(&bp->pdev->dev, "serial device irq %d out of range\n", 1127773bda96SJonathan Lemon r->irq_vec); 1128773bda96SJonathan Lemon return 0; 1129773bda96SJonathan Lemon } 1130773bda96SJonathan Lemon 1131773bda96SJonathan Lemon port = ptp_ocp_serial_line(bp, r); 1132773bda96SJonathan Lemon if (port < 0) 1133773bda96SJonathan Lemon return port; 1134773bda96SJonathan Lemon 1135773bda96SJonathan Lemon bp_assign_entry(bp, r, port); 1136773bda96SJonathan Lemon 1137773bda96SJonathan Lemon return 0; 1138773bda96SJonathan Lemon } 1139773bda96SJonathan Lemon 1140773bda96SJonathan Lemon static int 1141773bda96SJonathan Lemon ptp_ocp_register_mem(struct ptp_ocp *bp, struct ocp_resource *r) 1142773bda96SJonathan Lemon { 1143773bda96SJonathan Lemon void __iomem *mem; 1144773bda96SJonathan Lemon 1145773bda96SJonathan Lemon mem = ptp_ocp_get_mem(bp, r); 1146773bda96SJonathan Lemon if (!mem) 1147773bda96SJonathan Lemon return -EINVAL; 1148773bda96SJonathan Lemon 1149773bda96SJonathan Lemon bp_assign_entry(bp, r, mem); 1150773bda96SJonathan Lemon 1151773bda96SJonathan Lemon return 0; 1152773bda96SJonathan Lemon } 1153773bda96SJonathan Lemon 1154773bda96SJonathan Lemon /* FB specific board initializers; last "resource" registered. */ 1155773bda96SJonathan Lemon static int 1156773bda96SJonathan Lemon ptp_ocp_fb_board_init(struct ptp_ocp *bp, struct ocp_resource *r) 1157773bda96SJonathan Lemon { 1158773bda96SJonathan Lemon bp->flash_start = 1024 * 4096; 1159773bda96SJonathan Lemon 1160773bda96SJonathan Lemon return ptp_ocp_init_clock(bp); 1161773bda96SJonathan Lemon } 1162773bda96SJonathan Lemon 1163773bda96SJonathan Lemon static int 1164773bda96SJonathan Lemon ptp_ocp_register_resources(struct ptp_ocp *bp, kernel_ulong_t driver_data) 1165773bda96SJonathan Lemon { 1166773bda96SJonathan Lemon struct ocp_resource *r, *table; 1167773bda96SJonathan Lemon int err = 0; 1168773bda96SJonathan Lemon 1169773bda96SJonathan Lemon table = (struct ocp_resource *)driver_data; 1170773bda96SJonathan Lemon for (r = table; r->setup; r++) { 1171773bda96SJonathan Lemon err = r->setup(bp, r); 1172773bda96SJonathan Lemon if (err) 1173773bda96SJonathan Lemon break; 1174773bda96SJonathan Lemon } 1175773bda96SJonathan Lemon return err; 1176773bda96SJonathan Lemon } 1177773bda96SJonathan Lemon 1178773bda96SJonathan Lemon static ssize_t 1179773bda96SJonathan Lemon serialnum_show(struct device *dev, struct device_attribute *attr, char *buf) 1180773bda96SJonathan Lemon { 1181773bda96SJonathan Lemon struct ptp_ocp *bp = dev_get_drvdata(dev); 1182773bda96SJonathan Lemon 1183773bda96SJonathan Lemon if (!bp->has_serial) 1184773bda96SJonathan Lemon ptp_ocp_get_serial_number(bp); 1185773bda96SJonathan Lemon 1186773bda96SJonathan Lemon return sysfs_emit(buf, "%pM\n", bp->serial); 1187773bda96SJonathan Lemon } 1188773bda96SJonathan Lemon static DEVICE_ATTR_RO(serialnum); 1189773bda96SJonathan Lemon 1190773bda96SJonathan Lemon static ssize_t 1191ef0cfb34SJonathan Lemon gnss_sync_show(struct device *dev, struct device_attribute *attr, char *buf) 1192773bda96SJonathan Lemon { 1193773bda96SJonathan Lemon struct ptp_ocp *bp = dev_get_drvdata(dev); 1194773bda96SJonathan Lemon ssize_t ret; 1195773bda96SJonathan Lemon 1196ef0cfb34SJonathan Lemon if (bp->gnss_lost) 1197ef0cfb34SJonathan Lemon ret = sysfs_emit(buf, "LOST @ %ptT\n", &bp->gnss_lost); 1198773bda96SJonathan Lemon else 1199773bda96SJonathan Lemon ret = sysfs_emit(buf, "SYNC\n"); 1200773bda96SJonathan Lemon 1201773bda96SJonathan Lemon return ret; 1202773bda96SJonathan Lemon } 1203ef0cfb34SJonathan Lemon static DEVICE_ATTR_RO(gnss_sync); 1204773bda96SJonathan Lemon 1205773bda96SJonathan Lemon static ssize_t 1206773bda96SJonathan Lemon clock_source_show(struct device *dev, struct device_attribute *attr, char *buf) 1207773bda96SJonathan Lemon { 1208773bda96SJonathan Lemon struct ptp_ocp *bp = dev_get_drvdata(dev); 1209773bda96SJonathan Lemon const char *p; 1210773bda96SJonathan Lemon u32 select; 1211773bda96SJonathan Lemon 1212773bda96SJonathan Lemon select = ioread32(&bp->reg->select); 1213773bda96SJonathan Lemon p = ptp_ocp_clock_name_from_val(select >> 16); 1214773bda96SJonathan Lemon 1215773bda96SJonathan Lemon return sysfs_emit(buf, "%s\n", p); 1216773bda96SJonathan Lemon } 1217773bda96SJonathan Lemon 1218773bda96SJonathan Lemon static ssize_t 1219773bda96SJonathan Lemon clock_source_store(struct device *dev, struct device_attribute *attr, 1220773bda96SJonathan Lemon const char *buf, size_t count) 1221773bda96SJonathan Lemon { 1222773bda96SJonathan Lemon struct ptp_ocp *bp = dev_get_drvdata(dev); 1223773bda96SJonathan Lemon unsigned long flags; 1224773bda96SJonathan Lemon int val; 1225773bda96SJonathan Lemon 1226773bda96SJonathan Lemon val = ptp_ocp_clock_val_from_name(buf); 1227773bda96SJonathan Lemon if (val < 0) 1228773bda96SJonathan Lemon return val; 1229773bda96SJonathan Lemon 1230773bda96SJonathan Lemon spin_lock_irqsave(&bp->lock, flags); 1231773bda96SJonathan Lemon iowrite32(val, &bp->reg->select); 1232773bda96SJonathan Lemon spin_unlock_irqrestore(&bp->lock, flags); 1233773bda96SJonathan Lemon 1234773bda96SJonathan Lemon return count; 1235773bda96SJonathan Lemon } 1236773bda96SJonathan Lemon static DEVICE_ATTR_RW(clock_source); 1237773bda96SJonathan Lemon 1238773bda96SJonathan Lemon static ssize_t 1239773bda96SJonathan Lemon available_clock_sources_show(struct device *dev, 1240773bda96SJonathan Lemon struct device_attribute *attr, char *buf) 1241773bda96SJonathan Lemon { 1242773bda96SJonathan Lemon const char *clk; 1243773bda96SJonathan Lemon ssize_t count; 1244773bda96SJonathan Lemon int i; 1245773bda96SJonathan Lemon 1246773bda96SJonathan Lemon count = 0; 1247773bda96SJonathan Lemon for (i = 0; i < ARRAY_SIZE(ptp_ocp_clock); i++) { 1248773bda96SJonathan Lemon clk = ptp_ocp_clock[i].name; 1249773bda96SJonathan Lemon count += sysfs_emit_at(buf, count, "%s ", clk); 1250773bda96SJonathan Lemon } 1251773bda96SJonathan Lemon if (count) 1252773bda96SJonathan Lemon count--; 1253773bda96SJonathan Lemon count += sysfs_emit_at(buf, count, "\n"); 1254773bda96SJonathan Lemon return count; 1255773bda96SJonathan Lemon } 1256773bda96SJonathan Lemon static DEVICE_ATTR_RO(available_clock_sources); 1257773bda96SJonathan Lemon 1258773bda96SJonathan Lemon static struct attribute *timecard_attrs[] = { 1259773bda96SJonathan Lemon &dev_attr_serialnum.attr, 1260ef0cfb34SJonathan Lemon &dev_attr_gnss_sync.attr, 1261773bda96SJonathan Lemon &dev_attr_clock_source.attr, 1262773bda96SJonathan Lemon &dev_attr_available_clock_sources.attr, 1263773bda96SJonathan Lemon NULL, 1264773bda96SJonathan Lemon }; 1265773bda96SJonathan Lemon ATTRIBUTE_GROUPS(timecard); 1266773bda96SJonathan Lemon 1267773bda96SJonathan Lemon static void 1268773bda96SJonathan Lemon ptp_ocp_dev_release(struct device *dev) 1269773bda96SJonathan Lemon { 1270773bda96SJonathan Lemon struct ptp_ocp *bp = dev_get_drvdata(dev); 1271773bda96SJonathan Lemon 1272773bda96SJonathan Lemon mutex_lock(&ptp_ocp_lock); 1273773bda96SJonathan Lemon idr_remove(&ptp_ocp_idr, bp->id); 1274773bda96SJonathan Lemon mutex_unlock(&ptp_ocp_lock); 1275773bda96SJonathan Lemon } 1276773bda96SJonathan Lemon 1277773bda96SJonathan Lemon static int 1278773bda96SJonathan Lemon ptp_ocp_device_init(struct ptp_ocp *bp, struct pci_dev *pdev) 1279773bda96SJonathan Lemon { 1280773bda96SJonathan Lemon int err; 1281773bda96SJonathan Lemon 1282773bda96SJonathan Lemon mutex_lock(&ptp_ocp_lock); 1283773bda96SJonathan Lemon err = idr_alloc(&ptp_ocp_idr, bp, 0, 0, GFP_KERNEL); 1284773bda96SJonathan Lemon mutex_unlock(&ptp_ocp_lock); 1285773bda96SJonathan Lemon if (err < 0) { 1286773bda96SJonathan Lemon dev_err(&pdev->dev, "idr_alloc failed: %d\n", err); 1287773bda96SJonathan Lemon return err; 1288773bda96SJonathan Lemon } 1289773bda96SJonathan Lemon bp->id = err; 1290773bda96SJonathan Lemon 1291773bda96SJonathan Lemon bp->ptp_info = ptp_ocp_clock_info; 1292773bda96SJonathan Lemon spin_lock_init(&bp->lock); 1293ef0cfb34SJonathan Lemon bp->gnss_port = -1; 1294773bda96SJonathan Lemon bp->mac_port = -1; 1295773bda96SJonathan Lemon bp->pdev = pdev; 1296773bda96SJonathan Lemon 1297773bda96SJonathan Lemon device_initialize(&bp->dev); 1298773bda96SJonathan Lemon dev_set_name(&bp->dev, "ocp%d", bp->id); 1299773bda96SJonathan Lemon bp->dev.class = &timecard_class; 1300773bda96SJonathan Lemon bp->dev.parent = &pdev->dev; 1301773bda96SJonathan Lemon bp->dev.release = ptp_ocp_dev_release; 1302773bda96SJonathan Lemon dev_set_drvdata(&bp->dev, bp); 1303773bda96SJonathan Lemon 1304773bda96SJonathan Lemon err = device_add(&bp->dev); 1305773bda96SJonathan Lemon if (err) { 1306773bda96SJonathan Lemon dev_err(&bp->dev, "device add failed: %d\n", err); 1307773bda96SJonathan Lemon goto out; 1308773bda96SJonathan Lemon } 1309773bda96SJonathan Lemon 1310773bda96SJonathan Lemon pci_set_drvdata(pdev, bp); 1311773bda96SJonathan Lemon 1312773bda96SJonathan Lemon return 0; 1313773bda96SJonathan Lemon 1314773bda96SJonathan Lemon out: 1315773bda96SJonathan Lemon ptp_ocp_dev_release(&bp->dev); 1316d12f23faSJonathan Lemon put_device(&bp->dev); 1317773bda96SJonathan Lemon return err; 1318773bda96SJonathan Lemon } 1319773bda96SJonathan Lemon 1320773bda96SJonathan Lemon static void 1321773bda96SJonathan Lemon ptp_ocp_symlink(struct ptp_ocp *bp, struct device *child, const char *link) 1322773bda96SJonathan Lemon { 1323773bda96SJonathan Lemon struct device *dev = &bp->dev; 1324773bda96SJonathan Lemon 1325773bda96SJonathan Lemon if (sysfs_create_link(&dev->kobj, &child->kobj, link)) 1326773bda96SJonathan Lemon dev_err(dev, "%s symlink failed\n", link); 1327773bda96SJonathan Lemon } 1328773bda96SJonathan Lemon 1329773bda96SJonathan Lemon static void 1330773bda96SJonathan Lemon ptp_ocp_link_child(struct ptp_ocp *bp, const char *name, const char *link) 1331773bda96SJonathan Lemon { 1332773bda96SJonathan Lemon struct device *dev, *child; 1333773bda96SJonathan Lemon 1334773bda96SJonathan Lemon dev = &bp->pdev->dev; 1335773bda96SJonathan Lemon 1336773bda96SJonathan Lemon child = device_find_child_by_name(dev, name); 1337773bda96SJonathan Lemon if (!child) { 1338773bda96SJonathan Lemon dev_err(dev, "Could not find device %s\n", name); 1339773bda96SJonathan Lemon return; 1340773bda96SJonathan Lemon } 1341773bda96SJonathan Lemon 1342773bda96SJonathan Lemon ptp_ocp_symlink(bp, child, link); 1343773bda96SJonathan Lemon put_device(child); 1344773bda96SJonathan Lemon } 1345773bda96SJonathan Lemon 1346773bda96SJonathan Lemon static int 1347773bda96SJonathan Lemon ptp_ocp_complete(struct ptp_ocp *bp) 1348773bda96SJonathan Lemon { 1349773bda96SJonathan Lemon struct pps_device *pps; 1350773bda96SJonathan Lemon char buf[32]; 1351773bda96SJonathan Lemon 1352ef0cfb34SJonathan Lemon if (bp->gnss_port != -1) { 1353ef0cfb34SJonathan Lemon sprintf(buf, "ttyS%d", bp->gnss_port); 1354ef0cfb34SJonathan Lemon ptp_ocp_link_child(bp, buf, "ttyGNSS"); 1355773bda96SJonathan Lemon } 1356773bda96SJonathan Lemon if (bp->mac_port != -1) { 1357773bda96SJonathan Lemon sprintf(buf, "ttyS%d", bp->mac_port); 1358773bda96SJonathan Lemon ptp_ocp_link_child(bp, buf, "ttyMAC"); 1359773bda96SJonathan Lemon } 1360773bda96SJonathan Lemon sprintf(buf, "ptp%d", ptp_clock_index(bp->ptp)); 1361773bda96SJonathan Lemon ptp_ocp_link_child(bp, buf, "ptp"); 1362773bda96SJonathan Lemon 1363773bda96SJonathan Lemon pps = pps_lookup_dev(bp->ptp); 1364773bda96SJonathan Lemon if (pps) 1365773bda96SJonathan Lemon ptp_ocp_symlink(bp, pps->dev, "pps"); 1366773bda96SJonathan Lemon 1367773bda96SJonathan Lemon if (device_add_groups(&bp->dev, timecard_groups)) 1368773bda96SJonathan Lemon pr_err("device add groups failed\n"); 1369773bda96SJonathan Lemon 1370773bda96SJonathan Lemon return 0; 1371773bda96SJonathan Lemon } 1372773bda96SJonathan Lemon 1373773bda96SJonathan Lemon static void 1374773bda96SJonathan Lemon ptp_ocp_resource_summary(struct ptp_ocp *bp) 1375773bda96SJonathan Lemon { 1376773bda96SJonathan Lemon struct device *dev = &bp->pdev->dev; 1377773bda96SJonathan Lemon 1378773bda96SJonathan Lemon if (bp->image) { 1379773bda96SJonathan Lemon u32 ver = ioread32(&bp->image->version); 1380773bda96SJonathan Lemon 1381773bda96SJonathan Lemon dev_info(dev, "version %x\n", ver); 1382773bda96SJonathan Lemon if (ver & 0xffff) 1383773bda96SJonathan Lemon dev_info(dev, "regular image, version %d\n", 1384773bda96SJonathan Lemon ver & 0xffff); 1385773bda96SJonathan Lemon else 1386773bda96SJonathan Lemon dev_info(dev, "golden image, version %d\n", 1387773bda96SJonathan Lemon ver >> 16); 1388773bda96SJonathan Lemon } 1389ef0cfb34SJonathan Lemon if (bp->gnss_port != -1) 1390ef0cfb34SJonathan Lemon dev_info(dev, "GNSS @ /dev/ttyS%d 115200\n", bp->gnss_port); 1391773bda96SJonathan Lemon if (bp->mac_port != -1) 1392773bda96SJonathan Lemon dev_info(dev, "MAC @ /dev/ttyS%d 57600\n", bp->mac_port); 1393773bda96SJonathan Lemon } 1394773bda96SJonathan Lemon 1395773bda96SJonathan Lemon static void 1396773bda96SJonathan Lemon ptp_ocp_detach_sysfs(struct ptp_ocp *bp) 1397773bda96SJonathan Lemon { 1398773bda96SJonathan Lemon struct device *dev = &bp->dev; 1399773bda96SJonathan Lemon 1400ef0cfb34SJonathan Lemon sysfs_remove_link(&dev->kobj, "ttyGNSS"); 1401773bda96SJonathan Lemon sysfs_remove_link(&dev->kobj, "ttyMAC"); 1402773bda96SJonathan Lemon sysfs_remove_link(&dev->kobj, "ptp"); 1403773bda96SJonathan Lemon sysfs_remove_link(&dev->kobj, "pps"); 1404773bda96SJonathan Lemon device_remove_groups(dev, timecard_groups); 1405773bda96SJonathan Lemon } 1406773bda96SJonathan Lemon 1407773bda96SJonathan Lemon static void 1408773bda96SJonathan Lemon ptp_ocp_detach(struct ptp_ocp *bp) 1409773bda96SJonathan Lemon { 1410773bda96SJonathan Lemon ptp_ocp_detach_sysfs(bp); 1411773bda96SJonathan Lemon if (timer_pending(&bp->watchdog)) 1412773bda96SJonathan Lemon del_timer_sync(&bp->watchdog); 1413773bda96SJonathan Lemon if (bp->ts0) 1414773bda96SJonathan Lemon ptp_ocp_unregister_ext(bp->ts0); 1415773bda96SJonathan Lemon if (bp->ts1) 1416773bda96SJonathan Lemon ptp_ocp_unregister_ext(bp->ts1); 1417773bda96SJonathan Lemon if (bp->pps) 1418773bda96SJonathan Lemon ptp_ocp_unregister_ext(bp->pps); 1419ef0cfb34SJonathan Lemon if (bp->gnss_port != -1) 1420ef0cfb34SJonathan Lemon serial8250_unregister_port(bp->gnss_port); 1421773bda96SJonathan Lemon if (bp->mac_port != -1) 1422773bda96SJonathan Lemon serial8250_unregister_port(bp->mac_port); 1423773bda96SJonathan Lemon if (bp->spi_flash) 1424773bda96SJonathan Lemon platform_device_unregister(bp->spi_flash); 1425773bda96SJonathan Lemon if (bp->i2c_ctrl) 1426773bda96SJonathan Lemon platform_device_unregister(bp->i2c_ctrl); 1427773bda96SJonathan Lemon if (bp->i2c_clk) 1428773bda96SJonathan Lemon clk_hw_unregister_fixed_rate(bp->i2c_clk); 1429773bda96SJonathan Lemon if (bp->n_irqs) 1430773bda96SJonathan Lemon pci_free_irq_vectors(bp->pdev); 1431773bda96SJonathan Lemon if (bp->ptp) 1432773bda96SJonathan Lemon ptp_clock_unregister(bp->ptp); 1433773bda96SJonathan Lemon device_unregister(&bp->dev); 1434773bda96SJonathan Lemon } 1435773bda96SJonathan Lemon 1436a7e1abadSJonathan Lemon static int 1437a7e1abadSJonathan Lemon ptp_ocp_probe(struct pci_dev *pdev, const struct pci_device_id *id) 1438a7e1abadSJonathan Lemon { 1439773bda96SJonathan Lemon struct devlink *devlink; 1440a7e1abadSJonathan Lemon struct ptp_ocp *bp; 1441a7e1abadSJonathan Lemon int err; 1442a7e1abadSJonathan Lemon 1443919d13a7SLeon Romanovsky devlink = devlink_alloc(&ptp_ocp_devlink_ops, sizeof(*bp), &pdev->dev); 1444773bda96SJonathan Lemon if (!devlink) { 1445773bda96SJonathan Lemon dev_err(&pdev->dev, "devlink_alloc failed\n"); 1446a7e1abadSJonathan Lemon return -ENOMEM; 1447773bda96SJonathan Lemon } 1448773bda96SJonathan Lemon 1449919d13a7SLeon Romanovsky err = devlink_register(devlink); 1450773bda96SJonathan Lemon if (err) 1451773bda96SJonathan Lemon goto out_free; 1452a7e1abadSJonathan Lemon 1453a7e1abadSJonathan Lemon err = pci_enable_device(pdev); 1454a7e1abadSJonathan Lemon if (err) { 1455a7e1abadSJonathan Lemon dev_err(&pdev->dev, "pci_enable_device\n"); 1456773bda96SJonathan Lemon goto out_unregister; 1457a7e1abadSJonathan Lemon } 1458a7e1abadSJonathan Lemon 1459773bda96SJonathan Lemon bp = devlink_priv(devlink); 1460773bda96SJonathan Lemon err = ptp_ocp_device_init(bp, pdev); 1461773bda96SJonathan Lemon if (err) 1462d9fdbf13SJonathan Lemon goto out_disable; 1463a7e1abadSJonathan Lemon 1464773bda96SJonathan Lemon /* compat mode. 1465773bda96SJonathan Lemon * Older FPGA firmware only returns 2 irq's. 1466773bda96SJonathan Lemon * allow this - if not all of the IRQ's are returned, skip the 1467773bda96SJonathan Lemon * extra devices and just register the clock. 1468773bda96SJonathan Lemon */ 1469773bda96SJonathan Lemon err = pci_alloc_irq_vectors(pdev, 1, 10, PCI_IRQ_MSI | PCI_IRQ_MSIX); 1470773bda96SJonathan Lemon if (err < 0) { 1471773bda96SJonathan Lemon dev_err(&pdev->dev, "alloc_irq_vectors err: %d\n", err); 1472773bda96SJonathan Lemon goto out; 1473a7e1abadSJonathan Lemon } 1474773bda96SJonathan Lemon bp->n_irqs = err; 1475773bda96SJonathan Lemon pci_set_master(pdev); 1476a7e1abadSJonathan Lemon 1477773bda96SJonathan Lemon err = ptp_ocp_register_resources(bp, id->driver_data); 1478a7e1abadSJonathan Lemon if (err) 1479a7e1abadSJonathan Lemon goto out; 1480a7e1abadSJonathan Lemon 1481a7e1abadSJonathan Lemon bp->ptp = ptp_clock_register(&bp->ptp_info, &pdev->dev); 1482a7e1abadSJonathan Lemon if (IS_ERR(bp->ptp)) { 1483a7e1abadSJonathan Lemon err = PTR_ERR(bp->ptp); 1484773bda96SJonathan Lemon dev_err(&pdev->dev, "ptp_clock_register: %d\n", err); 1485773bda96SJonathan Lemon bp->ptp = NULL; 1486a7e1abadSJonathan Lemon goto out; 1487a7e1abadSJonathan Lemon } 1488a7e1abadSJonathan Lemon 1489773bda96SJonathan Lemon err = ptp_ocp_complete(bp); 1490773bda96SJonathan Lemon if (err) 1491773bda96SJonathan Lemon goto out; 1492773bda96SJonathan Lemon 1493a7e1abadSJonathan Lemon ptp_ocp_info(bp); 1494773bda96SJonathan Lemon ptp_ocp_resource_summary(bp); 1495a7e1abadSJonathan Lemon 1496a7e1abadSJonathan Lemon return 0; 1497a7e1abadSJonathan Lemon 1498a7e1abadSJonathan Lemon out: 1499773bda96SJonathan Lemon ptp_ocp_detach(bp); 1500773bda96SJonathan Lemon pci_set_drvdata(pdev, NULL); 1501d9fdbf13SJonathan Lemon out_disable: 1502d9fdbf13SJonathan Lemon pci_disable_device(pdev); 1503773bda96SJonathan Lemon out_unregister: 1504919d13a7SLeon Romanovsky devlink_unregister(devlink); 1505a7e1abadSJonathan Lemon out_free: 1506773bda96SJonathan Lemon devlink_free(devlink); 1507a7e1abadSJonathan Lemon 1508a7e1abadSJonathan Lemon return err; 1509a7e1abadSJonathan Lemon } 1510a7e1abadSJonathan Lemon 1511a7e1abadSJonathan Lemon static void 1512a7e1abadSJonathan Lemon ptp_ocp_remove(struct pci_dev *pdev) 1513a7e1abadSJonathan Lemon { 1514a7e1abadSJonathan Lemon struct ptp_ocp *bp = pci_get_drvdata(pdev); 1515773bda96SJonathan Lemon struct devlink *devlink = priv_to_devlink(bp); 1516a7e1abadSJonathan Lemon 1517773bda96SJonathan Lemon ptp_ocp_detach(bp); 1518a7e1abadSJonathan Lemon pci_set_drvdata(pdev, NULL); 1519d9fdbf13SJonathan Lemon pci_disable_device(pdev); 1520773bda96SJonathan Lemon 1521919d13a7SLeon Romanovsky devlink_unregister(devlink); 1522773bda96SJonathan Lemon devlink_free(devlink); 1523a7e1abadSJonathan Lemon } 1524a7e1abadSJonathan Lemon 1525a7e1abadSJonathan Lemon static struct pci_driver ptp_ocp_driver = { 1526a7e1abadSJonathan Lemon .name = KBUILD_MODNAME, 1527a7e1abadSJonathan Lemon .id_table = ptp_ocp_pcidev_id, 1528a7e1abadSJonathan Lemon .probe = ptp_ocp_probe, 1529a7e1abadSJonathan Lemon .remove = ptp_ocp_remove, 1530a7e1abadSJonathan Lemon }; 1531a7e1abadSJonathan Lemon 1532773bda96SJonathan Lemon static int 1533773bda96SJonathan Lemon ptp_ocp_i2c_notifier_call(struct notifier_block *nb, 1534773bda96SJonathan Lemon unsigned long action, void *data) 1535773bda96SJonathan Lemon { 1536773bda96SJonathan Lemon struct device *dev, *child = data; 1537773bda96SJonathan Lemon struct ptp_ocp *bp; 1538773bda96SJonathan Lemon bool add; 1539773bda96SJonathan Lemon 1540773bda96SJonathan Lemon switch (action) { 1541773bda96SJonathan Lemon case BUS_NOTIFY_ADD_DEVICE: 1542773bda96SJonathan Lemon case BUS_NOTIFY_DEL_DEVICE: 1543773bda96SJonathan Lemon add = action == BUS_NOTIFY_ADD_DEVICE; 1544773bda96SJonathan Lemon break; 1545773bda96SJonathan Lemon default: 1546773bda96SJonathan Lemon return 0; 1547773bda96SJonathan Lemon } 1548773bda96SJonathan Lemon 1549773bda96SJonathan Lemon if (!i2c_verify_adapter(child)) 1550773bda96SJonathan Lemon return 0; 1551773bda96SJonathan Lemon 1552773bda96SJonathan Lemon dev = child; 1553773bda96SJonathan Lemon while ((dev = dev->parent)) 1554773bda96SJonathan Lemon if (dev->driver && !strcmp(dev->driver->name, KBUILD_MODNAME)) 1555773bda96SJonathan Lemon goto found; 1556773bda96SJonathan Lemon return 0; 1557773bda96SJonathan Lemon 1558773bda96SJonathan Lemon found: 1559773bda96SJonathan Lemon bp = dev_get_drvdata(dev); 1560773bda96SJonathan Lemon if (add) 1561773bda96SJonathan Lemon ptp_ocp_symlink(bp, child, "i2c"); 1562773bda96SJonathan Lemon else 1563773bda96SJonathan Lemon sysfs_remove_link(&bp->dev.kobj, "i2c"); 1564773bda96SJonathan Lemon 1565773bda96SJonathan Lemon return 0; 1566773bda96SJonathan Lemon } 1567773bda96SJonathan Lemon 1568773bda96SJonathan Lemon static struct notifier_block ptp_ocp_i2c_notifier = { 1569773bda96SJonathan Lemon .notifier_call = ptp_ocp_i2c_notifier_call, 1570773bda96SJonathan Lemon }; 1571773bda96SJonathan Lemon 1572a7e1abadSJonathan Lemon static int __init 1573a7e1abadSJonathan Lemon ptp_ocp_init(void) 1574a7e1abadSJonathan Lemon { 1575773bda96SJonathan Lemon const char *what; 1576a7e1abadSJonathan Lemon int err; 1577a7e1abadSJonathan Lemon 1578773bda96SJonathan Lemon what = "timecard class"; 1579773bda96SJonathan Lemon err = class_register(&timecard_class); 1580773bda96SJonathan Lemon if (err) 1581773bda96SJonathan Lemon goto out; 1582773bda96SJonathan Lemon 1583773bda96SJonathan Lemon what = "i2c notifier"; 1584773bda96SJonathan Lemon err = bus_register_notifier(&i2c_bus_type, &ptp_ocp_i2c_notifier); 1585773bda96SJonathan Lemon if (err) 1586773bda96SJonathan Lemon goto out_notifier; 1587773bda96SJonathan Lemon 1588773bda96SJonathan Lemon what = "ptp_ocp driver"; 1589a7e1abadSJonathan Lemon err = pci_register_driver(&ptp_ocp_driver); 1590773bda96SJonathan Lemon if (err) 1591773bda96SJonathan Lemon goto out_register; 1592773bda96SJonathan Lemon 1593773bda96SJonathan Lemon return 0; 1594773bda96SJonathan Lemon 1595773bda96SJonathan Lemon out_register: 1596773bda96SJonathan Lemon bus_unregister_notifier(&i2c_bus_type, &ptp_ocp_i2c_notifier); 1597773bda96SJonathan Lemon out_notifier: 1598773bda96SJonathan Lemon class_unregister(&timecard_class); 1599773bda96SJonathan Lemon out: 1600773bda96SJonathan Lemon pr_err(KBUILD_MODNAME ": failed to register %s: %d\n", what, err); 1601a7e1abadSJonathan Lemon return err; 1602a7e1abadSJonathan Lemon } 1603a7e1abadSJonathan Lemon 1604a7e1abadSJonathan Lemon static void __exit 1605a7e1abadSJonathan Lemon ptp_ocp_fini(void) 1606a7e1abadSJonathan Lemon { 1607773bda96SJonathan Lemon bus_unregister_notifier(&i2c_bus_type, &ptp_ocp_i2c_notifier); 1608a7e1abadSJonathan Lemon pci_unregister_driver(&ptp_ocp_driver); 1609773bda96SJonathan Lemon class_unregister(&timecard_class); 1610a7e1abadSJonathan Lemon } 1611a7e1abadSJonathan Lemon 1612a7e1abadSJonathan Lemon module_init(ptp_ocp_init); 1613a7e1abadSJonathan Lemon module_exit(ptp_ocp_fini); 1614a7e1abadSJonathan Lemon 1615a7e1abadSJonathan Lemon MODULE_DESCRIPTION("OpenCompute TimeCard driver"); 1616a7e1abadSJonathan Lemon MODULE_LICENSE("GPL v2"); 1617