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
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
|
#ifndef UTIL_HPP
#define UTIL_HPP
#include "types.hpp"
#include <assert.h>
#include <type_traits>
constexpr u32 SCREEN_WIDTH = 240;
constexpr u32 SCREEN_HEIGHT = 160;
vu16* const REG_VCOUNT = reinterpret_cast<vu16*>(0x04000006);
enum DisplayControlMode : u16 {
Mode0 = 0x0000,
Mode1 = 0x0001,
Mode2 = 0x0002,
Mode3 = 0x0003,
Mode4 = 0x0004,
Mode5 = 0x0005,
};
enum DisplayControlLayer : u16 {
BG0 = 0x0100,
BG1 = 0x0200,
BG2 = 0x0400,
BG3 = 0x0800,
BG4 = 0x1000,
};
typedef u16 DisplayControlFlags;
constexpr DisplayControlFlags operator|(DisplayControlMode mode, DisplayControlLayer layer) {
return static_cast<DisplayControlFlags>(static_cast<u16>(mode) | static_cast<u16>(layer));
}
static inline void set_display_control(DisplayControlMode mode, DisplayControlLayer layer) {
static volatile DisplayControlFlags* const display_control = reinterpret_cast<DisplayControlFlags*>(0x04000000);
*display_control = mode | layer;
}
enum BGControlColorMode : u16 {
Mode_4bpp = 0x0000,
Mode_8bpp = 0x0080,
};
enum BGControlSize : u16 {
Regular_32x32 = 0x0000,
Regular_64x32 = 0x4000,
Regular_32x64 = 0x8000,
Regular_64x64 = 0xc000,
Affine_16x16 = 0x0000,
Affine_32x32 = 0x4000,
Affine_64x64 = 0x8000,
Affine_128x128 = 0xc000,
};
struct BGControlFlags {
u16 flags;
constexpr BGControlFlags() : flags(0) {}
constexpr BGControlFlags &set_priority(u16 priority) {
assert(priority < 4);
this->flags = (this->flags & 0xfffc) | priority;
return *this;
}
constexpr BGControlFlags &set_charblock_base(u16 block) {
assert(block < 4);
this->flags = (this->flags & 0xfff3) | (block << 2);
return *this;
}
constexpr BGControlFlags &set_mosaic(u16 enabled) {
this->flags = (this->flags & 0xffbf) | (!!enabled << 6);
return *this;
}
constexpr BGControlFlags &set_color_mode(BGControlColorMode mode) {
this->flags = (this->flags & 0xff7f) | mode;
return *this;
}
constexpr BGControlFlags &set_screenblock_base(u16 block) {
assert(block < 32);
this->flags = (this->flags & 0xe0ff) | (block << 8);
return *this;
}
constexpr BGControlFlags &set_affine_wrapping(u16 enabled) {
this->flags = (this->flags & 0xdfff) | (!!enabled << 13);
return *this;
}
constexpr BGControlFlags &set_size(BGControlSize size) {
this->flags = (this->flags & 0x3fff) | size;
return *this;
}
constexpr operator u16() const { return this->flags; }
};
static inline void set_bg_control(u16 bg, BGControlFlags flags) {
assert(bg < 4);
vu16* const reg = reinterpret_cast<vu16*>(0x04000008 + 2*bg);
*reg = flags;
}
static inline void set_bg_offsets(u16 bg, u16 h_offset, u16 v_offset) {
vu16* const h_reg = reinterpret_cast<vu16*>(0x04000010 + 4*bg);
vu16* const v_reg = reinterpret_cast<vu16*>(0x04000012 + 4*bg);
*h_reg = h_offset;
*v_reg = v_offset;
}
struct Color {
u16 data;
static constexpr Color from_rgb(u16 r, u16 g, u16 b) {
assert(r < 32 && g < 32 && b < 32);
return Color { .data = u16(r | (g << 5) | (b << 10)) };
}
};
typedef Color PaletteBank[16];
struct Tile4 { u32 data[8]; };
typedef Tile4 CharBlock4[512];
template <typename T>
static inline void volatile_copy(volatile T* dst, const T* src) {
using U = std::conditional_t<(sizeof(T) % sizeof(u32) == 0) && (alignof(T) % alignof(u32) == 0), u32, u16>;
static_assert(sizeof(T) % sizeof(U) == 0);
static_assert(alignof(T) % alignof(U) == 0);
auto *d = reinterpret_cast<volatile U*>(dst);
auto *s = reinterpret_cast<const U*>(src);
for (unsigned i = 0; i < sizeof(T) / sizeof(U); i++) {
d[i] = s[i];
}
}
static inline void set_tile(u16 block, u16 index, const Tile4 &tile) {
// TODO bounds check
volatile CharBlock4 *const blocks = reinterpret_cast<volatile CharBlock4*>(0x06000000);
volatile_copy(&blocks[block][index], &tile);
}
static inline void set_bg_palette(u32 bank, u32 index, const Color &color) {
volatile PaletteBank *const banks = reinterpret_cast<volatile PaletteBank*>(0x05000000);
volatile_copy(&banks[bank][index], &color);
}
// pair of screen entry bytes
struct ScreenEntry {
u16 data;
constexpr ScreenEntry() : data(0) {}
constexpr ScreenEntry &set_tile_index(u16 tid) {
assert(tid < 1024);
this->data = (this->data & ~0x03ff) | tid;
return *this;
}
constexpr ScreenEntry &set_hflip(u16 flip) {
this->data = (this->data & ~0x0400) | (!!flip << 10);
return *this;
}
constexpr ScreenEntry &set_vflip(u16 flip) {
this->data = (this->data & ~0x0800) | (!!flip << 11);
return *this;
}
constexpr ScreenEntry &set_palette_bank(u16 bank) {
assert(bank < 16);
this->data = (this->data & ~0xf000) | (bank << 12);
return *this;
}
constexpr operator u16() const { return this->data; }
};
typedef ScreenEntry ScreenBlock[1024];
CharBlock4 *const tile4_mem = reinterpret_cast<CharBlock4*>(0x06000000);
PaletteBank *const palette_bg_bank = reinterpret_cast<PaletteBank*>(0x05000000);
ScreenBlock *const screenblock_mem = reinterpret_cast<ScreenBlock*>(0x06000000);
#endif
|
