1 #ifndef __NVKM_FBRAM_FUC_H__
2 #define __NVKM_FBRAM_FUC_H__
3 #include <subdev/pmu.h>
4 
5 struct ramfuc {
6 	struct nvkm_memx *memx;
7 	struct nvkm_fb *fb;
8 	int sequence;
9 };
10 
11 struct ramfuc_reg {
12 	int sequence;
13 	bool force;
14 	u32 addr;
15 	u32 stride; /* in bytes */
16 	u32 mask;
17 	u32 data;
18 };
19 
20 static inline struct ramfuc_reg
21 ramfuc_stride(u32 addr, u32 stride, u32 mask)
22 {
23 	return (struct ramfuc_reg) {
24 		.sequence = 0,
25 		.addr = addr,
26 		.stride = stride,
27 		.mask = mask,
28 		.data = 0xdeadbeef,
29 	};
30 }
31 
32 static inline struct ramfuc_reg
33 ramfuc_reg2(u32 addr1, u32 addr2)
34 {
35 	return (struct ramfuc_reg) {
36 		.sequence = 0,
37 		.addr = addr1,
38 		.stride = addr2 - addr1,
39 		.mask = 0x3,
40 		.data = 0xdeadbeef,
41 	};
42 }
43 
44 static noinline struct ramfuc_reg
45 ramfuc_reg(u32 addr)
46 {
47 	return (struct ramfuc_reg) {
48 		.sequence = 0,
49 		.addr = addr,
50 		.stride = 0,
51 		.mask = 0x1,
52 		.data = 0xdeadbeef,
53 	};
54 }
55 
56 static inline int
57 ramfuc_init(struct ramfuc *ram, struct nvkm_fb *fb)
58 {
59 	struct nvkm_pmu *pmu = nvkm_pmu(fb);
60 	int ret;
61 
62 	ret = nvkm_memx_init(pmu, &ram->memx);
63 	if (ret)
64 		return ret;
65 
66 	ram->sequence++;
67 	ram->fb = fb;
68 	return 0;
69 }
70 
71 static inline int
72 ramfuc_exec(struct ramfuc *ram, bool exec)
73 {
74 	int ret = 0;
75 	if (ram->fb) {
76 		ret = nvkm_memx_fini(&ram->memx, exec);
77 		ram->fb = NULL;
78 	}
79 	return ret;
80 }
81 
82 static inline u32
83 ramfuc_rd32(struct ramfuc *ram, struct ramfuc_reg *reg)
84 {
85 	if (reg->sequence != ram->sequence)
86 		reg->data = nv_rd32(ram->fb, reg->addr);
87 	return reg->data;
88 }
89 
90 static inline void
91 ramfuc_wr32(struct ramfuc *ram, struct ramfuc_reg *reg, u32 data)
92 {
93 	unsigned int mask, off = 0;
94 
95 	reg->sequence = ram->sequence;
96 	reg->data = data;
97 
98 	for (mask = reg->mask; mask > 0; mask = (mask & ~1) >> 1) {
99 		if (mask & 1)
100 			nvkm_memx_wr32(ram->memx, reg->addr+off, reg->data);
101 		off += reg->stride;
102 	}
103 }
104 
105 static inline void
106 ramfuc_nuke(struct ramfuc *ram, struct ramfuc_reg *reg)
107 {
108 	reg->force = true;
109 }
110 
111 static inline u32
112 ramfuc_mask(struct ramfuc *ram, struct ramfuc_reg *reg, u32 mask, u32 data)
113 {
114 	u32 temp = ramfuc_rd32(ram, reg);
115 	if (temp != ((temp & ~mask) | data) || reg->force) {
116 		ramfuc_wr32(ram, reg, (temp & ~mask) | data);
117 		reg->force = false;
118 	}
119 	return temp;
120 }
121 
122 static inline void
123 ramfuc_wait(struct ramfuc *ram, u32 addr, u32 mask, u32 data, u32 nsec)
124 {
125 	nvkm_memx_wait(ram->memx, addr, mask, data, nsec);
126 }
127 
128 static inline void
129 ramfuc_nsec(struct ramfuc *ram, u32 nsec)
130 {
131 	nvkm_memx_nsec(ram->memx, nsec);
132 }
133 
134 static inline void
135 ramfuc_wait_vblank(struct ramfuc *ram)
136 {
137 	nvkm_memx_wait_vblank(ram->memx);
138 }
139 
140 static inline void
141 ramfuc_train(struct ramfuc *ram)
142 {
143 	nvkm_memx_train(ram->memx);
144 }
145 
146 static inline int
147 ramfuc_train_result(struct nvkm_fb *fb, u32 *result, u32 rsize)
148 {
149 	struct nvkm_pmu *pmu = nvkm_pmu(fb);
150 
151 	return nvkm_memx_train_result(pmu, result, rsize);
152 }
153 
154 static inline void
155 ramfuc_block(struct ramfuc *ram)
156 {
157 	nvkm_memx_block(ram->memx);
158 }
159 
160 static inline void
161 ramfuc_unblock(struct ramfuc *ram)
162 {
163 	nvkm_memx_unblock(ram->memx);
164 }
165 
166 #define ram_init(s,p)        ramfuc_init(&(s)->base, (p))
167 #define ram_exec(s,e)        ramfuc_exec(&(s)->base, (e))
168 #define ram_have(s,r)        ((s)->r_##r.addr != 0x000000)
169 #define ram_rd32(s,r)        ramfuc_rd32(&(s)->base, &(s)->r_##r)
170 #define ram_wr32(s,r,d)      ramfuc_wr32(&(s)->base, &(s)->r_##r, (d))
171 #define ram_nuke(s,r)        ramfuc_nuke(&(s)->base, &(s)->r_##r)
172 #define ram_mask(s,r,m,d)    ramfuc_mask(&(s)->base, &(s)->r_##r, (m), (d))
173 #define ram_wait(s,r,m,d,n)  ramfuc_wait(&(s)->base, (r), (m), (d), (n))
174 #define ram_nsec(s,n)        ramfuc_nsec(&(s)->base, (n))
175 #define ram_wait_vblank(s)   ramfuc_wait_vblank(&(s)->base)
176 #define ram_train(s)         ramfuc_train(&(s)->base)
177 #define ram_train_result(s,r,l) ramfuc_train_result((s), (r), (l))
178 #define ram_block(s)         ramfuc_block(&(s)->base)
179 #define ram_unblock(s)       ramfuc_unblock(&(s)->base)
180 #endif
181