move sboot to the root directory

[open-ath9k-htc-firmware.git] / sboot / magpie_1_1 / sboot / athos / src / xtos / intlevel-restore.S

diff --git a/sboot/magpie_1_1/sboot/athos/src/xtos/intlevel-restore.S b/sboot/magpie_1_1/sboot/athos/src/xtos/intlevel-restore.S
new file mode 100755 (executable)
index 0000000..a1490e8
--- /dev/null
+++ b/sboot/magpie_1_1/sboot/athos/src/xtos/intlevel-restore.S
@@ -0,0 +1,92 @@
+// intlevel-restore.S - Interrupt related assembler code - _xtos_restore_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"
+
+
+/***************************************************************************
+ *  void  _xtos_restore_intlevel(unsigned restoreval);
+ *
+ *  _xtos_restore_intlevel() restores the current interrupt level
+ *  according to a value returned by _xtos_set_intlevel() or
+ *  _xtos_set_min_intlevel() (or one of the corresponding macros).
+ *
+ *  NOTE:  In XEA2, this function may restore the entire PS register, not
+ *  just the PS.INTLEVEL field.  If some other PS field(s) must be changed
+ *  and kept intact across restoring PS.INTLEVEL (this is generally unlikely),
+ *  use the XTOS_RESTORE_JUST_INTLEVEL() macro instead (which is slower).
+ *
+ *  NOTE:  In XEA1, this function is implemented further below, identically
+ *  to _xtos_set_vpri().
+ *
+ *  NOTE:  The macro form of this function (XTOS_RESTORE_INTLEVEL())
+ *  is recommended (for XEA2 configs or where the config is unknown)
+ *  because it may be more efficient.
+ */
+
+       .text
+       .global _xtos_restore_intlevel
+       .type   _xtos_restore_intlevel,@function
+#if XCHAL_HAVE_XEA2
+       .align 4
+_xtos_restore_intlevel:
+       abi_entry
+# if XCHAL_HAVE_INTERRUPTS
+       wsr     a2, PS          // restore PS
+       rsync                   // wait for WSR to PS to complete
+# endif
+       abi_return
+       .size   _xtos_restore_intlevel, . - _xtos_restore_intlevel
+#endif
+
+
+
+/***************************************************************************
+ *  _xtos_set_vpri() is used to set the current virtual priority from C code;
+ *  it can be called from the application or from a C interrupt handler.
+ */
+
+       .global _xtos_set_vpri
+       .type   _xtos_set_vpri,@function
+       .align 4
+_xtos_set_vpri:
+#if XCHAL_HAVE_XEA1
+_xtos_restore_intlevel:
+#endif
+       abi_entry
+#if XCHAL_HAVE_INTERRUPTS && XTOS_VIRTUAL_INTENABLE
+       mov     a3, a2
+       movi    a4, _xtos_intstruct
+       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        // a3 = 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 /*XCHAL_HAVE_INTERRUPTS*/
+       abi_return
+       .size   _xtos_set_vpri, . - _xtos_set_vpri
+