Subversion Repositories openrisc_2011-10-31

#include "common.h"
#include "support.h"
#include "spr-defs.h"
 
/* Camera and CRT test.
   Draws gray cross across the screen, few color boxes at top left and moves around camera captured screen left/right
   in the middle. */ 
 
#define CAMERA_BASE     0x88000000
#define CRT_BASE        0xc0000000
#define VIDEO_RAM_START 0xa8000000      /* till including a83ffffc */
 
#define SCREEN_X        640
#define SCREEN_Y        480
 
#define CAMERA_X        352
#define CAMERA_Y        288
 
#define CAMERA_BUF(idx) (VIDEO_RAM_START + (idx) * CAMERA_X * CAMERA_Y)
#define FRAME_BUF       (CAMERA_BUF(2))
 
#define CAMERA_POS      (camera_pos_x + ((SCREEN_Y - CAMERA_Y) / 2) * SCREEN_X)
 
#define MIN(x,y)        ((x) < (y) ? (x) : (y))
 
#define set_mem32(addr,val)  (*((unsigned long *) (addr)) = (val))
#define get_mem32(addr)  (*((unsigned long *) (addr)))
#define set_palette(idx,r,g,b) set_mem32 (CRT_BASE + 0x400 + (idx) * 4, (((r) >> 3) << 11) | (((g) >> 2) << 5) | (((b) >> 3) << 0))
#define put_pixel(xx,yy,idx)   (*(unsigned char *)(FRAME_BUF + (xx) + (yy) * SCREEN_X) = (idx))
 
int camera_pos_x;
 
int camera_move_speed = 1;
 
int current_buf;
 
 
void camera_int(void) 
{
 
	    /* Change base addresse of camera */ 
	    set_mem32(CAMERA_BASE, CAMERA_BUF(current_buf));	/* Set address to store to */
 
 
	    /* Change base addresse of crt */ 
	    set_mem32(CRT_BASE + 8, CAMERA_BUF(1 - current_buf));	/* Tell CRT when camera buffer is */
 
printf("\n %08x\n ", CAMERA_BUF(current_buf));
 
 
current_buf = 1 - current_buf;
 
 
	    /* move the camera screen around */ 
	    camera_pos_x += camera_move_speed;
 
if (camera_pos_x >= SCREEN_X - CAMERA_X || camera_pos_x <= 0)
 
camera_move_speed = -camera_move_speed;
 
mtspr(SPR_PICSR, 0);
 
}
 
 
 
int crt_enable_cmd(int argc, char *argv[]) 
{
 
int i, x, y;
 
 
if (argc)
		return -1;
 
	    /* Init CRT */ 
	    set_mem32(CRT_BASE + 4, FRAME_BUF);	/* Frame buffer start */
 
set_mem32(CRT_BASE, get_mem32(CRT_BASE) | 1);	/* Enable CRT only */
 
 
	    /* Init palette */ 
	    for (i = 0; i < 32; i++) {
 
set_palette(8 * i + 0, 0x00, 0x00, 0x00);	/* black */
 
set_palette(8 * i + 1, 0xff, 0xff, 0xff);	/* white */
 
set_palette(8 * i + 2, 0x7f, 0x7f, 0x7f);	/* gray */
 
set_palette(8 * i + 3, 0xff, 0x00, 0x00);	/* red */
 
set_palette(8 * i + 4, 0x00, 0xff, 0x00);	/* green */
 
set_palette(8 * i + 5, 0x00, 0x00, 0xff);	/* blue */
 
set_palette(8 * i + 6, 0x00, 0xff, 0xff);	/* cyan */
 
set_palette(8 * i + 7, 0xff, 0x00, 0xff);	/* purple */
 
}
 
for (x = 0; x < SCREEN_X; x++)
 
for (y = 0; y < SCREEN_Y; y++)
 
put_pixel(x, y, 3);
 
return 0;
 
}
 
 
 
int crt_test_cmd(int argc, char *argv[]) 
{
 
int i, x, y;
 
if (argc)
		return -1;
 
for (x = 0; x < SCREEN_X; x++)
 
for (y = 0; y < SCREEN_Y; y++)
 
put_pixel(x, y, 0);
 
	    /* Draw gray X */ 
	    for (i = 0; i < SCREEN_Y; i++) {
 
put_pixel(i, i, 2);
 
put_pixel(SCREEN_X - i - 1, i, 1);
 
}
 
 
	    /* Draw color boxes */ 
	    for (y = 0; y < 50; y++)
 
for (x = 0; x < 50; x++)
 
for (i = 0; i < 8; i++)
 
put_pixel(i * 50 + x, y, i);
 
return 0;
 
}
 
 
 
int crt_disable_cmd(int argc, char *argv[]) 
{
 
if (argc)
		return -1;
 
set_mem32(CRT_BASE, get_mem32(CRT_BASE) & ~1);	/* Disable CRT */
 
return 0;
 
}
 
 
 
int camera_enable_cmd(int argc, char *argv[]) 
{
 
if (argc)
		return -1;
 
	    /* Init Camera */ 
	    set_mem32(CAMERA_BASE, CAMERA_BUF(current_buf = 0));	/* Set address to store to */
 
set_mem32(CAMERA_BASE + 4, 1);	/* Enable it */
 
 
	    /* Init CRT to display camera */ 
	    set_mem32(CRT_BASE + 8, CAMERA_BUF(1 - current_buf));	/* Tell CRT when camera buffer is */
 
camera_pos_x = 0;
 
set_mem32(CRT_BASE + 0xc, CAMERA_POS);
 
set_mem32(CRT_BASE, get_mem32(CRT_BASE) | 2);	/* Enable camera overlay */
 
 
	    /* Enable interrupts */ 
	    mtspr(SPR_SR, mfspr(SPR_SR) | SPR_SR_IEE);
 
mtspr(SPR_PICMR, mfspr(SPR_PICSR) | (1 << 13));
 
return 0;
 
}
 
 
 
int camera_disable_cmd(int argc, char *argv[]) 
{
 
if (argc)
		return -1;
 
	    /* Disable interrupts */ 
	    mtspr(SPR_SR, mfspr(SPR_SR) & ~SPR_SR_IEE);
 
mtspr(SPR_PICMR, mfspr(SPR_PICSR) & ~(1 << 13));
 
 
	    /* Disable Camera */ 
	    set_mem32(CAMERA_BASE + 4, 1);	/* Enable it */
 
set_mem32(CRT_BASE, get_mem32(CRT_BASE) & ~2);	/* Disable camera overlay */
 
return 0;
 
}
 
 
 
void module_camera_init(void) 
{
 
register_command("crt_enable", "", "enables CRT", crt_enable_cmd);
 
register_command("crt_disable", "", "disables CRT", crt_disable_cmd);
 
register_command("crt_test", "",
			  "enables CRT and displays some test patterns",
			  crt_test_cmd);
 
register_command("camera_enable", "", "enables camera",
			  camera_enable_cmd);
 
register_command("camera_disable", "", "disables camera",
			  camera_disable_cmd);
 
}