Blame view

app/app-prime-modbus/lib/fanet/sharemem.c 5.97 KB
8c2952457   김태훈   응용 프로그램 추가
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
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
  /**    
      @file     sharemem.c
      @date     2006
      @author   유영창 frog@falinux.com  FALinux.Co.,Ltd.
      @author   오재경 freefrug@falinux.com  FALinux.Co.,Ltd.
      @brief    공유메모리를 생성하고 해제한다.
  
      @modify   
      @todo    
      @bug     
      @remark   
      
      
      @warning 
  */
  //
  //  저작권    에프에이리눅스(주)
  //            외부공개 금지
  //
  //----------------------------------------------------------------------------
  #include <stdio.h>
  #include <stdlib.h>
  #include <unistd.h>
  #include <fcntl.h>
  #include <string.h>
  
  #include <sys/types.h>
  #include <sys/stat.h>
  #include <sys/signal.h>
  #include <sys/ioctl.h>
  #include <sys/poll.h> 
  
  #include <sys/ipc.h>
  #include <sys/shm.h>
  
  
  /// 공유메모리 관리를 위한 구조체
  typedef struct
  {
  	int	key;            // 사용자가 바라보는 식별자
      int	id;             // 공유메모리 핸들
  	char	data[0];    // 사용자가 엑세스하는 메모리
  	
  } share_t;
  
  
  //------------------------------------------------------------------------------
  /** @brief    공유메모리를 삭제한다.
      @param    key   공유메모리를 지정하는 유니크값
      @remark
  *///----------------------------------------------------------------------------
  void	share_delete( int key )
  {
  	FILE  *fp;
  	char   line[128];
  	int	   id = -1;
  	int    size;
  	
  	// shm 정보파일을 연다.
  	fp = fopen( "/proc/sysvipc/shm", "r" );
  	if(fp == NULL) 	return;
  	
  	// 첫번째 라인 무시  
  	fgets( line, sizeof(line), fp );
  	
  	while(1) 
  	{
  		int	tmp_key, tmp_id, tmp_perm, tmp_size;
  
  		if ( fgets( line, sizeof(line), fp ) == NULL ) break;
  		
  		// 키값과 크기를 읽어온다.
  		if ( sscanf( line, "%d %d %d %d", &tmp_key, &tmp_id, &tmp_perm, &tmp_size ) == 4 )
  		{
  			// printf( "SHM KEY = %d ID = %d SIZE=%d
  ", tmp_key, tmp_id, tmp_size );
  			if ( tmp_key == key )
  			{
  				id = tmp_id;	// 해당하는 id 를 찾았다
  				size = tmp_size;
  				break;		
  			} 
  		}
  	}
  	
  	// 파일을 닫는다.
  	fclose( fp );
  
  
  	// id 를 찾았다면 공유메모리를 삭제한다.
  	if( id >= 0 )
  	{
  		id = shmget( key, size, 0666 | IPC_CREAT);
  		shmctl( id, IPC_RMID, NULL ); 
  	}
  }
  //------------------------------------------------------------------------------
  /** @brief    공유 메모리를 생성한다. 
      @param    key   공유메모리를 지정하는 유니크값
      @param    size  생성할 공유메모리 크기
      @return   할당받은 공유메모리
      @remark
  *///----------------------------------------------------------------------------
  void	*share_create( int key, unsigned int size )
  {
  	int	id;
  	void	*ptr;
  	share_t *share; 
  	
  //	printf( "share_create key = %d
  " , key );
  	
  	// 공유 메모리를 생성하여 핸들을 얻거나 이미 있으면 해당 핸들을 가져 온다. 
  	id = shmget( key, sizeof(share_t) + size, 0666 | IPC_CREAT );
  //	printf("shmget id = %d
  ", id )
  
  	if( id < 0 ) 
  	{
  		// 만약에 기존에 다른 크기로 생성되어 있다면 
  		// 이전것을 모두 삭제 처리 하고 재 생성을 요청한다. 
  //		printf("Exit Share Memory %08X
  ", key );
  		share_delete( key );
  		
  		// 다시 할당받는다.
  		id = shmget( key, size + sizeof(share_t), 0666 | IPC_CREAT | IPC_EXCL );
  		
  		if( id < 0 ) return NULL;
  	}
  
  	// 공유메모리의 선두 주소를 얻어온다.
  	ptr = shmat( id, NULL, 0 ); 
  	if( ptr == NULL ) return NULL;
  	
  	// 공유메모리의 정보를 저장한다.
  	share = (share_t *) ptr;
  	share->key = key;
  	share->id  = id;
  	
  	return share->data;
  }
  //------------------------------------------------------------------------------
  /** @brief    공유 메모리를 해제한다.
      @param    data  share_create() 함수로 받은 메모리 포인터
      @remark
  *///----------------------------------------------------------------------------
  void	share_free( void *data )
  {
  	share_t	*share; 
  	int	id;
  	
  	share = (share_t *)( data - sizeof(share_t) );
  	id    = share->id;
  	
  	// 공유 메모리를 어드레스 공간에서 분리한다.
  	shmdt( share ); 
  	
  	// 공유 메모리를 사용하는 프로세스가 없다면 삭제하도록 설정한다.
  	shmctl( id, IPC_RMID, NULL ); 
  }
  
  
  /*
  
  //-------------------------------------------------------------------------------
  // 설명 : 
  // 주의 :
  //-------------------------------------------------------------------------------
  int	get_usrmsg( char *buf, int size )
  {
  	printf( "  type msg >> " );
  	fgets( buf, size, stdin );
  
  	if ( buf[strlen(buf)-1] == '
  ' ) buf[strlen(buf)-1] = 0;
  
  	if ( 0 == strcmp( buf, "exit" ) ) return -1;
  	
  	return 0;
  }
  
  
  
  //-------------------------------------------------------------------------------
  // 설명 : help
  // 주의 :
  //-------------------------------------------------------------------------------
  void	help( void )
  {
  	printf( " sap_shm [r|w] [key] [size]
  "	\
  		"    r|w   : read or write
  "   \
  		"    key   : shared mem key
  "  \
  		"    size  : shared mem size
  "	\
  		"    ex) ./sap_shm r 0x1234 256
  "\
  	);
  }
  
  // 메세지를 보내고 받기위한 구조체
  typedef struct 
  {
  	unsigned int	seq;
  	char		data[0];
  	
  } msg_t;
  
  //------------------------------------------------------------------------------
  // 설명 : main
  // 주의 : 
  //------------------------------------------------------------------------------
  int     main( int argc, char **argv )
  {
  	msg_t	*pmsg;
  	int	key, size;
  	char	dir;
  	
  	
  	if ( argc < 4 )
  	{
  		help();
  		return -1;	
  	}
  
  	dir  = argv[1][0];
  	key  = strtoul( argv[2], NULL, 0 );	
  	size = strtoul( argv[3], NULL, 0 );	
  	
  	// 공유메모리를 생성한다.
  	pmsg = (msg_t *)share_create( key, sizeof(msg_t) + size );
  	
  	if ( NULL == pmsg )
  	{
  		printf( " fail get shared mem
  " );
  		return -1;
  	}
  	
  	// 데이타를 공유메모리에 쓴다.	
  	if ( dir == 'w' )
  	{
  		pmsg->seq = 0;
  		while( 0 == get_usrmsg( pmsg->data, size ) )
  		{
  			pmsg->seq ++;
  		}	
  		
  		pmsg->seq ++;
  	}
  	// 데이타를 공유메모리에서 읽는다.
  	else
  	{
  		unsigned int seq = 0;
  		
  		while(1)
  		{
  			if ( seq != pmsg->seq )
  			{
  				printf( " --> %s
  ", pmsg->data );
  				seq = pmsg->seq;
  
  				if ( 0 == strcmp( pmsg->data, "exit" ) ) break;
  			}
  			
  			sleep(1);
  		}
  	}
  	
  	// 공유메모리를 해제한다.
  	share_free( pmsg );
  
  	printf( " shm test end
  " );
  	return 0;
  }
  
  */