blob: a0128e662e2ce64a286fb462a9114fb2c6c7c3a1 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
|
#include <stdarg.h>
#include <stddef.h>
#include "demo.h"
#include "float16.h"
#define GFX_VRAM_BASE 0x38000000
#define GFX_CMD_BASE 0x3c000000
#define GFX_CMD_SCAN (*(volatile unsigned *)(GFX_CMD_BASE + 4))
#define GFX_CMD_HEADER_BASE (*(volatile unsigned *)(GFX_CMD_BASE + 8))
#define GFX_CMD_HEADER_SIZE (*(volatile unsigned *)(GFX_CMD_BASE + 12))
#define GFX_CMD_FB_BASE_A (*(volatile unsigned *)(GFX_CMD_BASE + 16))
#define GFX_CMD_FB_BASE_B (*(volatile unsigned *)(GFX_CMD_BASE + 20))
#define FB_BASE_A 0x000000
#define FB_BASE_B 0x200000
#define HEADER_BASE 0x400000
#define HEADER_SIZE (1 - 1)
#define CODE_BASE 0x500000
#define CODE_SIZE (3 - 1)
#define DATA_BASE 0x600000
#define VRAM_HEADER_CODE_BASE ((unsigned *)(GFX_VRAM_BASE + HEADER_BASE + 0))
#define VRAM_HEADER_CODE_SIZE ((unsigned *)(GFX_VRAM_BASE + HEADER_BASE + 4))
#define VRAM_HEADER_DATA_BASE ((unsigned *)(GFX_VRAM_BASE + HEADER_BASE + 8))
#define VRAM_HEADER_DATA_SIZE ((unsigned *)(GFX_VRAM_BASE + HEADER_BASE + 12))
#define VRAM_CODE ((unsigned *)(GFX_VRAM_BASE + CODE_BASE))
#define VRAM_DATA ((short *)(GFX_VRAM_BASE + DATA_BASE))
static int swap_buffers;
static unsigned clear_color;
static unsigned data_size;
static void gfx_write_scan(int do_clear)
{
unsigned word = 0x02000000;
word |= clear_color;
if (swap_buffers)
word |= 0x01000000;
if (do_clear)
word |= 0x04000000;
GFX_CMD_SCAN = word;
}
void gfx_init(void)
{
data_size = 0;
clear_color = 0;
swap_buffers = 0;
gfx_write_scan(1);
GFX_CMD_FB_BASE_A = FB_BASE_A;
GFX_CMD_FB_BASE_B = FB_BASE_B;
GFX_CMD_HEADER_BASE = HEADER_BASE;
*VRAM_HEADER_CODE_BASE = CODE_BASE;
*VRAM_HEADER_CODE_SIZE = CODE_SIZE;
*VRAM_HEADER_DATA_BASE = DATA_BASE;
*VRAM_HEADER_DATA_SIZE = 0;
VRAM_CODE[0] = 0x00000120; // recv m1
VRAM_CODE[1] = 0x00001010; // send m1
VRAM_CODE[2] = 0x00001010; // send m1
}
void gfx_clear(void)
{
data_size = 0;
*VRAM_HEADER_DATA_SIZE = 0;
gfx_write_scan(1);
}
void gfx_swap(void)
{
swap_buffers = !swap_buffers;
gfx_write_scan(0);
}
void gfx_draw(void)
{
GFX_CMD_HEADER_SIZE = HEADER_SIZE;
}
void gfx_bg(unsigned color)
{
clear_color = color;
gfx_write_scan(0);
}
void gfx_data(unsigned block, unsigned lane, short data[static 4])
{
unsigned vec_num = block << 2 | lane;
for (unsigned i = 0; i < 4; ++i)
VRAM_DATA[vec_num << 2 | i] = data[i];
if (vec_num + 1 > data_size) {
data_size = vec_num + 1;
*VRAM_HEADER_DATA_SIZE = data_size;
}
}
|