blob: e68192ffdfd91dd59fcbad665116877335524711 [file] [log] [blame]
Achin Gupta4f6ad662013-10-25 09:08:21 +01001/*
2 * Copyright (c) 2013, ARM Limited. All rights reserved.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 *
7 * Redistributions of source code must retain the above copyright notice, this
8 * list of conditions and the following disclaimer.
9 *
10 * Redistributions in binary form must reproduce the above copyright notice,
11 * this list of conditions and the following disclaimer in the documentation
12 * and/or other materials provided with the distribution.
13 *
14 * Neither the name of ARM nor the names of its contributors may be used
15 * to endorse or promote products derived from this software without specific
16 * prior written permission.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 * POSSIBILITY OF SUCH DAMAGE.
29 */
30
31#include <arch_helpers.h>
32
33 .globl read_vbar
34 .globl read_vbar_el1
35 .globl read_vbar_el2
36 .globl read_vbar_el3
37 .globl write_vbar
38 .globl write_vbar_el1
39 .globl write_vbar_el2
40 .globl write_vbar_el3
41
42 .globl read_sctlr
43 .globl read_sctlr_el1
44 .globl read_sctlr_el2
45 .globl read_sctlr_el3
46 .globl write_sctlr
47 .globl write_sctlr_el1
48 .globl write_sctlr_el2
49 .globl write_sctlr_el3
50
51 .globl read_actlr
52 .globl read_actlr_el1
53 .globl read_actlr_el2
54 .globl read_actlr_el3
55 .globl write_actlr
56 .globl write_actlr_el1
57 .globl write_actlr_el2
58 .globl write_actlr_el3
59
60 .globl read_esr
61 .globl read_esr_el1
62 .globl read_esr_el2
63 .globl read_esr_el3
64 .globl write_esr
65 .globl write_esr_el1
66 .globl write_esr_el2
67 .globl write_esr_el3
68
69 .globl read_afsr0
70 .globl read_afsr0_el1
71 .globl read_afsr0_el2
72 .globl read_afsr0_el3
73 .globl write_afsr0
74 .globl write_afsr0_el1
75 .globl write_afsr0_el2
76 .globl write_afsr0_el3
77
78 .globl read_afsr1
79 .globl read_afsr1_el1
80 .globl read_afsr1_el2
81 .globl read_afsr1_el3
82 .globl write_afsr1
83 .globl write_afsr1_el1
84 .globl write_afsr1_el2
85 .globl write_afsr1_el3
86
87 .globl read_far
88 .globl read_far_el1
89 .globl read_far_el2
90 .globl read_far_el3
91 .globl write_far
92 .globl write_far_el1
93 .globl write_far_el2
94 .globl write_far_el3
95
96 .globl read_mair
97 .globl read_mair_el1
98 .globl read_mair_el2
99 .globl read_mair_el3
100 .globl write_mair
101 .globl write_mair_el1
102 .globl write_mair_el2
103 .globl write_mair_el3
104
105 .globl read_amair
106 .globl read_amair_el1
107 .globl read_amair_el2
108 .globl read_amair_el3
109 .globl write_amair
110 .globl write_amair_el1
111 .globl write_amair_el2
112 .globl write_amair_el3
113
114 .globl read_rvbar
115 .globl read_rvbar_el1
116 .globl read_rvbar_el2
117 .globl read_rvbar_el3
118
119 .globl read_rmr
120 .globl read_rmr_el1
121 .globl read_rmr_el2
122 .globl read_rmr_el3
123 .globl write_rmr
124 .globl write_rmr_el1
125 .globl write_rmr_el2
126 .globl write_rmr_el3
127
128 .globl read_tcr
129 .globl read_tcr_el1
130 .globl read_tcr_el2
131 .globl read_tcr_el3
132 .globl write_tcr
133 .globl write_tcr_el1
134 .globl write_tcr_el2
135 .globl write_tcr_el3
136
137 .globl read_cptr
138 .globl read_cptr_el2
139 .globl read_cptr_el3
140 .globl write_cptr
141 .globl write_cptr_el2
142 .globl write_cptr_el3
143
144 .globl read_ttbr0
145 .globl read_ttbr0_el1
146 .globl read_ttbr0_el2
147 .globl read_ttbr0_el3
148 .globl write_ttbr0
149 .globl write_ttbr0_el1
150 .globl write_ttbr0_el2
151 .globl write_ttbr0_el3
152
153 .globl read_ttbr1
154 .globl read_ttbr1_el1
155 .globl read_ttbr1_el2
156 .globl write_ttbr1
157 .globl write_ttbr1_el1
158 .globl write_ttbr1_el2
159
160 .globl read_cpacr
161 .globl write_cpacr
162
163 .globl read_cntfrq
164 .globl write_cntfrq
165
166 .globl read_cpuectlr
167 .globl write_cpuectlr
168
169 .globl read_cnthctl_el2
170 .globl write_cnthctl_el2
171
172 .globl read_cntfrq_el0
173 .globl write_cntfrq_el0
174
175 .globl read_scr
176 .globl write_scr
177
178 .globl read_hcr
179 .globl write_hcr
180
181 .globl read_midr
182 .globl read_mpidr
183
184 .globl read_current_el
185 .globl read_id_pfr1_el1
186 .globl read_id_aa64pfr0_el1
187
188#if SUPPORT_VFP
189 .globl enable_vfp
190 .globl read_fpexc
191 .globl write_fpexc
192#endif
193
194
195 .section .text, "ax"
196
197read_current_el:; .type read_current_el, %function
198 mrs x0, CurrentEl
199 ret
200
201
202read_id_pfr1_el1:; .type read_id_pfr1_el1, %function
203 mrs x0, id_pfr1_el1
204 ret
205
206
207read_id_aa64pfr0_el1:; .type read_id_aa64pfr0_el1, %function
208 mrs x0, id_aa64pfr0_el1
209 ret
210
211
212 /* -----------------------------------------------------
213 * VBAR accessors
214 * -----------------------------------------------------
215 */
216read_vbar:; .type read_vbar, %function
217 mrs x0, CurrentEl
218 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
219 b.eq read_vbar_el1
220 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
221 b.eq read_vbar_el2
222 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
223 b.eq read_vbar_el3
224
225
226read_vbar_el1:; .type read_vbar_el1, %function
227 mrs x0, vbar_el1
228 ret
229
230
231read_vbar_el2:; .type read_vbar_el2, %function
232 mrs x0, vbar_el2
233 ret
234
235
236read_vbar_el3:; .type read_vbar_el3, %function
237 mrs x0, vbar_el3
238 ret
239
240
241write_vbar:; .type write_vbar, %function
242 mrs x1, CurrentEl
243 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
244 b.eq write_vbar_el1
245 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
246 b.eq write_vbar_el2
247 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
248 b.eq write_vbar_el3
249
250
251write_vbar_el1:; .type write_vbar_el1, %function
252 msr vbar_el1, x0
253 isb
254 ret
255
256
257write_vbar_el2:; .type write_vbar_el2, %function
258 msr vbar_el2, x0
259 isb
260 ret
261
262
263write_vbar_el3:; .type write_vbar_el3, %function
264 msr vbar_el3, x0
265 isb
266 ret
267
268
269 /* -----------------------------------------------------
270 * AFSR0 accessors
271 * -----------------------------------------------------
272 */
273read_afsr0:; .type read_afsr0, %function
274 mrs x0, CurrentEl
275 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
276 b.eq read_afsr0_el1
277 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
278 b.eq read_afsr0_el2
279 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
280 b.eq read_afsr0_el3
281
282
283read_afsr0_el1:; .type read_afsr0_el1, %function
284 mrs x0, afsr0_el1
285 ret
286
287
288read_afsr0_el2:; .type read_afsr0_el2, %function
289 mrs x0, afsr0_el2
290 ret
291
292
293read_afsr0_el3:; .type read_afsr0_el3, %function
294 mrs x0, afsr0_el3
295 ret
296
297
298write_afsr0:; .type write_afsr0, %function
299 mrs x1, CurrentEl
300 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
301 b.eq write_afsr0_el1
302 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
303 b.eq write_afsr0_el2
304 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
305 b.eq write_afsr0_el3
306
307
308write_afsr0_el1:; .type write_afsr0_el1, %function
309 msr afsr0_el1, x0
310 isb
311 ret
312
313
314write_afsr0_el2:; .type write_afsr0_el2, %function
315 msr afsr0_el2, x0
316 isb
317 ret
318
319
320write_afsr0_el3:; .type write_afsr0_el3, %function
321 msr afsr0_el3, x0
322 isb
323 ret
324
325
326 /* -----------------------------------------------------
327 * FAR accessors
328 * -----------------------------------------------------
329 */
330read_far:; .type read_far, %function
331 mrs x0, CurrentEl
332 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
333 b.eq read_far_el1
334 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
335 b.eq read_far_el2
336 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
337 b.eq read_far_el3
338
339
340read_far_el1:; .type read_far_el1, %function
341 mrs x0, far_el1
342 ret
343
344
345read_far_el2:; .type read_far_el2, %function
346 mrs x0, far_el2
347 ret
348
349
350read_far_el3:; .type read_far_el3, %function
351 mrs x0, far_el3
352 ret
353
354
355write_far:; .type write_far, %function
356 mrs x1, CurrentEl
357 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
358 b.eq write_far_el1
359 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
360 b.eq write_far_el2
361 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
362 b.eq write_far_el3
363
364
365write_far_el1:; .type write_far_el1, %function
366 msr far_el1, x0
367 isb
368 ret
369
370
371write_far_el2:; .type write_far_el2, %function
372 msr far_el2, x0
373 isb
374 ret
375
376
377write_far_el3:; .type write_far_el3, %function
378 msr far_el3, x0
379 isb
380 ret
381
382
383 /* -----------------------------------------------------
384 * MAIR accessors
385 * -----------------------------------------------------
386 */
387read_mair:; .type read_mair, %function
388 mrs x0, CurrentEl
389 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
390 b.eq read_mair_el1
391 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
392 b.eq read_mair_el2
393 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
394 b.eq read_mair_el3
395
396
397read_mair_el1:; .type read_mair_el1, %function
398 mrs x0, mair_el1
399 ret
400
401
402read_mair_el2:; .type read_mair_el2, %function
403 mrs x0, mair_el2
404 ret
405
406
407read_mair_el3:; .type read_mair_el3, %function
408 mrs x0, mair_el3
409 ret
410
411
412write_mair:; .type write_mair, %function
413 mrs x1, CurrentEl
414 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
415 b.eq write_mair_el1
416 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
417 b.eq write_mair_el2
418 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
419 b.eq write_mair_el3
420
421
422write_mair_el1:; .type write_mair_el1, %function
423 msr mair_el1, x0
424 isb
425 ret
426
427
428write_mair_el2:; .type write_mair_el2, %function
429 msr mair_el2, x0
430 isb
431 ret
432
433
434write_mair_el3:; .type write_mair_el3, %function
435 msr mair_el3, x0
436 isb
437 ret
438
439
440 /* -----------------------------------------------------
441 * AMAIR accessors
442 * -----------------------------------------------------
443 */
444read_amair:; .type read_amair, %function
445 mrs x0, CurrentEl
446 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
447 b.eq read_amair_el1
448 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
449 b.eq read_amair_el2
450 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
451 b.eq read_amair_el3
452
453
454read_amair_el1:; .type read_amair_el1, %function
455 mrs x0, amair_el1
456 ret
457
458
459read_amair_el2:; .type read_amair_el2, %function
460 mrs x0, amair_el2
461 ret
462
463
464read_amair_el3:; .type read_amair_el3, %function
465 mrs x0, amair_el3
466 ret
467
468
469write_amair:; .type write_amair, %function
470 mrs x1, CurrentEl
471 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
472 b.eq write_amair_el1
473 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
474 b.eq write_amair_el2
475 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
476 b.eq write_amair_el3
477
478
479write_amair_el1:; .type write_amair_el1, %function
480 msr amair_el1, x0
481 isb
482 ret
483
484
485write_amair_el2:; .type write_amair_el2, %function
486 msr amair_el2, x0
487 isb
488 ret
489
490
491write_amair_el3:; .type write_amair_el3, %function
492 msr amair_el3, x0
493 isb
494 ret
495
496
497 /* -----------------------------------------------------
498 * RVBAR accessors
499 * -----------------------------------------------------
500 */
501read_rvbar:; .type read_rvbar, %function
502 mrs x0, CurrentEl
503 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
504 b.eq read_rvbar_el1
505 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
506 b.eq read_rvbar_el2
507 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
508 b.eq read_rvbar_el3
509
510
511read_rvbar_el1:; .type read_rvbar_el1, %function
512 mrs x0, rvbar_el1
513 ret
514
515
516read_rvbar_el2:; .type read_rvbar_el2, %function
517 mrs x0, rvbar_el2
518 ret
519
520
521read_rvbar_el3:; .type read_rvbar_el3, %function
522 mrs x0, rvbar_el3
523 ret
524
525
526 /* -----------------------------------------------------
527 * RMR accessors
528 * -----------------------------------------------------
529 */
530read_rmr:; .type read_rmr, %function
531 mrs x0, CurrentEl
532 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
533 b.eq read_rmr_el1
534 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
535 b.eq read_rmr_el2
536 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
537 b.eq read_rmr_el3
538
539
540read_rmr_el1:; .type read_rmr_el1, %function
541 mrs x0, rmr_el1
542 ret
543
544
545read_rmr_el2:; .type read_rmr_el2, %function
546 mrs x0, rmr_el2
547 ret
548
549
550read_rmr_el3:; .type read_rmr_el3, %function
551 mrs x0, rmr_el3
552 ret
553
554
555write_rmr:; .type write_rmr, %function
556 mrs x1, CurrentEl
557 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
558 b.eq write_rmr_el1
559 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
560 b.eq write_rmr_el2
561 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
562 b.eq write_rmr_el3
563
564
565write_rmr_el1:; .type write_rmr_el1, %function
566 msr rmr_el1, x0
567 isb
568 ret
569
570
571write_rmr_el2:; .type write_rmr_el2, %function
572 msr rmr_el2, x0
573 isb
574 ret
575
576
577write_rmr_el3:; .type write_rmr_el3, %function
578 msr rmr_el3, x0
579 isb
580 ret
581
582
583read_afsr1:; .type read_afsr1, %function
584 mrs x0, CurrentEl
585 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
586 b.eq read_afsr1_el1
587 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
588 b.eq read_afsr1_el2
589 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
590 b.eq read_afsr1_el3
591
592
593 /* -----------------------------------------------------
594 * AFSR1 accessors
595 * -----------------------------------------------------
596 */
597read_afsr1_el1:; .type read_afsr1_el1, %function
598 mrs x0, afsr1_el1
599 ret
600
601
602read_afsr1_el2:; .type read_afsr1_el2, %function
603 mrs x0, afsr1_el2
604 ret
605
606
607read_afsr1_el3:; .type read_afsr1_el3, %function
608 mrs x0, afsr1_el3
609 ret
610
611
612write_afsr1:; .type write_afsr1, %function
613 mrs x1, CurrentEl
614 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
615 b.eq write_afsr1_el1
616 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
617 b.eq write_afsr1_el2
618 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
619 b.eq write_afsr1_el3
620
621
622write_afsr1_el1:; .type write_afsr1_el1, %function
623 msr afsr1_el1, x0
624 isb
625 ret
626
627
628write_afsr1_el2:; .type write_afsr1_el2, %function
629 msr afsr1_el2, x0
630 isb
631 ret
632
633
634write_afsr1_el3:; .type write_afsr1_el3, %function
635 msr afsr1_el3, x0
636 isb
637 ret
638
639
640 /* -----------------------------------------------------
641 * SCTLR accessors
642 * -----------------------------------------------------
643 */
644read_sctlr:; .type read_sctlr, %function
645 mrs x0, CurrentEl
646 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
647 b.eq read_sctlr_el1
648 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
649 b.eq read_sctlr_el2
650 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
651 b.eq read_sctlr_el3
652
653
654read_sctlr_el1:; .type read_sctlr_el1, %function
655 mrs x0, sctlr_el1
656 ret
657
658
659read_sctlr_el2:; .type read_sctlr_el2, %function
660 mrs x0, sctlr_el2
661 ret
662
663
664read_sctlr_el3:; .type read_sctlr_el3, %function
665 mrs x0, sctlr_el3
666 ret
667
668
669write_sctlr:; .type write_sctlr, %function
670 mrs x1, CurrentEl
671 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
672 b.eq write_sctlr_el1
673 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
674 b.eq write_sctlr_el2
675 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
676 b.eq write_sctlr_el3
677
678
679write_sctlr_el1:; .type write_sctlr_el1, %function
680 msr sctlr_el1, x0
681 dsb sy
682 isb
683 ret
684
685
686write_sctlr_el2:; .type write_sctlr_el2, %function
687 msr sctlr_el2, x0
688 dsb sy
689 isb
690 ret
691
692
693write_sctlr_el3:; .type write_sctlr_el3, %function
694 msr sctlr_el3, x0
695 dsb sy
696 isb
697 ret
698
699
700 /* -----------------------------------------------------
701 * ACTLR accessors
702 * -----------------------------------------------------
703 */
704read_actlr:; .type read_actlr, %function
705 mrs x0, CurrentEl
706 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
707 b.eq read_actlr_el1
708 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
709 b.eq read_actlr_el2
710 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
711 b.eq read_actlr_el3
712
713
714read_actlr_el1:; .type read_actlr_el1, %function
715 mrs x0, actlr_el1
716 ret
717
718
719read_actlr_el2:; .type read_actlr_el2, %function
720 mrs x0, actlr_el2
721 ret
722
723
724read_actlr_el3:; .type read_actlr_el3, %function
725 mrs x0, actlr_el3
726 ret
727
728
729write_actlr:; .type write_actlr, %function
730 mrs x1, CurrentEl
731 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
732 b.eq write_actlr_el1
733 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
734 b.eq write_actlr_el2
735 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
736 b.eq write_actlr_el3
737
738
739write_actlr_el1:; .type write_actlr_el1, %function
740 msr actlr_el1, x0
741 dsb sy
742 isb
743 ret
744
745
746write_actlr_el2:; .type write_actlr_el2, %function
747 msr actlr_el2, x0
748 dsb sy
749 isb
750 ret
751
752
753write_actlr_el3:; .type write_actlr_el3, %function
754 msr actlr_el3, x0
755 dsb sy
756 isb
757 ret
758
759
760 /* -----------------------------------------------------
761 * ESR accessors
762 * -----------------------------------------------------
763 */
764read_esr:; .type read_esr, %function
765 mrs x0, CurrentEl
766 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
767 b.eq read_esr_el1
768 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
769 b.eq read_esr_el2
770 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
771 b.eq read_esr_el3
772
773
774read_esr_el1:; .type read_esr_el1, %function
775 mrs x0, esr_el1
776 ret
777
778
779read_esr_el2:; .type read_esr_el2, %function
780 mrs x0, esr_el2
781 ret
782
783
784read_esr_el3:; .type read_esr_el3, %function
785 mrs x0, esr_el3
786 ret
787
788
789write_esr:; .type write_esr, %function
790 mrs x1, CurrentEl
791 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
792 b.eq write_esr_el1
793 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
794 b.eq write_esr_el2
795 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
796 b.eq write_esr_el3
797
798
799write_esr_el1:; .type write_esr_el1, %function
800 msr esr_el1, x0
801 dsb sy
802 isb
803 ret
804
805
806write_esr_el2:; .type write_esr_el2, %function
807 msr esr_el2, x0
808 dsb sy
809 isb
810 ret
811
812
813write_esr_el3:; .type write_esr_el3, %function
814 msr esr_el3, x0
815 dsb sy
816 isb
817 ret
818
819
820 /* -----------------------------------------------------
821 * TCR accessors
822 * -----------------------------------------------------
823 */
824read_tcr:; .type read_tcr, %function
825 mrs x0, CurrentEl
826 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
827 b.eq read_tcr_el1
828 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
829 b.eq read_tcr_el2
830 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
831 b.eq read_tcr_el3
832
833
834read_tcr_el1:; .type read_tcr_el1, %function
835 mrs x0, tcr_el1
836 ret
837
838
839read_tcr_el2:; .type read_tcr_el2, %function
840 mrs x0, tcr_el2
841 ret
842
843
844read_tcr_el3:; .type read_tcr_el3, %function
845 mrs x0, tcr_el3
846 ret
847
848
849write_tcr:; .type write_tcr, %function
850 mrs x1, CurrentEl
851 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
852 b.eq write_tcr_el1
853 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
854 b.eq write_tcr_el2
855 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
856 b.eq write_tcr_el3
857
858
859write_tcr_el1:; .type write_tcr_el1, %function
860 msr tcr_el1, x0
861 dsb sy
862 isb
863 ret
864
865
866write_tcr_el2:; .type write_tcr_el2, %function
867 msr tcr_el2, x0
868 dsb sy
869 isb
870 ret
871
872
873write_tcr_el3:; .type write_tcr_el3, %function
874 msr tcr_el3, x0
875 dsb sy
876 isb
877 ret
878
879
880 /* -----------------------------------------------------
881 * CPTR accessors
882 * -----------------------------------------------------
883 */
884read_cptr:; .type read_cptr, %function
885 mrs x0, CurrentEl
886 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
887 b.eq read_cptr_el1
888 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
889 b.eq read_cptr_el2
890 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
891 b.eq read_cptr_el3
892
893
894read_cptr_el1:; .type read_cptr_el1, %function
895 b read_cptr_el1
896 ret
897
898
899read_cptr_el2:; .type read_cptr_el2, %function
900 mrs x0, cptr_el2
901 ret
902
903
904read_cptr_el3:; .type read_cptr_el3, %function
905 mrs x0, cptr_el3
906 ret
907
908
909write_cptr:; .type write_cptr, %function
910 mrs x1, CurrentEl
911 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
912 b.eq write_cptr_el1
913 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
914 b.eq write_cptr_el2
915 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
916 b.eq write_cptr_el3
917
918
919write_cptr_el1:; .type write_cptr_el1, %function
920 b write_cptr_el1
921
922
923write_cptr_el2:; .type write_cptr_el2, %function
924 msr cptr_el2, x0
925 dsb sy
926 isb
927 ret
928
929
930write_cptr_el3:; .type write_cptr_el3, %function
931 msr cptr_el3, x0
932 dsb sy
933 isb
934 ret
935
936
937 /* -----------------------------------------------------
938 * TTBR0 accessors
939 * -----------------------------------------------------
940 */
941read_ttbr0:; .type read_ttbr0, %function
942 mrs x0, CurrentEl
943 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
944 b.eq read_ttbr0_el1
945 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
946 b.eq read_ttbr0_el2
947 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
948 b.eq read_ttbr0_el3
949
950
951read_ttbr0_el1:; .type read_ttbr0_el1, %function
952 mrs x0, ttbr0_el1
953 ret
954
955
956read_ttbr0_el2:; .type read_ttbr0_el2, %function
957 mrs x0, ttbr0_el2
958 ret
959
960
961read_ttbr0_el3:; .type read_ttbr0_el3, %function
962 mrs x0, ttbr0_el3
963 ret
964
965
966write_ttbr0:; .type write_ttbr0, %function
967 mrs x1, CurrentEl
968 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
969 b.eq write_ttbr0_el1
970 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
971 b.eq write_ttbr0_el2
972 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
973 b.eq write_ttbr0_el3
974
975
976write_ttbr0_el1:; .type write_ttbr0_el1, %function
977 msr ttbr0_el1, x0
978 isb
979 ret
980
981
982write_ttbr0_el2:; .type write_ttbr0_el2, %function
983 msr ttbr0_el2, x0
984 isb
985 ret
986
987
988write_ttbr0_el3:; .type write_ttbr0_el3, %function
989 msr ttbr0_el3, x0
990 isb
991 ret
992
993
994 /* -----------------------------------------------------
995 * TTBR1 accessors
996 * -----------------------------------------------------
997 */
998read_ttbr1:; .type read_ttbr1, %function
999 mrs x0, CurrentEl
1000 cmp x0, #(MODE_EL1 << MODE_EL_SHIFT)
1001 b.eq read_ttbr1_el1
1002 cmp x0, #(MODE_EL2 << MODE_EL_SHIFT)
1003 b.eq read_ttbr1_el2
1004 cmp x0, #(MODE_EL3 << MODE_EL_SHIFT)
1005 b.eq read_ttbr1_el3
1006
1007
1008read_ttbr1_el1:; .type read_ttbr1_el1, %function
1009 mrs x0, ttbr1_el1
1010 ret
1011
1012
1013read_ttbr1_el2:; .type read_ttbr1_el2, %function
1014 b read_ttbr1_el2
1015
1016
1017read_ttbr1_el3:; .type read_ttbr1_el3, %function
1018 b read_ttbr1_el3
1019
1020
1021write_ttbr1:; .type write_ttbr1, %function
1022 mrs x1, CurrentEl
1023 cmp x1, #(MODE_EL1 << MODE_EL_SHIFT)
1024 b.eq write_ttbr1_el1
1025 cmp x1, #(MODE_EL2 << MODE_EL_SHIFT)
1026 b.eq write_ttbr1_el2
1027 cmp x1, #(MODE_EL3 << MODE_EL_SHIFT)
1028 b.eq write_ttbr1_el3
1029
1030
1031write_ttbr1_el1:; .type write_ttbr1_el1, %function
1032 msr ttbr1_el1, x0
1033 isb
1034 ret
1035
1036
1037write_ttbr1_el2:; .type write_ttbr1_el2, %function
1038 b write_ttbr1_el2
1039
1040
1041write_ttbr1_el3:; .type write_ttbr1_el3, %function
1042 b write_ttbr1_el3
1043
1044
1045read_hcr:; .type read_hcr, %function
1046 mrs x0, hcr_el2
1047 ret
1048
1049
1050write_hcr:; .type write_hcr, %function
1051 msr hcr_el2, x0
1052 dsb sy
1053 isb
1054 ret
1055
1056
1057read_cpacr:; .type read_cpacr, %function
1058 mrs x0, cpacr_el1
1059 ret
1060
1061
1062write_cpacr:; .type write_cpacr, %function
1063 msr cpacr_el1, x0
1064 ret
1065
1066
1067read_cntfrq_el0:; .type read_cntfrq_el0, %function
1068 mrs x0, cntfrq_el0
1069 ret
1070
1071
1072write_cntfrq_el0:; .type write_cntfrq_el0, %function
1073 msr cntfrq_el0, x0
1074 ret
1075
1076
1077read_cpuectlr:; .type read_cpuectlr, %function
1078 mrs x0, CPUECTLR_EL1
1079 ret
1080
1081
1082write_cpuectlr:; .type write_cpuectlr, %function
1083 msr CPUECTLR_EL1, x0
1084 dsb sy
1085 isb
1086 ret
1087
1088
1089read_cnthctl_el2:; .type read_cnthctl_el2, %function
1090 mrs x0, cnthctl_el2
1091 ret
1092
1093
1094write_cnthctl_el2:; .type write_cnthctl_el2, %function
1095 msr cnthctl_el2, x0
1096 ret
1097
1098
1099read_cntfrq:; .type read_cntfrq, %function
1100 mrs x0, cntfrq_el0
1101 ret
1102
1103
1104write_cntfrq:; .type write_cntfrq, %function
1105 msr cntfrq_el0, x0
1106 ret
1107
1108
1109write_scr:; .type write_scr, %function
1110 msr scr_el3, x0
1111 dsb sy
1112 isb
1113 ret
1114
1115
1116read_scr:; .type read_scr, %function
1117 mrs x0, scr_el3
1118 ret
1119
1120
1121read_midr:; .type read_midr, %function
1122 mrs x0, midr_el1
1123 ret
1124
1125
1126read_mpidr:; .type read_mpidr, %function
1127 mrs x0, mpidr_el1
1128 ret
1129
1130
1131#if SUPPORT_VFP
1132enable_vfp:; .type enable_vfp, %function
1133 mrs x0, cpacr_el1
1134 orr x0, x0, #CPACR_VFP_BITS
1135 msr cpacr_el1, x0
1136 mrs x0, cptr_el3
1137 mov x1, #AARCH64_CPTR_TFP
1138 bic x0, x0, x1
1139 msr cptr_el3, x0
1140 ret
1141
1142
1143 // int read_fpexc(void)
1144read_fpexc:; .type read_fpexc, %function
1145 b read_fpexc
1146 ret
1147
1148
1149 // void write_fpexc(int fpexc)
1150write_fpexc:; .type write_fpexc, %function
1151 b write_fpexc
1152 ret
1153
1154#endif