famap.c
3.03 KB
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
/**
@file famap.c
@date 2010/12/1
@author 오재경 freefrug@falinux.com FALinux.Co.,Ltd.
@brief * mmap 유틸리티이다.
* tmmap.c 가 tlist.c 를 반드시 포함해야하는 문제점이 있어 이를 보완하기
위해 작성되었다. (외부공개가 필요할때 사용하면 좋다.)
* 사용법은 파일의 끝에 작성되어 있다.
Ver 0.1.0
@modify
@todo
@bug
@remark
@warning tmmap.c tmmap.h 와는 같이 사용하지 않는다.
*/
//----------------------------------------------------------------------------
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
#include <fcntl.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <sys/time.h>
#include <sys/socket.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/poll.h>
#include <sys/mman.h>
#include <famap.h>
//------------------------------------------------------------------------------
/** @brief mmap 생성함수
@param ma mmap_alloc_t 구조체 포인터
@param phys_base 물리주소
@param size 크기
@return 사용할수 있는 가상주소
*///----------------------------------------------------------------------------
void *fa_mmap_alloc( mmap_alloc_t *ma, unsigned long phys_base, unsigned long size )
{
int dev_mem;
int base_ofs;
void *mmap_mem;
// 4K 정렬 주소로 변경한다.
base_ofs = phys_base & (PAGE_SIZE-1);
phys_base &= ~(PAGE_SIZE-1);
// 4K 단위의 메모리를 할당받는다.
size = PAGE_SIZE * ( (size + base_ofs + (PAGE_SIZE-1))/(PAGE_SIZE) );
dev_mem = open( "/dev/mem", O_RDWR|O_SYNC );
if (0 > dev_mem)
{
printf( "open error /dev/mem\n" );
return NULL;
}
// mmap 로 맵핑한다.
mmap_mem = mmap( 0, // 커널에서 알아서 할당요청
size, // 할당 크기
PROT_READ|PROT_WRITE, MAP_SHARED, // 할당 속성
dev_mem, // 파일 핸들
phys_base ); // 매핑 대상의 물리주소
if ( !mmap_mem )
{
printf( "mmap error !!!\n" );
return NULL;
}
// 관리구조체를 채운다.
ma->dev = dev_mem;
ma->phys = phys_base;
ma->size = size;
ma->virt = mmap_mem;
ma->base_ofs = base_ofs;
return mmap_mem + base_ofs;
}
//------------------------------------------------------------------------------
/** @brief mmap 포인터를 해제한다.
@param ma mmap_alloc_t 구조체 포인터
*///----------------------------------------------------------------------------
void fa_mmap_free( mmap_alloc_t *ma )
{
munmap( ma->virt, ma->size );
close ( ma->dev );
}
/// 샘플 ------------------------------------------------------------------------
#if 0
#include <famap.h>
static mmap_alloc_t io_map;
static volatile unsigned char *io_port;
void io_init( void )
{
io_port = (unsigned char *)fa_mmap_alloc( &io_map, PHY_BASE , PHY_SIZE );
// io_port[0] = 0x00;
}
void io_exit( void )
{
fa_mmap_free( &io_map );
}
#endif