Lines Matching +full:reg +full:- +full:addr
1 // SPDX-License-Identifier: GPL-2.0-or-later
19 #include "fsi-master.h"
97 static int __opb_write(struct fsi_master_aspeed *aspeed, u32 addr, in __opb_write() argument
100 void __iomem *base = aspeed->base; in __opb_write()
101 u32 reg, status; in __opb_write() local
106 writel(addr, base + OPB0_FSI_ADDR); in __opb_write()
111 ret = readl_poll_timeout(base + OPB_IRQ_STATUS, reg, in __opb_write()
112 (reg & OPB0_XFER_ACK_EN) != 0, in __opb_write()
117 trace_fsi_master_aspeed_opb_write(addr, val, transfer_size, status, reg); in __opb_write()
125 return -EIO; in __opb_write()
130 static int opb_writeb(struct fsi_master_aspeed *aspeed, u32 addr, u8 val) in opb_writeb() argument
132 return __opb_write(aspeed, addr, val, XFER_BYTE); in opb_writeb()
135 static int opb_writew(struct fsi_master_aspeed *aspeed, u32 addr, __be16 val) in opb_writew() argument
137 return __opb_write(aspeed, addr, (__force u16)val, XFER_HALFWORD); in opb_writew()
140 static int opb_writel(struct fsi_master_aspeed *aspeed, u32 addr, __be32 val) in opb_writel() argument
142 return __opb_write(aspeed, addr, (__force u32)val, XFER_FULLWORD); in opb_writel()
145 static int __opb_read(struct fsi_master_aspeed *aspeed, uint32_t addr, in __opb_read() argument
148 void __iomem *base = aspeed->base; in __opb_read()
149 u32 result, reg; in __opb_read() local
154 writel(addr, base + OPB0_FSI_ADDR); in __opb_read()
158 ret = readl_poll_timeout(base + OPB_IRQ_STATUS, reg, in __opb_read()
159 (reg & OPB0_XFER_ACK_EN) != 0, in __opb_read()
166 trace_fsi_master_aspeed_opb_read(addr, transfer_size, result, in __opb_read()
168 reg); in __opb_read()
176 return -EIO; in __opb_read()
190 return -EINVAL; in __opb_read()
198 static int opb_readl(struct fsi_master_aspeed *aspeed, uint32_t addr, __be32 *out) in opb_readl() argument
200 return __opb_read(aspeed, addr, XFER_FULLWORD, out); in opb_readl()
203 static int opb_readw(struct fsi_master_aspeed *aspeed, uint32_t addr, __be16 *out) in opb_readw() argument
205 return __opb_read(aspeed, addr, XFER_HALFWORD, (void *)out); in opb_readw()
208 static int opb_readb(struct fsi_master_aspeed *aspeed, uint32_t addr, u8 *out) in opb_readb() argument
210 return __opb_read(aspeed, addr, XFER_BYTE, (void *)out); in opb_readb()
230 if (err == -EIO) { in check_errors()
248 uint8_t id, uint32_t addr, void *val, size_t size) in aspeed_master_read() argument
254 return -EINVAL; in aspeed_master_read()
256 addr |= id << 21; in aspeed_master_read()
257 addr += link * FSI_HUB_LINK_SIZE; in aspeed_master_read()
259 mutex_lock(&aspeed->lock); in aspeed_master_read()
263 ret = opb_readb(aspeed, fsi_base + addr, val); in aspeed_master_read()
266 ret = opb_readw(aspeed, fsi_base + addr, val); in aspeed_master_read()
269 ret = opb_readl(aspeed, fsi_base + addr, val); in aspeed_master_read()
272 ret = -EINVAL; in aspeed_master_read()
278 mutex_unlock(&aspeed->lock); in aspeed_master_read()
283 uint8_t id, uint32_t addr, const void *val, size_t size) in aspeed_master_write() argument
289 return -EINVAL; in aspeed_master_write()
291 addr |= id << 21; in aspeed_master_write()
292 addr += link * FSI_HUB_LINK_SIZE; in aspeed_master_write()
294 mutex_lock(&aspeed->lock); in aspeed_master_write()
298 ret = opb_writeb(aspeed, fsi_base + addr, *(u8 *)val); in aspeed_master_write()
301 ret = opb_writew(aspeed, fsi_base + addr, *(__be16 *)val); in aspeed_master_write()
304 ret = opb_writel(aspeed, fsi_base + addr, *(__be32 *)val); in aspeed_master_write()
307 ret = -EINVAL; in aspeed_master_write()
313 mutex_unlock(&aspeed->lock); in aspeed_master_write()
322 __be32 reg; in aspeed_master_link_enable() local
327 reg = cpu_to_be32(0x80000000 >> bit); in aspeed_master_link_enable()
329 mutex_lock(&aspeed->lock); in aspeed_master_link_enable()
332 ret = opb_writel(aspeed, ctrl_base + FSI_MCENP0 + (4 * idx), reg); in aspeed_master_link_enable()
336 ret = opb_writel(aspeed, ctrl_base + FSI_MSENP0 + (4 * idx), reg); in aspeed_master_link_enable()
342 mutex_unlock(&aspeed->lock); in aspeed_master_link_enable()
348 uint32_t addr; in aspeed_master_term() local
351 addr = 0x4; in aspeed_master_term()
354 return aspeed_master_write(master, link, id, addr, &cmd, 4); in aspeed_master_term()
359 uint32_t addr; in aspeed_master_break() local
362 addr = 0x0; in aspeed_master_break()
365 return aspeed_master_write(master, link, 0, addr, &cmd, 4); in aspeed_master_break()
389 __be32 reg; in aspeed_master_init() local
391 reg = cpu_to_be32(FSI_MRESP_RST_ALL_MASTER | FSI_MRESP_RST_ALL_LINK in aspeed_master_init()
393 opb_writel(aspeed, ctrl_base + FSI_MRESP0, reg); in aspeed_master_init()
396 reg = cpu_to_be32(FSI_MRESP_RST_ALL_MASTER | FSI_MRESP_RST_ALL_LINK in aspeed_master_init()
398 opb_writel(aspeed, ctrl_base + FSI_MRESP0, reg); in aspeed_master_init()
400 reg = cpu_to_be32(FSI_MECTRL_EOAE | FSI_MECTRL_P8_AUTO_TERM); in aspeed_master_init()
401 opb_writel(aspeed, ctrl_base + FSI_MECTRL, reg); in aspeed_master_init()
403 reg = cpu_to_be32(FSI_MMODE_ECRC | FSI_MMODE_EPC | FSI_MMODE_RELA in aspeed_master_init()
407 dev_info(aspeed->dev, "mmode set to %08x (divisor %d)\n", in aspeed_master_init()
408 be32_to_cpu(reg), aspeed_fsi_divisor); in aspeed_master_init()
409 opb_writel(aspeed, ctrl_base + FSI_MMODE, reg); in aspeed_master_init()
411 reg = cpu_to_be32(0xffff0000); in aspeed_master_init()
412 opb_writel(aspeed, ctrl_base + FSI_MDLYR, reg); in aspeed_master_init()
414 reg = cpu_to_be32(~0); in aspeed_master_init()
415 opb_writel(aspeed, ctrl_base + FSI_MSENP0, reg); in aspeed_master_init()
420 opb_writel(aspeed, ctrl_base + FSI_MCENP0, reg); in aspeed_master_init()
424 reg = cpu_to_be32(FSI_MRESP_RST_ALL_MASTER | FSI_MRESP_RST_ALL_LINK); in aspeed_master_init()
425 opb_writel(aspeed, ctrl_base + FSI_MRESP0, reg); in aspeed_master_init()
430 reg = cpu_to_be32(FSI_MRESB_RST_GEN); in aspeed_master_init()
431 opb_writel(aspeed, ctrl_base + FSI_MRESB0, reg); in aspeed_master_init()
433 reg = cpu_to_be32(FSI_MRESB_RST_ERR); in aspeed_master_init()
434 opb_writel(aspeed, ctrl_base + FSI_MRESB0, reg); in aspeed_master_init()
444 mutex_lock(&aspeed->lock); in cfam_reset_store()
445 gpiod_set_value(aspeed->cfam_reset_gpio, 1); in cfam_reset_store()
447 gpiod_set_value(aspeed->cfam_reset_gpio, 0); in cfam_reset_store()
450 mutex_unlock(&aspeed->lock); in cfam_reset_store()
459 struct device *dev = aspeed->dev; in setup_cfam_reset()
463 gpio = devm_gpiod_get_optional(dev, "cfam-reset", GPIOD_OUT_LOW); in setup_cfam_reset()
469 aspeed->cfam_reset_gpio = gpio; in setup_cfam_reset()
489 routing_gpio = devm_gpiod_get_optional(dev, "fsi-routing", in tacoma_cabled_fsi_fixup()
496 mux_gpio = devm_gpiod_get_optional(dev, "fsi-mux", GPIOD_ASIS); in tacoma_cabled_fsi_fixup()
530 int rc, links, reg; in fsi_master_aspeed_probe() local
533 rc = tacoma_cabled_fsi_fixup(&pdev->dev); in fsi_master_aspeed_probe()
535 dev_err(&pdev->dev, "Tacoma FSI cable fixup failed\n"); in fsi_master_aspeed_probe()
541 return -ENOMEM; in fsi_master_aspeed_probe()
543 aspeed->dev = &pdev->dev; in fsi_master_aspeed_probe()
545 aspeed->base = devm_platform_ioremap_resource(pdev, 0); in fsi_master_aspeed_probe()
546 if (IS_ERR(aspeed->base)) { in fsi_master_aspeed_probe()
547 rc = PTR_ERR(aspeed->base); in fsi_master_aspeed_probe()
551 aspeed->clk = devm_clk_get(aspeed->dev, NULL); in fsi_master_aspeed_probe()
552 if (IS_ERR(aspeed->clk)) { in fsi_master_aspeed_probe()
553 dev_err(aspeed->dev, "couldn't get clock\n"); in fsi_master_aspeed_probe()
554 rc = PTR_ERR(aspeed->clk); in fsi_master_aspeed_probe()
557 rc = clk_prepare_enable(aspeed->clk); in fsi_master_aspeed_probe()
559 dev_err(aspeed->dev, "couldn't enable clock\n"); in fsi_master_aspeed_probe()
565 dev_err(&pdev->dev, "CFAM reset GPIO setup failed\n"); in fsi_master_aspeed_probe()
568 writel(0x1, aspeed->base + OPB_CLK_SYNC); in fsi_master_aspeed_probe()
570 aspeed->base + OPB_IRQ_MASK); in fsi_master_aspeed_probe()
573 writel(0x10, aspeed->base + OPB_RETRY_COUNTER); in fsi_master_aspeed_probe()
575 writel(ctrl_base, aspeed->base + OPB_CTRL_BASE); in fsi_master_aspeed_probe()
576 writel(fsi_base, aspeed->base + OPB_FSI_BASE); in fsi_master_aspeed_probe()
579 writel(0x00030b1b, aspeed->base + OPB0_READ_ORDER1); in fsi_master_aspeed_probe()
582 writel(0x0011101b, aspeed->base + OPB0_WRITE_ORDER1); in fsi_master_aspeed_probe()
583 writel(0x0c330f3f, aspeed->base + OPB0_WRITE_ORDER2); in fsi_master_aspeed_probe()
590 writel(0x1, aspeed->base + OPB0_SELECT); in fsi_master_aspeed_probe()
594 dev_err(&pdev->dev, "failed to read hub version\n"); in fsi_master_aspeed_probe()
598 reg = be32_to_cpu(raw); in fsi_master_aspeed_probe()
599 links = (reg >> 8) & 0xff; in fsi_master_aspeed_probe()
600 dev_info(&pdev->dev, "hub version %08x (%d links)\n", reg, links); in fsi_master_aspeed_probe()
602 aspeed->master.dev.parent = &pdev->dev; in fsi_master_aspeed_probe()
603 aspeed->master.dev.release = aspeed_master_release; in fsi_master_aspeed_probe()
604 aspeed->master.dev.of_node = of_node_get(dev_of_node(&pdev->dev)); in fsi_master_aspeed_probe()
606 aspeed->master.n_links = links; in fsi_master_aspeed_probe()
607 aspeed->master.read = aspeed_master_read; in fsi_master_aspeed_probe()
608 aspeed->master.write = aspeed_master_write; in fsi_master_aspeed_probe()
609 aspeed->master.send_break = aspeed_master_break; in fsi_master_aspeed_probe()
610 aspeed->master.term = aspeed_master_term; in fsi_master_aspeed_probe()
611 aspeed->master.link_enable = aspeed_master_link_enable; in fsi_master_aspeed_probe()
613 dev_set_drvdata(&pdev->dev, aspeed); in fsi_master_aspeed_probe()
615 mutex_init(&aspeed->lock); in fsi_master_aspeed_probe()
618 rc = fsi_master_register(&aspeed->master); in fsi_master_aspeed_probe()
624 * will be freed (via ->release) during any subsequent call to in fsi_master_aspeed_probe()
629 get_device(&aspeed->master.dev); in fsi_master_aspeed_probe()
633 clk_disable_unprepare(aspeed->clk); in fsi_master_aspeed_probe()
643 fsi_master_unregister(&aspeed->master); in fsi_master_aspeed_remove()
644 clk_disable_unprepare(aspeed->clk); in fsi_master_aspeed_remove()
650 { .compatible = "aspeed,ast2600-fsi-master" },
657 .name = "fsi-master-aspeed",