1 // SPDX-License-Identifier: GPL-2.0 OR MIT 2 /* Copyright 2017-2019 Qiang Yu <yuq825@gmail.com> */ 3 4 #include <linux/iopoll.h> 5 #include <linux/device.h> 6 7 #include "lima_device.h" 8 #include "lima_l2_cache.h" 9 #include "lima_regs.h" 10 11 #define l2_cache_write(reg, data) writel(data, ip->iomem + reg) 12 #define l2_cache_read(reg) readl(ip->iomem + reg) 13 14 static int lima_l2_cache_wait_idle(struct lima_ip *ip) 15 { 16 struct lima_device *dev = ip->dev; 17 int err; 18 u32 v; 19 20 err = readl_poll_timeout(ip->iomem + LIMA_L2_CACHE_STATUS, v, 21 !(v & LIMA_L2_CACHE_STATUS_COMMAND_BUSY), 22 0, 1000); 23 if (err) { 24 dev_err(dev->dev, "%s wait command timeout\n", 25 lima_ip_name(ip)); 26 return err; 27 } 28 return 0; 29 } 30 31 int lima_l2_cache_flush(struct lima_ip *ip) 32 { 33 int ret; 34 35 spin_lock(&ip->data.lock); 36 l2_cache_write(LIMA_L2_CACHE_COMMAND, LIMA_L2_CACHE_COMMAND_CLEAR_ALL); 37 ret = lima_l2_cache_wait_idle(ip); 38 spin_unlock(&ip->data.lock); 39 return ret; 40 } 41 42 static int lima_l2_cache_hw_init(struct lima_ip *ip) 43 { 44 int err; 45 46 err = lima_l2_cache_flush(ip); 47 if (err) 48 return err; 49 50 l2_cache_write(LIMA_L2_CACHE_ENABLE, 51 LIMA_L2_CACHE_ENABLE_ACCESS | 52 LIMA_L2_CACHE_ENABLE_READ_ALLOCATE); 53 l2_cache_write(LIMA_L2_CACHE_MAX_READS, 0x1c); 54 55 return 0; 56 } 57 58 int lima_l2_cache_resume(struct lima_ip *ip) 59 { 60 return lima_l2_cache_hw_init(ip); 61 } 62 63 void lima_l2_cache_suspend(struct lima_ip *ip) 64 { 65 66 } 67 68 int lima_l2_cache_init(struct lima_ip *ip) 69 { 70 int i; 71 u32 size; 72 struct lima_device *dev = ip->dev; 73 74 /* l2_cache2 only exists when one of PP4-7 present */ 75 if (ip->id == lima_ip_l2_cache2) { 76 for (i = lima_ip_pp4; i <= lima_ip_pp7; i++) { 77 if (dev->ip[i].present) 78 break; 79 } 80 if (i > lima_ip_pp7) 81 return -ENODEV; 82 } 83 84 spin_lock_init(&ip->data.lock); 85 86 size = l2_cache_read(LIMA_L2_CACHE_SIZE); 87 dev_info(dev->dev, "%s %uK, %u-way, %ubyte cache line, %ubit external bus\n", 88 lima_ip_name(ip), 89 1 << (((size >> 16) & 0xff) - 10), 90 1 << ((size >> 8) & 0xff), 91 1 << (size & 0xff), 92 1 << ((size >> 24) & 0xff)); 93 94 return lima_l2_cache_hw_init(ip); 95 } 96 97 void lima_l2_cache_fini(struct lima_ip *ip) 98 { 99 100 } 101