Subversion Repositories openrisc_me

------------------------------------------------------------------------------

--                                                                          --

--                 GNAT RUN-TIME LIBRARY (GNARL) COMPONENTS                 --

--                                                                          --

--                     S Y S T E M . I N T E R R U P T S                    --

--                                                                          --

--                                  B o d y                                 --

--                                                                          --

--          Copyright (C) 1998-2009, Free Software Foundation, Inc.         --

--                                                                          --

-- GNARL is free software; you can  redistribute it  and/or modify it under --

-- terms of the  GNU General Public License as published  by the Free Soft- --

-- ware  Foundation;  either version 3,  or (at your option) any later ver- --

-- sion.  GNAT is distributed in the hope that it will be useful, but WITH- --

-- OUT ANY WARRANTY;  without even the  implied warranty of MERCHANTABILITY --

-- or FITNESS FOR A PARTICULAR PURPOSE.                                     --

--                                                                          --

-- As a special exception under Section 7 of GPL version 3, you are granted --

-- additional permissions described in the GCC Runtime Library Exception,   --

-- version 3.1, as published by the Free Software Foundation.               --

--                                                                          --

-- You should have received a copy of the GNU General Public License and    --

-- a copy of the GCC Runtime Library Exception along with this program;     --

-- see the files COPYING3 and COPYING.RUNTIME respectively.  If not, see    --

-- <http://www.gnu.org/licenses/>.                                          --

--                                                                          --

-- GNARL was developed by the GNARL team at Florida State University.       --

-- Extensive contributions were provided by Ada Core Technologies, Inc.     --

--                                                                          --

------------------------------------------------------------------------------

--  This is the IRIX & NT version of this package

with Ada.Task_Identification;

with Ada.Unchecked_Conversion;

with Interfaces.C;

with System.Storage_Elements;

with System.Task_Primitives.Operations;

with System.Tasking.Utilities;

with System.Tasking.Rendezvous;

with System.Tasking.Initialization;

with System.Interrupt_Management;

with System.Parameters;

