1130 lines
38 KiB
Ada
1130 lines
38 KiB
Ada
------------------------------------------------------------------------------
|
|
-- --
|
|
-- GNU ADA 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) 1992-2002, 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 2, or (at your option) any later ver- --
|
|
-- sion. GNARL 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. See the GNU General Public License --
|
|
-- for more details. You should have received a copy of the GNU General --
|
|
-- Public License distributed with GNARL; see file COPYING. If not, write --
|
|
-- to the Free Software Foundation, 59 Temple Place - Suite 330, Boston, --
|
|
-- MA 02111-1307, USA. --
|
|
-- --
|
|
-- As a special exception, if other files instantiate generics from this --
|
|
-- unit, or you link this unit with other files to produce an executable, --
|
|
-- this unit does not by itself cause the resulting executable to be --
|
|
-- covered by the GNU General Public License. This exception does not --
|
|
-- however invalidate any other reasons why the executable file might be --
|
|
-- covered by the GNU Public License. --
|
|
-- --
|
|
-- GNARL was developed by the GNARL team at Florida State University. --
|
|
-- Extensive contributions were provided by Ada Core Technologies Inc. --
|
|
-- --
|
|
------------------------------------------------------------------------------
|
|
|
|
-- Invariants:
|
|
|
|
-- All user-handleable signals are masked at all times in all
|
|
-- tasks/threads except possibly for the Interrupt_Manager task.
|
|
|
|
-- When a user task wants to have the effect of masking/unmasking an
|
|
-- signal, it must call Block_Interrupt/Unblock_Interrupt, which
|
|
-- will have the effect of unmasking/masking the signal in the
|
|
-- Interrupt_Manager task. These comments do not apply to vectored
|
|
-- hardware interrupts, which may be masked or unmasked using routined
|
|
-- interfaced to the relevant VxWorks system calls.
|
|
|
|
-- Once we associate a Signal_Server_Task with an signal, the task never
|
|
-- goes away, and we never remove the association. On the other hand, it
|
|
-- is more convenient to terminate an associated Interrupt_Server_Task
|
|
-- for a vectored hardware interrupt (since we use a binary semaphore
|
|
-- for synchronization with the umbrella handler).
|
|
|
|
-- There is no more than one signal per Signal_Server_Task and no more than
|
|
-- one Signal_Server_Task per signal. The same relation holds for hardware
|
|
-- interrupts and Interrupt_Server_Task's at any given time. That is,
|
|
-- only one non-terminated Interrupt_Server_Task exists for a give
|
|
-- interrupt at any time.
|
|
|
|
-- Within this package, the lock L is used to protect the various status
|
|
-- tables. If there is a Server_Task associated with a signal or interrupt,
|
|
-- we use the per-task lock of the Server_Task instead so that we protect the
|
|
-- status between Interrupt_Manager and Server_Task. Protection among
|
|
-- service requests are ensured via user calls to the Interrupt_Manager
|
|
-- entries.
|
|
|
|
-- This is the VxWorks version of this package, supporting vectored hardware
|
|
-- interrupts.
|
|
|
|
with Unchecked_Conversion;
|
|
|
|
with System.OS_Interface; use System.OS_Interface;
|
|
|
|
with Interfaces.VxWorks;
|
|
|
|
with Ada.Task_Identification;
|
|
-- used for Task_ID type
|
|
|
|
with Ada.Exceptions;
|
|
-- used for Raise_Exception
|
|
|
|
with System.Task_Primitives.Operations;
|
|
-- used for Write_Lock
|
|
-- Unlock
|
|
-- Abort
|
|
-- Wakeup_Task
|
|
-- Sleep
|
|
-- Initialize_Lock
|
|
|
|
with System.Storage_Elements;
|
|
-- used for To_Address
|
|
-- To_Integer
|
|
-- Integer_Address
|
|
|
|
with System.Tasking;
|
|
-- used for Task_ID
|
|
-- Task_Entry_Index
|
|
-- Null_Task
|
|
-- Self
|
|
-- Interrupt_Manager_ID
|
|
|
|
with System.Tasking.Utilities;
|
|
-- used for Make_Independent
|
|
|
|
with System.Tasking.Rendezvous;
|
|
-- used for Call_Simple
|
|
pragma Elaborate_All (System.Tasking.Rendezvous);
|
|
|
|
package body System.Interrupts is
|
|
|
|
use Tasking;
|
|
use Ada.Exceptions;
|
|
|
|
package PRI renames System.Task_Primitives;
|
|
package POP renames System.Task_Primitives.Operations;
|
|
|
|
function To_Ada is new Unchecked_Conversion
|
|
(System.Tasking.Task_ID, Ada.Task_Identification.Task_Id);
|
|
|
|
function To_System is new Unchecked_Conversion
|
|
(Ada.Task_Identification.Task_Id, Task_ID);
|
|
|
|
-----------------
|
|
-- Local Tasks --
|
|
-----------------
|
|
|
|
-- WARNING: System.Tasking.Stages performs calls to this task
|
|
-- with low-level constructs. Do not change this spec without synchro-
|
|
-- nizing it.
|
|
|
|
task Interrupt_Manager is
|
|
entry Detach_Interrupt_Entries (T : Task_ID);
|
|
|
|
entry Attach_Handler
|
|
(New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean;
|
|
Restoration : Boolean := False);
|
|
|
|
entry Exchange_Handler
|
|
(Old_Handler : out Parameterless_Handler;
|
|
New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean);
|
|
|
|
entry Detach_Handler
|
|
(Interrupt : Interrupt_ID;
|
|
Static : Boolean);
|
|
|
|
entry Bind_Interrupt_To_Entry
|
|
(T : Task_ID;
|
|
E : Task_Entry_Index;
|
|
Interrupt : Interrupt_ID);
|
|
|
|
pragma Interrupt_Priority (System.Interrupt_Priority'First);
|
|
end Interrupt_Manager;
|
|
|
|
task type Interrupt_Server_Task
|
|
(Interrupt : Interrupt_ID; Int_Sema : SEM_ID) is
|
|
-- Server task for vectored hardware interrupt handling
|
|
pragma Interrupt_Priority (System.Interrupt_Priority'First + 2);
|
|
end Interrupt_Server_Task;
|
|
|
|
type Interrupt_Task_Access is access Interrupt_Server_Task;
|
|
|
|
-------------------------------
|
|
-- Local Types and Variables --
|
|
-------------------------------
|
|
|
|
type Entry_Assoc is record
|
|
T : Task_ID;
|
|
E : Task_Entry_Index;
|
|
end record;
|
|
|
|
type Handler_Assoc is record
|
|
H : Parameterless_Handler;
|
|
Static : Boolean; -- Indicates static binding;
|
|
end record;
|
|
|
|
User_Handler : array (Interrupt_ID) of Handler_Assoc :=
|
|
(others => (null, Static => False));
|
|
pragma Volatile_Components (User_Handler);
|
|
-- Holds the protected procedure handler (if any) and its Static
|
|
-- information for each interrupt or signal. A handler is static
|
|
-- iff it is specified through the pragma Attach_Handler.
|
|
|
|
User_Entry : array (Interrupt_ID) of Entry_Assoc :=
|
|
(others => (T => Null_Task, E => Null_Task_Entry));
|
|
pragma Volatile_Components (User_Entry);
|
|
-- Holds the task and entry index (if any) for each interrupt / signal
|
|
|
|
-- 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.
|
|
|
|
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_Handler_Head : R_Link := null;
|
|
Registered_Handler_Tail : R_Link := null;
|
|
|
|
Server_ID : array (Interrupt_ID) of System.Tasking.Task_ID :=
|
|
(others => System.Tasking.Null_Task);
|
|
pragma Atomic_Components (Server_ID);
|
|
-- Holds the Task_ID of the Server_Task for each interrupt / signal.
|
|
-- Task_ID is needed to accomplish locking per interrupt base. Also
|
|
-- is needed to determine whether to create a new Server_Task.
|
|
|
|
Semaphore_ID_Map : array
|
|
(Interrupt_ID range 0 .. System.OS_Interface.Max_HW_Interrupt)
|
|
of SEM_ID := (others => 0);
|
|
-- Array of binary semaphores associated with vectored interrupts
|
|
-- Note that the last bound should be Max_HW_Interrupt, but this will raise
|
|
-- Storage_Error if Num_HW_Interrupts is null, so use an extra 4 bytes
|
|
-- instead.
|
|
|
|
Interrupt_Access_Hold : Interrupt_Task_Access;
|
|
-- Variable for allocating an Interrupt_Server_Task
|
|
|
|
Default_Handler : array (HW_Interrupt) of Interfaces.VxWorks.VOIDFUNCPTR;
|
|
-- Vectored interrupt handlers installed prior to program startup.
|
|
-- These are saved only when the umbrella handler is installed for
|
|
-- a given interrupt number.
|
|
|
|
-----------------------
|
|
-- Local Subprograms --
|
|
-----------------------
|
|
|
|
procedure Check_Reserved_Interrupt (Interrupt : Interrupt_ID);
|
|
-- Check if Id is a reserved interrupt, and if so raise Program_Error
|
|
-- with an appropriate message, otherwise return.
|
|
|
|
procedure Finalize_Interrupt_Servers;
|
|
-- Unbind the handlers for hardware interrupt server tasks at program
|
|
-- termination.
|
|
|
|
function Is_Registered (Handler : Parameterless_Handler) return Boolean;
|
|
-- See if Handler has been "pragma"ed using Interrupt_Handler.
|
|
-- Always consider a null handler as registered.
|
|
|
|
procedure Notify_Interrupt (Param : System.Address);
|
|
-- Umbrella handler for vectored interrupts (not signals)
|
|
|
|
procedure Install_Default_Action (Interrupt : HW_Interrupt);
|
|
-- Restore a handler that was in place prior to program execution
|
|
|
|
procedure Install_Umbrella_Handler
|
|
(Interrupt : HW_Interrupt;
|
|
Handler : Interfaces.VxWorks.VOIDFUNCPTR);
|
|
-- Install the runtime umbrella handler for a vectored hardware
|
|
-- interrupt
|
|
|
|
procedure Unimplemented (Feature : String);
|
|
pragma No_Return (Unimplemented);
|
|
-- Used to mark a call to an unimplemented function. Raises Program_Error
|
|
-- with an appropriate message noting that Feature is unimplemented.
|
|
|
|
--------------------
|
|
-- Attach_Handler --
|
|
--------------------
|
|
|
|
-- Calling this procedure with New_Handler = null and Static = True
|
|
-- means we want to detach the current handler regardless of the
|
|
-- previous handler's binding status (ie. do not care if it is a
|
|
-- dynamic or static handler).
|
|
|
|
-- This option is needed so that during the finalization of a PO, we
|
|
-- can detach handlers attached through pragma Attach_Handler.
|
|
|
|
procedure Attach_Handler
|
|
(New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean := False) is
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
Interrupt_Manager.Attach_Handler (New_Handler, Interrupt, Static);
|
|
end Attach_Handler;
|
|
|
|
-----------------------------
|
|
-- Bind_Interrupt_To_Entry --
|
|
-----------------------------
|
|
|
|
-- This procedure raises a Program_Error if it tries to
|
|
-- bind an interrupt to which an Entry or a Procedure is
|
|
-- already bound.
|
|
|
|
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));
|
|
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
Interrupt_Manager.Bind_Interrupt_To_Entry (T, E, Interrupt);
|
|
end Bind_Interrupt_To_Entry;
|
|
|
|
---------------------
|
|
-- Block_Interrupt --
|
|
---------------------
|
|
|
|
procedure Block_Interrupt (Interrupt : Interrupt_ID) is
|
|
begin
|
|
Unimplemented ("Block_Interrupt");
|
|
end Block_Interrupt;
|
|
|
|
------------------------------
|
|
-- Check_Reserved_Interrupt --
|
|
------------------------------
|
|
|
|
procedure Check_Reserved_Interrupt (Interrupt : Interrupt_ID) is
|
|
begin
|
|
if Is_Reserved (Interrupt) then
|
|
Raise_Exception
|
|
(Program_Error'Identity,
|
|
"Interrupt" & Interrupt_ID'Image (Interrupt) & " is reserved");
|
|
else
|
|
return;
|
|
end if;
|
|
end Check_Reserved_Interrupt;
|
|
|
|
---------------------
|
|
-- Current_Handler --
|
|
---------------------
|
|
|
|
function Current_Handler
|
|
(Interrupt : Interrupt_ID) return Parameterless_Handler is
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
|
|
-- ??? Since Parameterless_Handler is not Atomic, the
|
|
-- current implementation is wrong. We need a new service in
|
|
-- Interrupt_Manager to ensure atomicity.
|
|
|
|
return User_Handler (Interrupt).H;
|
|
end Current_Handler;
|
|
|
|
--------------------
|
|
-- Detach_Handler --
|
|
--------------------
|
|
|
|
-- Calling this procedure with Static = True means we want to Detach the
|
|
-- current handler regardless of the previous handler's binding status
|
|
-- (i.e. do not care if it is a dynamic or static handler).
|
|
|
|
-- This option is needed so that during the finalization of a PO, we can
|
|
-- detach handlers attached through pragma Attach_Handler.
|
|
|
|
procedure Detach_Handler
|
|
(Interrupt : Interrupt_ID;
|
|
Static : Boolean := False) is
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
Interrupt_Manager.Detach_Handler (Interrupt, Static);
|
|
end Detach_Handler;
|
|
|
|
------------------------------
|
|
-- Detach_Interrupt_Entries --
|
|
------------------------------
|
|
|
|
procedure Detach_Interrupt_Entries (T : Task_ID) is
|
|
begin
|
|
Interrupt_Manager.Detach_Interrupt_Entries (T);
|
|
end Detach_Interrupt_Entries;
|
|
|
|
----------------------
|
|
-- Exchange_Handler --
|
|
----------------------
|
|
|
|
-- Calling this procedure with New_Handler = null and Static = True
|
|
-- means we want to detach the current handler regardless of the
|
|
-- previous handler's binding status (ie. do not care if it is a
|
|
-- dynamic or static handler).
|
|
|
|
-- This option is needed so that during the finalization of a PO, we
|
|
-- can detach handlers attached through pragma Attach_Handler.
|
|
|
|
procedure Exchange_Handler
|
|
(Old_Handler : out Parameterless_Handler;
|
|
New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean := False) is
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
Interrupt_Manager.Exchange_Handler
|
|
(Old_Handler, New_Handler, Interrupt, Static);
|
|
end Exchange_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 / signal tasks are
|
|
-- gone.
|
|
|
|
if not Interrupt_Manager'Terminated then
|
|
for N in reverse Object.Previous_Handlers'Range loop
|
|
Interrupt_Manager.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;
|
|
end if;
|
|
|
|
Tasking.Protected_Objects.Entries.Finalize
|
|
(Tasking.Protected_Objects.Entries.Protection_Entries (Object));
|
|
end Finalize;
|
|
|
|
--------------------------------
|
|
-- Finalize_Interrupt_Servers --
|
|
--------------------------------
|
|
|
|
-- Restore default handlers for interrupt servers.
|
|
-- This is called by the Interrupt_Manager task when it receives the abort
|
|
-- signal during program finalization.
|
|
|
|
procedure Finalize_Interrupt_Servers is
|
|
begin
|
|
if HW_Interrupt'Last >= 0 then
|
|
for Int in HW_Interrupt loop
|
|
if Server_ID (Interrupt_ID (Int)) /= null
|
|
and then
|
|
not Ada.Task_Identification.Is_Terminated
|
|
(To_Ada (Server_ID (Interrupt_ID (Int))))
|
|
then
|
|
Interrupt_Manager.Attach_Handler
|
|
(New_Handler => null,
|
|
Interrupt => Interrupt_ID (Int),
|
|
Static => True,
|
|
Restoration => True);
|
|
end if;
|
|
end loop;
|
|
end if;
|
|
end Finalize_Interrupt_Servers;
|
|
|
|
-------------------------------------
|
|
-- Has_Interrupt_Or_Attach_Handler --
|
|
-------------------------------------
|
|
|
|
function Has_Interrupt_Or_Attach_Handler
|
|
(Object : access Dynamic_Interrupt_Protection) return Boolean is
|
|
begin
|
|
return True;
|
|
end Has_Interrupt_Or_Attach_Handler;
|
|
|
|
function Has_Interrupt_Or_Attach_Handler
|
|
(Object : access Static_Interrupt_Protection) return Boolean is
|
|
begin
|
|
return True;
|
|
end Has_Interrupt_Or_Attach_Handler;
|
|
|
|
----------------------
|
|
-- Ignore_Interrupt --
|
|
----------------------
|
|
|
|
procedure Ignore_Interrupt (Interrupt : Interrupt_ID) is
|
|
begin
|
|
Unimplemented ("Ignore_Interrupt");
|
|
end Ignore_Interrupt;
|
|
|
|
----------------------------
|
|
-- Install_Default_Action --
|
|
----------------------------
|
|
|
|
procedure Install_Default_Action (Interrupt : HW_Interrupt) is
|
|
begin
|
|
-- Restore original interrupt handler
|
|
|
|
Interfaces.VxWorks.intVecSet
|
|
(Interfaces.VxWorks.INUM_TO_IVEC (Integer (Interrupt)),
|
|
Default_Handler (Interrupt));
|
|
Default_Handler (Interrupt) := null;
|
|
end Install_Default_Action;
|
|
|
|
----------------------
|
|
-- 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 := User_Handler
|
|
(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_Umbrella_Handler --
|
|
------------------------------
|
|
|
|
procedure Install_Umbrella_Handler
|
|
(Interrupt : HW_Interrupt;
|
|
Handler : Interfaces.VxWorks.VOIDFUNCPTR)
|
|
is
|
|
use Interfaces.VxWorks;
|
|
|
|
Vec : constant Interrupt_Vector :=
|
|
INUM_TO_IVEC (Interfaces.VxWorks.int (Interrupt));
|
|
Old_Handler : constant VOIDFUNCPTR :=
|
|
intVecGet (INUM_TO_IVEC (Interfaces.VxWorks.int (Interrupt)));
|
|
Stat : Interfaces.VxWorks.STATUS;
|
|
|
|
begin
|
|
-- Only install umbrella handler when no Ada handler has already been
|
|
-- installed. Note that the interrupt number is passed as a parameter
|
|
-- when an interrupt occurs, so the umbrella handler has a different
|
|
-- wrapper generated by intConnect for each interrupt number.
|
|
|
|
if Default_Handler (Interrupt) = null then
|
|
Stat :=
|
|
intConnect (Vec, VOIDFUNCPTR (Handler), System.Address (Interrupt));
|
|
Default_Handler (Interrupt) := Old_Handler;
|
|
end if;
|
|
end Install_Umbrella_Handler;
|
|
|
|
----------------
|
|
-- Is_Blocked --
|
|
----------------
|
|
|
|
function Is_Blocked (Interrupt : Interrupt_ID) return Boolean is
|
|
begin
|
|
Unimplemented ("Is_Blocked");
|
|
return False;
|
|
end Is_Blocked;
|
|
|
|
-----------------------
|
|
-- Is_Entry_Attached --
|
|
-----------------------
|
|
|
|
function Is_Entry_Attached (Interrupt : Interrupt_ID) return Boolean is
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
return User_Entry (Interrupt).T /= Null_Task;
|
|
end Is_Entry_Attached;
|
|
|
|
-------------------------
|
|
-- Is_Handler_Attached --
|
|
-------------------------
|
|
|
|
function Is_Handler_Attached (Interrupt : Interrupt_ID) return Boolean is
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
return User_Handler (Interrupt).H /= null;
|
|
end Is_Handler_Attached;
|
|
|
|
----------------
|
|
-- Is_Ignored --
|
|
----------------
|
|
|
|
function Is_Ignored (Interrupt : Interrupt_ID) return Boolean is
|
|
begin
|
|
Unimplemented ("Is_Ignored");
|
|
return False;
|
|
end Is_Ignored;
|
|
|
|
-------------------
|
|
-- Is_Registered --
|
|
-------------------
|
|
|
|
function Is_Registered (Handler : Parameterless_Handler) return Boolean is
|
|
type Fat_Ptr is record
|
|
Object_Addr : System.Address;
|
|
Handler_Addr : System.Address;
|
|
end record;
|
|
|
|
function To_Fat_Ptr is new Unchecked_Conversion
|
|
(Parameterless_Handler, Fat_Ptr);
|
|
|
|
Ptr : R_Link;
|
|
Fat : Fat_Ptr;
|
|
|
|
begin
|
|
if Handler = null then
|
|
return True;
|
|
end if;
|
|
|
|
Fat := To_Fat_Ptr (Handler);
|
|
|
|
Ptr := Registered_Handler_Head;
|
|
|
|
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;
|
|
|
|
-----------------
|
|
-- Is_Reserved --
|
|
-----------------
|
|
|
|
function Is_Reserved (Interrupt : Interrupt_ID) return Boolean is
|
|
begin
|
|
return False;
|
|
end Is_Reserved;
|
|
|
|
----------------------
|
|
-- Notify_Interrupt --
|
|
----------------------
|
|
|
|
-- Umbrella handler for vectored hardware interrupts (as opposed to
|
|
-- signals and exceptions). As opposed to the signal implementation,
|
|
-- this handler is only installed in the vector table while there is
|
|
-- an active association of an Ada handler to the interrupt.
|
|
|
|
-- Otherwise, the handler that existed prior to program startup is
|
|
-- in the vector table. This ensures that handlers installed by
|
|
-- the BSP are active unless explicitly replaced in the program text.
|
|
|
|
-- Each Interrupt_Server_Task has an associated binary semaphore
|
|
-- on which it pends once it's been started. This routine determines
|
|
-- The appropriate semaphore and and issues a semGive call, waking
|
|
-- the server task. When a handler is unbound,
|
|
-- System.Interrupts.Unbind_Handler issues a semFlush, and the
|
|
-- server task deletes its semaphore and terminates.
|
|
|
|
procedure Notify_Interrupt (Param : System.Address) is
|
|
Interrupt : Interrupt_ID := Interrupt_ID (Param);
|
|
Discard_Result : STATUS;
|
|
|
|
begin
|
|
Discard_Result := semGive (Semaphore_ID_Map (Interrupt));
|
|
end Notify_Interrupt;
|
|
|
|
---------------
|
|
-- Reference --
|
|
---------------
|
|
|
|
function Reference (Interrupt : Interrupt_ID) return System.Address is
|
|
begin
|
|
Check_Reserved_Interrupt (Interrupt);
|
|
return Storage_Elements.To_Address
|
|
(Storage_Elements.Integer_Address (Interrupt));
|
|
end Reference;
|
|
|
|
--------------------------------
|
|
-- Register_Interrupt_Handler --
|
|
--------------------------------
|
|
|
|
procedure Register_Interrupt_Handler (Handler_Addr : System.Address) is
|
|
New_Node_Ptr : R_Link;
|
|
begin
|
|
-- This routine registers a handler as usable for dynamic
|
|
-- interrupt handler association. Routines attaching and detaching
|
|
-- handlers dynamically should determine whether the handler is
|
|
-- registered. Program_Error should be raised if it is not registered.
|
|
|
|
-- Pragma Interrupt_Handler can only appear in a library
|
|
-- level PO definition and instantiation. Therefore, we do not need
|
|
-- to implement an unregister operation. Nor do we need to
|
|
-- protect the queue structure with a lock.
|
|
|
|
pragma Assert (Handler_Addr /= System.Null_Address);
|
|
|
|
New_Node_Ptr := new Registered_Handler;
|
|
New_Node_Ptr.H := Handler_Addr;
|
|
|
|
if Registered_Handler_Head = null then
|
|
Registered_Handler_Head := New_Node_Ptr;
|
|
Registered_Handler_Tail := New_Node_Ptr;
|
|
|
|
else
|
|
Registered_Handler_Tail.Next := New_Node_Ptr;
|
|
Registered_Handler_Tail := New_Node_Ptr;
|
|
end if;
|
|
end Register_Interrupt_Handler;
|
|
|
|
-----------------------
|
|
-- Unblock_Interrupt --
|
|
-----------------------
|
|
|
|
procedure Unblock_Interrupt (Interrupt : Interrupt_ID) is
|
|
begin
|
|
Unimplemented ("Unblock_Interrupt");
|
|
end Unblock_Interrupt;
|
|
|
|
------------------
|
|
-- Unblocked_By --
|
|
------------------
|
|
|
|
function Unblocked_By
|
|
(Interrupt : Interrupt_ID) return System.Tasking.Task_ID is
|
|
begin
|
|
Unimplemented ("Unblocked_By");
|
|
return Null_Task;
|
|
end Unblocked_By;
|
|
|
|
------------------------
|
|
-- Unignore_Interrupt --
|
|
------------------------
|
|
|
|
procedure Unignore_Interrupt (Interrupt : Interrupt_ID) is
|
|
begin
|
|
Unimplemented ("Unignore_Interrupt");
|
|
end Unignore_Interrupt;
|
|
|
|
-------------------
|
|
-- Unimplemented --
|
|
-------------------
|
|
|
|
procedure Unimplemented (Feature : String) is
|
|
begin
|
|
Raise_Exception
|
|
(Program_Error'Identity,
|
|
Feature & " not implemented on VxWorks");
|
|
end Unimplemented;
|
|
|
|
-----------------------
|
|
-- Interrupt_Manager --
|
|
-----------------------
|
|
|
|
task body Interrupt_Manager is
|
|
---------------------
|
|
-- Local Variables --
|
|
---------------------
|
|
|
|
Self_Id : constant Task_ID := POP.Self;
|
|
|
|
--------------------
|
|
-- Local Routines --
|
|
--------------------
|
|
|
|
procedure Bind_Handler (Interrupt : Interrupt_ID);
|
|
-- This procedure does not do anything if a signal is blocked.
|
|
-- Otherwise, we have to interrupt Server_Task for status change through
|
|
-- a wakeup signal.
|
|
|
|
procedure Unbind_Handler (Interrupt : Interrupt_ID);
|
|
-- This procedure does not do anything if a signal is blocked.
|
|
-- Otherwise, we have to interrupt Server_Task for status change
|
|
-- through an abort signal.
|
|
|
|
procedure Unprotected_Exchange_Handler
|
|
(Old_Handler : out Parameterless_Handler;
|
|
New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean;
|
|
Restoration : Boolean := False);
|
|
|
|
procedure Unprotected_Detach_Handler
|
|
(Interrupt : Interrupt_ID;
|
|
Static : Boolean);
|
|
|
|
------------------
|
|
-- Bind_Handler --
|
|
------------------
|
|
|
|
procedure Bind_Handler (Interrupt : Interrupt_ID) is
|
|
begin
|
|
Install_Umbrella_Handler
|
|
(HW_Interrupt (Interrupt), Notify_Interrupt'Access);
|
|
end Bind_Handler;
|
|
|
|
--------------------
|
|
-- Unbind_Handler --
|
|
--------------------
|
|
|
|
procedure Unbind_Handler (Interrupt : Interrupt_ID) is
|
|
S : STATUS;
|
|
use type STATUS;
|
|
|
|
begin
|
|
-- Hardware interrupt
|
|
|
|
Install_Default_Action (HW_Interrupt (Interrupt));
|
|
|
|
-- Flush server task off semaphore, allowing it to terminate
|
|
|
|
S := semFlush (Semaphore_ID_Map (Interrupt));
|
|
pragma Assert (S = 0);
|
|
end Unbind_Handler;
|
|
|
|
--------------------------------
|
|
-- Unprotected_Detach_Handler --
|
|
--------------------------------
|
|
|
|
procedure Unprotected_Detach_Handler
|
|
(Interrupt : Interrupt_ID;
|
|
Static : Boolean)
|
|
is
|
|
Old_Handler : Parameterless_Handler;
|
|
begin
|
|
if User_Entry (Interrupt).T /= Null_Task then
|
|
-- If an interrupt entry is installed raise
|
|
-- Program_Error. (propagate it to the caller).
|
|
|
|
Raise_Exception (Program_Error'Identity,
|
|
"An interrupt entry is already installed");
|
|
end if;
|
|
|
|
-- Note : Static = True will pass the following check. This is the
|
|
-- case when we want to detach a handler regardless of the static
|
|
-- status of the Current_Handler.
|
|
|
|
if not Static and then User_Handler (Interrupt).Static then
|
|
-- Trying to detach a static Interrupt Handler.
|
|
-- raise Program_Error.
|
|
|
|
Raise_Exception (Program_Error'Identity,
|
|
"Trying to detach a static Interrupt Handler");
|
|
end if;
|
|
|
|
Old_Handler := User_Handler (Interrupt).H;
|
|
|
|
-- The new handler
|
|
|
|
User_Handler (Interrupt).H := null;
|
|
User_Handler (Interrupt).Static := False;
|
|
|
|
if Old_Handler /= null then
|
|
Unbind_Handler (Interrupt);
|
|
end if;
|
|
end Unprotected_Detach_Handler;
|
|
|
|
----------------------------------
|
|
-- Unprotected_Exchange_Handler --
|
|
----------------------------------
|
|
|
|
procedure Unprotected_Exchange_Handler
|
|
(Old_Handler : out Parameterless_Handler;
|
|
New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean;
|
|
Restoration : Boolean := False) is
|
|
begin
|
|
if User_Entry (Interrupt).T /= Null_Task then
|
|
-- If an interrupt entry is already installed, raise
|
|
-- Program_Error. (propagate it to the caller).
|
|
|
|
Raise_Exception
|
|
(Program_Error'Identity,
|
|
"An interrupt is already installed");
|
|
end if;
|
|
|
|
-- Note : A null handler with Static = True will
|
|
-- pass the following check. This is the case when we want to
|
|
-- detach a handler regardless of the Static status
|
|
-- of Current_Handler.
|
|
-- We don't check anything if Restoration is True, since we
|
|
-- may be detaching a static handler to restore a dynamic one.
|
|
|
|
if not Restoration and then not Static
|
|
and then (User_Handler (Interrupt).Static
|
|
|
|
-- Trying to overwrite a static Interrupt Handler with a
|
|
-- dynamic Handler
|
|
|
|
-- The new handler is not specified as an
|
|
-- Interrupt Handler by a pragma.
|
|
|
|
or else not Is_Registered (New_Handler))
|
|
then
|
|
Raise_Exception
|
|
(Program_Error'Identity,
|
|
"Trying to overwrite a static Interrupt Handler with a " &
|
|
"dynamic Handler");
|
|
end if;
|
|
|
|
-- Save the old handler
|
|
|
|
Old_Handler := User_Handler (Interrupt).H;
|
|
|
|
-- The new handler
|
|
|
|
User_Handler (Interrupt).H := New_Handler;
|
|
|
|
if New_Handler = null then
|
|
|
|
-- The null handler means we are detaching the handler.
|
|
|
|
User_Handler (Interrupt).Static := False;
|
|
|
|
else
|
|
User_Handler (Interrupt).Static := Static;
|
|
end if;
|
|
|
|
-- Invoke a corresponding Server_Task if not yet created.
|
|
-- Place Task_ID info in Server_ID array.
|
|
|
|
if New_Handler /= null
|
|
and then
|
|
(Server_ID (Interrupt) = Null_Task
|
|
or else
|
|
Ada.Task_Identification.Is_Terminated
|
|
(To_Ada (Server_ID (Interrupt))))
|
|
then
|
|
Interrupt_Access_Hold :=
|
|
new Interrupt_Server_Task
|
|
(Interrupt, semBCreate (SEM_Q_FIFO, SEM_EMPTY));
|
|
Server_ID (Interrupt) :=
|
|
To_System (Interrupt_Access_Hold.all'Identity);
|
|
end if;
|
|
|
|
if (New_Handler = null) and then Old_Handler /= null then
|
|
-- Restore default handler
|
|
|
|
Unbind_Handler (Interrupt);
|
|
|
|
elsif Old_Handler = null then
|
|
-- Save default handler
|
|
|
|
Bind_Handler (Interrupt);
|
|
end if;
|
|
end Unprotected_Exchange_Handler;
|
|
|
|
-- Start of processing for Interrupt_Manager
|
|
|
|
begin
|
|
-- By making this task independent of any master, when the process
|
|
-- goes away, the Interrupt_Manager will terminate gracefully.
|
|
|
|
System.Tasking.Utilities.Make_Independent;
|
|
|
|
loop
|
|
-- A block is needed to absorb Program_Error exception
|
|
|
|
declare
|
|
Old_Handler : Parameterless_Handler;
|
|
|
|
begin
|
|
select
|
|
accept Attach_Handler
|
|
(New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean;
|
|
Restoration : Boolean := False)
|
|
do
|
|
Unprotected_Exchange_Handler
|
|
(Old_Handler, New_Handler, Interrupt, Static, Restoration);
|
|
end Attach_Handler;
|
|
|
|
or
|
|
accept Exchange_Handler
|
|
(Old_Handler : out Parameterless_Handler;
|
|
New_Handler : Parameterless_Handler;
|
|
Interrupt : Interrupt_ID;
|
|
Static : Boolean)
|
|
do
|
|
Unprotected_Exchange_Handler
|
|
(Old_Handler, New_Handler, Interrupt, Static);
|
|
end Exchange_Handler;
|
|
|
|
or
|
|
accept Detach_Handler
|
|
(Interrupt : Interrupt_ID;
|
|
Static : Boolean)
|
|
do
|
|
Unprotected_Detach_Handler (Interrupt, Static);
|
|
end Detach_Handler;
|
|
or
|
|
accept Bind_Interrupt_To_Entry
|
|
(T : Task_ID;
|
|
E : Task_Entry_Index;
|
|
Interrupt : Interrupt_ID)
|
|
do
|
|
-- If there is a binding already (either a procedure or an
|
|
-- entry), raise Program_Error (propagate it to the caller).
|
|
|
|
if User_Handler (Interrupt).H /= null
|
|
or else User_Entry (Interrupt).T /= Null_Task
|
|
then
|
|
Raise_Exception
|
|
(Program_Error'Identity,
|
|
"A binding for this interrupt is already present");
|
|
end if;
|
|
|
|
User_Entry (Interrupt) := Entry_Assoc' (T => T, E => E);
|
|
|
|
-- Indicate the attachment of interrupt entry in the ATCB.
|
|
-- This is needed so when an interrupt entry task terminates
|
|
-- the binding can be cleaned. The call to unbinding must be
|
|
-- make by the task before it terminates.
|
|
|
|
T.Interrupt_Entry := True;
|
|
|
|
-- Invoke a corresponding Server_Task if not yet created.
|
|
-- Place Task_ID info in Server_ID array.
|
|
|
|
if Server_ID (Interrupt) = Null_Task
|
|
or else
|
|
Ada.Task_Identification.Is_Terminated
|
|
(To_Ada (Server_ID (Interrupt)))
|
|
then
|
|
Interrupt_Access_Hold := new Interrupt_Server_Task
|
|
(Interrupt, semBCreate (SEM_Q_FIFO, SEM_EMPTY));
|
|
Server_ID (Interrupt) :=
|
|
To_System (Interrupt_Access_Hold.all'Identity);
|
|
end if;
|
|
|
|
Bind_Handler (Interrupt);
|
|
end Bind_Interrupt_To_Entry;
|
|
|
|
or
|
|
accept Detach_Interrupt_Entries (T : Task_ID) do
|
|
for Int in Interrupt_ID'Range loop
|
|
if not Is_Reserved (Int) then
|
|
if User_Entry (Int).T = T then
|
|
User_Entry (Int) := Entry_Assoc'
|
|
(T => Null_Task, E => Null_Task_Entry);
|
|
Unbind_Handler (Int);
|
|
end if;
|
|
end if;
|
|
end loop;
|
|
|
|
-- Indicate in ATCB that no interrupt entries are attached.
|
|
|
|
T.Interrupt_Entry := False;
|
|
end Detach_Interrupt_Entries;
|
|
end select;
|
|
|
|
exception
|
|
-- If there is a Program_Error we just want to propagate it to
|
|
-- the caller and do not want to stop this task.
|
|
|
|
when Program_Error =>
|
|
null;
|
|
|
|
when others =>
|
|
pragma Assert (False);
|
|
null;
|
|
end;
|
|
end loop;
|
|
|
|
exception
|
|
when Standard'Abort_Signal =>
|
|
-- Flush interrupt server semaphores, so they can terminate
|
|
Finalize_Interrupt_Servers;
|
|
raise;
|
|
end Interrupt_Manager;
|
|
|
|
---------------------------
|
|
-- Interrupt_Server_Task --
|
|
---------------------------
|
|
|
|
-- Server task for vectored hardware interrupt handling
|
|
|
|
task body Interrupt_Server_Task is
|
|
Self_Id : constant Task_ID := Self;
|
|
Tmp_Handler : Parameterless_Handler;
|
|
Tmp_ID : Task_ID;
|
|
Tmp_Entry_Index : Task_Entry_Index;
|
|
S : STATUS;
|
|
|
|
use type STATUS;
|
|
|
|
begin
|
|
System.Tasking.Utilities.Make_Independent;
|
|
Semaphore_ID_Map (Interrupt) := Int_Sema;
|
|
|
|
loop
|
|
-- Pend on semaphore that will be triggered by the
|
|
-- umbrella handler when the associated interrupt comes in
|
|
|
|
S := semTake (Int_Sema, WAIT_FOREVER);
|
|
pragma Assert (S = 0);
|
|
|
|
if User_Handler (Interrupt).H /= null then
|
|
|
|
-- Protected procedure handler
|
|
|
|
Tmp_Handler := User_Handler (Interrupt).H;
|
|
Tmp_Handler.all;
|
|
|
|
elsif User_Entry (Interrupt).T /= Null_Task then
|
|
|
|
-- Interrupt entry handler
|
|
|
|
Tmp_ID := User_Entry (Interrupt).T;
|
|
Tmp_Entry_Index := User_Entry (Interrupt).E;
|
|
System.Tasking.Rendezvous.Call_Simple
|
|
(Tmp_ID, Tmp_Entry_Index, System.Null_Address);
|
|
|
|
else
|
|
-- Semaphore has been flushed by an unbind operation in
|
|
-- the Interrupt_Manager. Terminate the server task.
|
|
|
|
-- Wait for the Interrupt_Manager to complete its work
|
|
|
|
POP.Write_Lock (Self_Id);
|
|
|
|
-- Delete the associated semaphore
|
|
|
|
S := semDelete (Int_Sema);
|
|
|
|
pragma Assert (S = 0);
|
|
|
|
-- Set status for the Interrupt_Manager
|
|
|
|
Semaphore_ID_Map (Interrupt) := 0;
|
|
Server_ID (Interrupt) := Null_Task;
|
|
POP.Unlock (Self_Id);
|
|
|
|
exit;
|
|
end if;
|
|
end loop;
|
|
end Interrupt_Server_Task;
|
|
|
|
begin
|
|
-- Get Interrupt_Manager's ID so that Abort_Interrupt can be sent.
|
|
|
|
Interrupt_Manager_ID := To_System (Interrupt_Manager'Identity);
|
|
end System.Interrupts;
|