68 static int nxp_spifi_wait_for_cmd(struct nxp_spifi *spifi)  in nxp_spifi_wait_for_cmd()  argument
73 	ret = readb_poll_timeout(spifi->io_base + SPIFI_STAT, stat,  in nxp_spifi_wait_for_cmd()
76 		dev_warn(spifi->dev, "command timed out\n");  in nxp_spifi_wait_for_cmd()
81 static int nxp_spifi_reset(struct nxp_spifi *spifi)  in nxp_spifi_reset()  argument
86 	writel(SPIFI_STAT_RESET, spifi->io_base + SPIFI_STAT);  in nxp_spifi_reset()
87 	ret = readb_poll_timeout(spifi->io_base + SPIFI_STAT, stat,  in nxp_spifi_reset()
90 		dev_warn(spifi->dev, "state reset timed out\n");  in nxp_spifi_reset()
95 static int nxp_spifi_set_memory_mode_off(struct nxp_spifi *spifi)  in nxp_spifi_set_memory_mode_off()  argument
99 	if (!spifi->memory_mode)  in nxp_spifi_set_memory_mode_off()
102 	ret = nxp_spifi_reset(spifi);  in nxp_spifi_set_memory_mode_off()
104 		dev_err(spifi->dev, "unable to enter command mode\n");  in nxp_spifi_set_memory_mode_off()
106 		spifi->memory_mode = false;  in nxp_spifi_set_memory_mode_off()
111 static int nxp_spifi_set_memory_mode_on(struct nxp_spifi *spifi)  in nxp_spifi_set_memory_mode_on()  argument
116 	if (spifi->memory_mode)  in nxp_spifi_set_memory_mode_on()
119 	writel(spifi->mcmd, spifi->io_base + SPIFI_MCMD);  in nxp_spifi_set_memory_mode_on()
120 	ret = readb_poll_timeout(spifi->io_base + SPIFI_STAT, stat,  in nxp_spifi_set_memory_mode_on()
123 		dev_err(spifi->dev, "unable to enter memory mode\n");  in nxp_spifi_set_memory_mode_on()
125 		spifi->memory_mode = true;  in nxp_spifi_set_memory_mode_on()
132 	struct nxp_spifi *spifi = nor->priv;  in nxp_spifi_read_reg()  local
136 	ret = nxp_spifi_set_memory_mode_off(spifi);  in nxp_spifi_read_reg()
144 	writel(cmd, spifi->io_base + SPIFI_CMD);  in nxp_spifi_read_reg()
147 		*buf++ = readb(spifi->io_base + SPIFI_DATA);  in nxp_spifi_read_reg()
149 	return nxp_spifi_wait_for_cmd(spifi);  in nxp_spifi_read_reg()
154 	struct nxp_spifi *spifi = nor->priv;  in nxp_spifi_write_reg()  local
158 	ret = nxp_spifi_set_memory_mode_off(spifi);  in nxp_spifi_write_reg()
167 	writel(cmd, spifi->io_base + SPIFI_CMD);  in nxp_spifi_write_reg()
170 		writeb(*buf++, spifi->io_base + SPIFI_DATA);  in nxp_spifi_write_reg()
172 	return nxp_spifi_wait_for_cmd(spifi);  in nxp_spifi_write_reg()
178 	struct nxp_spifi *spifi = nor->priv;  in nxp_spifi_read()  local
181 	ret = nxp_spifi_set_memory_mode_on(spifi);  in nxp_spifi_read()
185 	memcpy_fromio(buf, spifi->flash_base + from, len);  in nxp_spifi_read()
194 	struct nxp_spifi *spifi = nor->priv;  in nxp_spifi_write()  local
198 	ret = nxp_spifi_set_memory_mode_off(spifi);  in nxp_spifi_write()
202 	writel(to, spifi->io_base + SPIFI_ADDR);  in nxp_spifi_write()
209 	      SPIFI_CMD_FRAMEFORM(spifi->nor.addr_width + 1);  in nxp_spifi_write()
210 	writel(cmd, spifi->io_base + SPIFI_CMD);  in nxp_spifi_write()
213 		writeb(*buf++, spifi->io_base + SPIFI_DATA);  in nxp_spifi_write()
215 	nxp_spifi_wait_for_cmd(spifi);  in nxp_spifi_write()
220 	struct nxp_spifi *spifi = nor->priv;  in nxp_spifi_erase()  local
224 	ret = nxp_spifi_set_memory_mode_off(spifi);  in nxp_spifi_erase()
228 	writel(offs, spifi->io_base + SPIFI_ADDR);  in nxp_spifi_erase()
232 	      SPIFI_CMD_FRAMEFORM(spifi->nor.addr_width + 1);  in nxp_spifi_erase()
233 	writel(cmd, spifi->io_base + SPIFI_CMD);  in nxp_spifi_erase()
235 	return nxp_spifi_wait_for_cmd(spifi);  in nxp_spifi_erase()
238 static int nxp_spifi_setup_memory_cmd(struct nxp_spifi *spifi)  in nxp_spifi_setup_memory_cmd()  argument
240 	switch (spifi->nor.flash_read) {  in nxp_spifi_setup_memory_cmd()
243 		spifi->mcmd = SPIFI_CMD_FIELDFORM_ALL_SERIAL;  in nxp_spifi_setup_memory_cmd()
247 		spifi->mcmd = SPIFI_CMD_FIELDFORM_QUAD_DUAL_DATA;  in nxp_spifi_setup_memory_cmd()
250 		dev_err(spifi->dev, "unsupported SPI read mode\n");  in nxp_spifi_setup_memory_cmd()
255 	if (spifi->nor.addr_width < 1 || spifi->nor.addr_width > 4)  in nxp_spifi_setup_memory_cmd()
258 	spifi->mcmd |= SPIFI_CMD_OPCODE(spifi->nor.read_opcode) |  in nxp_spifi_setup_memory_cmd()
259 		       SPIFI_CMD_INTLEN(spifi->nor.read_dummy / 8) |  in nxp_spifi_setup_memory_cmd()
260 		       SPIFI_CMD_FRAMEFORM(spifi->nor.addr_width + 1);  in nxp_spifi_setup_memory_cmd()
271 static int nxp_spifi_setup_flash(struct nxp_spifi *spifi,  in nxp_spifi_setup_flash()  argument
291 			dev_err(spifi->dev, "unsupported rx-bus-width\n");  in nxp_spifi_setup_flash()
326 		dev_err(spifi->dev, "only mode 0 and 3 supported\n");  in nxp_spifi_setup_flash()
330 	writel(ctrl, spifi->io_base + SPIFI_CTRL);  in nxp_spifi_setup_flash()
332 	spifi->nor.dev   = spifi->dev;  in nxp_spifi_setup_flash()
333 	spifi->nor.flash_node = np;  in nxp_spifi_setup_flash()
334 	spifi->nor.priv  = spifi;  in nxp_spifi_setup_flash()
335 	spifi->nor.read  = nxp_spifi_read;  in nxp_spifi_setup_flash()
336 	spifi->nor.write = nxp_spifi_write;  in nxp_spifi_setup_flash()
337 	spifi->nor.erase = nxp_spifi_erase;  in nxp_spifi_setup_flash()
338 	spifi->nor.read_reg  = nxp_spifi_read_reg;  in nxp_spifi_setup_flash()
339 	spifi->nor.write_reg = nxp_spifi_write_reg;  in nxp_spifi_setup_flash()
350 	nxp_spifi_dummy_id_read(&spifi->nor);  in nxp_spifi_setup_flash()
352 	ret = spi_nor_scan(&spifi->nor, NULL, flash_read);  in nxp_spifi_setup_flash()
354 		dev_err(spifi->dev, "device scan failed\n");  in nxp_spifi_setup_flash()
358 	ret = nxp_spifi_setup_memory_cmd(spifi);  in nxp_spifi_setup_flash()
360 		dev_err(spifi->dev, "memory command setup failed\n");  in nxp_spifi_setup_flash()
365 	ret = mtd_device_parse_register(&spifi->nor.mtd, NULL, &ppdata, NULL, 0);  in nxp_spifi_setup_flash()
367 		dev_err(spifi->dev, "mtd device parse failed\n");  in nxp_spifi_setup_flash()
377 	struct nxp_spifi *spifi;  in nxp_spifi_probe()  local
381 	spifi = devm_kzalloc(&pdev->dev, sizeof(*spifi), GFP_KERNEL);  in nxp_spifi_probe()
382 	if (!spifi)  in nxp_spifi_probe()
386 	spifi->io_base = devm_ioremap_resource(&pdev->dev, res);  in nxp_spifi_probe()
387 	if (IS_ERR(spifi->io_base))  in nxp_spifi_probe()
388 		return PTR_ERR(spifi->io_base);  in nxp_spifi_probe()
391 	spifi->flash_base = devm_ioremap_resource(&pdev->dev, res);  in nxp_spifi_probe()
392 	if (IS_ERR(spifi->flash_base))  in nxp_spifi_probe()
393 		return PTR_ERR(spifi->flash_base);  in nxp_spifi_probe()
395 	spifi->clk_spifi = devm_clk_get(&pdev->dev, "spifi");  in nxp_spifi_probe()
396 	if (IS_ERR(spifi->clk_spifi)) {  in nxp_spifi_probe()
398 		return PTR_ERR(spifi->clk_spifi);  in nxp_spifi_probe()
401 	spifi->clk_reg = devm_clk_get(&pdev->dev, "reg");  in nxp_spifi_probe()
402 	if (IS_ERR(spifi->clk_reg)) {  in nxp_spifi_probe()
404 		return PTR_ERR(spifi->clk_reg);  in nxp_spifi_probe()
407 	ret = clk_prepare_enable(spifi->clk_reg);  in nxp_spifi_probe()
413 	ret = clk_prepare_enable(spifi->clk_spifi);  in nxp_spifi_probe()
419 	spifi->dev = &pdev->dev;  in nxp_spifi_probe()
420 	platform_set_drvdata(pdev, spifi);  in nxp_spifi_probe()
423 	nxp_spifi_reset(spifi);  in nxp_spifi_probe()
424 	writel(0, spifi->io_base + SPIFI_IDATA);  in nxp_spifi_probe()
425 	writel(0, spifi->io_base + SPIFI_MCMD);  in nxp_spifi_probe()
426 	nxp_spifi_reset(spifi);  in nxp_spifi_probe()
435 	ret = nxp_spifi_setup_flash(spifi, flash_np);  in nxp_spifi_probe()
444 	clk_disable_unprepare(spifi->clk_spifi);  in nxp_spifi_probe()
446 	clk_disable_unprepare(spifi->clk_reg);  in nxp_spifi_probe()
452 	struct nxp_spifi *spifi = platform_get_drvdata(pdev);  in nxp_spifi_remove()  local
454 	mtd_device_unregister(&spifi->nor.mtd);  in nxp_spifi_remove()
455 	clk_disable_unprepare(spifi->clk_spifi);  in nxp_spifi_remove()
456 	clk_disable_unprepare(spifi->clk_reg);  in nxp_spifi_remove()