| Line | |
|---|
| 1 | /* Peek and poke using /dev/mem.
|
|---|
| 2 | *
|
|---|
| 3 | * Callers now ought to check the return values.
|
|---|
| 4 | *
|
|---|
| 5 | * Calling peek() requires read permission on /dev/mem, and consumes
|
|---|
| 6 | * a file descriptor. Calling poke() requires write permission, and
|
|---|
| 7 | * consumes another file descriptor.
|
|---|
| 8 | */
|
|---|
| 9 |
|
|---|
| 10 | #include <sys/types.h>
|
|---|
| 11 | #include <fcntl.h>
|
|---|
| 12 | #include <unistd.h>
|
|---|
| 13 |
|
|---|
| 14 | _PROTOTYPE( int peek, (unsigned segment, unsigned offset));
|
|---|
| 15 | _PROTOTYPE( int poke, (unsigned segment, unsigned offset, unsigned value));
|
|---|
| 16 |
|
|---|
| 17 | #define SEGSIZE 0x10
|
|---|
| 18 |
|
|---|
| 19 | int peek(segment, offset)
|
|---|
| 20 | unsigned segment;
|
|---|
| 21 | unsigned offset;
|
|---|
| 22 | {
|
|---|
| 23 | unsigned char chvalue;
|
|---|
| 24 | static int infd = -1;
|
|---|
| 25 |
|
|---|
| 26 | if (infd < 0) infd = open("/dev/mem", O_RDONLY);
|
|---|
| 27 | if (infd < 0 ||
|
|---|
| 28 | lseek(infd, (unsigned long) segment * SEGSIZE + offset, SEEK_SET) < 0 ||
|
|---|
| 29 | read(infd, (char *) &chvalue, (unsigned) 1) != 1)
|
|---|
| 30 | return(-1);
|
|---|
| 31 | return(chvalue);
|
|---|
| 32 | }
|
|---|
| 33 |
|
|---|
| 34 | int poke(segment, offset, value)
|
|---|
| 35 | unsigned segment;
|
|---|
| 36 | unsigned offset;
|
|---|
| 37 | unsigned value;
|
|---|
| 38 | {
|
|---|
| 39 | unsigned char chvalue;
|
|---|
| 40 | static int outfd = -1;
|
|---|
| 41 |
|
|---|
| 42 | chvalue = value;
|
|---|
| 43 | if (outfd < 0) outfd = open("/dev/mem", O_WRONLY);
|
|---|
| 44 | if (outfd < 0 ||
|
|---|
| 45 | lseek(outfd, (unsigned long) segment * SEGSIZE + offset, SEEK_SET) < 0 ||
|
|---|
| 46 | write(outfd, (char *) &chvalue, (unsigned) 1) != 1)
|
|---|
| 47 | return(-1);
|
|---|
| 48 | return(chvalue);
|
|---|
| 49 | }
|
|---|
Note:
See
TracBrowser
for help on using the repository browser.