package body System.Interrupts is

   use Parameters;

   use Tasking;

   use System.OS_Interface;

   use Interfaces.C;

   package STPO renames System.Task_Primitives.Operations;

   package IMNG renames System.Interrupt_Management;

   subtype int is Interfaces.C.int;

   function To_System is new Ada.Unchecked_Conversion

     (Ada.Task_Identification.Task_Id, Task_Id);

   type Handler_Kind is (Unknown, Task_Entry, Protected_Procedure);

   type Handler_Desc is record

      Kind   : Handler_Kind := Unknown;

      T      : Task_Id;

      E      : Task_Entry_Index;

      H      : Parameterless_Handler;

      Static : Boolean := False;

   end record;

   task type Server_Task (Interrupt : Interrupt_ID) is

      pragma Interrupt_Priority (System.Interrupt_Priority'Last);

   end Server_Task;

   type Server_Task_Access is access Server_Task;

   Handlers        : array (Interrupt_ID) of Task_Id;

   Descriptors     : array (Interrupt_ID) of Handler_Desc;

   Interrupt_Count : array (Interrupt_ID) of Integer := (others => 0);

   pragma Volatile_Components (Interrupt_Count);

   procedure Attach_Handler

     (New_Handler : Parameterless_Handler;

      Interrupt   : Interrupt_ID;

      Static      : Boolean;

      Restoration : Boolean);

   --  This internal procedure is needed to finalize protected objects

   --  that contain interrupt handlers.

   procedure Signal_Handler (Sig : Interrupt_ID);

   pragma Convention (C, Signal_Handler);

   --  This procedure is used to handle all the signals

   --  Type and Head, Tail of the list containing Registered Interrupt

   --  Handlers. These definitions are used to register the handlers

   --  specified by the pragma Interrupt_Handler.

   --------------------------

   -- Handler Registration --

   --------------------------

   type Registered_Handler;

   type R_Link is access all Registered_Handler;

   type Registered_Handler is record

      H    : System.Address := System.Null_Address;

      Next : R_Link := null;

   end record;

   Registered_Handlers : R_Link := null;

   function Is_Registered (Handler : Parameterless_Handler) return Boolean;

   --  See if the Handler has been "pragma"ed using Interrupt_Handler.

   --  Always consider a null handler as registered.

   type Handler_Ptr is access procedure (Sig : Interrupt_ID);

   pragma Convention (C, Handler_Ptr);

   function TISR is new Ada.Unchecked_Conversion (Handler_Ptr, isr_address);

   --------------------

   -- Signal_Handler --

   --------------------

   procedure Signal_Handler (Sig : Interrupt_ID) is

      Handler : Task_Id renames Handlers (Sig);

   begin

      if Intr_Attach_Reset and then

        intr_attach (int (Sig), TISR (Signal_Handler'Access)) = FUNC_ERR

      then

         raise Program_Error;

      end if;

      if Handler /= null then

         Interrupt_Count (Sig) := Interrupt_Count (Sig) + 1;

         STPO.Wakeup (Handler, Interrupt_Server_Idle_Sleep);

      end if;

   end Signal_Handler;

   -----------------

   -- Is_Reserved --

   -----------------

   function Is_Reserved (Interrupt : Interrupt_ID) return Boolean is

   begin

      return IMNG.Reserve (IMNG.Interrupt_ID (Interrupt));

   end Is_Reserved;

   -----------------------

   -- Is_Entry_Attached --

   -----------------------

   function Is_Entry_Attached (Interrupt : Interrupt_ID) return Boolean is

   begin

      if Is_Reserved (Interrupt) then

         raise Program_Error with

           "Interrupt" & Interrupt_ID'Image (Interrupt) & " is reserved";

      end if;

      return Descriptors (Interrupt).T /= Null_Task;

   end Is_Entry_Attached;

   -------------------------

   -- Is_Handler_Attached --

   -------------------------

   function Is_Handler_Attached (Interrupt : Interrupt_ID) return Boolean is

   begin

      if Is_Reserved (Interrupt) then

         raise Program_Error with

           "Interrupt" & Interrupt_ID'Image (Interrupt) & " is reserved";

      else

         return Descriptors (Interrupt).Kind /= Unknown;

      end if;

   end Is_Handler_Attached;

   ----------------

   -- Is_Ignored --

   ----------------

   function Is_Ignored (Interrupt : Interrupt_ID) return Boolean is

   begin

      raise Program_Error;

      return False;

   end Is_Ignored;

   ------------------

   -- Unblocked_By --

   ------------------

   function Unblocked_By (Interrupt : Interrupt_ID) return Task_Id is

   begin

      raise Program_Error;

      return Null_Task;

   end Unblocked_By;

   ----------------------

   -- Ignore_Interrupt --

   ----------------------

   procedure Ignore_Interrupt (Interrupt : Interrupt_ID) is

   begin

      raise Program_Error;

   end Ignore_Interrupt;

   ------------------------

   -- Unignore_Interrupt --

   ------------------------

   procedure Unignore_Interrupt (Interrupt : Interrupt_ID) is

   begin

      raise Program_Error;

   end Unignore_Interrupt;

   -------------------------------------

   -- Has_Interrupt_Or_Attach_Handler --

   -------------------------------------

   function Has_Interrupt_Or_Attach_Handler

     (Object : access Dynamic_Interrupt_Protection) return Boolean

   is

      pragma Unreferenced (Object);

   begin

      return True;

   end Has_Interrupt_Or_Attach_Handler;

   --------------

   -- Finalize --

   --------------

   procedure Finalize (Object : in out Static_Interrupt_Protection) is

   begin

      --  ??? loop to be executed only when we're not doing library level

      --  finalization, since in this case all interrupt tasks are gone.

      for N in reverse Object.Previous_Handlers'Range loop

         Attach_Handler

           (New_Handler => Object.Previous_Handlers (N).Handler,

            Interrupt   => Object.Previous_Handlers (N).Interrupt,

            Static      => Object.Previous_Handlers (N).Static,

            Restoration => True);

      end loop;

      Tasking.Protected_Objects.Entries.Finalize

        (Tasking.Protected_Objects.Entries.Protection_Entries (Object));

   end Finalize;

   -------------------------------------

   -- Has_Interrupt_Or_Attach_Handler --

   -------------------------------------

   function Has_Interrupt_Or_Attach_Handler

     (Object : access Static_Interrupt_Protection) return Boolean

   is

      pragma Unreferenced (Object);

   begin

      return True;

   end Has_Interrupt_Or_Attach_Handler;

   ----------------------

   -- Install_Handlers --

   ----------------------

   procedure Install_Handlers

     (Object       : access Static_Interrupt_Protection;

      New_Handlers : New_Handler_Array)

   is

   begin

      for N in New_Handlers'Range loop

         --  We need a lock around this ???

         Object.Previous_Handlers (N).Interrupt := New_Handlers (N).Interrupt;

         Object.Previous_Handlers (N).Static    := Descriptors

           (New_Handlers (N).Interrupt).Static;

         --  We call Exchange_Handler and not directly Interrupt_Manager.

         --  Exchange_Handler so we get the Is_Reserved check.

         Exchange_Handler

           (Old_Handler => Object.Previous_Handlers (N).Handler,

            New_Handler => New_Handlers (N).Handler,

            Interrupt   => New_Handlers (N).Interrupt,

            Static      => True);

      end loop;

   end Install_Handlers;

   ---------------------------------

   -- Install_Restricted_Handlers --

   ---------------------------------

   procedure Install_Restricted_Handlers (Handlers : New_Handler_Array) is

   begin

      for N in Handlers'Range loop

         Attach_Handler (Handlers (N).Handler, Handlers (N).Interrupt, True);

      end loop;

   end Install_Restricted_Handlers;

   ---------------------

   -- Current_Handler --

   ---------------------

   function Current_Handler

     (Interrupt : Interrupt_ID) return Parameterless_Handler

   is

   begin

      if Is_Reserved (Interrupt) then

         raise Program_Error;

      end if;

      if Descriptors (Interrupt).Kind = Protected_Procedure then

         return Descriptors (Interrupt).H;

      else

         return null;

      end if;

   end Current_Handler;

   --------------------

   -- Attach_Handler --

   --------------------

   procedure Attach_Handler

     (New_Handler : Parameterless_Handler;

      Interrupt   : Interrupt_ID;

      Static      : Boolean := False) is

   begin

      Attach_Handler (New_Handler, Interrupt, Static, False);

   end Attach_Handler;

   procedure Attach_Handler

     (New_Handler : Parameterless_Handler;

      Interrupt   : Interrupt_ID;

      Static      : Boolean;

      Restoration : Boolean)

   is

      New_Task : Server_Task_Access;

   begin

      if Is_Reserved (Interrupt) then

         raise Program_Error;

      end if;

      if not Restoration and then not Static

         --  Tries to overwrite a static Interrupt Handler with dynamic handle

        and then

          (Descriptors (Interrupt).Static

            --  New handler not specified as an Interrupt Handler by a pragma

             or else not Is_Registered (New_Handler))

      then

         raise Program_Error with

           "Trying to overwrite a static Interrupt Handler with a " &

           "dynamic Handler";

      end if;

      if Handlers (Interrupt) = null then

         New_Task := new Server_Task (Interrupt);

         Handlers (Interrupt) := To_System (New_Task.all'Identity);

      end if;

      if intr_attach (int (Interrupt),

        TISR (Signal_Handler'Access)) = FUNC_ERR

      then

         raise Program_Error;

      end if;

      if New_Handler = null then

         --  The null handler means we are detaching the handler

         Descriptors (Interrupt) :=

           (Kind => Unknown, T => null, E => 0, H => null, Static => False);

      else

         Descriptors (Interrupt).Kind := Protected_Procedure;

         Descriptors (Interrupt).H := New_Handler;

         Descriptors (Interrupt).Static := Static;

      end if;

   end Attach_Handler;

   ----------------------

   -- Exchange_Handler --

   ----------------------

   procedure Exchange_Handler

     (Old_Handler : out Parameterless_Handler;

      New_Handler : Parameterless_Handler;

      Interrupt   : Interrupt_ID;

      Static      : Boolean := False)

   is

   begin

      if Is_Reserved (Interrupt) then

         raise Program_Error;

      end if;

      if Descriptors (Interrupt).Kind = Task_Entry then

         --  In case we have an Interrupt Entry already installed.

         --  raise a program error. (propagate it to the caller).

         raise Program_Error with "An interrupt is already installed";

      else

         Old_Handler := Current_Handler (Interrupt);

         Attach_Handler (New_Handler, Interrupt, Static);

      end if;

   end Exchange_Handler;

   --------------------

   -- Detach_Handler --

   --------------------

   procedure Detach_Handler

     (Interrupt : Interrupt_ID;

      Static    : Boolean := False)

   is

   begin

      if Is_Reserved (Interrupt) then

         raise Program_Error;

      end if;

      if Descriptors (Interrupt).Kind = Task_Entry then

         raise Program_Error with "Trying to detach an Interrupt Entry";

      end if;

      if not Static and then Descriptors (Interrupt).Static then

         raise Program_Error with

           "Trying to detach a static Interrupt Handler";

      end if;

      Descriptors (Interrupt) :=

        (Kind => Unknown, T => null, E => 0, H => null, Static => False);

      if intr_attach (int (Interrupt), null) = FUNC_ERR then

         raise Program_Error;

      end if;

   end Detach_Handler;

   ---------------

   -- Reference --

   ---------------

   function Reference (Interrupt : Interrupt_ID) return System.Address is

      Signal : constant System.Address :=

                 System.Storage_Elements.To_Address

                   (System.Storage_Elements.Integer_Address (Interrupt));

   begin

      if Is_Reserved (Interrupt) then

         --  Only usable Interrupts can be used for binding it to an Entry

         raise Program_Error;

      end if;

      return Signal;

   end Reference;

   --------------------------------

   -- Register_Interrupt_Handler --

   --------------------------------

   procedure Register_Interrupt_Handler (Handler_Addr : System.Address) is

   begin

      Registered_Handlers :=

       new Registered_Handler'(H => Handler_Addr, Next => Registered_Handlers);

   end Register_Interrupt_Handler;

   -------------------

   -- Is_Registered --

   -------------------

   --  See if the Handler has been "pragma"ed using Interrupt_Handler.

   --  Always consider a null handler as registered.

   function Is_Registered (Handler : Parameterless_Handler) return Boolean is

      Ptr : R_Link := Registered_Handlers;

      type Fat_Ptr is record

         Object_Addr  : System.Address;

         Handler_Addr : System.Address;

      end record;

      function To_Fat_Ptr is new Ada.Unchecked_Conversion

        (Parameterless_Handler, Fat_Ptr);

      Fat : Fat_Ptr;

   begin

      if Handler = null then

         return True;

      end if;

      Fat := To_Fat_Ptr (Handler);

      while Ptr /= null loop

         if Ptr.H = Fat.Handler_Addr then

            return True;

         end if;

         Ptr := Ptr.Next;

      end loop;

      return False;

   end Is_Registered;

   -----------------------------

   -- Bind_Interrupt_To_Entry --

   -----------------------------

   procedure Bind_Interrupt_To_Entry

     (T       : Task_Id;

      E       : Task_Entry_Index;

      Int_Ref : System.Address)

   is

      Interrupt   : constant Interrupt_ID :=

                      Interrupt_ID (Storage_Elements.To_Integer (Int_Ref));

      New_Task : Server_Task_Access;

   begin

      if Is_Reserved (Interrupt) then

         raise Program_Error;

      end if;

      if Descriptors (Interrupt).Kind /= Unknown then

         raise Program_Error with

           "A binding for this interrupt is already present";

      end if;

      if Handlers (Interrupt) = null then

         New_Task := new Server_Task (Interrupt);

         Handlers (Interrupt) := To_System (New_Task.all'Identity);

      end if;

      if intr_attach (int (Interrupt),

        TISR (Signal_Handler'Access)) = FUNC_ERR

      then

         raise Program_Error;

      end if;

      Descriptors (Interrupt).Kind := Task_Entry;

      Descriptors (Interrupt).T := T;

      Descriptors (Interrupt).E := E;

      --  Indicate the attachment of Interrupt Entry in ATCB. This is needed so

      --  that when an Interrupt Entry task terminates the binding can be

      --  cleaned up. The call to unbinding must be make by the task before it

      --  terminates.

      T.Interrupt_Entry := True;

   end Bind_Interrupt_To_Entry;

   ------------------------------

   -- Detach_Interrupt_Entries --

   ------------------------------

   procedure Detach_Interrupt_Entries (T : Task_Id) is

   begin

      for J in Interrupt_ID loop

         if not Is_Reserved (J) then

            if Descriptors (J).Kind = Task_Entry

              and then Descriptors (J).T = T

            then

               Descriptors (J).Kind := Unknown;

               if intr_attach (int (J), null) = FUNC_ERR then

                  raise Program_Error;

               end if;

            end if;

         end if;

      end loop;

      --  Indicate in ATCB that no Interrupt Entries are attached

      T.Interrupt_Entry := True;

   end Detach_Interrupt_Entries;

   ---------------------

   -- Block_Interrupt --

   ---------------------

   procedure Block_Interrupt (Interrupt : Interrupt_ID) is

   begin

      raise Program_Error;

   end Block_Interrupt;

   -----------------------

   -- Unblock_Interrupt --

   -----------------------

   procedure Unblock_Interrupt (Interrupt : Interrupt_ID) is

   begin

      raise Program_Error;

   end Unblock_Interrupt;

   ----------------

   -- Is_Blocked --

   ----------------

   function Is_Blocked (Interrupt : Interrupt_ID) return Boolean is

   begin

      raise Program_Error;

      return False;

   end Is_Blocked;

   task body Server_Task is

      Desc    : Handler_Desc renames Descriptors (Interrupt);

      Self_Id : constant Task_Id := STPO.Self;

      Temp    : Parameterless_Handler;

   begin

      Utilities.Make_Independent;

      loop

         while Interrupt_Count (Interrupt) > 0 loop

            Interrupt_Count (Interrupt) := Interrupt_Count (Interrupt) - 1;

            begin

               case Desc.Kind is

                  when Unknown =>

                     null;

                  when Task_Entry =>

                     Rendezvous.Call_Simple (Desc.T, Desc.E, Null_Address);

                  when Protected_Procedure =>

                     Temp := Desc.H;

                     Temp.all;

               end case;

            exception

               when others => null;

            end;

         end loop;

         Initialization.Defer_Abort (Self_Id);

         if Single_Lock then

            STPO.Lock_RTS;

         end if;

         STPO.Write_Lock (Self_Id);

         Self_Id.Common.State := Interrupt_Server_Idle_Sleep;

         STPO.Sleep (Self_Id, Interrupt_Server_Idle_Sleep);

         Self_Id.Common.State := Runnable;

         STPO.Unlock (Self_Id);

         if Single_Lock then

            STPO.Unlock_RTS;

         end if;

         Initialization.Undefer_Abort (Self_Id);

         --  Undefer abort here to allow a window for this task to be aborted

         --  at the time of system shutdown.

      end loop;

   end Server_Task;

end System.Interrupts;