From 8faca06664388ed141b2f7b9b5ddcfb0b4577fe8 Mon Sep 17 00:00:00 2001
From: Joel Sherrill <joel.sherrill@OARcorp.com>
Date: Mon, 22 Apr 1996 16:46:36 +0000
Subject: thread.c: added support for optional user provided stack allocator

wkspace.c: made initialization routine a regular subroutine
---
 c/src/exec/score/src/wkspace.c | 43 ++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 43 insertions(+)

(limited to 'c/src/exec/score/src/wkspace.c')

diff --git a/c/src/exec/score/src/wkspace.c b/c/src/exec/score/src/wkspace.c
index f168e91d62..1dda9408bb 100644
--- a/c/src/exec/score/src/wkspace.c
+++ b/c/src/exec/score/src/wkspace.c
@@ -20,6 +20,49 @@
 #include <rtems/score/wkspace.h>
 #include <rtems/score/interr.h>
 
+/*PAGE
+ *
+ *  _Workspace_Handler_initialization
+ */
+ 
+void _Workspace_Handler_initialization(
+  void       *starting_address,
+  unsigned32  size
+)
+{
+  unsigned32 *zero_out_array;
+  unsigned32  index;
+  unsigned32  memory_available;
+ 
+  if ( !starting_address || !_Addresses_Is_aligned( starting_address ) )
+    _Internal_error_Occurred(
+      INTERNAL_ERROR_CORE,
+      TRUE,
+      INTERNAL_ERROR_INVALID_WORKSPACE_ADDRESS
+    );
+ 
+  if ( _CPU_Table.do_zero_of_workspace ) {
+    for( zero_out_array  = (unsigned32 *) starting_address, index = 0 ;
+         index < size / 4 ;
+         index++ )
+      zero_out_array[ index ] = 0;
+  }
+ 
+  memory_available = _Heap_Initialize(
+    &_Workspace_Area,
+    starting_address,
+    size,
+    CPU_HEAP_ALIGNMENT
+  );
+ 
+  if ( memory_available == 0 )
+    _Internal_error_Occurred(
+      INTERNAL_ERROR_CORE,
+      TRUE,
+      INTERNAL_ERROR_TOO_LITTLE_WORKSPACE
+    );
+}
+
 /*PAGE
  *
  *  _Workspace_Allocate_or_fatal_error
-- 
cgit v1.2.3