dsa/b53/b53_mmap.c

33 static int b53_mmap_read8(struct b53_device *dev, u8 page, u8 reg, u8 *val)
38 	*val = readb(regs + (page << 8) + reg);
43 static int b53_mmap_read16(struct b53_device *dev, u8 page, u8 reg, u16 *val)
48 	if (WARN_ON(reg % 2))
52 		*val = ioread16be(regs + (page << 8) + reg);
54 		*val = readw(regs + (page << 8) + reg);
59 static int b53_mmap_read32(struct b53_device *dev, u8 page, u8 reg, u32 *val)
64 	if (WARN_ON(reg % 4))
68 		*val = ioread32be(regs + (page << 8) + reg);
70 		*val = readl(regs + (page << 8) + reg);
75 static int b53_mmap_read48(struct b53_device *dev, u8 page, u8 reg, u64 *val)
80 	if (WARN_ON(reg % 2))
83 	if (reg % 4) {
88 			lo = ioread16be(regs + (page << 8) + reg);
89 			hi = ioread32be(regs + (page << 8) + reg + 2);
91 			lo = readw(regs + (page << 8) + reg);
92 			hi = readl(regs + (page << 8) + reg + 2);
101 			lo = ioread32be(regs + (page << 8) + reg);
102 			hi = ioread16be(regs + (page << 8) + reg + 4);
104 			lo = readl(regs + (page << 8) + reg);
105 			hi = readw(regs + (page << 8) + reg + 4);
114 static int b53_mmap_read64(struct b53_device *dev, u8 page, u8 reg, u64 *val)
120 	if (WARN_ON(reg % 4))
124 		lo = ioread32be(regs + (page << 8) + reg);
125 		hi = ioread32be(regs + (page << 8) + reg + 4);
127 		lo = readl(regs + (page << 8) + reg);
128 		hi = readl(regs + (page << 8) + reg + 4);
136 static int b53_mmap_write8(struct b53_device *dev, u8 page, u8 reg, u8 value)
141 	writeb(value, regs + (page << 8) + reg);
146 static int b53_mmap_write16(struct b53_device *dev, u8 page, u8 reg,
152 	if (WARN_ON(reg % 2))
156 		iowrite16be(value, regs + (page << 8) + reg);
158 		writew(value, regs + (page << 8) + reg);
163 static int b53_mmap_write32(struct b53_device *dev, u8 page, u8 reg,
169 	if (WARN_ON(reg % 4))
173 		iowrite32be(value, regs + (page << 8) + reg);
175 		writel(value, regs + (page << 8) + reg);
180 static int b53_mmap_write48(struct b53_device *dev, u8 page, u8 reg,
183 	if (WARN_ON(reg % 2))
186 	if (reg % 4) {
190 		b53_mmap_write16(dev, page, reg, lo);
191 		b53_mmap_write32(dev, page, reg + 2, hi);
196 		b53_mmap_write32(dev, page, reg, lo);
197 		b53_mmap_write16(dev, page, reg + 4, hi);
203 static int b53_mmap_write64(struct b53_device *dev, u8 page, u8 reg,
211 	if (WARN_ON(reg % 4))
214 	b53_mmap_write32(dev, page, reg, lo);
215 	b53_mmap_write32(dev, page, reg + 4, hi);
220 static int b53_mmap_phy_read16(struct b53_device *dev, int addr, int reg,
226 static int b53_mmap_phy_write16(struct b53_device *dev, int addr, int reg,
276 		u32 reg;
278 		if (of_property_read_u32(of_port, "reg", &reg))
281 		if (reg < B53_N_PORTS)
282 			pdata->enabled_ports |= BIT(reg);