Subversion Repositories openrisc_me

#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);

}