1 // SPDX-License-Identifier: GPL-2.0 OR MIT
2 /* Copyright 2018-2019 Qiang Yu <yuq825@gmail.com> */
3 
4 #include <linux/io.h>
5 #include <linux/device.h>
6 
7 #include "lima_device.h"
8 #include "lima_bcast.h"
9 #include "lima_regs.h"
10 
11 #define bcast_write(reg, data) writel(data, ip->iomem + reg)
12 #define bcast_read(reg) readl(ip->iomem + reg)
13 
lima_bcast_enable(struct lima_device * dev,int num_pp)14 void lima_bcast_enable(struct lima_device *dev, int num_pp)
15 {
16 	struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_pp;
17 	struct lima_ip *ip = dev->ip + lima_ip_bcast;
18 	int i, mask = bcast_read(LIMA_BCAST_BROADCAST_MASK) & 0xffff0000;
19 
20 	for (i = 0; i < num_pp; i++) {
21 		struct lima_ip *pp = pipe->processor[i];
22 
23 		mask |= 1 << (pp->id - lima_ip_pp0);
24 	}
25 
26 	bcast_write(LIMA_BCAST_BROADCAST_MASK, mask);
27 }
28 
lima_bcast_hw_init(struct lima_ip * ip)29 static int lima_bcast_hw_init(struct lima_ip *ip)
30 {
31 	bcast_write(LIMA_BCAST_BROADCAST_MASK, ip->data.mask << 16);
32 	bcast_write(LIMA_BCAST_INTERRUPT_MASK, ip->data.mask);
33 	return 0;
34 }
35 
lima_bcast_resume(struct lima_ip * ip)36 int lima_bcast_resume(struct lima_ip *ip)
37 {
38 	return lima_bcast_hw_init(ip);
39 }
40 
lima_bcast_suspend(struct lima_ip * ip)41 void lima_bcast_suspend(struct lima_ip *ip)
42 {
43 
44 }
45 
lima_bcast_init(struct lima_ip * ip)46 int lima_bcast_init(struct lima_ip *ip)
47 {
48 	int i;
49 
50 	for (i = lima_ip_pp0; i <= lima_ip_pp7; i++) {
51 		if (ip->dev->ip[i].present)
52 			ip->data.mask |= 1 << (i - lima_ip_pp0);
53 	}
54 
55 	return lima_bcast_hw_init(ip);
56 }
57 
lima_bcast_fini(struct lima_ip * ip)58 void lima_bcast_fini(struct lima_ip *ip)
59 {
60 
61 }
62 
63