99 lines
2.0 KiB
C
99 lines
2.0 KiB
C
|
// 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, "l2 cache wait command timeout\n");
|
||
|
|
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, "l2 cache %uK, %u-way, %ubyte cache line, %ubit external bus\n",
|
||
|
|
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)
|
||
|
|
{
|
||
|
|
|
||
|
|
}
|