100 lines · 2.0 KB · C
RawDownload
// 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){ }