101 lines · c
1// SPDX-License-Identifier: GPL-2.0 OR MIT2/* 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 14static 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 31int 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 42static 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 58int lima_l2_cache_resume(struct lima_ip *ip)59{60 return lima_l2_cache_hw_init(ip);61}62 63void lima_l2_cache_suspend(struct lima_ip *ip)64{65 66}67 68int 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 97void lima_l2_cache_fini(struct lima_ip *ip)98{99 100}101