| // SPDX-License-Identifier: GPL-2.0 OR MIT |
| /* Copyright 2017-2019 Qiang Yu <yuq825@gmail.com> */ |
| |
| #include <linux/iopoll.h> |
| #include <linux/device.h> |
| |
| #include "lima_device.h" |
| #include "lima_l2_cache.h" |
| #include "lima_regs.h" |
| |
| #define l2_cache_write(reg, data) writel(data, ip->iomem + reg) |
| #define l2_cache_read(reg) readl(ip->iomem + reg) |
| |
| static int lima_l2_cache_wait_idle(struct lima_ip *ip) |
| { |
| struct lima_device *dev = ip->dev; |
| int err; |
| u32 v; |
| |
| err = readl_poll_timeout(ip->iomem + LIMA_L2_CACHE_STATUS, v, |
| !(v & LIMA_L2_CACHE_STATUS_COMMAND_BUSY), |
| 0, 1000); |
| if (err) { |
| dev_err(dev->dev, "%s wait command timeout\n", |
| lima_ip_name(ip)); |
| return err; |
| } |
| return 0; |
| } |
| |
| int lima_l2_cache_flush(struct lima_ip *ip) |
| { |
| int ret; |
| |
| spin_lock(&ip->data.lock); |
| l2_cache_write(LIMA_L2_CACHE_COMMAND, LIMA_L2_CACHE_COMMAND_CLEAR_ALL); |
| ret = lima_l2_cache_wait_idle(ip); |
| spin_unlock(&ip->data.lock); |
| return ret; |
| } |
| |
| static int lima_l2_cache_hw_init(struct lima_ip *ip) |
| { |
| int err; |
| |
| err = lima_l2_cache_flush(ip); |
| if (err) |
| return err; |
| |
| l2_cache_write(LIMA_L2_CACHE_ENABLE, |
| LIMA_L2_CACHE_ENABLE_ACCESS | |
| LIMA_L2_CACHE_ENABLE_READ_ALLOCATE); |
| l2_cache_write(LIMA_L2_CACHE_MAX_READS, 0x1c); |
| |
| return 0; |
| } |
| |
| int lima_l2_cache_resume(struct lima_ip *ip) |
| { |
| return lima_l2_cache_hw_init(ip); |
| } |
| |
| void lima_l2_cache_suspend(struct lima_ip *ip) |
| { |
| |
| } |
| |
| int lima_l2_cache_init(struct lima_ip *ip) |
| { |
| int i; |
| u32 size; |
| struct lima_device *dev = ip->dev; |
| |
| /* l2_cache2 only exists when one of PP4-7 present */ |
| if (ip->id == lima_ip_l2_cache2) { |
| for (i = lima_ip_pp4; i <= lima_ip_pp7; i++) { |
| if (dev->ip[i].present) |
| break; |
| } |
| if (i > lima_ip_pp7) |
| return -ENODEV; |
| } |
| |
| spin_lock_init(&ip->data.lock); |
| |
| size = l2_cache_read(LIMA_L2_CACHE_SIZE); |
| dev_info(dev->dev, "%s %uK, %u-way, %ubyte cache line, %ubit external bus\n", |
| lima_ip_name(ip), |
| 1 << (((size >> 16) & 0xff) - 10), |
| 1 << ((size >> 8) & 0xff), |
| 1 << (size & 0xff), |
| 1 << ((size >> 24) & 0xff)); |
| |
| return lima_l2_cache_hw_init(ip); |
| } |
| |
| void lima_l2_cache_fini(struct lima_ip *ip) |
| { |
| |
| } |