blob: 72ed070d43bafb6add3ab32a3abcaab126885ec0 [file] [log] [blame]
(* RTdata.mod implements a mechanism whereby devices can attach data.
Copyright (C) 2008-2025 Free Software Foundation, Inc.
Contributed by Gaius Mulley <gaius.mulley@southwales.ac.uk>.
This file is part of GNU Modula-2.
GNU Modula-2 is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 3, or (at your option)
any later version.
GNU Modula-2 is distributed in the hope that it will be useful, but
WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
General Public License for more details.
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/>. *)
IMPLEMENTATION MODULE RTdata ;
FROM IOLink IMPORT RAISEdevException ;
FROM RTentity IMPORT Group, InitGroup, PutKey, IsIn, DelKey ;
FROM Storage IMPORT ALLOCATE, DEALLOCATE ;
IMPORT IOChan ;
TYPE
key = (allocated, deallocated) ;
(* each module can register one of these *)
ModuleId = POINTER TO RECORD
id: CARDINAL ;
END ;
(* each device can contain multiple of the these *)
ModuleData = POINTER TO RECORD
mid : ModuleId ;
data : ADDRESS ;
free : FreeProcedure ;
right: ModuleData ;
END ;
(*
MakeModuleId - creates a unique module Id.
*)
PROCEDURE MakeModuleId (VAR m: ModuleId) ;
BEGIN
INC(lastId) ;
NEW(m) ;
WITH m^ DO
id := lastId
END ;
PutKey(mids, m, ORD(allocated))
END MakeModuleId ;
(*
verifyModuleId - verifies that, m, has not been deallocated.
*)
PROCEDURE verifyModuleId (m: ModuleId; d: DeviceTablePtr) ;
BEGIN
IF NOT IsIn(mids, m)
THEN
WITH d^ DO
RAISEdevException(cid, did, IOChan.hardDeviceError,
'RTdata: invalid module id')
END
END
END verifyModuleId ;
(*
InitData - adds, datum, to the device, d. The datum
is associated with ModuleID, m.
*)
PROCEDURE InitData (d: DeviceTablePtr; m: ModuleId;
datum: ADDRESS; f: FreeProcedure) ;
VAR
md: ModuleData ;
BEGIN
NEW(md) ;
WITH md^ DO
mid := m ;
data := datum ;
free := f ;
right := d^.cd
END ;
d^.cd := md
END InitData ;
(*
GetData - returns the datum assocated with ModuleId, m.
*)
PROCEDURE GetData (d: DeviceTablePtr; m: ModuleId) : ADDRESS ;
VAR
md: ModuleData ;
BEGIN
verifyModuleId(m, d) ;
md := d^.cd ;
WHILE md#NIL DO
IF md^.mid=m
THEN
RETURN( md^.data )
ELSE
md := md^.right
END
END ;
RETURN( md )
END GetData ;
(*
KillData - destroys the datum associated with ModuleId, m,
in device, d. It invokes the free procedure
given during InitData.
*)
PROCEDURE KillData (d: DeviceTablePtr; m: ModuleId) ;
VAR
last,
md : ModuleData ;
BEGIN
verifyModuleId(m, d) ;
last := NIL ;
md := d^.cd ;
WHILE md#NIL DO
IF md^.mid=m
THEN
IF last=NIL
THEN
d^.cd := md^.right
ELSE
last^.right := md^.right
END ;
DelKey(mids, m) ;
md^.free(md^.data) ;
md^.data := NIL ;
DISPOSE(md)
ELSE
last := md ;
md := md^.right
END
END
END KillData ;
VAR
mids : Group ;
lastId: CARDINAL ;
BEGIN
mids := InitGroup() ;
lastId := 0
END RTdata.