Skip to content

added simple logger into program; #11

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Open
r-novel wants to merge 1 commit into
base: master
Choose a base branch
from
Open

added simple logger into program; #11

Changes from all commits
Commits
Show all changes
1 commit
Select commit
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
72 changes: 53 additions & 19 deletions pcimem.c
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -35,11 +35,35 @@
#include <sys/types.h>
#include <sys/mman.h>

#define PRINT_ERROR \
do { \
fprintf(stderr, "Error at line %d, file %s (%d) [%s]\n", \
__LINE__, __FILE__, errno, strerror(errno)); exit(1); \
} while(0)
#define GREEN "[1;32m"
#define MAGENTA "[1;35m"
#define ORANGE "[1;38;05;214m"
#define CYAN "[1;36m"
#define RED "[1;31m"
#define BLUE "[1;94m"

#define info 1
#define debug 2
#define trace 3
#define warning 4
#define error 5

#define LOG(lvl, msg, ...) do { \
char* prefix; \
char* color; \
FILE* stream = stdout; \
switch(lvl) { \
case info: prefix = "[i]"; color = GREEN; break; \
case debug: prefix = "[d]"; color = MAGENTA; break; \
case trace: prefix = "[t]"; color = CYAN; break; \
case warning: prefix = "[w]"; color = ORANGE; break; \
case error: prefix = "[e]"; color = RED; stream = stderr; break; \
default: break; \
} \
fprintf(stream, "[%s %s]\033[1;94m [%s] [%s():%d]\033[0m \033%s %s: "msg" \033[0m\n", \
__DATE__, __TIME__, __FILE__, \
__func__, __LINE__, color, prefix, ##__VA_ARGS__); \
} while (0)


int main(int argc, char **argv) {
Expand All @@ -59,13 +83,14 @@ int main(int argc, char **argv) {
if(argc < 3) {
// pcimem /sys/bus/pci/devices/0001\:00\:07.0/resource0 0x100 w 0x00
// argv[0] [1] [2] [3] [4]
fprintf(stderr, "\nUsage:\t%s { sysfile } { offset } [ type*count [ data ] ]\n"
LOG(info, "\nUsage:\t%s { sysfile } { offset } [ type*count [ data ] ]\n"
"\tsys file: sysfs file for the pci resource to act on\n"
"\toffset : offset into pci memory region to act upon\n"
"\ttype : access operation type : [b]yte, [h]alfword, [w]ord, [d]ouble-word\n"
"\t*count : number of items to read: w*100 will dump 100 words\n"
"\tdata : data to be written\n\n",
"\tdata : data to be written",
argv[0]);

exit(1);
}
filename = argv[1];
Expand All @@ -91,25 +116,31 @@ int main(int argc, char **argv) {
type_width = 8;
break;
default:
fprintf(stderr, "Illegal data type '%c'.\n", access_type);
LOG(error, "Illegal data type '%c'.", access_type);
exit(2);
}

if((fd = open(filename, O_RDWR | O_SYNC)) == -1) PRINT_ERROR;
printf("%s opened.\n", filename);
printf("Target offset is 0x%x, page size is %ld\n", (int) target, sysconf(_SC_PAGE_SIZE));
if((fd = open(filename, O_RDWR | O_SYNC)) == -1) {
LOG(error, "Can't open file; reason: (%d) [%s]", errno, strerror(errno));
exit(1);
}
LOG(info, "%s opened.", filename);
LOG(info, "Target offset is 0x%x, page size is %ld\n", (int) target, sysconf(_SC_PAGE_SIZE));
fflush(stdout);

target_base = target & ~(sysconf(_SC_PAGE_SIZE)-1);
if (target + items_count*type_width - target_base > map_size)
map_size = target + items_count*type_width - target_base;

/* Map one page */
printf("mmap(%d, %d, 0x%x, 0x%x, %d, 0x%x)\n", 0, map_size, PROT_READ | PROT_WRITE, MAP_SHARED, fd, (int) target);
LOG(info, "mmap(%d, %d, 0x%x, 0x%x, %d, 0x%x)\n", 0, map_size, PROT_READ | PROT_WRITE, MAP_SHARED, fd, (int) target);

map_base = mmap(0, map_size, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target_base);
if(map_base == (void *) -1) PRINT_ERROR;
printf("PCI Memory mapped to address 0x%08lx.\n", (unsigned long) map_base);
if(map_base == (void *) -1) {
LOG(error, "mmap error; reason: (%d) [%s]", errno, strerror(errno));
exit(1);
};
LOG(info, "PCI Memory mapped to address 0x%08lx.", (unsigned long) map_base);
fflush(stdout);

for (i = 0; i < items_count; i++) {
Expand All @@ -131,14 +162,14 @@ int main(int argc, char **argv) {
}

if (verbose)
printf("Value at offset 0x%X (%p): 0x%0*lX\n", (int) target + i*type_width, virt_addr, type_width*2, read_result);
LOG(info, "Value at offset 0x%X (%p): 0x%0*lX", (int) target + i*type_width, virt_addr, type_width*2, read_result);
else {
if (read_result != prev_read_result || i == 0) {
printf("0x%04X: 0x%0*lX\n", (int)(target + i*type_width), type_width*2, read_result);
LOG(info, "0x%04X: 0x%0*lX", (int)(target + i*type_width), type_width*2, read_result);
read_result_dupped = 0;
} else {
if (!read_result_dupped)
printf("...\n");
LOG(info, "...");
read_result_dupped = 1;
}
}
Expand Down Expand Up @@ -169,12 +200,15 @@ int main(int argc, char **argv) {
read_result = *((uint64_t *) virt_addr);
break;
}
printf("Written 0x%0*lX; readback 0x%*lX\n", type_width,
LOG(info, "Written 0x%0*lX; readback 0x%*lX", type_width,
writeval, type_width, read_result);
fflush(stdout);
}

if(munmap(map_base, map_size) == -1) PRINT_ERROR;
if(munmap(map_base, map_size) == -1) {
LOG(error, "error with munmap; reason: (%d) [%s]", errno, strerror(errno));
exit(1);
}
close(fd);
return 0;
}