intlevel-set.S
3.36 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
#include "os_type.h"
#ifdef FREE_RTOS
// intlevel-set.S - Interrupt related assembler code - _xtos_set_intlevel
// Copyright (c) 2004-2010 Tensilica Inc.
//
// Permission is hereby granted, free of charge, to any person obtaining
// a copy of this software and associated documentation files (the
// "Software"), to deal in the Software without restriction, including
// without limitation the rights to use, copy, modify, merge, publish,
// distribute, sublicense, and/or sell copies of the Software, and to
// permit persons to whom the Software is furnished to do so, subject to
// the following conditions:
//
// The above copyright notice and this permission notice shall be included
// in all copies or substantial portions of the Software.
//
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
// EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
// MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
// IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY
// CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
// TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
// SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
#include <xtensa/coreasm.h>
#include <xtensa/config/specreg.h>
//#include "xtos-internal.h"
/***************************************************************************
* unsigned _xtos_set_intlevel(int intlevel);
*
* _xtos_set_intlevel() is used to set the current priority from C code;
* it can be called from the application or from a C interrupt handler.
*
* NOTE: This version allows the 'intlevel' parameter to be computed
* at run-time, and thus is longer. It is much more efficient, and
* highly recommented, to use the XTOS_SET_INTLEVEL(intlevel) macro instead
* (which requires a constant intlevel).
*/
.text
.align 4
.section .libkernel_text.text, "ax"
.global _xtos_set_intlevel
.type _xtos_set_intlevel,@function
_xtos_set_intlevel:
abi_entry
#if XCHAL_HAVE_INTERRUPTS
#if XCHAL_HAVE_XEA2
/* In XEA2, we can simply safely set PS.INTLEVEL directly: */
rsr a3, PS // get old (current) PS.INTLEVEL
movi a4, ~0xF
extui a2, a2, 0, 4 // keep only INTLEVEL bits of parameter
and a4, a4, a3 // mask out PS.INTLEVEL
or a4, a4, a2 // insert requested INTLEVEL
wsr a4, PS // update PS.INTLEVEL
extui a2, a3, 0, 4 // return only old PS.INTLEVEL field
rsync // wait for WSR to PS to complete
#else
/* In XEA1, we have to rely on INTENABLE register virtualization: */
movi a4, Xthal_intlevel_andbelow_mask
extui a3, a2, 0, 4 // keep only INTLEVEL bits of parameter
addx4 a5, a3, a4 // index mask to use
l32i a3, a5, 0 // get mask of interrupts at requested intlevel and below
movi a5, -1 // all 1's
movi a4, _xtos_intstruct
xor a3, a3, a5 // mask of interrupts at intlevels above the requested one (to enable)
xtos_lock a7 // MUST USE highest address register of function to avoid window overflows in critical section
l32i a2, a4, XTOS_VPRI_ENABLED_OFS // return old xtos_vpri_enabled (current vpri)
l32i a5, a4, XTOS_ENABLED_OFS // a5 = xtos_enabled
s32i a3, a4, XTOS_VPRI_ENABLED_OFS // set new xtos_vpri_enabled (current vpri)
and a5, a5, a3 // a5 = xtos_enabled & xtos_vpri_enabled
wsr a5, INTENABLE
xtos_unlock a7
#endif
#endif /*XCHAL_HAVE_INTERRUPTS*/
abi_return
.size _xtos_set_intlevel, . - _xtos_set_intlevel
#endif //FREE_RTOS