| // intlevel-setmin.S - Interrupt related assembler code - _xtos_set_min_intlevel |
| |
| // Copyright (c) 2004-2015 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 "../xtos-internal.h" |
| |
| #if XCHAL_HAVE_XEA2 |
| |
| |
| /*************************************************************************** |
| * unsigned _xtos_set_min_intlevel(int intlevel); |
| * |
| * _xtos_set_min_intlevel() is identical to _xtos_set_intlevel() except |
| * that it will not lower the current interrupt level. Instead, |
| * it ensures that the current interrupt level is at least as high |
| * as specified. |
| * |
| * 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_MIN_INTLEVEL(intlevel) macro instead |
| * (which requires a constant intlevel). |
| */ |
| |
| .text |
| .align 4 |
| .global _xtos_set_min_intlevel |
| .type _xtos_set_min_intlevel,@function |
| _xtos_set_min_intlevel: |
| abi_entry |
| #if XCHAL_HAVE_INTERRUPTS |
| /* In XEA2, we can simply safely set PS.INTLEVEL directly: */ |
| extui a3, a2, 0, 4 // keep only INTLEVEL bits of parameter |
| rsr.ps a2 // get old (current) PS.INTLEVEL |
| movi a4, ~0xF |
| extui a5, a2, 0, 4 // look at old PS.INTLEVEL |
| sub a5, a3, a5 // new.intlevel - old.intlevel |
| and a4, a4, a2 // mask out PS.INTLEVEL |
| or a4, a4, a3 // insert requested INTLEVEL |
| movltz a4, a2, a5 // keep same PS if already higher than requested |
| wsr.ps a4 // update PS.INTLEVEL |
| rsync // wait for WSR to PS to complete |
| #endif /*XCHAL_HAVE_INTERRUPTS*/ |
| abi_return |
| |
| .size _xtos_set_min_intlevel, . - _xtos_set_min_intlevel |
| |
| #endif /* XEA2 */ |
| |