1
2
3
4
5
6#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
7
8#include <linux/kernel.h>
9#include <linux/types.h>
10#include <linux/bug.h>
11#include <asm/hardware/cp14.h>
12
13#include "coresight-etm.h"
14
15int etm_readl_cp14(u32 reg, unsigned int *val)
16{
17 switch (reg) {
18 case ETMCR:
19 *val = etm_read(ETMCR);
20 return 0;
21 case ETMCCR:
22 *val = etm_read(ETMCCR);
23 return 0;
24 case ETMTRIGGER:
25 *val = etm_read(ETMTRIGGER);
26 return 0;
27 case ETMSR:
28 *val = etm_read(ETMSR);
29 return 0;
30 case ETMSCR:
31 *val = etm_read(ETMSCR);
32 return 0;
33 case ETMTSSCR:
34 *val = etm_read(ETMTSSCR);
35 return 0;
36 case ETMTEEVR:
37 *val = etm_read(ETMTEEVR);
38 return 0;
39 case ETMTECR1:
40 *val = etm_read(ETMTECR1);
41 return 0;
42 case ETMFFLR:
43 *val = etm_read(ETMFFLR);
44 return 0;
45 case ETMACVRn(0):
46 *val = etm_read(ETMACVR0);
47 return 0;
48 case ETMACVRn(1):
49 *val = etm_read(ETMACVR1);
50 return 0;
51 case ETMACVRn(2):
52 *val = etm_read(ETMACVR2);
53 return 0;
54 case ETMACVRn(3):
55 *val = etm_read(ETMACVR3);
56 return 0;
57 case ETMACVRn(4):
58 *val = etm_read(ETMACVR4);
59 return 0;
60 case ETMACVRn(5):
61 *val = etm_read(ETMACVR5);
62 return 0;
63 case ETMACVRn(6):
64 *val = etm_read(ETMACVR6);
65 return 0;
66 case ETMACVRn(7):
67 *val = etm_read(ETMACVR7);
68 return 0;
69 case ETMACVRn(8):
70 *val = etm_read(ETMACVR8);
71 return 0;
72 case ETMACVRn(9):
73 *val = etm_read(ETMACVR9);
74 return 0;
75 case ETMACVRn(10):
76 *val = etm_read(ETMACVR10);
77 return 0;
78 case ETMACVRn(11):
79 *val = etm_read(ETMACVR11);
80 return 0;
81 case ETMACVRn(12):
82 *val = etm_read(ETMACVR12);
83 return 0;
84 case ETMACVRn(13):
85 *val = etm_read(ETMACVR13);
86 return 0;
87 case ETMACVRn(14):
88 *val = etm_read(ETMACVR14);
89 return 0;
90 case ETMACVRn(15):
91 *val = etm_read(ETMACVR15);
92 return 0;
93 case ETMACTRn(0):
94 *val = etm_read(ETMACTR0);
95 return 0;
96 case ETMACTRn(1):
97 *val = etm_read(ETMACTR1);
98 return 0;
99 case ETMACTRn(2):
100 *val = etm_read(ETMACTR2);
101 return 0;
102 case ETMACTRn(3):
103 *val = etm_read(ETMACTR3);
104 return 0;
105 case ETMACTRn(4):
106 *val = etm_read(ETMACTR4);
107 return 0;
108 case ETMACTRn(5):
109 *val = etm_read(ETMACTR5);
110 return 0;
111 case ETMACTRn(6):
112 *val = etm_read(ETMACTR6);
113 return 0;
114 case ETMACTRn(7):
115 *val = etm_read(ETMACTR7);
116 return 0;
117 case ETMACTRn(8):
118 *val = etm_read(ETMACTR8);
119 return 0;
120 case ETMACTRn(9):
121 *val = etm_read(ETMACTR9);
122 return 0;
123 case ETMACTRn(10):
124 *val = etm_read(ETMACTR10);
125 return 0;
126 case ETMACTRn(11):
127 *val = etm_read(ETMACTR11);
128 return 0;
129 case ETMACTRn(12):
130 *val = etm_read(ETMACTR12);
131 return 0;
132 case ETMACTRn(13):
133 *val = etm_read(ETMACTR13);
134 return 0;
135 case ETMACTRn(14):
136 *val = etm_read(ETMACTR14);
137 return 0;
138 case ETMACTRn(15):
139 *val = etm_read(ETMACTR15);
140 return 0;
141 case ETMCNTRLDVRn(0):
142 *val = etm_read(ETMCNTRLDVR0);
143 return 0;
144 case ETMCNTRLDVRn(1):
145 *val = etm_read(ETMCNTRLDVR1);
146 return 0;
147 case ETMCNTRLDVRn(2):
148 *val = etm_read(ETMCNTRLDVR2);
149 return 0;
150 case ETMCNTRLDVRn(3):
151 *val = etm_read(ETMCNTRLDVR3);
152 return 0;
153 case ETMCNTENRn(0):
154 *val = etm_read(ETMCNTENR0);
155 return 0;
156 case ETMCNTENRn(1):
157 *val = etm_read(ETMCNTENR1);
158 return 0;
159 case ETMCNTENRn(2):
160 *val = etm_read(ETMCNTENR2);
161 return 0;
162 case ETMCNTENRn(3):
163 *val = etm_read(ETMCNTENR3);
164 return 0;
165 case ETMCNTRLDEVRn(0):
166 *val = etm_read(ETMCNTRLDEVR0);
167 return 0;
168 case ETMCNTRLDEVRn(1):
169 *val = etm_read(ETMCNTRLDEVR1);
170 return 0;
171 case ETMCNTRLDEVRn(2):
172 *val = etm_read(ETMCNTRLDEVR2);
173 return 0;
174 case ETMCNTRLDEVRn(3):
175 *val = etm_read(ETMCNTRLDEVR3);
176 return 0;
177 case ETMCNTVRn(0):
178 *val = etm_read(ETMCNTVR0);
179 return 0;
180 case ETMCNTVRn(1):
181 *val = etm_read(ETMCNTVR1);
182 return 0;
183 case ETMCNTVRn(2):
184 *val = etm_read(ETMCNTVR2);
185 return 0;
186 case ETMCNTVRn(3):
187 *val = etm_read(ETMCNTVR3);
188 return 0;
189 case ETMSQ12EVR:
190 *val = etm_read(ETMSQ12EVR);
191 return 0;
192 case ETMSQ21EVR:
193 *val = etm_read(ETMSQ21EVR);
194 return 0;
195 case ETMSQ23EVR:
196 *val = etm_read(ETMSQ23EVR);
197 return 0;
198 case ETMSQ31EVR:
199 *val = etm_read(ETMSQ31EVR);
200 return 0;
201 case ETMSQ32EVR:
202 *val = etm_read(ETMSQ32EVR);
203 return 0;
204 case ETMSQ13EVR:
205 *val = etm_read(ETMSQ13EVR);
206 return 0;
207 case ETMSQR:
208 *val = etm_read(ETMSQR);
209 return 0;
210 case ETMEXTOUTEVRn(0):
211 *val = etm_read(ETMEXTOUTEVR0);
212 return 0;
213 case ETMEXTOUTEVRn(1):
214 *val = etm_read(ETMEXTOUTEVR1);
215 return 0;
216 case ETMEXTOUTEVRn(2):
217 *val = etm_read(ETMEXTOUTEVR2);
218 return 0;
219 case ETMEXTOUTEVRn(3):
220 *val = etm_read(ETMEXTOUTEVR3);
221 return 0;
222 case ETMCIDCVRn(0):
223 *val = etm_read(ETMCIDCVR0);
224 return 0;
225 case ETMCIDCVRn(1):
226 *val = etm_read(ETMCIDCVR1);
227 return 0;
228 case ETMCIDCVRn(2):
229 *val = etm_read(ETMCIDCVR2);
230 return 0;
231 case ETMCIDCMR:
232 *val = etm_read(ETMCIDCMR);
233 return 0;
234 case ETMIMPSPEC0:
235 *val = etm_read(ETMIMPSPEC0);
236 return 0;
237 case ETMIMPSPEC1:
238 *val = etm_read(ETMIMPSPEC1);
239 return 0;
240 case ETMIMPSPEC2:
241 *val = etm_read(ETMIMPSPEC2);
242 return 0;
243 case ETMIMPSPEC3:
244 *val = etm_read(ETMIMPSPEC3);
245 return 0;
246 case ETMIMPSPEC4:
247 *val = etm_read(ETMIMPSPEC4);
248 return 0;
249 case ETMIMPSPEC5:
250 *val = etm_read(ETMIMPSPEC5);
251 return 0;
252 case ETMIMPSPEC6:
253 *val = etm_read(ETMIMPSPEC6);
254 return 0;
255 case ETMIMPSPEC7:
256 *val = etm_read(ETMIMPSPEC7);
257 return 0;
258 case ETMSYNCFR:
259 *val = etm_read(ETMSYNCFR);
260 return 0;
261 case ETMIDR:
262 *val = etm_read(ETMIDR);
263 return 0;
264 case ETMCCER:
265 *val = etm_read(ETMCCER);
266 return 0;
267 case ETMEXTINSELR:
268 *val = etm_read(ETMEXTINSELR);
269 return 0;
270 case ETMTESSEICR:
271 *val = etm_read(ETMTESSEICR);
272 return 0;
273 case ETMEIBCR:
274 *val = etm_read(ETMEIBCR);
275 return 0;
276 case ETMTSEVR:
277 *val = etm_read(ETMTSEVR);
278 return 0;
279 case ETMAUXCR:
280 *val = etm_read(ETMAUXCR);
281 return 0;
282 case ETMTRACEIDR:
283 *val = etm_read(ETMTRACEIDR);
284 return 0;
285 case ETMVMIDCVR:
286 *val = etm_read(ETMVMIDCVR);
287 return 0;
288 case ETMOSLSR:
289 *val = etm_read(ETMOSLSR);
290 return 0;
291 case ETMOSSRR:
292 *val = etm_read(ETMOSSRR);
293 return 0;
294 case ETMPDCR:
295 *val = etm_read(ETMPDCR);
296 return 0;
297 case ETMPDSR:
298 *val = etm_read(ETMPDSR);
299 return 0;
300 default:
301 *val = 0;
302 return -EINVAL;
303 }
304}
305
306int etm_writel_cp14(u32 reg, u32 val)
307{
308 switch (reg) {
309 case ETMCR:
310 etm_write(val, ETMCR);
311 break;
312 case ETMTRIGGER:
313 etm_write(val, ETMTRIGGER);
314 break;
315 case ETMSR:
316 etm_write(val, ETMSR);
317 break;
318 case ETMTSSCR:
319 etm_write(val, ETMTSSCR);
320 break;
321 case ETMTEEVR:
322 etm_write(val, ETMTEEVR);
323 break;
324 case ETMTECR1:
325 etm_write(val, ETMTECR1);
326 break;
327 case ETMFFLR:
328 etm_write(val, ETMFFLR);
329 break;
330 case ETMACVRn(0):
331 etm_write(val, ETMACVR0);
332 break;
333 case ETMACVRn(1):
334 etm_write(val, ETMACVR1);
335 break;
336 case ETMACVRn(2):
337 etm_write(val, ETMACVR2);
338 break;
339 case ETMACVRn(3):
340 etm_write(val, ETMACVR3);
341 break;
342 case ETMACVRn(4):
343 etm_write(val, ETMACVR4);
344 break;
345 case ETMACVRn(5):
346 etm_write(val, ETMACVR5);
347 break;
348 case ETMACVRn(6):
349 etm_write(val, ETMACVR6);
350 break;
351 case ETMACVRn(7):
352 etm_write(val, ETMACVR7);
353 break;
354 case ETMACVRn(8):
355 etm_write(val, ETMACVR8);
356 break;
357 case ETMACVRn(9):
358 etm_write(val, ETMACVR9);
359 break;
360 case ETMACVRn(10):
361 etm_write(val, ETMACVR10);
362 break;
363 case ETMACVRn(11):
364 etm_write(val, ETMACVR11);
365 break;
366 case ETMACVRn(12):
367 etm_write(val, ETMACVR12);
368 break;
369 case ETMACVRn(13):
370 etm_write(val, ETMACVR13);
371 break;
372 case ETMACVRn(14):
373 etm_write(val, ETMACVR14);
374 break;
375 case ETMACVRn(15):
376 etm_write(val, ETMACVR15);
377 break;
378 case ETMACTRn(0):
379 etm_write(val, ETMACTR0);
380 break;
381 case ETMACTRn(1):
382 etm_write(val, ETMACTR1);
383 break;
384 case ETMACTRn(2):
385 etm_write(val, ETMACTR2);
386 break;
387 case ETMACTRn(3):
388 etm_write(val, ETMACTR3);
389 break;
390 case ETMACTRn(4):
391 etm_write(val, ETMACTR4);
392 break;
393 case ETMACTRn(5):
394 etm_write(val, ETMACTR5);
395 break;
396 case ETMACTRn(6):
397 etm_write(val, ETMACTR6);
398 break;
399 case ETMACTRn(7):
400 etm_write(val, ETMACTR7);
401 break;
402 case ETMACTRn(8):
403 etm_write(val, ETMACTR8);
404 break;
405 case ETMACTRn(9):
406 etm_write(val, ETMACTR9);
407 break;
408 case ETMACTRn(10):
409 etm_write(val, ETMACTR10);
410 break;
411 case ETMACTRn(11):
412 etm_write(val, ETMACTR11);
413 break;
414 case ETMACTRn(12):
415 etm_write(val, ETMACTR12);
416 break;
417 case ETMACTRn(13):
418 etm_write(val, ETMACTR13);
419 break;
420 case ETMACTRn(14):
421 etm_write(val, ETMACTR14);
422 break;
423 case ETMACTRn(15):
424 etm_write(val, ETMACTR15);
425 break;
426 case ETMCNTRLDVRn(0):
427 etm_write(val, ETMCNTRLDVR0);
428 break;
429 case ETMCNTRLDVRn(1):
430 etm_write(val, ETMCNTRLDVR1);
431 break;
432 case ETMCNTRLDVRn(2):
433 etm_write(val, ETMCNTRLDVR2);
434 break;
435 case ETMCNTRLDVRn(3):
436 etm_write(val, ETMCNTRLDVR3);
437 break;
438 case ETMCNTENRn(0):
439 etm_write(val, ETMCNTENR0);
440 break;
441 case ETMCNTENRn(1):
442 etm_write(val, ETMCNTENR1);
443 break;
444 case ETMCNTENRn(2):
445 etm_write(val, ETMCNTENR2);
446 break;
447 case ETMCNTENRn(3):
448 etm_write(val, ETMCNTENR3);
449 break;
450 case ETMCNTRLDEVRn(0):
451 etm_write(val, ETMCNTRLDEVR0);
452 break;
453 case ETMCNTRLDEVRn(1):
454 etm_write(val, ETMCNTRLDEVR1);
455 break;
456 case ETMCNTRLDEVRn(2):
457 etm_write(val, ETMCNTRLDEVR2);
458 break;
459 case ETMCNTRLDEVRn(3):
460 etm_write(val, ETMCNTRLDEVR3);
461 break;
462 case ETMCNTVRn(0):
463 etm_write(val, ETMCNTVR0);
464 break;
465 case ETMCNTVRn(1):
466 etm_write(val, ETMCNTVR1);
467 break;
468 case ETMCNTVRn(2):
469 etm_write(val, ETMCNTVR2);
470 break;
471 case ETMCNTVRn(3):
472 etm_write(val, ETMCNTVR3);
473 break;
474 case ETMSQ12EVR:
475 etm_write(val, ETMSQ12EVR);
476 break;
477 case ETMSQ21EVR:
478 etm_write(val, ETMSQ21EVR);
479 break;
480 case ETMSQ23EVR:
481 etm_write(val, ETMSQ23EVR);
482 break;
483 case ETMSQ31EVR:
484 etm_write(val, ETMSQ31EVR);
485 break;
486 case ETMSQ32EVR:
487 etm_write(val, ETMSQ32EVR);
488 break;
489 case ETMSQ13EVR:
490 etm_write(val, ETMSQ13EVR);
491 break;
492 case ETMSQR:
493 etm_write(val, ETMSQR);
494 break;
495 case ETMEXTOUTEVRn(0):
496 etm_write(val, ETMEXTOUTEVR0);
497 break;
498 case ETMEXTOUTEVRn(1):
499 etm_write(val, ETMEXTOUTEVR1);
500 break;
501 case ETMEXTOUTEVRn(2):
502 etm_write(val, ETMEXTOUTEVR2);
503 break;
504 case ETMEXTOUTEVRn(3):
505 etm_write(val, ETMEXTOUTEVR3);
506 break;
507 case ETMCIDCVRn(0):
508 etm_write(val, ETMCIDCVR0);
509 break;
510 case ETMCIDCVRn(1):
511 etm_write(val, ETMCIDCVR1);
512 break;
513 case ETMCIDCVRn(2):
514 etm_write(val, ETMCIDCVR2);
515 break;
516 case ETMCIDCMR:
517 etm_write(val, ETMCIDCMR);
518 break;
519 case ETMIMPSPEC0:
520 etm_write(val, ETMIMPSPEC0);
521 break;
522 case ETMIMPSPEC1:
523 etm_write(val, ETMIMPSPEC1);
524 break;
525 case ETMIMPSPEC2:
526 etm_write(val, ETMIMPSPEC2);
527 break;
528 case ETMIMPSPEC3:
529 etm_write(val, ETMIMPSPEC3);
530 break;
531 case ETMIMPSPEC4:
532 etm_write(val, ETMIMPSPEC4);
533 break;
534 case ETMIMPSPEC5:
535 etm_write(val, ETMIMPSPEC5);
536 break;
537 case ETMIMPSPEC6:
538 etm_write(val, ETMIMPSPEC6);
539 break;
540 case ETMIMPSPEC7:
541 etm_write(val, ETMIMPSPEC7);
542 break;
543 case ETMSYNCFR:
544 etm_write(val, ETMSYNCFR);
545 break;
546 case ETMEXTINSELR:
547 etm_write(val, ETMEXTINSELR);
548 break;
549 case ETMTESSEICR:
550 etm_write(val, ETMTESSEICR);
551 break;
552 case ETMEIBCR:
553 etm_write(val, ETMEIBCR);
554 break;
555 case ETMTSEVR:
556 etm_write(val, ETMTSEVR);
557 break;
558 case ETMAUXCR:
559 etm_write(val, ETMAUXCR);
560 break;
561 case ETMTRACEIDR:
562 etm_write(val, ETMTRACEIDR);
563 break;
564 case ETMVMIDCVR:
565 etm_write(val, ETMVMIDCVR);
566 break;
567 case ETMOSLAR:
568 etm_write(val, ETMOSLAR);
569 break;
570 case ETMOSSRR:
571 etm_write(val, ETMOSSRR);
572 break;
573 case ETMPDCR:
574 etm_write(val, ETMPDCR);
575 break;
576 case ETMPDSR:
577 etm_write(val, ETMPDSR);
578 break;
579 default:
580 return -EINVAL;
581 }
582
583 return 0;
584}
585
