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.
*/
#if 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;
}
|