summaryrefslogtreecommitdiffstats
path: root/cpukit/posix/src/shmheap.c
blob: 3fceace786b2f0c66bec8fc6ae70dbb520a3bcd2 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
/**
 * @file
 */

/*
 * Copyright (c) 2016 Gedare Bloom.
 *
 * The license and distribution terms for this file may be
 * found in the file LICENSE in this distribution or at
 * http://www.rtems.org/license/LICENSE.
 */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include <errno.h>
#include <stdlib.h>
#include <string.h>
#include <rtems/posix/shmimpl.h>

int _POSIX_Shm_Object_create_from_heap(
  POSIX_Shm_Object *shm_obj,
  size_t size
)
{
  void *p = calloc( 1, size ); /* get zero'd memory */
  if ( p != NULL ) {
    shm_obj->handle = p;
    shm_obj->size = size;
  } else {
    errno = EIO;
  }
  return 0;
}

int _POSIX_Shm_Object_delete_from_heap( POSIX_Shm_Object *shm_obj )
{
  /* zero out memory before releasing it. */
  memset( shm_obj->handle, 0, shm_obj->size );
  free( shm_obj->handle );
  shm_obj->handle = NULL;
  shm_obj->size = 0;
  return 0;
}

int _POSIX_Shm_Object_resize_from_heap(
  POSIX_Shm_Object *shm_obj,
  size_t size
)
{
  void *p;
  int err = 0;

  if ( size < shm_obj->size ) {
    /* zero out if shrinking */
    p = (void*)((uintptr_t)shm_obj->handle + (uintptr_t)size);
    memset( p, 0, shm_obj->size - size );
  }
  p = realloc( shm_obj->handle, size );
  if ( p != NULL ) {
    shm_obj->handle = p;
    if ( size > shm_obj->size ) {
      /* initialize added memory */ 
      memset( p, 0, size - shm_obj->size );
    }
    shm_obj->size = size;
  } else {
    err = EIO;
  }
  return err;
}

/* This is identical to _POSIX_Shm_Object_read_from_wkspace */
int _POSIX_Shm_Object_read_from_heap(
  POSIX_Shm_Object *shm_obj,
  void *buf,
  size_t count
)
{
  if ( shm_obj == NULL || shm_obj->handle == NULL )
    return 0;

  if ( shm_obj->size < count ) {
    count = shm_obj->size;
  }

  memcpy( buf, shm_obj->handle, count );

  return count;
}

/* This is identical to _POSIX_Shm_Object_mmap_from_wkspace */
void * _POSIX_Shm_Object_mmap_from_heap(
  POSIX_Shm_Object *shm_obj,
  size_t len,
  int prot,
  off_t off
)
{
  if ( shm_obj == NULL || shm_obj->handle == NULL )
    return 0;

  /* This is already checked by mmap. Maybe make it a debug assert? */
  if ( shm_obj->size < len + off ) {
    return NULL;
  }

  return (char*)shm_obj->handle + off;
}