Lines Matching +full:ext +full:- +full:gen
1 // SPDX-License-Identifier: GPL-2.0-only
13 #include <linux/clk-provider.h>
15 #include <linux/platform_data/i2c-xiic.h>
16 #include <linux/platform_data/i2c-ocores.h>
24 #include <linux/nvmem-consumer.h>
409 static int ptp_ocp_signal_from_perout(struct ptp_ocp *bp, int gen,
437 (void *)((uintptr_t)(bp) + (map)->bp_offset); \
453 uintptr_t addr = (uintptr_t)(bp) + (res)->bp_offset; \
493 --
650 .name = "xiic-i2c",
700 .modalias = "spi-nor",
825 .modalias = "spi-nor",
834 .name = "ocores-i2c",
990 .modalias = "spi-nor",
999 .name = "ocores-i2c",
1005 .reg_io_width = 4, // 32-bit/4-byte
1006 .reg_shift = 2, // 32-bit addressing
1055 { .name = "EXT", .value = 0xff },
1146 return bp->sma_op->init(bp); in ptp_ocp_sma_init()
1152 return bp->sma_op->get(bp, sma_nr); in ptp_ocp_sma_get()
1158 return bp->sma_op->set_inputs(bp, sma_nr, val); in ptp_ocp_sma_set_inputs()
1164 return bp->sma_op->set_output(bp, sma_nr, val); in ptp_ocp_sma_set_output()
1189 return -EINVAL; in ptp_ocp_select_val_from_name()
1202 count--; in ptp_ocp_select_table_show()
1217 iowrite32(ctrl, &bp->reg->ctrl); in __ptp_ocp_gettime_locked()
1220 ctrl = ioread32(&bp->reg->ctrl); in __ptp_ocp_gettime_locked()
1226 if (sts && bp->ts_window_adjust) { in __ptp_ocp_gettime_locked()
1227 s64 ns = timespec64_to_ns(&sts->post_ts); in __ptp_ocp_gettime_locked()
1229 sts->post_ts = ns_to_timespec64(ns - bp->ts_window_adjust); in __ptp_ocp_gettime_locked()
1232 time_ns = ioread32(&bp->reg->time_ns); in __ptp_ocp_gettime_locked()
1233 time_sec = ioread32(&bp->reg->time_sec); in __ptp_ocp_gettime_locked()
1235 ts->tv_sec = time_sec; in __ptp_ocp_gettime_locked()
1236 ts->tv_nsec = time_ns; in __ptp_ocp_gettime_locked()
1238 return ctrl & OCP_CTRL_READ_TIME_DONE ? 0 : -ETIMEDOUT; in __ptp_ocp_gettime_locked()
1249 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_gettimex()
1251 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_gettimex()
1262 time_ns = ts->tv_nsec; in __ptp_ocp_settime_locked()
1263 time_sec = ts->tv_sec; in __ptp_ocp_settime_locked()
1265 select = ioread32(&bp->reg->select); in __ptp_ocp_settime_locked()
1266 iowrite32(OCP_SELECT_CLK_REG, &bp->reg->select); in __ptp_ocp_settime_locked()
1268 iowrite32(time_ns, &bp->reg->adjust_ns); in __ptp_ocp_settime_locked()
1269 iowrite32(time_sec, &bp->reg->adjust_sec); in __ptp_ocp_settime_locked()
1272 iowrite32(ctrl, &bp->reg->ctrl); in __ptp_ocp_settime_locked()
1275 iowrite32(select >> 16, &bp->reg->select); in __ptp_ocp_settime_locked()
1284 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_settime()
1286 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_settime()
1296 select = ioread32(&bp->reg->select); in __ptp_ocp_adjtime_locked()
1297 iowrite32(OCP_SELECT_CLK_REG, &bp->reg->select); in __ptp_ocp_adjtime_locked()
1299 iowrite32(adj_val, &bp->reg->offset_ns); in __ptp_ocp_adjtime_locked()
1300 iowrite32(NSEC_PER_SEC, &bp->reg->offset_window_ns); in __ptp_ocp_adjtime_locked()
1303 iowrite32(ctrl, &bp->reg->ctrl); in __ptp_ocp_adjtime_locked()
1306 iowrite32(select >> 16, &bp->reg->select); in __ptp_ocp_adjtime_locked()
1316 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_adjtime_coarse()
1323 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_adjtime_coarse()
1333 if (delta_ns > NSEC_PER_SEC || -delta_ns > NSEC_PER_SEC) { in ptp_ocp_adjtime()
1339 adj_ns = sign ? -delta_ns : delta_ns; in ptp_ocp_adjtime()
1341 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_adjtime()
1343 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_adjtime()
1354 return -EOPNOTSUPP; in ptp_ocp_null_adjfine()
1366 return -EOPNOTSUPP; in ptp_ocp_null_adjphase()
1374 struct ptp_ocp_ext_src *ext = NULL; in ptp_ocp_enable() local
1378 switch (rq->type) { in ptp_ocp_enable()
1381 switch (rq->extts.index) { in ptp_ocp_enable()
1383 ext = bp->ts0; in ptp_ocp_enable()
1386 ext = bp->ts1; in ptp_ocp_enable()
1389 ext = bp->ts2; in ptp_ocp_enable()
1392 ext = bp->ts3; in ptp_ocp_enable()
1395 ext = bp->ts4; in ptp_ocp_enable()
1398 ext = bp->pps; in ptp_ocp_enable()
1404 ext = bp->pps; in ptp_ocp_enable()
1407 switch (rq->perout.index) { in ptp_ocp_enable()
1412 if (on && (rq->perout.period.sec != 1 || in ptp_ocp_enable()
1413 rq->perout.period.nsec != 0)) in ptp_ocp_enable()
1414 return -EINVAL; in ptp_ocp_enable()
1420 req = rq->perout.index - 1; in ptp_ocp_enable()
1421 ext = bp->signal_out[req]; in ptp_ocp_enable()
1422 err = ptp_ocp_signal_from_perout(bp, req, &rq->perout); in ptp_ocp_enable()
1429 return -EOPNOTSUPP; in ptp_ocp_enable()
1432 err = -ENXIO; in ptp_ocp_enable()
1433 if (ext) in ptp_ocp_enable()
1434 err = ext->info->enable(ext, req, on); in ptp_ocp_enable()
1458 snprintf(buf, sizeof(buf), "OUT: GEN%d", chan); in ptp_ocp_verify()
1463 return -EOPNOTSUPP; in ptp_ocp_verify()
1491 select = ioread32(&bp->reg->select); in __ptp_ocp_clear_drift_locked()
1492 iowrite32(OCP_SELECT_CLK_REG, &bp->reg->select); in __ptp_ocp_clear_drift_locked()
1494 iowrite32(0, &bp->reg->drift_ns); in __ptp_ocp_clear_drift_locked()
1497 iowrite32(ctrl, &bp->reg->ctrl); in __ptp_ocp_clear_drift_locked()
1500 iowrite32(select >> 16, &bp->reg->select); in __ptp_ocp_clear_drift_locked()
1508 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_utc_distribute()
1510 bp->utc_tai_offset = val; in ptp_ocp_utc_distribute()
1512 if (bp->irig_out) in ptp_ocp_utc_distribute()
1513 iowrite32(val, &bp->irig_out->adj_sec); in ptp_ocp_utc_distribute()
1514 if (bp->dcf_out) in ptp_ocp_utc_distribute()
1515 iowrite32(val, &bp->dcf_out->adj_sec); in ptp_ocp_utc_distribute()
1516 if (bp->nmea_out) in ptp_ocp_utc_distribute()
1517 iowrite32(val, &bp->nmea_out->adj_sec); in ptp_ocp_utc_distribute()
1519 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_utc_distribute()
1529 status = ioread32(&bp->pps_to_clk->status); in ptp_ocp_watchdog()
1532 iowrite32(status, &bp->pps_to_clk->status); in ptp_ocp_watchdog()
1533 if (!bp->gnss_lost) { in ptp_ocp_watchdog()
1534 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_watchdog()
1536 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_watchdog()
1537 bp->gnss_lost = ktime_get_real_seconds(); in ptp_ocp_watchdog()
1540 } else if (bp->gnss_lost) { in ptp_ocp_watchdog()
1541 bp->gnss_lost = 0; in ptp_ocp_watchdog()
1547 if (bp->tod) { in ptp_ocp_watchdog()
1548 status = ioread32(&bp->tod->utc_status); in ptp_ocp_watchdog()
1551 utc_offset != bp->utc_tai_offset) in ptp_ocp_watchdog()
1555 mod_timer(&bp->watchdog, jiffies + HZ); in ptp_ocp_watchdog()
1566 ctrl = ioread32(&bp->reg->ctrl); in ptp_ocp_estimate_pci_timing()
1569 iowrite32(ctrl, &bp->reg->ctrl); in ptp_ocp_estimate_pci_timing()
1573 ctrl = ioread32(&bp->reg->ctrl); in ptp_ocp_estimate_pci_timing()
1577 delay = min(delay, end - start); in ptp_ocp_estimate_pci_timing()
1579 bp->ts_window_adjust = (delay >> 5) * 3; in ptp_ocp_estimate_pci_timing()
1589 iowrite32(ctrl, &bp->reg->ctrl); in ptp_ocp_init_clock()
1592 iowrite32(servo_conf->servo_offset_p, &bp->reg->servo_offset_p); in ptp_ocp_init_clock()
1593 iowrite32(servo_conf->servo_offset_i, &bp->reg->servo_offset_i); in ptp_ocp_init_clock()
1594 iowrite32(servo_conf->servo_drift_p, &bp->reg->servo_drift_p); in ptp_ocp_init_clock()
1595 iowrite32(servo_conf->servo_drift_p, &bp->reg->servo_drift_i); in ptp_ocp_init_clock()
1599 iowrite32(ctrl, &bp->reg->ctrl); in ptp_ocp_init_clock()
1601 if ((ioread32(&bp->reg->ctrl) & OCP_CTRL_ENABLE) == 0) { in ptp_ocp_init_clock()
1602 dev_err(&bp->pdev->dev, "clock not enabled\n"); in ptp_ocp_init_clock()
1603 return -ENODEV; in ptp_ocp_init_clock()
1608 bp->sync = ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC; in ptp_ocp_init_clock()
1609 if (!bp->sync) { in ptp_ocp_init_clock()
1611 ptp_ocp_settime(&bp->ptp_info, &ts); in ptp_ocp_init_clock()
1615 if (bp->pps_to_clk) { in ptp_ocp_init_clock()
1616 timer_setup(&bp->watchdog, ptp_ocp_watchdog, 0); in ptp_ocp_init_clock()
1617 mod_timer(&bp->watchdog, jiffies + HZ); in ptp_ocp_init_clock()
1628 ctrl = ioread32(&bp->tod->ctrl); in ptp_ocp_tod_init()
1631 iowrite32(ctrl, &bp->tod->ctrl); in ptp_ocp_tod_init()
1633 reg = ioread32(&bp->tod->utc_status); in ptp_ocp_tod_init()
1656 idx = ARRAY_SIZE(gnss_name) - 1; in ptp_ocp_tod_gnss_name()
1679 dev = dev->parent; in ptp_ocp_nvmem_match()
1680 if (!i2c_verify_client(dev) || info->tag != dev->platform_data) in ptp_ocp_nvmem_match()
1683 while ((dev = dev->parent)) in ptp_ocp_nvmem_match()
1684 if (dev->driver && !strcmp(dev->driver->name, KBUILD_MODNAME)) in ptp_ocp_nvmem_match()
1685 return info->bp == dev_get_drvdata(dev); in ptp_ocp_nvmem_match()
1713 if (!bp->i2c_ctrl) in ptp_ocp_read_eeprom()
1719 for (map = bp->eeprom_map; map->len; map++) { in ptp_ocp_read_eeprom()
1720 if (map->tag != tag) { in ptp_ocp_read_eeprom()
1721 tag = map->tag; in ptp_ocp_read_eeprom()
1731 ret = nvmem_device_read(nvmem, map->off, map->len, in ptp_ocp_read_eeprom()
1733 if (ret != map->len) in ptp_ocp_read_eeprom()
1737 bp->has_eeprom_data = true; in ptp_ocp_read_eeprom()
1744 dev_err(&bp->pdev->dev, "could not read eeprom: %d\n", ret); in ptp_ocp_read_eeprom()
1754 dev = &bp->spi_flash->dev; in ptp_ocp_find_flash()
1776 hdr = (const struct ptp_ocp_firmware_header *)fw->data; in ptp_ocp_devlink_fw_image()
1777 if (memcmp(hdr->magic, OCP_FIRMWARE_MAGIC_HEADER, 4)) { in ptp_ocp_devlink_fw_image()
1781 return -EINVAL; in ptp_ocp_devlink_fw_image()
1784 if (be16_to_cpu(hdr->pci_vendor_id) != bp->pdev->vendor || in ptp_ocp_devlink_fw_image()
1785 be16_to_cpu(hdr->pci_device_id) != bp->pdev->device) { in ptp_ocp_devlink_fw_image()
1789 return -EINVAL; in ptp_ocp_devlink_fw_image()
1793 length = be32_to_cpu(hdr->image_size); in ptp_ocp_devlink_fw_image()
1794 if (length != (fw->size - offset)) { in ptp_ocp_devlink_fw_image()
1798 return -EINVAL; in ptp_ocp_devlink_fw_image()
1801 crc = crc16(0xffff, &fw->data[offset], length); in ptp_ocp_devlink_fw_image()
1802 if (be16_to_cpu(hdr->crc) != crc) { in ptp_ocp_devlink_fw_image()
1806 return -EINVAL; in ptp_ocp_devlink_fw_image()
1809 *data = &fw->data[offset]; in ptp_ocp_devlink_fw_image()
1832 base = bp->flash_start; in ptp_ocp_devlink_flash()
1853 resid -= len; in ptp_ocp_devlink_flash()
1871 dev_err(&bp->pdev->dev, "Can't find Flash SPI adapter\n"); in ptp_ocp_devlink_flash_update()
1872 return -ENODEV; in ptp_ocp_devlink_flash_update()
1878 err = ptp_ocp_devlink_flash(devlink, dev, params->fw); in ptp_ocp_devlink_flash_update()
1896 fw_image = bp->fw_loader ? "loader" : "fw"; in ptp_ocp_devlink_info_get()
1897 sprintf(buf, "%d.%d", bp->fw_tag, bp->fw_version); in ptp_ocp_devlink_info_get()
1902 if (!bp->has_eeprom_data) { in ptp_ocp_devlink_info_get()
1904 if (!bp->has_eeprom_data) in ptp_ocp_devlink_info_get()
1908 sprintf(buf, "%pM", bp->serial); in ptp_ocp_devlink_info_get()
1915 bp->board_id); in ptp_ocp_devlink_info_get()
1932 return devm_ioremap_resource(&bp->pdev->dev, &res); in __ptp_ocp_get_mem()
1940 start = pci_resource_start(bp->pdev, 0) + r->offset; in ptp_ocp_get_mem()
1941 return __ptp_ocp_get_mem(bp, start, r->size); in ptp_ocp_get_mem()
1948 struct pci_dev *pdev = bp->pdev; in ptp_ocp_register_spi()
1954 start = pci_resource_start(pdev, 0) + r->offset; in ptp_ocp_register_spi()
1955 res[0] = DEFINE_RES_MEM(start, r->size); in ptp_ocp_register_spi()
1956 res[1] = DEFINE_RES_IRQ(pci_irq_vector(pdev, r->irq_vec)); in ptp_ocp_register_spi()
1958 info = r->extra; in ptp_ocp_register_spi()
1960 id += info->pci_offset; in ptp_ocp_register_spi()
1962 p = platform_device_register_resndata(&pdev->dev, info->name, id, in ptp_ocp_register_spi()
1963 res, ARRAY_SIZE(res), info->data, in ptp_ocp_register_spi()
1964 info->data_size); in ptp_ocp_register_spi()
1980 info = r->extra; in ptp_ocp_i2c_bus()
1981 start = pci_resource_start(pdev, 0) + r->offset; in ptp_ocp_i2c_bus()
1982 res[0] = DEFINE_RES_MEM(start, r->size); in ptp_ocp_i2c_bus()
1983 res[1] = DEFINE_RES_IRQ(pci_irq_vector(pdev, r->irq_vec)); in ptp_ocp_i2c_bus()
1985 return platform_device_register_resndata(&pdev->dev, info->name, in ptp_ocp_i2c_bus()
1987 info->data, info->data_size); in ptp_ocp_i2c_bus()
1993 struct pci_dev *pdev = bp->pdev; in ptp_ocp_register_i2c()
2000 info = r->extra; in ptp_ocp_register_i2c()
2001 id = pci_dev_id(bp->pdev); in ptp_ocp_register_i2c()
2004 clk = clk_hw_register_fixed_rate(&pdev->dev, buf, NULL, 0, in ptp_ocp_register_i2c()
2005 info->fixed_rate); in ptp_ocp_register_i2c()
2008 bp->i2c_clk = clk; in ptp_ocp_register_i2c()
2010 sprintf(buf, "%s.%d", info->name, id); in ptp_ocp_register_i2c()
2011 devm_clk_hw_register_clkdev(&pdev->dev, clk, NULL, buf); in ptp_ocp_register_i2c()
2012 p = ptp_ocp_i2c_bus(bp->pdev, r, id); in ptp_ocp_register_i2c()
2025 struct ptp_ocp_ext_src *ext = priv; in ptp_ocp_signal_irq() local
2026 struct signal_reg __iomem *reg = ext->mem; in ptp_ocp_signal_irq()
2027 struct ptp_ocp *bp = ext->bp; in ptp_ocp_signal_irq()
2029 int gen; in ptp_ocp_signal_irq() local
2031 gen = ext->info->index - 1; in ptp_ocp_signal_irq()
2033 enable = ioread32(®->enable); in ptp_ocp_signal_irq()
2034 status = ioread32(®->status); in ptp_ocp_signal_irq()
2038 iowrite32(0, ®->intr_mask); in ptp_ocp_signal_irq()
2039 iowrite32(0, ®->enable); in ptp_ocp_signal_irq()
2040 bp->signal[gen].running = false; in ptp_ocp_signal_irq()
2043 iowrite32(0, ®->intr); /* ack interrupt */ in ptp_ocp_signal_irq()
2049 ptp_ocp_signal_set(struct ptp_ocp *bp, int gen, struct ptp_ocp_signal *s) in ptp_ocp_signal_set() argument
2056 if (!s->period) in ptp_ocp_signal_set()
2059 if (!s->pulse) in ptp_ocp_signal_set()
2060 s->pulse = ktime_divns(s->period * s->duty, 100); in ptp_ocp_signal_set()
2062 err = ptp_ocp_gettimex(&bp->ptp_info, &ts, &sts); in ptp_ocp_signal_set()
2067 if (!s->start) { in ptp_ocp_signal_set()
2068 /* roundup() does not work on 32-bit systems */ in ptp_ocp_signal_set()
2069 s->start = DIV64_U64_ROUND_UP(start_ns, s->period); in ptp_ocp_signal_set()
2070 s->start *= s->period; in ptp_ocp_signal_set()
2071 s->start = ktime_add(s->start, s->phase); in ptp_ocp_signal_set()
2074 if (s->duty < 1 || s->duty > 99) in ptp_ocp_signal_set()
2075 return -EINVAL; in ptp_ocp_signal_set()
2077 if (s->pulse < 1 || s->pulse > s->period) in ptp_ocp_signal_set()
2078 return -EINVAL; in ptp_ocp_signal_set()
2080 if (s->start < start_ns) in ptp_ocp_signal_set()
2081 return -EINVAL; in ptp_ocp_signal_set()
2083 bp->signal[gen] = *s; in ptp_ocp_signal_set()
2089 ptp_ocp_signal_from_perout(struct ptp_ocp *bp, int gen, in ptp_ocp_signal_from_perout() argument
2094 if (req->flags & ~(PTP_PEROUT_DUTY_CYCLE | in ptp_ocp_signal_from_perout()
2096 return -EOPNOTSUPP; in ptp_ocp_signal_from_perout()
2098 s.polarity = bp->signal[gen].polarity; in ptp_ocp_signal_from_perout()
2099 s.period = ktime_set(req->period.sec, req->period.nsec); in ptp_ocp_signal_from_perout()
2103 if (req->flags & PTP_PEROUT_DUTY_CYCLE) { in ptp_ocp_signal_from_perout()
2104 s.pulse = ktime_set(req->on.sec, req->on.nsec); in ptp_ocp_signal_from_perout()
2108 if (req->flags & PTP_PEROUT_PHASE) in ptp_ocp_signal_from_perout()
2109 s.phase = ktime_set(req->phase.sec, req->phase.nsec); in ptp_ocp_signal_from_perout()
2111 s.start = ktime_set(req->start.sec, req->start.nsec); in ptp_ocp_signal_from_perout()
2113 return ptp_ocp_signal_set(bp, gen, &s); in ptp_ocp_signal_from_perout()
2119 struct ptp_ocp_ext_src *ext = priv; in ptp_ocp_signal_enable() local
2120 struct signal_reg __iomem *reg = ext->mem; in ptp_ocp_signal_enable()
2121 struct ptp_ocp *bp = ext->bp; in ptp_ocp_signal_enable()
2123 int gen; in ptp_ocp_signal_enable() local
2125 gen = ext->info->index - 1; in ptp_ocp_signal_enable()
2127 iowrite32(0, ®->intr_mask); in ptp_ocp_signal_enable()
2128 iowrite32(0, ®->enable); in ptp_ocp_signal_enable()
2129 bp->signal[gen].running = false; in ptp_ocp_signal_enable()
2133 ts = ktime_to_timespec64(bp->signal[gen].start); in ptp_ocp_signal_enable()
2134 iowrite32(ts.tv_sec, ®->start_sec); in ptp_ocp_signal_enable()
2135 iowrite32(ts.tv_nsec, ®->start_ns); in ptp_ocp_signal_enable()
2137 ts = ktime_to_timespec64(bp->signal[gen].period); in ptp_ocp_signal_enable()
2138 iowrite32(ts.tv_sec, ®->period_sec); in ptp_ocp_signal_enable()
2139 iowrite32(ts.tv_nsec, ®->period_ns); in ptp_ocp_signal_enable()
2141 ts = ktime_to_timespec64(bp->signal[gen].pulse); in ptp_ocp_signal_enable()
2142 iowrite32(ts.tv_sec, ®->pulse_sec); in ptp_ocp_signal_enable()
2143 iowrite32(ts.tv_nsec, ®->pulse_ns); in ptp_ocp_signal_enable()
2145 iowrite32(bp->signal[gen].polarity, ®->polarity); in ptp_ocp_signal_enable()
2146 iowrite32(0, ®->repeat_count); in ptp_ocp_signal_enable()
2148 iowrite32(0, ®->intr); /* clear interrupt state */ in ptp_ocp_signal_enable()
2149 iowrite32(1, ®->intr_mask); /* enable interrupt */ in ptp_ocp_signal_enable()
2150 iowrite32(3, ®->enable); /* valid & enable */ in ptp_ocp_signal_enable()
2152 bp->signal[gen].running = true; in ptp_ocp_signal_enable()
2160 struct ptp_ocp_ext_src *ext = priv; in ptp_ocp_ts_irq() local
2161 struct ts_reg __iomem *reg = ext->mem; in ptp_ocp_ts_irq()
2165 if (ext == ext->bp->pps) { in ptp_ocp_ts_irq()
2166 if (ext->bp->pps_req_map & OCP_REQ_PPS) { in ptp_ocp_ts_irq()
2168 ptp_clock_event(ext->bp->ptp, &ev); in ptp_ocp_ts_irq()
2171 if ((ext->bp->pps_req_map & ~OCP_REQ_PPS) == 0) in ptp_ocp_ts_irq()
2175 /* XXX should fix API - this converts s/ns -> ts -> s/ns */ in ptp_ocp_ts_irq()
2176 sec = ioread32(®->time_sec); in ptp_ocp_ts_irq()
2177 nsec = ioread32(®->time_ns); in ptp_ocp_ts_irq()
2180 ev.index = ext->info->index; in ptp_ocp_ts_irq()
2183 ptp_clock_event(ext->bp->ptp, &ev); in ptp_ocp_ts_irq()
2186 iowrite32(1, ®->intr); /* write 1 to ack */ in ptp_ocp_ts_irq()
2194 struct ptp_ocp_ext_src *ext = priv; in ptp_ocp_ts_enable() local
2195 struct ts_reg __iomem *reg = ext->mem; in ptp_ocp_ts_enable()
2196 struct ptp_ocp *bp = ext->bp; in ptp_ocp_ts_enable()
2198 if (ext == bp->pps) { in ptp_ocp_ts_enable()
2199 u32 old_map = bp->pps_req_map; in ptp_ocp_ts_enable()
2202 bp->pps_req_map |= req; in ptp_ocp_ts_enable()
2204 bp->pps_req_map &= ~req; in ptp_ocp_ts_enable()
2207 if ((!!old_map ^ !!bp->pps_req_map) == 0) in ptp_ocp_ts_enable()
2212 iowrite32(1, ®->enable); in ptp_ocp_ts_enable()
2213 iowrite32(1, ®->intr_mask); in ptp_ocp_ts_enable()
2214 iowrite32(1, ®->intr); in ptp_ocp_ts_enable()
2216 iowrite32(0, ®->intr_mask); in ptp_ocp_ts_enable()
2217 iowrite32(0, ®->enable); in ptp_ocp_ts_enable()
2224 ptp_ocp_unregister_ext(struct ptp_ocp_ext_src *ext) in ptp_ocp_unregister_ext() argument
2226 ext->info->enable(ext, ~0, false); in ptp_ocp_unregister_ext()
2227 pci_free_irq(ext->bp->pdev, ext->irq_vec, ext); in ptp_ocp_unregister_ext()
2228 kfree(ext); in ptp_ocp_unregister_ext()
2234 struct pci_dev *pdev = bp->pdev; in ptp_ocp_register_ext()
2235 struct ptp_ocp_ext_src *ext; in ptp_ocp_register_ext() local
2238 ext = kzalloc(sizeof(*ext), GFP_KERNEL); in ptp_ocp_register_ext()
2239 if (!ext) in ptp_ocp_register_ext()
2240 return -ENOMEM; in ptp_ocp_register_ext()
2242 ext->mem = ptp_ocp_get_mem(bp, r); in ptp_ocp_register_ext()
2243 if (IS_ERR(ext->mem)) { in ptp_ocp_register_ext()
2244 err = PTR_ERR(ext->mem); in ptp_ocp_register_ext()
2248 ext->bp = bp; in ptp_ocp_register_ext()
2249 ext->info = r->extra; in ptp_ocp_register_ext()
2250 ext->irq_vec = r->irq_vec; in ptp_ocp_register_ext()
2252 err = pci_request_irq(pdev, r->irq_vec, ext->info->irq_fcn, NULL, in ptp_ocp_register_ext()
2253 ext, "ocp%d.%s", bp->id, r->name); in ptp_ocp_register_ext()
2255 dev_err(&pdev->dev, "Could not get irq %d\n", r->irq_vec); in ptp_ocp_register_ext()
2259 bp_assign_entry(bp, r, ext); in ptp_ocp_register_ext()
2264 kfree(ext); in ptp_ocp_register_ext()
2271 struct pci_dev *pdev = bp->pdev; in ptp_ocp_serial_line()
2278 uart.port.dev = &pdev->dev; in ptp_ocp_serial_line()
2281 uart.port.mapbase = pci_resource_start(pdev, 0) + r->offset; in ptp_ocp_serial_line()
2282 uart.port.irq = pci_irq_vector(pdev, r->irq_vec); in ptp_ocp_serial_line()
2293 struct ptp_ocp_serial_port *p = (struct ptp_ocp_serial_port *)r->extra; in ptp_ocp_register_serial()
2301 port.baud = p->baud; in ptp_ocp_register_serial()
2325 if (!bp->nmea_out) in ptp_ocp_nmea_out_init()
2328 iowrite32(0, &bp->nmea_out->ctrl); /* disable */ in ptp_ocp_nmea_out_init()
2329 iowrite32(7, &bp->nmea_out->uart_baud); /* 115200 */ in ptp_ocp_nmea_out_init()
2330 iowrite32(1, &bp->nmea_out->ctrl); /* enable */ in ptp_ocp_nmea_out_init()
2338 iowrite32(0, ®->enable); /* disable */ in _ptp_ocp_signal_init()
2340 val = ioread32(®->polarity); in _ptp_ocp_signal_init()
2341 s->polarity = val ? true : false; in _ptp_ocp_signal_init()
2342 s->duty = 50; in _ptp_ocp_signal_init()
2351 if (bp->signal_out[i]) in ptp_ocp_signal_init()
2352 _ptp_ocp_signal_init(&bp->signal[i], in ptp_ocp_signal_init()
2353 bp->signal_out[i]->mem); in ptp_ocp_signal_init()
2359 sysfs_remove_groups(&bp->dev.kobj, bp->attr_group); in ptp_ocp_attr_group_del()
2360 kfree(bp->attr_group); in ptp_ocp_attr_group_del()
2372 if (attr_tbl[i].cap & bp->fw_cap) in ptp_ocp_attr_group_add()
2375 bp->attr_group = kcalloc(count + 1, sizeof(struct attribute_group *), in ptp_ocp_attr_group_add()
2377 if (!bp->attr_group) in ptp_ocp_attr_group_add()
2378 return -ENOMEM; in ptp_ocp_attr_group_add()
2382 if (attr_tbl[i].cap & bp->fw_cap) in ptp_ocp_attr_group_add()
2383 bp->attr_group[count++] = attr_tbl[i].group; in ptp_ocp_attr_group_add()
2385 err = sysfs_create_groups(&bp->dev.kobj, bp->attr_group); in ptp_ocp_attr_group_add()
2387 bp->attr_group[0] = NULL; in ptp_ocp_attr_group_add()
2410 return ptp_ocp_enable_fpga(&bp->irig_out->ctrl, in ptp_ocp_irig_out()
2417 return ptp_ocp_enable_fpga(&bp->irig_in->ctrl, in ptp_ocp_irig_in()
2424 return ptp_ocp_enable_fpga(&bp->dcf_out->ctrl, in ptp_ocp_dcf_out()
2431 return ptp_ocp_enable_fpga(&bp->dcf_in->ctrl, in ptp_ocp_dcf_in()
2455 if (bp->sma[sma_nr - 1].fixed_fcn) in ptp_ocp_sma_fb_get()
2456 return (sma_nr - 1) & 1; in ptp_ocp_sma_fb_get()
2458 if (bp->sma[sma_nr - 1].mode == SMA_MODE_IN) in ptp_ocp_sma_fb_get()
2459 gpio = sma_nr > 2 ? &bp->sma_map2->gpio1 : &bp->sma_map1->gpio1; in ptp_ocp_sma_fb_get()
2461 gpio = sma_nr > 2 ? &bp->sma_map1->gpio2 : &bp->sma_map2->gpio2; in ptp_ocp_sma_fb_get()
2474 gpio = sma_nr > 2 ? &bp->sma_map1->gpio2 : &bp->sma_map2->gpio2; in ptp_ocp_sma_fb_set_output()
2477 mask = 0xffff << (16 - shift); in ptp_ocp_sma_fb_set_output()
2479 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_sma_fb_set_output()
2488 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_sma_fb_set_output()
2500 gpio = sma_nr > 2 ? &bp->sma_map2->gpio1 : &bp->sma_map1->gpio1; in ptp_ocp_sma_fb_set_inputs()
2503 mask = 0xffff << (16 - shift); in ptp_ocp_sma_fb_set_inputs()
2505 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_sma_fb_set_inputs()
2514 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_sma_fb_set_inputs()
2535 bp->sma[i].default_fcn = i & 1; in ptp_ocp_sma_fb_init()
2536 bp->sma[i].dpll_prop = prop; in ptp_ocp_sma_fb_init()
2537 bp->sma[i].dpll_prop.board_label = in ptp_ocp_sma_fb_init()
2538 bp->ptp_info.pin_config[i].name; in ptp_ocp_sma_fb_init()
2540 bp->sma[0].mode = SMA_MODE_IN; in ptp_ocp_sma_fb_init()
2541 bp->sma[1].mode = SMA_MODE_IN; in ptp_ocp_sma_fb_init()
2542 bp->sma[2].mode = SMA_MODE_OUT; in ptp_ocp_sma_fb_init()
2543 bp->sma[3].mode = SMA_MODE_OUT; in ptp_ocp_sma_fb_init()
2545 if (!bp->sma_map1) { in ptp_ocp_sma_fb_init()
2547 bp->sma[i].fixed_fcn = true; in ptp_ocp_sma_fb_init()
2548 bp->sma[i].fixed_dir = true; in ptp_ocp_sma_fb_init()
2549 bp->sma[1].dpll_prop.capabilities &= in ptp_ocp_sma_fb_init()
2558 reg = ioread32(&bp->sma_map2->gpio2); in ptp_ocp_sma_fb_init()
2561 bp->sma[i].fixed_dir = true; in ptp_ocp_sma_fb_init()
2563 reg = ioread32(&bp->sma_map1->gpio1); in ptp_ocp_sma_fb_init()
2564 bp->sma[0].mode = reg & BIT(15) ? SMA_MODE_IN : SMA_MODE_OUT; in ptp_ocp_sma_fb_init()
2565 bp->sma[1].mode = reg & BIT(31) ? SMA_MODE_IN : SMA_MODE_OUT; in ptp_ocp_sma_fb_init()
2567 reg = ioread32(&bp->sma_map1->gpio2); in ptp_ocp_sma_fb_init()
2568 bp->sma[2].mode = reg & BIT(15) ? SMA_MODE_OUT : SMA_MODE_IN; in ptp_ocp_sma_fb_init()
2569 bp->sma[3].mode = reg & BIT(31) ? SMA_MODE_OUT : SMA_MODE_IN; in ptp_ocp_sma_fb_init()
2597 return -ENOMEM; in ptp_ocp_set_pins()
2604 bp->ptp_info.n_pins = 4; in ptp_ocp_set_pins()
2605 bp->ptp_info.pin_config = config; in ptp_ocp_set_pins()
2616 version = ioread32(&bp->image->version); in ptp_ocp_fb_set_version()
2621 bp->fw_loader = true; in ptp_ocp_fb_set_version()
2624 bp->fw_tag = version >> 15; in ptp_ocp_fb_set_version()
2625 bp->fw_version = version & 0x7fff; in ptp_ocp_fb_set_version()
2627 if (bp->fw_tag) { in ptp_ocp_fb_set_version()
2639 bp->fw_cap = cap; in ptp_ocp_fb_set_version()
2648 bp->flash_start = 1024 * 4096; in ptp_ocp_fb_board_init()
2649 bp->eeprom_map = fb_eeprom_map; in ptp_ocp_fb_board_init()
2650 bp->fw_version = ioread32(&bp->image->version); in ptp_ocp_fb_board_init()
2651 bp->sma_op = &ocp_fb_sma_op; in ptp_ocp_fb_board_init()
2668 return ptp_ocp_init_clock(bp, r->extra); in ptp_ocp_fb_board_init()
2674 bool allow = !r->irq_vec || r->irq_vec < bp->n_irqs; in ptp_ocp_allow_irq()
2677 dev_err(&bp->pdev->dev, "irq %d out of range, skipping %s\n", in ptp_ocp_allow_irq()
2678 r->irq_vec, r->name); in ptp_ocp_allow_irq()
2689 for (r = table; r->setup; r++) { in ptp_ocp_register_resources()
2692 err = r->setup(bp, r); in ptp_ocp_register_resources()
2694 dev_err(&bp->pdev->dev, in ptp_ocp_register_resources()
2696 r->name, err); in ptp_ocp_register_resources()
2718 bp->sma[0].mode = SMA_MODE_IN; in ptp_ocp_art_sma_init()
2719 bp->sma[1].mode = SMA_MODE_IN; in ptp_ocp_art_sma_init()
2720 bp->sma[2].mode = SMA_MODE_OUT; in ptp_ocp_art_sma_init()
2721 bp->sma[3].mode = SMA_MODE_OUT; in ptp_ocp_art_sma_init()
2723 bp->sma[0].default_fcn = 0x08; /* IN: 10Mhz */ in ptp_ocp_art_sma_init()
2724 bp->sma[1].default_fcn = 0x01; /* IN: PPS1 */ in ptp_ocp_art_sma_init()
2725 bp->sma[2].default_fcn = 0x10; /* OUT: 10Mhz */ in ptp_ocp_art_sma_init()
2726 bp->sma[3].default_fcn = 0x02; /* OUT: PHC */ in ptp_ocp_art_sma_init()
2730 bp->sma[i].dpll_prop = prop; in ptp_ocp_art_sma_init()
2731 bp->sma[i].dpll_prop.board_label = in ptp_ocp_art_sma_init()
2732 bp->ptp_info.pin_config[i].name; in ptp_ocp_art_sma_init()
2733 if (!bp->art_sma) { in ptp_ocp_art_sma_init()
2734 bp->sma[i].fixed_fcn = true; in ptp_ocp_art_sma_init()
2735 bp->sma[i].fixed_dir = true; in ptp_ocp_art_sma_init()
2738 reg = ioread32(&bp->art_sma->map[i].gpio); in ptp_ocp_art_sma_init()
2742 bp->sma[i].fixed_fcn = true; in ptp_ocp_art_sma_init()
2743 bp->sma[i].fixed_dir = true; in ptp_ocp_art_sma_init()
2747 bp->sma[i].mode = SMA_MODE_IN; in ptp_ocp_art_sma_init()
2748 bp->sma[i].dpll_prop.capabilities = in ptp_ocp_art_sma_init()
2752 bp->sma[i].mode = SMA_MODE_OUT; in ptp_ocp_art_sma_init()
2753 bp->sma[i].dpll_prop.capabilities = in ptp_ocp_art_sma_init()
2763 if (bp->sma[sma_nr - 1].fixed_fcn) in ptp_ocp_art_sma_get()
2764 return bp->sma[sma_nr - 1].default_fcn; in ptp_ocp_art_sma_get()
2766 return ioread32(&bp->art_sma->map[sma_nr - 1].gpio) & 0xff; in ptp_ocp_art_sma_get()
2780 return -EINVAL; in ptp_ocp_art_sma_set()
2782 gpio = &bp->art_sma->map[sma_nr - 1].gpio; in ptp_ocp_art_sma_set()
2784 spin_lock_irqsave(&bp->lock, flags); in ptp_ocp_art_sma_set()
2787 err = -EOPNOTSUPP; in ptp_ocp_art_sma_set()
2792 spin_unlock_irqrestore(&bp->lock, flags); in ptp_ocp_art_sma_set()
2811 bp->flash_start = 0x1000000; in ptp_ocp_art_board_init()
2812 bp->eeprom_map = art_eeprom_map; in ptp_ocp_art_board_init()
2813 bp->fw_cap = OCP_CAP_BASIC; in ptp_ocp_art_board_init()
2814 bp->fw_version = ioread32(&bp->reg->version); in ptp_ocp_art_board_init()
2815 bp->fw_tag = 2; in ptp_ocp_art_board_init()
2816 bp->sma_op = &ocp_art_sma_op; in ptp_ocp_art_board_init()
2819 iowrite32(1, &bp->board_config->mro50_serial_activate); in ptp_ocp_art_board_init()
2830 return ptp_ocp_init_clock(bp, r->extra); in ptp_ocp_art_board_init()
2840 bp->flash_start = 0xA00000; in ptp_ocp_adva_board_init()
2841 bp->eeprom_map = fb_eeprom_map; in ptp_ocp_adva_board_init()
2842 bp->sma_op = &ocp_adva_sma_op; in ptp_ocp_adva_board_init()
2844 version = ioread32(&bp->image->version); in ptp_ocp_adva_board_init()
2848 bp->fw_loader = true; in ptp_ocp_adva_board_init()
2850 bp->fw_tag = 3; in ptp_ocp_adva_board_init()
2851 bp->fw_version = version & 0xffff; in ptp_ocp_adva_board_init()
2852 bp->fw_cap = OCP_CAP_BASIC | OCP_CAP_SIGNAL | OCP_CAP_FREQ; in ptp_ocp_adva_board_init()
2867 return ptp_ocp_init_clock(bp, r->extra); in ptp_ocp_adva_board_init()
2905 count--; in ptp_ocp_show_inputs()
2920 return -ENOMEM; in sma_parse_inputs()
2922 ret = -EINVAL; in sma_parse_inputs()
2942 ret = -EINVAL; in sma_parse_inputs()
2953 struct ptp_ocp_sma_connector *sma = &bp->sma[sma_nr - 1]; in ptp_ocp_sma_show()
2957 tbl = bp->sma_op->tbl; in ptp_ocp_sma_show()
2960 if (sma->mode == SMA_MODE_IN) { in ptp_ocp_sma_show()
2961 if (sma->disabled) in ptp_ocp_sma_show()
2982 return ptp_ocp_sma_show(bp, 2, buf, -1, 1); in sma2_show()
2990 return ptp_ocp_sma_show(bp, 3, buf, -1, 0); in sma3_show()
2998 return ptp_ocp_sma_show(bp, 4, buf, -1, 1); in sma4_show()
3004 struct ptp_ocp_sma_connector *sma = &bp->sma[sma_nr - 1]; in ptp_ocp_sma_store_val()
3006 if (sma->fixed_dir && (mode != sma->mode || val & SMA_DISABLE)) in ptp_ocp_sma_store_val()
3007 return -EOPNOTSUPP; in ptp_ocp_sma_store_val()
3009 if (sma->fixed_fcn) { in ptp_ocp_sma_store_val()
3010 if (val != sma->default_fcn) in ptp_ocp_sma_store_val()
3011 return -EOPNOTSUPP; in ptp_ocp_sma_store_val()
3015 sma->disabled = !!(val & SMA_DISABLE); in ptp_ocp_sma_store_val()
3017 if (mode != sma->mode) { in ptp_ocp_sma_store_val()
3022 sma->mode = mode; in ptp_ocp_sma_store_val()
3025 if (!sma->fixed_dir) in ptp_ocp_sma_store_val()
3028 if (sma->disabled) in ptp_ocp_sma_store_val()
3042 struct ptp_ocp_sma_connector *sma = &bp->sma[sma_nr - 1]; in ptp_ocp_sma_store()
3046 mode = sma->mode; in ptp_ocp_sma_store()
3047 val = sma_parse_inputs(bp->sma_op->tbl, buf, &mode); in ptp_ocp_sma_store()
3107 return ptp_ocp_select_table_show(bp->sma_op->tbl[0], buf); in available_sma_inputs_show()
3117 return ptp_ocp_select_table_show(bp->sma_op->tbl[1], buf); in available_sma_outputs_show()
3137 int gen = (uintptr_t)ea->var; in signal_store() local
3143 return -ENOMEM; in signal_store()
3145 err = -EINVAL; in signal_store()
3146 s.duty = bp->signal[gen].duty; in signal_store()
3147 s.phase = bp->signal[gen].phase; in signal_store()
3148 s.period = bp->signal[gen].period; in signal_store()
3149 s.polarity = bp->signal[gen].polarity; in signal_store()
3153 argc--; in signal_store()
3159 argc--; in signal_store()
3165 argc--; in signal_store()
3171 argc--; in signal_store()
3180 err = ptp_ocp_signal_set(bp, gen, &s); in signal_store()
3184 err = ptp_ocp_signal_enable(bp->signal_out[gen], gen, s.period != 0); in signal_store()
3201 i = (uintptr_t)ea->var; in signal_show()
3202 signal = &bp->signal[i]; in signal_show()
3204 count = sysfs_emit(buf, "%llu %d %llu %d", signal->period, in signal_show()
3205 signal->duty, signal->phase, signal->polarity); in signal_show()
3207 ts = ktime_to_timespec64(signal->start); in signal_show()
3222 int i = (uintptr_t)ea->var; in duty_show()
3224 return sysfs_emit(buf, "%d\n", bp->signal[i].duty); in duty_show()
3236 int i = (uintptr_t)ea->var; in period_show()
3238 return sysfs_emit(buf, "%llu\n", bp->signal[i].period); in period_show()
3250 int i = (uintptr_t)ea->var; in phase_show()
3252 return sysfs_emit(buf, "%llu\n", bp->signal[i].phase); in phase_show()
3265 int i = (uintptr_t)ea->var; in polarity_show()
3267 return sysfs_emit(buf, "%d\n", bp->signal[i].polarity); in polarity_show()
3279 int i = (uintptr_t)ea->var; in running_show()
3281 return sysfs_emit(buf, "%d\n", bp->signal[i].running); in running_show()
3293 int i = (uintptr_t)ea->var; in start_show()
3296 ts = ktime_to_timespec64(bp->signal[i].start); in start_show()
3310 int idx = (uintptr_t)ea->var; in seconds_store()
3318 return -EINVAL; in seconds_store()
3323 iowrite32(val, &bp->freq_in[idx]->ctrl); in seconds_store()
3333 int idx = (uintptr_t)ea->var; in seconds_show()
3336 val = ioread32(&bp->freq_in[idx]->ctrl); in seconds_show()
3354 int idx = (uintptr_t)ea->var; in frequency_show()
3357 val = ioread32(&bp->freq_in[idx]->status); in frequency_show()
3377 return sysfs_emit(buf, "ttyS%d", bp->port[(uintptr_t)ea->var].line); in ptp_ocp_tty_show()
3388 if (strncmp(attr->name, "tty", 3)) in ptp_ocp_timecard_tty_is_visible()
3389 return attr->mode; in ptp_ocp_timecard_tty_is_visible()
3393 port = &bp->port[(uintptr_t)ea->var]; in ptp_ocp_timecard_tty_is_visible()
3394 return port->line == -1 ? 0 : 0444; in ptp_ocp_timecard_tty_is_visible()
3424 if (!bp->has_eeprom_data) in serialnum_show()
3427 return sysfs_emit(buf, "%pM\n", bp->serial); in serialnum_show()
3437 if (bp->gnss_lost) in gnss_sync_show()
3438 ret = sysfs_emit(buf, "LOST @ %ptT\n", &bp->gnss_lost); in gnss_sync_show()
3452 return sysfs_emit(buf, "%d\n", bp->utc_tai_offset); in utc_tai_offset_show()
3480 return sysfs_emit(buf, "%d\n", bp->ts_window_adjust); in ts_window_adjust_show()
3496 bp->ts_window_adjust = val; in ts_window_adjust_store()
3508 val = ioread32(&bp->irig_out->ctrl); in irig_b_mode_show()
3528 return -EINVAL; in irig_b_mode_store()
3532 spin_lock_irqsave(&bp->lock, flags); in irig_b_mode_store()
3533 iowrite32(0, &bp->irig_out->ctrl); /* disable */ in irig_b_mode_store()
3534 iowrite32(reg, &bp->irig_out->ctrl); /* change mode */ in irig_b_mode_store()
3535 iowrite32(reg | IRIG_M_CTRL_ENABLE, &bp->irig_out->ctrl); in irig_b_mode_store()
3536 spin_unlock_irqrestore(&bp->lock, flags); in irig_b_mode_store()
3549 select = ioread32(&bp->reg->select); in clock_source_show()
3567 spin_lock_irqsave(&bp->lock, flags); in clock_source_store()
3568 iowrite32(val, &bp->reg->select); in clock_source_store()
3569 spin_unlock_irqrestore(&bp->lock, flags); in clock_source_store()
3591 val = ioread32(&bp->reg->status_drift); in clock_status_drift_show()
3592 res = (val & ~INT_MAX) ? -1 : 1; in clock_status_drift_show()
3606 val = ioread32(&bp->reg->status_offset); in clock_status_offset_show()
3607 res = (val & ~INT_MAX) ? -1 : 1; in clock_status_offset_show()
3621 val = ioread32(&bp->tod->adj_sec); in tod_correction_show()
3622 res = (val & ~INT_MAX) ? -1 : 1; in tod_correction_show()
3640 res *= -1; in tod_correction_store()
3645 spin_lock_irqsave(&bp->lock, flags); in tod_correction_store()
3646 iowrite32(val, &bp->tod->adj_sec); in tod_correction_store()
3647 spin_unlock_irqrestore(&bp->lock, flags); in tod_correction_store()
3718 count = size - off; in disciplining_config_read()
3723 err = -EFAULT; in disciplining_config_read()
3744 return -EFAULT; in disciplining_config_write()
3752 err = -EFAULT; in disciplining_config_write()
3780 count = size - off; in temperature_table_read()
3785 err = -EFAULT; in temperature_table_read()
3806 return -EFAULT; in temperature_table_write()
3814 err = -EFAULT; in temperature_table_write()
3931 if (bp->sma[i].mode != SMA_MODE_IN) in gpio_input_map()
3939 def = "----"; in gpio_input_map()
3949 strcpy(ans, "----"); in gpio_output_map()
3951 if (bp->sma[i].mode != SMA_MODE_OUT) in gpio_output_map()
3961 struct signal_reg __iomem *reg = bp->signal_out[nr]->mem; in _signal_summary_show()
3962 struct ptp_ocp_signal *signal = &bp->signal[nr]; in _signal_summary_show()
3970 on = signal->running; in _signal_summary_show()
3971 sprintf(label, "GEN%d", nr + 1); in _signal_summary_show()
3974 signal->period, signal->duty, signal->phase, in _signal_summary_show()
3975 signal->polarity); in _signal_summary_show()
3977 val = ioread32(®->enable); in _signal_summary_show()
3979 val = ioread32(®->status); in _signal_summary_show()
3982 seq_printf(s, " start:%llu\n", signal->start); in _signal_summary_show()
3997 val = ioread32(®->ctrl); in _frequency_summary_show()
4005 val = ioread32(®->status); in _frequency_summary_show()
4018 struct device *dev = s->private; in ptp_ocp_summary_show()
4031 return -ENOMEM; in ptp_ocp_summary_show()
4035 seq_printf(s, "%7s: /dev/ptp%d\n", "PTP", ptp_clock_index(bp->ptp)); in ptp_ocp_summary_show()
4037 if (bp->port[i].line != -1) in ptp_ocp_summary_show()
4039 bp->port[i].line); in ptp_ocp_summary_show()
4043 if (bp->sma_map1) { in ptp_ocp_summary_show()
4046 reg = ioread32(&bp->sma_map1->gpio1); in ptp_ocp_summary_show()
4050 reg = ioread32(&bp->sma_map1->gpio2); in ptp_ocp_summary_show()
4054 reg = ioread32(&bp->sma_map2->gpio1); in ptp_ocp_summary_show()
4058 reg = ioread32(&bp->sma_map2->gpio2); in ptp_ocp_summary_show()
4079 if (bp->ts0) { in ptp_ocp_summary_show()
4080 ts_reg = bp->ts0->mem; in ptp_ocp_summary_show()
4081 on = ioread32(&ts_reg->enable); in ptp_ocp_summary_show()
4087 if (bp->ts1) { in ptp_ocp_summary_show()
4088 ts_reg = bp->ts1->mem; in ptp_ocp_summary_show()
4089 on = ioread32(&ts_reg->enable); in ptp_ocp_summary_show()
4095 if (bp->ts2) { in ptp_ocp_summary_show()
4096 ts_reg = bp->ts2->mem; in ptp_ocp_summary_show()
4097 on = ioread32(&ts_reg->enable); in ptp_ocp_summary_show()
4103 if (bp->ts3) { in ptp_ocp_summary_show()
4104 ts_reg = bp->ts3->mem; in ptp_ocp_summary_show()
4105 on = ioread32(&ts_reg->enable); in ptp_ocp_summary_show()
4111 if (bp->ts4) { in ptp_ocp_summary_show()
4112 ts_reg = bp->ts4->mem; in ptp_ocp_summary_show()
4113 on = ioread32(&ts_reg->enable); in ptp_ocp_summary_show()
4119 if (bp->pps) { in ptp_ocp_summary_show()
4120 ts_reg = bp->pps->mem; in ptp_ocp_summary_show()
4122 on = ioread32(&ts_reg->enable); in ptp_ocp_summary_show()
4123 map = !!(bp->pps_req_map & OCP_REQ_TIMESTAMP); in ptp_ocp_summary_show()
4127 map = !!(bp->pps_req_map & OCP_REQ_PPS); in ptp_ocp_summary_show()
4132 if (bp->fw_cap & OCP_CAP_SIGNAL) in ptp_ocp_summary_show()
4136 if (bp->fw_cap & OCP_CAP_FREQ) in ptp_ocp_summary_show()
4138 _frequency_summary_show(s, i, bp->freq_in[i]); in ptp_ocp_summary_show()
4140 if (bp->irig_out) { in ptp_ocp_summary_show()
4141 ctrl = ioread32(&bp->irig_out->ctrl); in ptp_ocp_summary_show()
4143 val = ioread32(&bp->irig_out->status); in ptp_ocp_summary_show()
4149 if (bp->irig_in) { in ptp_ocp_summary_show()
4150 on = ioread32(&bp->irig_in->ctrl) & IRIG_S_CTRL_ENABLE; in ptp_ocp_summary_show()
4151 val = ioread32(&bp->irig_in->status); in ptp_ocp_summary_show()
4157 if (bp->dcf_out) { in ptp_ocp_summary_show()
4158 on = ioread32(&bp->dcf_out->ctrl) & DCF_M_CTRL_ENABLE; in ptp_ocp_summary_show()
4159 val = ioread32(&bp->dcf_out->status); in ptp_ocp_summary_show()
4165 if (bp->dcf_in) { in ptp_ocp_summary_show()
4166 on = ioread32(&bp->dcf_in->ctrl) & DCF_S_CTRL_ENABLE; in ptp_ocp_summary_show()
4167 val = ioread32(&bp->dcf_in->status); in ptp_ocp_summary_show()
4173 if (bp->nmea_out) { in ptp_ocp_summary_show()
4174 on = ioread32(&bp->nmea_out->ctrl) & 1; in ptp_ocp_summary_show()
4175 val = ioread32(&bp->nmea_out->status); in ptp_ocp_summary_show()
4181 if (bp->pps_select) { in ptp_ocp_summary_show()
4182 val = ioread32(&bp->pps_select->gpio1); in ptp_ocp_summary_show()
4193 src = "----"; in ptp_ocp_summary_show()
4206 val = ioread32(&bp->reg->select); in ptp_ocp_summary_show()
4209 sprintf(buf, "----"); in ptp_ocp_summary_show()
4225 bp->sync ? "sync" : "unsynced"); in ptp_ocp_summary_show()
4227 if (!ptp_ocp_gettimex(&bp->ptp_info, &ts, &sts)) { in ptp_ocp_summary_show()
4234 ns += (s64)bp->utc_tai_offset * NSEC_PER_SEC; in ptp_ocp_summary_show()
4241 bp->utc_tai_offset); in ptp_ocp_summary_show()
4243 timespec64_to_ns(&ts) - ns, in ptp_ocp_summary_show()
4244 post_ns - pre_ns); in ptp_ocp_summary_show()
4255 struct device *dev = s->private; in ptp_ocp_tod_status_show()
4262 val = ioread32(&bp->tod->ctrl); in ptp_ocp_tod_status_show()
4276 val = ioread32(&bp->tod->version); in ptp_ocp_tod_status_show()
4280 val = ioread32(&bp->tod->status); in ptp_ocp_tod_status_show()
4283 val = ioread32(&bp->tod->adj_sec); in ptp_ocp_tod_status_show()
4284 idx = (val & ~INT_MAX) ? -1 : 1; in ptp_ocp_tod_status_show()
4288 val = ioread32(&bp->tod->utc_status); in ptp_ocp_tod_status_show()
4296 val = ioread32(&bp->tod->leap); in ptp_ocp_tod_status_show()
4310 d = debugfs_create_dir(dev_name(&bp->dev), ptp_ocp_debugfs_root); in ptp_ocp_debugfs_add_device()
4311 bp->debug_root = d; in ptp_ocp_debugfs_add_device()
4312 debugfs_create_file("summary", 0444, bp->debug_root, in ptp_ocp_debugfs_add_device()
4313 &bp->dev, &ptp_ocp_summary_fops); in ptp_ocp_debugfs_add_device()
4314 if (bp->tod) in ptp_ocp_debugfs_add_device()
4315 debugfs_create_file("tod_status", 0444, bp->debug_root, in ptp_ocp_debugfs_add_device()
4316 &bp->dev, &ptp_ocp_tod_status_fops); in ptp_ocp_debugfs_add_device()
4322 debugfs_remove_recursive(bp->debug_root); in ptp_ocp_debugfs_remove_device()
4343 idr_remove(&ptp_ocp_idr, bp->id); in ptp_ocp_dev_release()
4356 dev_err(&pdev->dev, "idr_alloc failed: %d\n", err); in ptp_ocp_device_init()
4359 bp->id = err; in ptp_ocp_device_init()
4361 bp->ptp_info = ptp_ocp_clock_info; in ptp_ocp_device_init()
4362 spin_lock_init(&bp->lock); in ptp_ocp_device_init()
4365 bp->port[i].line = -1; in ptp_ocp_device_init()
4367 bp->pdev = pdev; in ptp_ocp_device_init()
4369 device_initialize(&bp->dev); in ptp_ocp_device_init()
4370 dev_set_name(&bp->dev, "ocp%d", bp->id); in ptp_ocp_device_init()
4371 bp->dev.class = &timecard_class; in ptp_ocp_device_init()
4372 bp->dev.parent = &pdev->dev; in ptp_ocp_device_init()
4373 bp->dev.release = ptp_ocp_dev_release; in ptp_ocp_device_init()
4374 dev_set_drvdata(&bp->dev, bp); in ptp_ocp_device_init()
4376 err = device_add(&bp->dev); in ptp_ocp_device_init()
4378 dev_err(&bp->dev, "device add failed: %d\n", err); in ptp_ocp_device_init()
4387 put_device(&bp->dev); in ptp_ocp_device_init()
4394 struct device *dev = &bp->dev; in ptp_ocp_symlink()
4396 if (sysfs_create_link(&dev->kobj, &child->kobj, link)) in ptp_ocp_symlink()
4405 dev = &bp->pdev->dev; in ptp_ocp_link_child()
4423 sprintf(buf, "ptp%d", ptp_clock_index(bp->ptp)); in ptp_ocp_complete()
4426 pps = pps_lookup_dev(bp->ptp); in ptp_ocp_complete()
4428 ptp_ocp_symlink(bp, &pps->dev, "pps"); in ptp_ocp_complete()
4441 version = ioread32(&bp->reg->version); in ptp_ocp_phc_info()
4442 select = ioread32(&bp->reg->select); in ptp_ocp_phc_info()
4443 dev_info(&bp->pdev->dev, "Version %d.%d.%d, clock %s, device ptp%d\n", in ptp_ocp_phc_info()
4446 ptp_clock_index(bp->ptp)); in ptp_ocp_phc_info()
4448 if (!ptp_ocp_gettimex(&bp->ptp_info, &ts, NULL)) in ptp_ocp_phc_info()
4449 dev_info(&bp->pdev->dev, "Time: %lld.%ld, %s\n", in ptp_ocp_phc_info()
4451 bp->sync ? "in-sync" : "UNSYNCED"); in ptp_ocp_phc_info()
4457 if (port != -1) in ptp_ocp_serial_info()
4458 dev_info(dev, "%5s: /dev/ttyS%-2d @ %6d\n", name, port, baud); in ptp_ocp_serial_info()
4469 struct device *dev = &bp->pdev->dev; in ptp_ocp_info()
4476 if (i == PORT_NMEA && bp->nmea_out && bp->port[PORT_NMEA].line != -1) { in ptp_ocp_info()
4477 bp->port[PORT_NMEA].baud = -1; in ptp_ocp_info()
4479 reg = ioread32(&bp->nmea_out->uart_baud); in ptp_ocp_info()
4481 bp->port[PORT_NMEA].baud = nmea_baud[reg]; in ptp_ocp_info()
4483 ptp_ocp_serial_info(dev, ptp_ocp_tty_port_name(i), bp->port[i].line, in ptp_ocp_info()
4484 bp->port[i].baud); in ptp_ocp_info()
4491 struct device *dev = &bp->dev; in ptp_ocp_detach_sysfs()
4493 sysfs_remove_link(&dev->kobj, "ptp"); in ptp_ocp_detach_sysfs()
4494 sysfs_remove_link(&dev->kobj, "pps"); in ptp_ocp_detach_sysfs()
4505 if (timer_pending(&bp->watchdog)) in ptp_ocp_detach()
4506 del_timer_sync(&bp->watchdog); in ptp_ocp_detach()
4507 if (bp->ts0) in ptp_ocp_detach()
4508 ptp_ocp_unregister_ext(bp->ts0); in ptp_ocp_detach()
4509 if (bp->ts1) in ptp_ocp_detach()
4510 ptp_ocp_unregister_ext(bp->ts1); in ptp_ocp_detach()
4511 if (bp->ts2) in ptp_ocp_detach()
4512 ptp_ocp_unregister_ext(bp->ts2); in ptp_ocp_detach()
4513 if (bp->ts3) in ptp_ocp_detach()
4514 ptp_ocp_unregister_ext(bp->ts3); in ptp_ocp_detach()
4515 if (bp->ts4) in ptp_ocp_detach()
4516 ptp_ocp_unregister_ext(bp->ts4); in ptp_ocp_detach()
4517 if (bp->pps) in ptp_ocp_detach()
4518 ptp_ocp_unregister_ext(bp->pps); in ptp_ocp_detach()
4520 if (bp->signal_out[i]) in ptp_ocp_detach()
4521 ptp_ocp_unregister_ext(bp->signal_out[i]); in ptp_ocp_detach()
4523 if (bp->port[i].line != -1) in ptp_ocp_detach()
4524 serial8250_unregister_port(bp->port[i].line); in ptp_ocp_detach()
4525 platform_device_unregister(bp->spi_flash); in ptp_ocp_detach()
4526 platform_device_unregister(bp->i2c_ctrl); in ptp_ocp_detach()
4527 if (bp->i2c_clk) in ptp_ocp_detach()
4528 clk_hw_unregister_fixed_rate(bp->i2c_clk); in ptp_ocp_detach()
4529 if (bp->n_irqs) in ptp_ocp_detach()
4530 pci_free_irq_vectors(bp->pdev); in ptp_ocp_detach()
4531 if (bp->ptp) in ptp_ocp_detach()
4532 ptp_clock_unregister(bp->ptp); in ptp_ocp_detach()
4533 kfree(bp->ptp_info.pin_config); in ptp_ocp_detach()
4534 device_unregister(&bp->dev); in ptp_ocp_detach()
4545 *status = bp->sync ? DPLL_LOCK_STATUS_LOCKED : DPLL_LOCK_STATUS_UNLOCKED; in ptp_ocp_dpll_lock_status_get()
4558 if (bp->pps_select) { in ptp_ocp_dpll_state_get()
4559 idx = ioread32(&bp->pps_select->gpio1); in ptp_ocp_dpll_state_get()
4560 *state = (&bp->sma[idx] == pin_priv) ? DPLL_PIN_STATE_CONNECTED : in ptp_ocp_dpll_state_get()
4565 return -EINVAL; in ptp_ocp_dpll_state_get()
4584 *direction = sma->mode == SMA_MODE_IN ? in ptp_ocp_dpll_direction_get()
4600 int sma_nr = (sma - bp->sma); in ptp_ocp_dpll_direction_set()
4602 if (sma->fixed_dir) in ptp_ocp_dpll_direction_set()
4603 return -EOPNOTSUPP; in ptp_ocp_dpll_direction_set()
4618 int sma_nr = (sma - bp->sma); in ptp_ocp_dpll_frequency_set()
4621 if (sma->fixed_fcn) in ptp_ocp_dpll_frequency_set()
4622 return -EOPNOTSUPP; in ptp_ocp_dpll_frequency_set()
4624 tbl = bp->sma_op->tbl[sma->mode]; in ptp_ocp_dpll_frequency_set()
4627 return ptp_ocp_sma_store_val(bp, i, sma->mode, sma_nr + 1); in ptp_ocp_dpll_frequency_set()
4628 return -EINVAL; in ptp_ocp_dpll_frequency_set()
4640 int sma_nr = (sma - bp->sma); in ptp_ocp_dpll_frequency_get()
4644 val = bp->sma_op->get(bp, sma_nr + 1); in ptp_ocp_dpll_frequency_get()
4645 tbl = bp->sma_op->tbl[sma->mode]; in ptp_ocp_dpll_frequency_get()
4652 return -EINVAL; in ptp_ocp_dpll_frequency_get()
4675 sync = !!(ioread32(&bp->reg->status) & OCP_STATUS_IN_SYNC); in ptp_ocp_sync_work()
4677 if (bp->sync != sync) in ptp_ocp_sync_work()
4678 dpll_device_change_ntf(bp->dpll); in ptp_ocp_sync_work()
4680 bp->sync = sync; in ptp_ocp_sync_work()
4682 queue_delayed_work(system_power_efficient_wq, &bp->sync_work, HZ); in ptp_ocp_sync_work()
4693 devlink = devlink_alloc(&ptp_ocp_devlink_ops, sizeof(*bp), &pdev->dev); in ptp_ocp_probe()
4695 dev_err(&pdev->dev, "devlink_alloc failed\n"); in ptp_ocp_probe()
4696 return -ENOMEM; in ptp_ocp_probe()
4701 dev_err(&pdev->dev, "pci_enable_device\n"); in ptp_ocp_probe()
4710 INIT_DELAYED_WORK(&bp->sync_work, ptp_ocp_sync_work); in ptp_ocp_probe()
4714 * allow this - if not all of the IRQ's are returned, skip the in ptp_ocp_probe()
4719 dev_err(&pdev->dev, "alloc_irq_vectors err: %d\n", err); in ptp_ocp_probe()
4722 bp->n_irqs = err; in ptp_ocp_probe()
4725 err = ptp_ocp_register_resources(bp, id->driver_data); in ptp_ocp_probe()
4729 bp->ptp = ptp_clock_register(&bp->ptp_info, &pdev->dev); in ptp_ocp_probe()
4730 if (IS_ERR(bp->ptp)) { in ptp_ocp_probe()
4731 err = PTR_ERR(bp->ptp); in ptp_ocp_probe()
4732 dev_err(&pdev->dev, "ptp_clock_register: %d\n", err); in ptp_ocp_probe()
4733 bp->ptp = NULL; in ptp_ocp_probe()
4745 bp->dpll = dpll_device_get(clkid, 0, THIS_MODULE); in ptp_ocp_probe()
4746 if (IS_ERR(bp->dpll)) { in ptp_ocp_probe()
4747 err = PTR_ERR(bp->dpll); in ptp_ocp_probe()
4748 dev_err(&pdev->dev, "dpll_device_alloc failed\n"); in ptp_ocp_probe()
4752 err = dpll_device_register(bp->dpll, DPLL_TYPE_PPS, &dpll_ops, bp); in ptp_ocp_probe()
4757 bp->sma[i].dpll_pin = dpll_pin_get(clkid, i, THIS_MODULE, &bp->sma[i].dpll_prop); in ptp_ocp_probe()
4758 if (IS_ERR(bp->sma[i].dpll_pin)) { in ptp_ocp_probe()
4759 err = PTR_ERR(bp->sma[i].dpll_pin); in ptp_ocp_probe()
4763 err = dpll_pin_register(bp->dpll, bp->sma[i].dpll_pin, &dpll_pins_ops, in ptp_ocp_probe()
4764 &bp->sma[i]); in ptp_ocp_probe()
4766 dpll_pin_put(bp->sma[i].dpll_pin); in ptp_ocp_probe()
4770 queue_delayed_work(system_power_efficient_wq, &bp->sync_work, HZ); in ptp_ocp_probe()
4775 --i; in ptp_ocp_probe()
4776 dpll_pin_unregister(bp->dpll, bp->sma[i].dpll_pin, &dpll_pins_ops, &bp->sma[i]); in ptp_ocp_probe()
4777 dpll_pin_put(bp->sma[i].dpll_pin); in ptp_ocp_probe()
4779 dpll_device_put(bp->dpll); in ptp_ocp_probe()
4796 cancel_delayed_work_sync(&bp->sync_work); in ptp_ocp_remove()
4798 if (bp->sma[i].dpll_pin) { in ptp_ocp_remove()
4799 dpll_pin_unregister(bp->dpll, bp->sma[i].dpll_pin, &dpll_pins_ops, &bp->sma[i]); in ptp_ocp_remove()
4800 dpll_pin_put(bp->sma[i].dpll_pin); in ptp_ocp_remove()
4803 dpll_device_unregister(bp->dpll, &dpll_ops, bp); in ptp_ocp_remove()
4804 dpll_device_put(bp->dpll); in ptp_ocp_remove()
4840 while ((dev = dev->parent)) in ptp_ocp_i2c_notifier_call()
4841 if (dev->driver && !strcmp(dev->driver->name, KBUILD_MODNAME)) in ptp_ocp_i2c_notifier_call()
4850 sysfs_remove_link(&bp->dev.kobj, "i2c"); in ptp_ocp_i2c_notifier_call()