]>
Commit | Line | Data |
---|---|---|
1 | /* | |
2 | * devmem2.c: Simple program to read/write from/to any location in memory. | |
3 | * | |
4 | * Copyright (C) 2000, Jan-Derk Bakker (J.D.Bakker@its.tudelft.nl) | |
5 | * | |
6 | * | |
7 | * This software has been developed for the LART computing board | |
8 | * (http://www.lart.tudelft.nl/). The development has been sponsored by | |
9 | * the Mobile MultiMedia Communications (http://www.mmc.tudelft.nl/) | |
10 | * and Ubiquitous Communications (http://www.ubicom.tudelft.nl/) | |
11 | * projects. | |
12 | * | |
13 | * The author can be reached at: | |
14 | * | |
15 | * Jan-Derk Bakker | |
16 | * Information and Communication Theory Group | |
17 | * Faculty of Information Technology and Systems | |
18 | * Delft University of Technology | |
19 | * P.O. Box 5031 | |
20 | * 2600 GA Delft | |
21 | * The Netherlands | |
22 | * | |
23 | * | |
24 | * This program is free software; you can redistribute it and/or modify | |
25 | * it under the terms of the GNU General Public License as published by | |
26 | * the Free Software Foundation; either version 2 of the License, or | |
27 | * (at your option) any later version. | |
28 | * | |
29 | * This program is distributed in the hope that it will be useful, | |
30 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
31 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
32 | * GNU General Public License for more details. | |
33 | * | |
34 | * You should have received a copy of the GNU General Public License | |
35 | * along with this program; if not, write to the Free Software | |
36 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
37 | * | |
38 | */ | |
39 | ||
40 | #include <stdio.h> | |
41 | #include <stdlib.h> | |
42 | #include <unistd.h> | |
43 | #include <string.h> | |
44 | #include <errno.h> | |
45 | #include <signal.h> | |
46 | #include <fcntl.h> | |
47 | #include <ctype.h> | |
48 | #include <termios.h> | |
49 | #include <sys/types.h> | |
50 | #include <sys/mman.h> | |
51 | #include <sys/stat.h> | |
52 | ||
53 | ||
54 | #define FATAL do { fprintf(stderr, "Error at line %d, file %s (%d) [%s]\n", \ | |
55 | __LINE__, __FILE__, errno, strerror(errno)); exit(1); } while(0) | |
56 | ||
57 | #define MAP_SIZE 4096UL | |
58 | #define MAP_MASK (MAP_SIZE - 1) | |
59 | ||
60 | int main(int argc, char **argv) { | |
61 | ||
62 | int fd, input_fd; | |
63 | ||
64 | void *map_base, *virt_addr; | |
65 | unsigned long read_result, writeval; | |
66 | off_t target; | |
67 | int access_type = 'w'; | |
68 | ||
69 | if(argc < 3) { | |
70 | fprintf(stderr, "\nUsage:\t%s { address } { file }\n" | |
71 | "\taddress : memory address to act upon\n" | |
72 | "\tfile : file to load\n\n", argv[0]); | |
73 | exit(1); | |
74 | } | |
75 | ||
76 | input_fd = open(argv[2], O_RDONLY); | |
77 | if (input_fd < 0) FATAL; | |
78 | ||
79 | struct stat st; | |
80 | if (fstat(input_fd, &st) < 0) FATAL; | |
81 | ||
82 | char * buf = malloc(st.st_size); | |
83 | if (!buf) FATAL; | |
84 | if (read(input_fd, buf, st.st_size) != st.st_size) FATAL; | |
85 | ||
86 | target = strtoul(argv[1], 0, 0); | |
87 | ||
88 | fd = open("/dev/mem", O_RDWR | O_SYNC); | |
89 | if (fd < 0) FATAL; | |
90 | ||
91 | printf("/dev/mem opened.\n"); | |
92 | fflush(stdout); | |
93 | ||
94 | /* Map one page */ | |
95 | map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, | |
96 | MAP_SHARED, fd, target & ~MAP_MASK); | |
97 | ||
98 | if (map_base == (void *) -1) FATAL; | |
99 | ||
100 | printf("Memory mapped at address %p.\n", map_base); | |
101 | fflush(stdout); | |
102 | ||
103 | virt_addr = map_base + (target & MAP_MASK); | |
104 | memcpy(virt_addr, buf, st.st_size); | |
105 | ||
106 | printf("Copied %d bytes.\n", st.st_size); | |
107 | ||
108 | return 0; | |
109 | } |