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()
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()
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()
213 static int check_errors(struct fsi_master_aspeed *aspeed, int err)  in check_errors()  argument
220 		opb_readl(aspeed, ctrl_base + FSI_MRESP0, &mresp0);  in check_errors()
221 		opb_readl(aspeed, ctrl_base + FSI_MSTAP0, &mstap0);  in check_errors()
222 		opb_readl(aspeed, ctrl_base + FSI_MESRB0, &mesrb0);  in check_errors()
234 		ret = opb_writel(aspeed, ctrl_base + FSI_MRESP0,  in check_errors()
250 	struct fsi_master_aspeed *aspeed = to_fsi_master_aspeed(master);  in aspeed_master_read()  local
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()
276 	ret = check_errors(aspeed, ret);  in aspeed_master_read()
278 	mutex_unlock(&aspeed->lock);  in aspeed_master_read()
285 	struct fsi_master_aspeed *aspeed = to_fsi_master_aspeed(master);  in aspeed_master_write()  local
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()
311 	ret = check_errors(aspeed, ret);  in aspeed_master_write()
313 	mutex_unlock(&aspeed->lock);  in aspeed_master_write()
320 	struct fsi_master_aspeed *aspeed = to_fsi_master_aspeed(master);  in aspeed_master_link_enable()  local
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()
370 	struct fsi_master_aspeed *aspeed =  in aspeed_master_release()  local
373 	kfree(aspeed);  in aspeed_master_release()
387 static int aspeed_master_init(struct fsi_master_aspeed *aspeed)  in aspeed_master_init()  argument
393 	opb_writel(aspeed, ctrl_base + FSI_MRESP0, reg);  in aspeed_master_init()
398 	opb_writel(aspeed, ctrl_base + FSI_MRESP0, reg);  in aspeed_master_init()
401 	opb_writel(aspeed, ctrl_base + FSI_MECTRL, reg);  in aspeed_master_init()
407 	dev_info(aspeed->dev, "mmode set to %08x (divisor %d)\n",  in aspeed_master_init()
409 	opb_writel(aspeed, ctrl_base + FSI_MMODE, reg);  in aspeed_master_init()
412 	opb_writel(aspeed, ctrl_base + FSI_MDLYR, reg);  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()
422 	opb_readl(aspeed, ctrl_base + FSI_MAEB, NULL);  in aspeed_master_init()
425 	opb_writel(aspeed, ctrl_base + FSI_MRESP0, reg);  in aspeed_master_init()
427 	opb_readl(aspeed, ctrl_base + FSI_MLEVP0, NULL);  in aspeed_master_init()
431 	opb_writel(aspeed, ctrl_base + FSI_MRESB0, reg);  in aspeed_master_init()
434 	opb_writel(aspeed, ctrl_base + FSI_MRESB0, reg);  in aspeed_master_init()
442 	struct fsi_master_aspeed *aspeed = dev_get_drvdata(dev);  in cfam_reset_store()  local
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()
448 	mutex_unlock(&aspeed->lock);  in cfam_reset_store()
455 static int setup_cfam_reset(struct fsi_master_aspeed *aspeed)  in setup_cfam_reset()  argument
457 	struct device *dev = aspeed->dev;  in setup_cfam_reset()
467 	aspeed->cfam_reset_gpio = gpio;  in setup_cfam_reset()
527 	struct fsi_master_aspeed *aspeed;  in fsi_master_aspeed_probe()  local
537 	aspeed = kzalloc(sizeof(*aspeed), GFP_KERNEL);  in fsi_master_aspeed_probe()
538 	if (!aspeed)  in fsi_master_aspeed_probe()
541 	aspeed->dev = &pdev->dev;  in fsi_master_aspeed_probe()
543 	aspeed->base = devm_platform_ioremap_resource(pdev, 0);  in fsi_master_aspeed_probe()
544 	if (IS_ERR(aspeed->base)) {  in fsi_master_aspeed_probe()
545 		rc = PTR_ERR(aspeed->base);  in fsi_master_aspeed_probe()
549 	aspeed->clk = devm_clk_get(aspeed->dev, NULL);  in fsi_master_aspeed_probe()
550 	if (IS_ERR(aspeed->clk)) {  in fsi_master_aspeed_probe()
551 		dev_err(aspeed->dev, "couldn't get clock\n");  in fsi_master_aspeed_probe()
552 		rc = PTR_ERR(aspeed->clk);  in fsi_master_aspeed_probe()
555 	rc = clk_prepare_enable(aspeed->clk);  in fsi_master_aspeed_probe()
557 		dev_err(aspeed->dev, "couldn't enable clock\n");  in fsi_master_aspeed_probe()
561 	rc = setup_cfam_reset(aspeed);  in fsi_master_aspeed_probe()
566 	writel(0x1, aspeed->base + OPB_CLK_SYNC);  in fsi_master_aspeed_probe()
568 			aspeed->base + OPB_IRQ_MASK);  in fsi_master_aspeed_probe()
571 	writel(0x10, aspeed->base + OPB_RETRY_COUNTER);  in fsi_master_aspeed_probe()
573 	writel(ctrl_base, aspeed->base + OPB_CTRL_BASE);  in fsi_master_aspeed_probe()
574 	writel(fsi_base, aspeed->base + OPB_FSI_BASE);  in fsi_master_aspeed_probe()
577 	writel(0x00030b1b, aspeed->base + OPB0_READ_ORDER1);  in fsi_master_aspeed_probe()
580 	writel(0x0011101b, aspeed->base + OPB0_WRITE_ORDER1);  in fsi_master_aspeed_probe()
581 	writel(0x0c330f3f, aspeed->base + OPB0_WRITE_ORDER2);  in fsi_master_aspeed_probe()
588 	writel(0x1, aspeed->base + OPB0_SELECT);  in fsi_master_aspeed_probe()
590 	rc = opb_readl(aspeed, ctrl_base + FSI_MVER, &raw);  in fsi_master_aspeed_probe()
600 	aspeed->master.dev.parent = &pdev->dev;  in fsi_master_aspeed_probe()
601 	aspeed->master.dev.release = aspeed_master_release;  in fsi_master_aspeed_probe()
602 	aspeed->master.dev.of_node = of_node_get(dev_of_node(&pdev->dev));  in fsi_master_aspeed_probe()
604 	aspeed->master.n_links = links;  in fsi_master_aspeed_probe()
605 	aspeed->master.read = aspeed_master_read;  in fsi_master_aspeed_probe()
606 	aspeed->master.write = aspeed_master_write;  in fsi_master_aspeed_probe()
607 	aspeed->master.send_break = aspeed_master_break;  in fsi_master_aspeed_probe()
608 	aspeed->master.term = aspeed_master_term;  in fsi_master_aspeed_probe()
609 	aspeed->master.link_enable = aspeed_master_link_enable;  in fsi_master_aspeed_probe()
611 	dev_set_drvdata(&pdev->dev, aspeed);  in fsi_master_aspeed_probe()
613 	mutex_init(&aspeed->lock);  in fsi_master_aspeed_probe()
614 	aspeed_master_init(aspeed);  in fsi_master_aspeed_probe()
616 	rc = fsi_master_register(&aspeed->master);  in fsi_master_aspeed_probe()
627 	get_device(&aspeed->master.dev);  in fsi_master_aspeed_probe()
631 	clk_disable_unprepare(aspeed->clk);  in fsi_master_aspeed_probe()
633 	kfree(aspeed);  in fsi_master_aspeed_probe()
639 	struct fsi_master_aspeed *aspeed = platform_get_drvdata(pdev);  in fsi_master_aspeed_remove()  local
641 	fsi_master_unregister(&aspeed->master);  in fsi_master_aspeed_remove()
642 	clk_disable_unprepare(aspeed->clk);  in fsi_master_aspeed_remove()
648 	{ .compatible = "aspeed,ast2600-fsi-master" },
655 		.name		= "fsi-master-aspeed",