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
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