libgloss/sparc_leon/catch_interrupt_pending.c

   1 /*
   2  * Copyright (c) 2011 Aeroflex Gaisler
   3  *
   4  * BSD license:
   5  *
   6  * Permission is hereby granted, free of charge, to any person obtaining a copy
   7  * of this software and associated documentation files (the "Software"), to deal
   8  * in the Software without restriction, including without limitation the rights
   9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10  * copies of the Software, and to permit persons to whom the Software is
  11  * furnished to do so, subject to the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be included in
  14  * all copies or substantial portions of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22  * THE SOFTWARE.
  23  */
  24
  25
  26 #include <asm-leon/leonstack.h>
  27 #include <asm-leon/irq.h>
  28 #define NULL 0
  29
  30 TAILQ_HEAD (pending_queue, pendingaction) pending =
  31 TAILQ_HEAD_INITIALIZER (pending);
  32
  33      void add_pending (struct pendingaction *a)
  34 {
  35   unsigned long old = leonbare_disable_traps ();
  36   TAILQ_INSERT_TAIL (&pending, a, next);
  37   leonbare_enable_traps (old);
  38 }
  39
  40 struct pendingaction *
  41 get_pending ()
  42 {
  43   struct pendingaction *a = 0;
  44   unsigned long old = leonbare_disable_traps ();
  45   if (a = TAILQ_FIRST (&pending))
  46     {
  47       TAILQ_REMOVE (&pending, a, next);
  48     }
  49   leonbare_enable_traps (old);
  50   return a;
  51 }
  52
  53 void
  54 process_pending ()
  55 {
  56   struct pendingaction *a;
  57   while (a = get_pending ())
  58     {
  59       if (a->handler)
  60         {
  61           a->handler (a->arg);
  62         }
  63     }
  64 }