^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2006, 2007 Eugene Konev <ejka@openwrt.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Parts of the VLYNQ specification can be found here:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * http://www.ti.com/litv/pdf/sprue36a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/irq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/vlynq.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define VLYNQ_CTRL_PM_ENABLE 0x80000000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define VLYNQ_CTRL_CLOCK_INT 0x00008000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define VLYNQ_CTRL_CLOCK_DIV(x) (((x) & 7) << 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define VLYNQ_CTRL_INT_LOCAL 0x00004000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define VLYNQ_CTRL_INT_ENABLE 0x00002000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #define VLYNQ_CTRL_INT_VECTOR(x) (((x) & 0x1f) << 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define VLYNQ_CTRL_INT2CFG 0x00000080
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define VLYNQ_CTRL_RESET 0x00000001
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define VLYNQ_CTRL_CLOCK_MASK (0x7 << 16)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define VLYNQ_INT_OFFSET 0x00000014
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define VLYNQ_REMOTE_OFFSET 0x00000080
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define VLYNQ_STATUS_LINK 0x00000001
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define VLYNQ_STATUS_LERROR 0x00000080
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define VLYNQ_STATUS_RERROR 0x00000100
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define VINT_ENABLE 0x00000100
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define VINT_TYPE_EDGE 0x00000080
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define VINT_LEVEL_LOW 0x00000040
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define VINT_VECTOR(x) ((x) & 0x1f)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define VINT_OFFSET(irq) (8 * ((irq) % 4))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define VLYNQ_AUTONEGO_V2 0x00010000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) struct vlynq_regs {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) u32 revision;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) u32 control;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) u32 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) u32 int_prio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) u32 int_status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) u32 int_pending;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) u32 int_ptr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) u32 tx_offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct vlynq_mapping rx_mapping[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) u32 chip;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) u32 autonego;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) u32 unused[6];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) u32 int_device[8];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) #ifdef CONFIG_VLYNQ_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) static void vlynq_dump_regs(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) printk(KERN_DEBUG "VLYNQ local=%p remote=%p\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) dev->local, dev->remote);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) for (i = 0; i < 32; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) printk(KERN_DEBUG "VLYNQ: local %d: %08x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) i + 1, ((u32 *)dev->local)[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) printk(KERN_DEBUG "VLYNQ: remote %d: %08x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) i + 1, ((u32 *)dev->remote)[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) static void vlynq_dump_mem(u32 *base, int count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) for (i = 0; i < (count + 3) / 4; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (i % 4 == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) printk(KERN_DEBUG "\nMEM[0x%04x]:", i * 4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) printk(KERN_DEBUG " 0x%08x", *(base + i));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) printk(KERN_DEBUG "\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) /* Check the VLYNQ link status with a given device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) static int vlynq_linked(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) for (i = 0; i < 100; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) if (readl(&dev->local->status) & VLYNQ_STATUS_LINK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) cpu_relax();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) static void vlynq_reset(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) writel(readl(&dev->local->control) | VLYNQ_CTRL_RESET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) /* Wait for the devices to finish resetting */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) msleep(5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) /* Remove reset bit */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) writel(readl(&dev->local->control) & ~VLYNQ_CTRL_RESET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) /* Give some time for the devices to settle */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) msleep(5);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static void vlynq_irq_unmask(struct irq_data *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) struct vlynq_device *dev = irq_data_get_irq_chip_data(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) int virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) BUG_ON(!dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) virq = d->irq - dev->irq_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) val = readl(&dev->remote->int_device[virq >> 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) val |= (VINT_ENABLE | virq) << VINT_OFFSET(virq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) writel(val, &dev->remote->int_device[virq >> 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) static void vlynq_irq_mask(struct irq_data *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) struct vlynq_device *dev = irq_data_get_irq_chip_data(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) int virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) BUG_ON(!dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) virq = d->irq - dev->irq_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) val = readl(&dev->remote->int_device[virq >> 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) val &= ~(VINT_ENABLE << VINT_OFFSET(virq));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) writel(val, &dev->remote->int_device[virq >> 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) static int vlynq_irq_type(struct irq_data *d, unsigned int flow_type)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) struct vlynq_device *dev = irq_data_get_irq_chip_data(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) int virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) BUG_ON(!dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) virq = d->irq - dev->irq_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) val = readl(&dev->remote->int_device[virq >> 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) switch (flow_type & IRQ_TYPE_SENSE_MASK) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) case IRQ_TYPE_EDGE_RISING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) case IRQ_TYPE_EDGE_FALLING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) case IRQ_TYPE_EDGE_BOTH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) val |= VINT_TYPE_EDGE << VINT_OFFSET(virq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) val &= ~(VINT_LEVEL_LOW << VINT_OFFSET(virq));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) case IRQ_TYPE_LEVEL_HIGH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) val &= ~(VINT_TYPE_EDGE << VINT_OFFSET(virq));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) val &= ~(VINT_LEVEL_LOW << VINT_OFFSET(virq));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) case IRQ_TYPE_LEVEL_LOW:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) val &= ~(VINT_TYPE_EDGE << VINT_OFFSET(virq));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) val |= VINT_LEVEL_LOW << VINT_OFFSET(virq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) writel(val, &dev->remote->int_device[virq >> 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) static void vlynq_local_ack(struct irq_data *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) struct vlynq_device *dev = irq_data_get_irq_chip_data(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) u32 status = readl(&dev->local->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) pr_debug("%s: local status: 0x%08x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) dev_name(&dev->dev), status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) writel(status, &dev->local->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) static void vlynq_remote_ack(struct irq_data *d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) struct vlynq_device *dev = irq_data_get_irq_chip_data(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) u32 status = readl(&dev->remote->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) pr_debug("%s: remote status: 0x%08x\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) dev_name(&dev->dev), status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) writel(status, &dev->remote->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) static irqreturn_t vlynq_irq(int irq, void *dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) struct vlynq_device *dev = dev_id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) u32 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) int virq = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) status = readl(&dev->local->int_status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) writel(status, &dev->local->int_status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) if (unlikely(!status))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) spurious_interrupt();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) while (status) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) if (status & 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) do_IRQ(dev->irq_start + virq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) status >>= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) virq++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) return IRQ_HANDLED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) static struct irq_chip vlynq_irq_chip = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) .name = "vlynq",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) .irq_unmask = vlynq_irq_unmask,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) .irq_mask = vlynq_irq_mask,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) .irq_set_type = vlynq_irq_type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) static struct irq_chip vlynq_local_chip = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) .name = "vlynq local error",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) .irq_unmask = vlynq_irq_unmask,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) .irq_mask = vlynq_irq_mask,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) .irq_ack = vlynq_local_ack,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) static struct irq_chip vlynq_remote_chip = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) .name = "vlynq local error",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) .irq_unmask = vlynq_irq_unmask,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) .irq_mask = vlynq_irq_mask,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) .irq_ack = vlynq_remote_ack,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) static int vlynq_setup_irq(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) int i, virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) if (dev->local_irq == dev->remote_irq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) printk(KERN_ERR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) "%s: local vlynq irq should be different from remote\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) dev_name(&dev->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) /* Clear local and remote error bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) writel(readl(&dev->local->status), &dev->local->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) writel(readl(&dev->remote->status), &dev->remote->status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) /* Now setup interrupts */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) val = VLYNQ_CTRL_INT_VECTOR(dev->local_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) val |= VLYNQ_CTRL_INT_ENABLE | VLYNQ_CTRL_INT_LOCAL |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) VLYNQ_CTRL_INT2CFG;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) val |= readl(&dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) writel(VLYNQ_INT_OFFSET, &dev->local->int_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) writel(val, &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) val = VLYNQ_CTRL_INT_VECTOR(dev->remote_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) val |= VLYNQ_CTRL_INT_ENABLE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) val |= readl(&dev->remote->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) writel(VLYNQ_INT_OFFSET, &dev->remote->int_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) writel(val, &dev->remote->int_ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) writel(val, &dev->remote->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) for (i = dev->irq_start; i <= dev->irq_end; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) virq = i - dev->irq_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) if (virq == dev->local_irq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) irq_set_chip_and_handler(i, &vlynq_local_chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) handle_level_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) irq_set_chip_data(i, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) } else if (virq == dev->remote_irq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) irq_set_chip_and_handler(i, &vlynq_remote_chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) handle_level_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) irq_set_chip_data(i, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) irq_set_chip_and_handler(i, &vlynq_irq_chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) handle_simple_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) irq_set_chip_data(i, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) writel(0, &dev->remote->int_device[virq >> 2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) if (request_irq(dev->irq, vlynq_irq, IRQF_SHARED, "vlynq", dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) printk(KERN_ERR "%s: request_irq failed\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) dev_name(&dev->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) static void vlynq_device_release(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) struct vlynq_device *vdev = to_vlynq_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) kfree(vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) static int vlynq_device_match(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) struct device_driver *drv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) struct vlynq_device *vdev = to_vlynq_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) struct vlynq_driver *vdrv = to_vlynq_driver(drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) struct vlynq_device_id *ids = vdrv->id_table;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) while (ids->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) if (ids->id == vdev->dev_id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) vdev->divisor = ids->divisor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) vlynq_set_drvdata(vdev, ids);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) printk(KERN_INFO "Driver found for VLYNQ "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) "device: %08x\n", vdev->dev_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) printk(KERN_DEBUG "Not using the %08x VLYNQ device's driver"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) " for VLYNQ device: %08x\n", ids->id, vdev->dev_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) ids++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) static int vlynq_device_probe(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) struct vlynq_device *vdev = to_vlynq_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) struct vlynq_driver *drv = to_vlynq_driver(dev->driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) struct vlynq_device_id *id = vlynq_get_drvdata(vdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) int result = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) if (drv->probe)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) result = drv->probe(vdev, id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) if (result)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) put_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) static int vlynq_device_remove(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) struct vlynq_driver *drv = to_vlynq_driver(dev->driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) if (drv->remove)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) drv->remove(to_vlynq_device(dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) int __vlynq_register_driver(struct vlynq_driver *driver, struct module *owner)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) driver->driver.name = driver->name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) driver->driver.bus = &vlynq_bus_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) return driver_register(&driver->driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) EXPORT_SYMBOL(__vlynq_register_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) void vlynq_unregister_driver(struct vlynq_driver *driver)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) driver_unregister(&driver->driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) EXPORT_SYMBOL(vlynq_unregister_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) * A VLYNQ remote device can clock the VLYNQ bus master
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) * using a dedicated clock line. In that case, both the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) * remove device and the bus master should have the same
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) * serial clock dividers configured. Iterate through the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) * 8 possible dividers until we actually link with the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) * device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) static int __vlynq_try_remote(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) vlynq_reset(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) for (i = dev->dev_id ? vlynq_rdiv2 : vlynq_rdiv8; dev->dev_id ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) i <= vlynq_rdiv8 : i >= vlynq_rdiv2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) dev->dev_id ? i++ : i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) if (!vlynq_linked(dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) writel((readl(&dev->remote->control) &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) ~VLYNQ_CTRL_CLOCK_MASK) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) VLYNQ_CTRL_CLOCK_INT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) VLYNQ_CTRL_CLOCK_DIV(i - vlynq_rdiv1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) &dev->remote->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) writel((readl(&dev->local->control)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) & ~(VLYNQ_CTRL_CLOCK_INT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) VLYNQ_CTRL_CLOCK_MASK)) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) VLYNQ_CTRL_CLOCK_DIV(i - vlynq_rdiv1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) if (vlynq_linked(dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) printk(KERN_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) "%s: using remote clock divisor %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) dev_name(&dev->dev), i - vlynq_rdiv1 + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) dev->divisor = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) vlynq_reset(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) * A VLYNQ remote device can be clocked by the VLYNQ bus
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) * master using a dedicated clock line. In that case, only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) * the bus master configures the serial clock divider.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) * Iterate through the 8 possible dividers until we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) * actually get a link with the device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) static int __vlynq_try_local(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) vlynq_reset(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) for (i = dev->dev_id ? vlynq_ldiv2 : vlynq_ldiv8; dev->dev_id ?
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) i <= vlynq_ldiv8 : i >= vlynq_ldiv2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) dev->dev_id ? i++ : i--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) writel((readl(&dev->local->control) &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) ~VLYNQ_CTRL_CLOCK_MASK) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) VLYNQ_CTRL_CLOCK_INT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) VLYNQ_CTRL_CLOCK_DIV(i - vlynq_ldiv1),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) if (vlynq_linked(dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) printk(KERN_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) "%s: using local clock divisor %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) dev_name(&dev->dev), i - vlynq_ldiv1 + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) dev->divisor = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) vlynq_reset(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) * When using external clocking method, serial clock
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) * is supplied by an external oscillator, therefore we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) * should mask the local clock bit in the clock control
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) * register for both the bus master and the remote device.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) static int __vlynq_try_external(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) vlynq_reset(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) if (!vlynq_linked(dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) writel((readl(&dev->remote->control) &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) ~VLYNQ_CTRL_CLOCK_INT),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) &dev->remote->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) writel((readl(&dev->local->control) &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) ~VLYNQ_CTRL_CLOCK_INT),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) if (vlynq_linked(dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) printk(KERN_DEBUG "%s: using external clock\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) dev_name(&dev->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) dev->divisor = vlynq_div_external;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) static int __vlynq_enable_device(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) struct plat_vlynq_ops *ops = dev->dev.platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) result = ops->on(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) if (result)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) switch (dev->divisor) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) case vlynq_div_external:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) case vlynq_div_auto:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) /* When the device is brought from reset it should have clock
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) * generation negotiated by hardware.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) * Check which device is generating clocks and perform setup
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) * accordingly */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) if (vlynq_linked(dev) && readl(&dev->remote->control) &
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) VLYNQ_CTRL_CLOCK_INT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) if (!__vlynq_try_remote(dev) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) !__vlynq_try_local(dev) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) !__vlynq_try_external(dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) if (!__vlynq_try_external(dev) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) !__vlynq_try_local(dev) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) !__vlynq_try_remote(dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) case vlynq_ldiv1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) case vlynq_ldiv2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) case vlynq_ldiv3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) case vlynq_ldiv4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) case vlynq_ldiv5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) case vlynq_ldiv6:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) case vlynq_ldiv7:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) case vlynq_ldiv8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) writel(VLYNQ_CTRL_CLOCK_INT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) VLYNQ_CTRL_CLOCK_DIV(dev->divisor -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) vlynq_ldiv1), &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) writel(0, &dev->remote->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (vlynq_linked(dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) printk(KERN_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) "%s: using local clock divisor %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) dev_name(&dev->dev),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) dev->divisor - vlynq_ldiv1 + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) case vlynq_rdiv1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) case vlynq_rdiv2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) case vlynq_rdiv3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) case vlynq_rdiv4:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) case vlynq_rdiv5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) case vlynq_rdiv6:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) case vlynq_rdiv7:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) case vlynq_rdiv8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) writel(0, &dev->local->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) writel(VLYNQ_CTRL_CLOCK_INT |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) VLYNQ_CTRL_CLOCK_DIV(dev->divisor -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) vlynq_rdiv1), &dev->remote->control);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) if (vlynq_linked(dev)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) printk(KERN_DEBUG
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) "%s: using remote clock divisor %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) dev_name(&dev->dev),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) dev->divisor - vlynq_rdiv1 + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) ops->off(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) int vlynq_enable_device(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) struct plat_vlynq_ops *ops = dev->dev.platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) int result = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) result = __vlynq_enable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) if (result)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) result = vlynq_setup_irq(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) if (result)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) ops->off(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) dev->enabled = !result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) EXPORT_SYMBOL(vlynq_enable_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) void vlynq_disable_device(struct vlynq_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) struct plat_vlynq_ops *ops = dev->dev.platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) dev->enabled = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) free_irq(dev->irq, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) ops->off(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) EXPORT_SYMBOL(vlynq_disable_device);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) int vlynq_set_local_mapping(struct vlynq_device *dev, u32 tx_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) struct vlynq_mapping *mapping)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) if (!dev->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) writel(tx_offset, &dev->local->tx_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) for (i = 0; i < 4; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) writel(mapping[i].offset, &dev->local->rx_mapping[i].offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) writel(mapping[i].size, &dev->local->rx_mapping[i].size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) EXPORT_SYMBOL(vlynq_set_local_mapping);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) int vlynq_set_remote_mapping(struct vlynq_device *dev, u32 tx_offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) struct vlynq_mapping *mapping)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) if (!dev->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) writel(tx_offset, &dev->remote->tx_offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) for (i = 0; i < 4; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) writel(mapping[i].offset, &dev->remote->rx_mapping[i].offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) writel(mapping[i].size, &dev->remote->rx_mapping[i].size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) EXPORT_SYMBOL(vlynq_set_remote_mapping);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) int vlynq_set_local_irq(struct vlynq_device *dev, int virq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) int irq = dev->irq_start + virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) if (dev->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) if ((irq < dev->irq_start) || (irq > dev->irq_end))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) if (virq == dev->remote_irq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) dev->local_irq = virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) EXPORT_SYMBOL(vlynq_set_local_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) int vlynq_set_remote_irq(struct vlynq_device *dev, int virq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) int irq = dev->irq_start + virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) if (dev->enabled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return -EBUSY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) if ((irq < dev->irq_start) || (irq > dev->irq_end))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) if (virq == dev->local_irq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) dev->remote_irq = virq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) EXPORT_SYMBOL(vlynq_set_remote_irq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) static int vlynq_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) struct vlynq_device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) struct resource *regs_res, *mem_res, *irq_res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) int len, result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) regs_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "regs");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) if (!regs_res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) mem_res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "mem");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) if (!mem_res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) irq_res = platform_get_resource_byname(pdev, IORESOURCE_IRQ, "devirq");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) if (!irq_res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) dev = kzalloc(sizeof(*dev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) if (!dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) printk(KERN_ERR
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) "vlynq: failed to allocate device structure\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) dev->id = pdev->id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) dev->dev.bus = &vlynq_bus_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) dev->dev.parent = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) dev_set_name(&dev->dev, "vlynq%d", dev->id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) dev->dev.platform_data = pdev->dev.platform_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) dev->dev.release = vlynq_device_release;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) dev->regs_start = regs_res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) dev->regs_end = regs_res->end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) dev->mem_start = mem_res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) dev->mem_end = mem_res->end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) len = resource_size(regs_res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) if (!request_mem_region(regs_res->start, len, dev_name(&dev->dev))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) printk(KERN_ERR "%s: Can't request vlynq registers\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) dev_name(&dev->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) result = -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) goto fail_request;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) dev->local = ioremap(regs_res->start, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) if (!dev->local) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) printk(KERN_ERR "%s: Can't remap vlynq registers\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) dev_name(&dev->dev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) result = -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) goto fail_remap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) dev->remote = (struct vlynq_regs *)((void *)dev->local +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) VLYNQ_REMOTE_OFFSET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) dev->irq = platform_get_irq_byname(pdev, "irq");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) dev->irq_start = irq_res->start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) dev->irq_end = irq_res->end;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) dev->local_irq = dev->irq_end - dev->irq_start;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) dev->remote_irq = dev->local_irq - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) if (device_register(&dev->dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) goto fail_register;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) platform_set_drvdata(pdev, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) printk(KERN_INFO "%s: regs 0x%p, irq %d, mem 0x%p\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) dev_name(&dev->dev), (void *)dev->regs_start, dev->irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) (void *)dev->mem_start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) dev->dev_id = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) dev->divisor = vlynq_div_auto;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) result = __vlynq_enable_device(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) if (result == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) dev->dev_id = readl(&dev->remote->chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) ((struct plat_vlynq_ops *)(dev->dev.platform_data))->off(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) if (dev->dev_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) printk(KERN_INFO "Found a VLYNQ device: %08x\n", dev->dev_id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) fail_register:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) iounmap(dev->local);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) fail_remap:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) fail_request:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) release_mem_region(regs_res->start, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) kfree(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) static int vlynq_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) struct vlynq_device *dev = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) device_unregister(&dev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) iounmap(dev->local);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) release_mem_region(dev->regs_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) dev->regs_end - dev->regs_start + 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) kfree(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) static struct platform_driver vlynq_platform_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) .driver.name = "vlynq",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) .probe = vlynq_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) .remove = vlynq_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) struct bus_type vlynq_bus_type = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) .name = "vlynq",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) .match = vlynq_device_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) .probe = vlynq_device_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) .remove = vlynq_device_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) EXPORT_SYMBOL(vlynq_bus_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) static int vlynq_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) int res = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) res = bus_register(&vlynq_bus_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) goto fail_bus;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) res = platform_driver_register(&vlynq_platform_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) if (res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) goto fail_platform;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) fail_platform:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) bus_unregister(&vlynq_bus_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) fail_bus:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) return res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) static void vlynq_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) platform_driver_unregister(&vlynq_platform_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) bus_unregister(&vlynq_bus_type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) module_init(vlynq_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) module_exit(vlynq_exit);
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags