1 |
2 |
marcus.erl |
#include "common.h"
|
2 |
|
|
#include "support.h"
|
3 |
246 |
julius |
#include "spr-defs.h"
|
4 |
2 |
marcus.erl |
|
5 |
|
|
/* Camera and CRT test.
|
6 |
|
|
Draws gray cross across the screen, few color boxes at top left and moves around camera captured screen left/right
|
7 |
|
|
in the middle. */
|
8 |
|
|
|
9 |
|
|
#define CAMERA_BASE 0x88000000
|
10 |
|
|
#define CRT_BASE 0xc0000000
|
11 |
|
|
#define VIDEO_RAM_START 0xa8000000 /* till including a83ffffc */
|
12 |
|
|
|
13 |
|
|
#define SCREEN_X 640
|
14 |
|
|
#define SCREEN_Y 480
|
15 |
|
|
|
16 |
|
|
#define CAMERA_X 352
|
17 |
|
|
#define CAMERA_Y 288
|
18 |
|
|
|
19 |
|
|
#define CAMERA_BUF(idx) (VIDEO_RAM_START + (idx) * CAMERA_X * CAMERA_Y)
|
20 |
|
|
#define FRAME_BUF (CAMERA_BUF(2))
|
21 |
|
|
|
22 |
|
|
#define CAMERA_POS (camera_pos_x + ((SCREEN_Y - CAMERA_Y) / 2) * SCREEN_X)
|
23 |
|
|
|
24 |
|
|
#define MIN(x,y) ((x) < (y) ? (x) : (y))
|
25 |
|
|
|
26 |
|
|
#define set_mem32(addr,val) (*((unsigned long *) (addr)) = (val))
|
27 |
|
|
#define get_mem32(addr) (*((unsigned long *) (addr)))
|
28 |
|
|
#define set_palette(idx,r,g,b) set_mem32 (CRT_BASE + 0x400 + (idx) * 4, (((r) >> 3) << 11) | (((g) >> 2) << 5) | (((b) >> 3) << 0))
|
29 |
|
|
#define put_pixel(xx,yy,idx) (*(unsigned char *)(FRAME_BUF + (xx) + (yy) * SCREEN_X) = (idx))
|
30 |
|
|
|
31 |
|
|
int camera_pos_x;
|
32 |
|
|
int camera_move_speed = 1;
|
33 |
|
|
int current_buf;
|
34 |
|
|
|
35 |
|
|
void camera_int (void)
|
36 |
|
|
{
|
37 |
|
|
/* Change base addresse of camera */
|
38 |
|
|
set_mem32 (CAMERA_BASE, CAMERA_BUF(current_buf)); /* Set address to store to */
|
39 |
|
|
|
40 |
|
|
/* Change base addresse of crt */
|
41 |
|
|
set_mem32 (CRT_BASE + 8, CAMERA_BUF(1 - current_buf)); /* Tell CRT when camera buffer is */
|
42 |
|
|
printf ("\n %08x\n ", CAMERA_BUF(current_buf));
|
43 |
|
|
|
44 |
|
|
current_buf = 1 - current_buf;
|
45 |
|
|
|
46 |
|
|
/* move the camera screen around */
|
47 |
|
|
camera_pos_x += camera_move_speed;
|
48 |
|
|
if (camera_pos_x >= SCREEN_X - CAMERA_X || camera_pos_x <= 0)
|
49 |
|
|
camera_move_speed = -camera_move_speed;
|
50 |
|
|
mtspr(SPR_PICSR, 0);
|
51 |
|
|
}
|
52 |
|
|
|
53 |
|
|
int crt_enable_cmd (int argc, char *argv[])
|
54 |
|
|
{
|
55 |
|
|
int i, x, y;
|
56 |
|
|
|
57 |
|
|
if (argc) return -1;
|
58 |
|
|
/* Init CRT */
|
59 |
|
|
set_mem32 (CRT_BASE + 4, FRAME_BUF); /* Frame buffer start */
|
60 |
|
|
set_mem32 (CRT_BASE, get_mem32 (CRT_BASE) | 1); /* Enable CRT only */
|
61 |
|
|
|
62 |
|
|
/* Init palette */
|
63 |
|
|
for (i = 0; i < 32; i++) {
|
64 |
|
|
set_palette (8 * i + 0, 0x00, 0x00, 0x00); /* black */
|
65 |
|
|
set_palette (8 * i + 1, 0xff, 0xff, 0xff); /* white */
|
66 |
|
|
set_palette (8 * i + 2, 0x7f, 0x7f, 0x7f); /* gray */
|
67 |
|
|
set_palette (8 * i + 3, 0xff, 0x00, 0x00); /* red */
|
68 |
|
|
set_palette (8 * i + 4, 0x00, 0xff, 0x00); /* green */
|
69 |
|
|
set_palette (8 * i + 5, 0x00, 0x00, 0xff); /* blue */
|
70 |
|
|
set_palette (8 * i + 6, 0x00, 0xff, 0xff); /* cyan */
|
71 |
|
|
set_palette (8 * i + 7, 0xff, 0x00, 0xff); /* purple */
|
72 |
|
|
}
|
73 |
|
|
for (x = 0; x < SCREEN_X; x++)
|
74 |
|
|
for (y = 0; y < SCREEN_Y; y++)
|
75 |
|
|
put_pixel(x, y, 3);
|
76 |
|
|
return 0;
|
77 |
|
|
}
|
78 |
|
|
|
79 |
|
|
int crt_test_cmd (int argc, char *argv[])
|
80 |
|
|
{
|
81 |
|
|
int i, x, y;
|
82 |
|
|
if (argc) return -1;
|
83 |
|
|
for (x = 0; x < SCREEN_X; x++)
|
84 |
|
|
for (y = 0; y < SCREEN_Y; y++)
|
85 |
|
|
put_pixel(x, y, 0);
|
86 |
|
|
/* Draw gray X */
|
87 |
|
|
for (i = 0; i < SCREEN_Y; i++) {
|
88 |
|
|
put_pixel (i, i, 2);
|
89 |
|
|
put_pixel (SCREEN_X - i - 1, i, 1);
|
90 |
|
|
}
|
91 |
|
|
|
92 |
|
|
/* Draw color boxes */
|
93 |
|
|
for (y = 0; y < 50; y++)
|
94 |
|
|
for (x = 0; x < 50; x++)
|
95 |
|
|
for (i = 0; i < 8; i++)
|
96 |
|
|
put_pixel (i * 50 + x, y, i);
|
97 |
|
|
return 0;
|
98 |
|
|
}
|
99 |
|
|
|
100 |
|
|
int crt_disable_cmd (int argc, char *argv[])
|
101 |
|
|
{
|
102 |
|
|
if (argc) return -1;
|
103 |
|
|
set_mem32 (CRT_BASE, get_mem32 (CRT_BASE) & ~1); /* Disable CRT */
|
104 |
|
|
return 0;
|
105 |
|
|
}
|
106 |
|
|
|
107 |
|
|
int camera_enable_cmd (int argc, char *argv[])
|
108 |
|
|
{
|
109 |
|
|
if (argc) return -1;
|
110 |
|
|
/* Init Camera */
|
111 |
|
|
set_mem32 (CAMERA_BASE, CAMERA_BUF(current_buf = 0)); /* Set address to store to */
|
112 |
|
|
set_mem32 (CAMERA_BASE + 4, 1); /* Enable it */
|
113 |
|
|
|
114 |
|
|
/* Init CRT to display camera */
|
115 |
|
|
set_mem32 (CRT_BASE + 8, CAMERA_BUF(1 - current_buf)); /* Tell CRT when camera buffer is */
|
116 |
|
|
camera_pos_x = 0;
|
117 |
|
|
set_mem32 (CRT_BASE + 0xc, CAMERA_POS);
|
118 |
|
|
set_mem32 (CRT_BASE, get_mem32 (CRT_BASE) | 2); /* Enable camera overlay */
|
119 |
|
|
|
120 |
|
|
/* Enable interrupts */
|
121 |
|
|
mtspr (SPR_SR, mfspr(SPR_SR) | SPR_SR_IEE);
|
122 |
|
|
mtspr (SPR_PICMR, mfspr(SPR_PICSR) | (1 << 13));
|
123 |
|
|
return 0;
|
124 |
|
|
}
|
125 |
|
|
|
126 |
|
|
int camera_disable_cmd (int argc, char *argv[])
|
127 |
|
|
{
|
128 |
|
|
if (argc) return -1;
|
129 |
|
|
/* Disable interrupts */
|
130 |
|
|
mtspr (SPR_SR, mfspr(SPR_SR) & ~SPR_SR_IEE);
|
131 |
|
|
mtspr (SPR_PICMR, mfspr(SPR_PICSR) & ~(1 << 13));
|
132 |
|
|
|
133 |
|
|
/* Disable Camera */
|
134 |
|
|
set_mem32 (CAMERA_BASE + 4, 1); /* Enable it */
|
135 |
|
|
set_mem32 (CRT_BASE, get_mem32 (CRT_BASE) & ~2); /* Disable camera overlay */
|
136 |
|
|
return 0;
|
137 |
|
|
}
|
138 |
|
|
|
139 |
|
|
void module_camera_init (void)
|
140 |
|
|
{
|
141 |
|
|
register_command ("crt_enable", "", "enables CRT", crt_enable_cmd);
|
142 |
|
|
register_command ("crt_disable", "", "disables CRT", crt_disable_cmd);
|
143 |
|
|
register_command ("crt_test", "", "enables CRT and displays some test patterns", crt_test_cmd);
|
144 |
|
|
register_command ("camera_enable", "", "enables camera", camera_enable_cmd);
|
145 |
|
|
register_command ("camera_disable", "", "disables camera", camera_disable_cmd);
|
146 |
|
|
}
|