pragma Polling (Off);
with System.Tasking.Debug;
with Interfaces.C;
with Interfaces.C.Strings;
with System.OS_Interface;
with System.Parameters;
with System.Tasking;
with System.Soft_Links;
with System.OS_Primitives;
with System.Task_Info;
with Unchecked_Conversion;
with Unchecked_Deallocation;
package body System.Task_Primitives.Operations is
use System.Tasking.Debug;
use System.Tasking;
use Interfaces.C;
use Interfaces.C.Strings;
use System.OS_Interface;
use System.Parameters;
use System.OS_Primitives;
pragma Link_With ("-Xlinker --stack=0x800000,0x1000");
package SSL renames System.Soft_Links;
Environment_Task_ID : Task_ID;
Single_RTS_Lock : aliased RTS_Lock;
Time_Slice_Val : Integer;
pragma Import (C, Time_Slice_Val, "__gl_time_slice_val");
Dispatching_Policy : Character;
pragma Import (C, Dispatching_Policy, "__gl_task_dispatching_policy");
FIFO_Within_Priorities : constant Boolean := Dispatching_Policy = 'F';
type Fake_ATCB;
type Fake_ATCB_Ptr is access Fake_ATCB;
type Fake_ATCB is record
Stack_Base : Interfaces.C.unsigned := 0;
Next : Fake_ATCB_Ptr;
Real_ATCB : aliased Ada_Task_Control_Block (0);
end record;
Fake_ATCB_List : Fake_ATCB_Ptr;
Fake_Task_Elaborated : aliased Boolean := True;
Next_Fake_ATCB : Fake_ATCB_Ptr;
function New_Fake_ATCB return Task_ID;
TlsIndex : DWORD;
pragma Export (Ada, TlsIndex);
function To_Task_Id is new Unchecked_Conversion (System.Address, Task_ID);
function To_Address is new Unchecked_Conversion (Task_ID, System.Address);
function New_Fake_ATCB return Task_ID is
Self_ID : Task_ID;
P, Q : Fake_ATCB_Ptr;
Succeeded : Boolean;
Res : BOOL;
begin
Lock_RTS;
Q := null;
P := Fake_ATCB_List;
while P /= null loop
if P.Stack_Base = 0 then
Q := P;
end if;
P := P.Next;
end loop;
if Q = null then
Self_ID := Next_Fake_ATCB.Real_ATCB'Access;
Next_Fake_ATCB.Stack_Base := 1;
Next_Fake_ATCB.Next := Fake_ATCB_List;
Fake_ATCB_List := Next_Fake_ATCB;
Next_Fake_ATCB := null;
else
Self_ID := Q.Real_ATCB'Access;
Q.Stack_Base := 1;
end if;
Self_ID.Common.LL.Thread := GetCurrentThread;
Res := TlsSetValue (TlsIndex, To_Address (Self_ID));
pragma Assert (Res = True);
System.Tasking.Initialize_ATCB
(Self_ID, null, Null_Address, Null_Task, Fake_Task_Elaborated'Access,
System.Priority'First, Task_Info.Unspecified_Task_Info, 0, Self_ID,
Succeeded);
pragma Assert (Succeeded);
if Next_Fake_ATCB = null then
Next_Fake_ATCB := new Fake_ATCB;
end if;
Self_ID.Master_of_Task := 0;
Self_ID.Master_Within := Self_ID.Master_of_Task + 1;
for L in Self_ID.Entry_Calls'Range loop
Self_ID.Entry_Calls (L).Self := Self_ID;
Self_ID.Entry_Calls (L).Level := L;
end loop;
Self_ID.Common.State := Runnable;
Self_ID.Awake_Count := 1;
Self_ID.Deferral_Level := 0;
System.Soft_Links.Create_TSD (Self_ID.Common.Compiler_Data);
Unlock_RTS;
return Self_ID;
end New_Fake_ATCB;
procedure Initialize_Cond (Cond : access Condition_Variable);
procedure Finalize_Cond (Cond : access Condition_Variable);
procedure Cond_Signal (Cond : access Condition_Variable);
procedure Cond_Wait
(Cond : access Condition_Variable;
L : access RTS_Lock);
procedure Cond_Timed_Wait
(Cond : access Condition_Variable;
L : access RTS_Lock;
Rel_Time : Duration;
Timed_Out : out Boolean;
Status : out Integer);
procedure Initialize_Cond (Cond : access Condition_Variable) is
hEvent : HANDLE;
begin
hEvent := CreateEvent (null, True, False, Null_Ptr);
pragma Assert (hEvent /= 0);
Cond.all := Condition_Variable (hEvent);
end Initialize_Cond;
procedure Finalize_Cond (Cond : access Condition_Variable) is
Result : BOOL;
begin
Result := CloseHandle (HANDLE (Cond.all));
pragma Assert (Result = True);
end Finalize_Cond;
procedure Cond_Signal (Cond : access Condition_Variable) is
Result : BOOL;
begin
Result := SetEvent (HANDLE (Cond.all));
pragma Assert (Result = True);
end Cond_Signal;
procedure Cond_Wait
(Cond : access Condition_Variable;
L : access RTS_Lock)
is
Result : DWORD;
Result_Bool : BOOL;
begin
Result_Bool := ResetEvent (HANDLE (Cond.all));
pragma Assert (Result_Bool = True);
Unlock (L);
Result := WaitForSingleObject (HANDLE (Cond.all), Wait_Infinite);
pragma Assert (Result = 0);
Write_Lock (L);
end Cond_Wait;
procedure Cond_Timed_Wait
(Cond : access Condition_Variable;
L : access RTS_Lock;
Rel_Time : Duration;
Timed_Out : out Boolean;
Status : out Integer)
is
Time_Out : DWORD;
Result : BOOL;
Int_Rel_Time : DWORD;
Wait_Result : DWORD;
begin
Result := ResetEvent (HANDLE (Cond.all));
pragma Assert (Result = True);
Unlock (L);
if Rel_Time <= 0.0 then
Timed_Out := True;
else
Int_Rel_Time := DWORD (Rel_Time);
Time_Out := Int_Rel_Time * 1000 +
DWORD ((Rel_Time - Duration (Int_Rel_Time)) * 1000.0);
Wait_Result := WaitForSingleObject (HANDLE (Cond.all), Time_Out);
if Wait_Result = WAIT_TIMEOUT then
Timed_Out := True;
Wait_Result := 0;
else
Timed_Out := False;
end if;
end if;
Write_Lock (L);
if Timed_Out then
Result := SetEvent (HANDLE (Cond.all));
pragma Assert (Result = True);
end if;
Status := Integer (Wait_Result);
end Cond_Timed_Wait;
procedure Stack_Guard (T : ST.Task_ID; On : Boolean) is
begin
null;
end Stack_Guard;
function Get_Thread_Id (T : ST.Task_ID) return OSI.Thread_Id is
begin
return T.Common.LL.Thread;
end Get_Thread_Id;
function Self return Task_ID is
Self_Id : Task_ID;
begin
Self_Id := To_Task_Id (TlsGetValue (TlsIndex));
if Self_Id = null then
return New_Fake_ATCB;
end if;
return Self_Id;
end Self;
procedure Initialize_Lock
(Prio : System.Any_Priority;
L : access Lock) is
begin
InitializeCriticalSection (L.Mutex'Access);
L.Owner_Priority := 0;
L.Priority := Prio;
end Initialize_Lock;
procedure Initialize_Lock (L : access RTS_Lock; Level : Lock_Level) is
begin
InitializeCriticalSection (CRITICAL_SECTION (L.all)'Unrestricted_Access);
end Initialize_Lock;
procedure Finalize_Lock (L : access Lock) is
begin
DeleteCriticalSection (L.Mutex'Access);
end Finalize_Lock;
procedure Finalize_Lock (L : access RTS_Lock) is
begin
DeleteCriticalSection (CRITICAL_SECTION (L.all)'Unrestricted_Access);
end Finalize_Lock;
procedure Write_Lock (L : access Lock; Ceiling_Violation : out Boolean) is
begin
L.Owner_Priority := Get_Priority (Self);
if L.Priority < L.Owner_Priority then
Ceiling_Violation := True;
return;
end if;
EnterCriticalSection (L.Mutex'Access);
Ceiling_Violation := False;
end Write_Lock;
procedure Write_Lock
(L : access RTS_Lock; Global_Lock : Boolean := False) is
begin
if not Single_Lock or else Global_Lock then
EnterCriticalSection (CRITICAL_SECTION (L.all)'Unrestricted_Access);
end if;
end Write_Lock;
procedure Write_Lock (T : Task_ID) is
begin
if not Single_Lock then
EnterCriticalSection
(CRITICAL_SECTION (T.Common.LL.L)'Unrestricted_Access);
end if;
end Write_Lock;
procedure Read_Lock (L : access Lock; Ceiling_Violation : out Boolean) is
begin
Write_Lock (L, Ceiling_Violation);
end Read_Lock;
procedure Unlock (L : access Lock) is
begin
LeaveCriticalSection (L.Mutex'Access);
end Unlock;
procedure Unlock (L : access RTS_Lock; Global_Lock : Boolean := False) is
begin
if not Single_Lock or else Global_Lock then
LeaveCriticalSection (CRITICAL_SECTION (L.all)'Unrestricted_Access);
end if;
end Unlock;
procedure Unlock (T : Task_ID) is
begin
if not Single_Lock then
LeaveCriticalSection
(CRITICAL_SECTION (T.Common.LL.L)'Unrestricted_Access);
end if;
end Unlock;
procedure Sleep
(Self_ID : Task_ID;
Reason : System.Tasking.Task_States) is
begin
pragma Assert (Self_ID = Self);
if Single_Lock then
Cond_Wait (Self_ID.Common.LL.CV'Access, Single_RTS_Lock'Access);
else
Cond_Wait (Self_ID.Common.LL.CV'Access, Self_ID.Common.LL.L'Access);
end if;
if Self_ID.Deferral_Level = 0
and then Self_ID.Pending_ATC_Level < Self_ID.ATC_Nesting_Level
then
Unlock (Self_ID);
raise Standard'Abort_Signal;
end if;
end Sleep;
procedure Timed_Sleep
(Self_ID : Task_ID;
Time : Duration;
Mode : ST.Delay_Modes;
Reason : System.Tasking.Task_States;
Timedout : out Boolean;
Yielded : out Boolean)
is
Check_Time : constant Duration := Monotonic_Clock;
Rel_Time : Duration;
Abs_Time : Duration;
Result : Integer;
Local_Timedout : Boolean;
begin
Timedout := True;
Yielded := False;
if Mode = Relative then
Rel_Time := Time;
Abs_Time := Duration'Min (Time, Max_Sensible_Delay) + Check_Time;
else
Rel_Time := Time - Check_Time;
Abs_Time := Time;
end if;
if Rel_Time > 0.0 then
loop
exit when Self_ID.Pending_ATC_Level < Self_ID.ATC_Nesting_Level
or else Self_ID.Pending_Priority_Change;
if Single_Lock then
Cond_Timed_Wait (Self_ID.Common.LL.CV'Access,
Single_RTS_Lock'Access, Rel_Time, Local_Timedout, Result);
else
Cond_Timed_Wait (Self_ID.Common.LL.CV'Access,
Self_ID.Common.LL.L'Access, Rel_Time, Local_Timedout, Result);
end if;
exit when Abs_Time <= Monotonic_Clock;
if not Local_Timedout then
Timedout := False;
exit;
end if;
Rel_Time := Abs_Time - Monotonic_Clock;
end loop;
end if;
end Timed_Sleep;
procedure Timed_Delay
(Self_ID : Task_ID;
Time : Duration;
Mode : ST.Delay_Modes)
is
Check_Time : constant Duration := Monotonic_Clock;
Rel_Time : Duration;
Abs_Time : Duration;
Result : Integer;
Timedout : Boolean;
begin
SSL.Abort_Defer.all;
if Single_Lock then
Lock_RTS;
end if;
Write_Lock (Self_ID);
if Mode = Relative then
Rel_Time := Time;
Abs_Time := Time + Check_Time;
else
Rel_Time := Time - Check_Time;
Abs_Time := Time;
end if;
if Rel_Time > 0.0 then
Self_ID.Common.State := Delay_Sleep;
loop
if Self_ID.Pending_Priority_Change then
Self_ID.Pending_Priority_Change := False;
Self_ID.Common.Base_Priority := Self_ID.New_Base_Priority;
Set_Priority (Self_ID, Self_ID.Common.Base_Priority);
end if;
exit when Self_ID.Pending_ATC_Level < Self_ID.ATC_Nesting_Level;
if Single_Lock then
Cond_Timed_Wait (Self_ID.Common.LL.CV'Access,
Single_RTS_Lock'Access, Rel_Time, Timedout, Result);
else
Cond_Timed_Wait (Self_ID.Common.LL.CV'Access,
Self_ID.Common.LL.L'Access, Rel_Time, Timedout, Result);
end if;
exit when Abs_Time <= Monotonic_Clock;
Rel_Time := Abs_Time - Monotonic_Clock;
end loop;
Self_ID.Common.State := Runnable;
end if;
Unlock (Self_ID);
if Single_Lock then
Unlock_RTS;
end if;
Yield;
SSL.Abort_Undefer.all;
end Timed_Delay;
procedure Wakeup (T : Task_ID; Reason : System.Tasking.Task_States) is
begin
Cond_Signal (T.Common.LL.CV'Access);
end Wakeup;
procedure Yield (Do_Yield : Boolean := True) is
begin
if Do_Yield then
Sleep (0);
end if;
end Yield;
type Prio_Array_Type is array (System.Any_Priority) of Integer;
pragma Atomic_Components (Prio_Array_Type);
Prio_Array : Prio_Array_Type;
procedure Set_Priority
(T : Task_ID;
Prio : System.Any_Priority;
Loss_Of_Inheritance : Boolean := False)
is
Res : BOOL;
Array_Item : Integer;
begin
Res := SetThreadPriority
(T.Common.LL.Thread, Interfaces.C.int (Underlying_Priorities (Prio)));
pragma Assert (Res = True);
if Time_Slice_Val = 0
and then Underlying_Priorities (Prio) = Thread_Priority_Idle
and then Loss_Of_Inheritance
then
Sleep (20);
end if;
if FIFO_Within_Priorities then
if Loss_Of_Inheritance
and then Prio < T.Common.Current_Priority
then
Array_Item := Prio_Array (T.Common.Base_Priority) + 1;
Prio_Array (T.Common.Base_Priority) := Array_Item;
loop
Yield;
exit when Array_Item = Prio_Array (T.Common.Base_Priority)
or else Prio_Array (T.Common.Base_Priority) = 1;
end loop;
Prio_Array (T.Common.Base_Priority) :=
Prio_Array (T.Common.Base_Priority) - 1;
end if;
end if;
T.Common.Current_Priority := Prio;
end Set_Priority;
function Get_Priority (T : Task_ID) return System.Any_Priority is
begin
return T.Common.Current_Priority;
end Get_Priority;
procedure Enter_Task (Self_ID : Task_ID) is
procedure Init_Float;
pragma Import (C, Init_Float, "__gnat_init_float");
Succeeded : BOOL;
begin
Succeeded := TlsSetValue (TlsIndex, To_Address (Self_ID));
pragma Assert (Succeeded = True);
Init_Float;
Self_ID.Common.LL.Thread_Id := GetCurrentThreadId;
Lock_RTS;
for J in Known_Tasks'Range loop
if Known_Tasks (J) = null then
Known_Tasks (J) := Self_ID;
Self_ID.Known_Tasks_Index := J;
exit;
end if;
end loop;
Unlock_RTS;
end Enter_Task;
function New_ATCB (Entry_Num : Task_Entry_Index) return Task_ID is
begin
return new Ada_Task_Control_Block (Entry_Num);
end New_ATCB;
procedure Initialize_TCB (Self_ID : Task_ID; Succeeded : out Boolean) is
begin
Initialize_Cond (Self_ID.Common.LL.CV'Access);
if not Single_Lock then
Initialize_Lock (Self_ID.Common.LL.L'Access, ATCB_Level);
end if;
Succeeded := True;
end Initialize_TCB;
procedure Create_Task
(T : Task_ID;
Wrapper : System.Address;
Stack_Size : System.Parameters.Size_Type;
Priority : System.Any_Priority;
Succeeded : out Boolean)
is
hTask : HANDLE;
TaskId : aliased DWORD;
pTaskParameter : System.OS_Interface.PVOID;
dwStackSize : DWORD;
Result : DWORD;
Entry_Point : PTHREAD_START_ROUTINE;
function To_PTHREAD_START_ROUTINE is new
Unchecked_Conversion (System.Address, PTHREAD_START_ROUTINE);
begin
pTaskParameter := To_Address (T);
if Stack_Size = Unspecified_Size then
dwStackSize := DWORD (Default_Stack_Size);
elsif Stack_Size < Minimum_Stack_Size then
dwStackSize := DWORD (Minimum_Stack_Size);
else
dwStackSize := DWORD (Stack_Size);
end if;
Entry_Point := To_PTHREAD_START_ROUTINE (Wrapper);
hTask := CreateThread
(null,
dwStackSize,
Entry_Point,
pTaskParameter,
DWORD (Create_Suspended),
TaskId'Unchecked_Access);
if hTask = 0 then
raise Storage_Error;
end if;
T.Common.LL.Thread := hTask;
Set_Priority (T, Priority);
Result := ResumeThread (hTask);
pragma Assert (Result = 1);
Succeeded := Result = 1;
end Create_Task;
procedure Finalize_TCB (T : Task_ID) is
Self_ID : Task_ID := T;
Result : DWORD;
Succeeded : BOOL;
procedure Free is new
Unchecked_Deallocation (Ada_Task_Control_Block, Task_ID);
begin
if not Single_Lock then
Finalize_Lock (T.Common.LL.L'Access);
end if;
Finalize_Cond (T.Common.LL.CV'Access);
if T.Known_Tasks_Index /= -1 then
Known_Tasks (T.Known_Tasks_Index) := null;
end if;
Result := WaitForSingleObject (T.Common.LL.Thread, Wait_Infinite);
pragma Assert (Result /= WAIT_FAILED);
Succeeded := CloseHandle (T.Common.LL.Thread);
pragma Assert (Succeeded = True);
Free (Self_ID);
end Finalize_TCB;
procedure Exit_Task is
begin
ExitThread (0);
end Exit_Task;
procedure Abort_Task (T : Task_ID) is
begin
null;
end Abort_Task;
function Environment_Task return Task_ID is
begin
return Environment_Task_ID;
end Environment_Task;
procedure Lock_RTS is
begin
Write_Lock (Single_RTS_Lock'Access, Global_Lock => True);
end Lock_RTS;
procedure Unlock_RTS is
begin
Unlock (Single_RTS_Lock'Access, Global_Lock => True);
end Unlock_RTS;
procedure Initialize (Environment_Task : Task_ID) is
Res : BOOL;
begin
Environment_Task_ID := Environment_Task;
if Time_Slice_Val = 0 or else FIFO_Within_Priorities then
Res := OS_Interface.SetPriorityClass
(GetCurrentProcess, Realtime_Priority_Class);
end if;
TlsIndex := TlsAlloc;
Initialize_Lock (Single_RTS_Lock'Access, RTS_Lock_Level);
Environment_Task.Common.LL.Thread := GetCurrentThread;
Enter_Task (Environment_Task);
Next_Fake_ATCB := new Fake_ATCB;
end Initialize;
function Monotonic_Clock return Duration
renames System.OS_Primitives.Monotonic_Clock;
function RT_Resolution return Duration is
begin
return 0.000_001; end RT_Resolution;
function Check_Exit (Self_ID : ST.Task_ID) return Boolean is
begin
return True;
end Check_Exit;
function Check_No_Locks (Self_ID : ST.Task_ID) return Boolean is
begin
return True;
end Check_No_Locks;
function Suspend_Task
(T : ST.Task_ID;
Thread_Self : Thread_Id) return Boolean is
begin
if T.Common.LL.Thread /= Thread_Self then
return SuspendThread (T.Common.LL.Thread) = NO_ERROR;
else
return True;
end if;
end Suspend_Task;
function Resume_Task
(T : ST.Task_ID;
Thread_Self : Thread_Id) return Boolean is
begin
if T.Common.LL.Thread /= Thread_Self then
return ResumeThread (T.Common.LL.Thread) = NO_ERROR;
else
return True;
end if;
end Resume_Task;
end System.Task_Primitives.Operations;