qi-hardware/ben-blinkenlights
1
0
Fork 0
mirror of git://projects.qi-hardware.com/ben-blinkenlights.git synced 2024-11-24 01:47:30 +02:00
Code

video.c: working version, with screen grabber

Browse Source
This commit is contained in:
Werner Almesberger 2011-04-24 00:10:23 -03:00
parent b85ae15479
commit 18f2957cd4
1 changed files with 39 additions and 9 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

48
video/video.c
View File

@ -56,6 +56,9 @@
#define DEFAULT_COUNT (1000*1000) #define DEFAULT_COUNT (1000*1000)
static uint8_t thres = 63;
/* ----- Ben hardware ------------------------------------------------------ */ /* ----- Ben hardware ------------------------------------------------------ */
@ -127,23 +130,32 @@ static void release_timer(void)
} }
static void ben_setup(void) static void *map(off_t addr, size_t size)
{ {
volatile void *base;
int fd; int fd;
void *mem;
fd = open("/dev/mem", O_RDWR | O_SYNC); fd = open("/dev/mem", O_RDWR | O_SYNC);
if (fd < 0) { if (fd < 0) {
perror("/dev/mem"); perror("/dev/mem");
exit(1); exit(1);
} }
base = mmap(NULL, PAGE_SIZE*3*16, PROT_READ | PROT_WRITE, MAP_SHARED, mem = mmap(NULL, size, PROT_READ | PROT_WRITE, MAP_SHARED, fd, addr);
fd, SOC_BASE); if (mem == MAP_FAILED) {
if (base == MAP_FAILED) {
perror("mmap"); perror("mmap");
exit(1); exit(1);
} }
return mem;
}
static void ben_setup(void)
{
volatile void *base;
base = map(SOC_BASE, PAGE_SIZE*3*16);
icmr = base+0x1004; icmr = base+0x1004;
icmsr = base+0x1008; icmsr = base+0x1008;
icmcr = base+0x100c; icmcr = base+0x100c;
@ -201,10 +213,9 @@ static uint32_t pick(int set, int bit, uint32_t val)
} }
static uint32_t pattern(int r, int g, int b, int hsync, int vsync, int set) static uint32_t pattern(int set, int r, int g, int b)
{ {
return pick(set, r, R) | pick(set, g, G) | pick(set, b, B) | return pick(set, r, R) | pick(set, g, G) | pick(set, b, B);
pick(set, hsync, HSYNC) | pick(set, vsync, VSYNC);
} }
@ -360,13 +371,31 @@ static void grid(uint8_t *f)
} }
static void grab(uint8_t *f)
{
uint32_t *fb = map(0x01d00000, 4*320*240);
int x, y;
uint32_t pix;
for (y = 0; y != 240; y++)
for (x = 0; x != 320; x++) {
pix = *fb++;
*f++ = pattern(!(x & 1),
((pix >> 16) & 255) >= thres,
((pix >> 8) & 255) >= thres,
(pix & 255) >= thres);
}
}
static void session(int n) static void session(int n)
{ {
uint8_t f[320*(240+1)]; uint8_t f[320*(240+1)];
int i; int i;
memset(f, 0, sizeof(f)); memset(f, 0, sizeof(f));
grid(f); grab(f);
// grid(f);
disable_interrupts(); disable_interrupts();
@ -379,6 +408,7 @@ static void session(int n)
int main(int argc, char **argv) int main(int argc, char **argv)
{ {
thres = atoi(argv[2]);
setup(); setup();
session(atoi(argv[1])); session(atoi(argv[1]));
cleanup(); cleanup();