nds_test2

annotate src/ds3.c @ 1:d625ba001a62

find changesets by author, revision, files, or words in the commit message
more stuff in ds3
author John Tsiombikas <nuclear@member.fsf.org>
date Mon, 29 Jan 2018 03:48:05 +0200
parents abcaf667f2bd
children dd8c9847bae9
rev   line source
nuclear@0 1 #include <stdint.h>
nuclear@1 2 #include <math.h>
nuclear@0 3 #include "dsregs.h"
nuclear@0 4 #include "ds3.h"
nuclear@0 5
nuclear@0 6 void ds3_enable(unsigned int x)
nuclear@0 7 {
nuclear@0 8 REG_DISP3DCNT |= x;
nuclear@0 9 }
nuclear@0 10
nuclear@0 11 void ds3_disable(unsigned int x)
nuclear@0 12 {
nuclear@0 13 REG_DISP3DCNT &= ~x;
nuclear@0 14 }
nuclear@0 15
nuclear@0 16 void ds3_clear_color(uint16_t color, int a)
nuclear@0 17 {
nuclear@0 18 REG_CLEAR_COLOR = color | ((a & 0x1f) << 16);
nuclear@0 19 }
nuclear@0 20
nuclear@0 21 void ds3_clear_depth(int z)
nuclear@0 22 {
nuclear@0 23 REG_CLEAR_DEPTH = z;
nuclear@0 24 }
nuclear@0 25
nuclear@0 26 void ds3_viewport(int x, int y, int w, int h)
nuclear@0 27 {
nuclear@0 28 int x1 = x + w - 1;
nuclear@0 29 int y1 = y + h - 1;
nuclear@0 30
nuclear@0 31 if(x1 > 255) x1 = 255;
nuclear@0 32 if(y1 > 191) y1 = 191;
nuclear@0 33
nuclear@0 34 REG_VIEWPORT = x | (y << 8) | (x1 << 16) | (y1 << 24);
nuclear@0 35 }
nuclear@0 36
nuclear@0 37 void ds3_matrix_mode(int mmode)
nuclear@0 38 {
nuclear@0 39 REG_MTX_MODE = mmode;
nuclear@0 40 }
nuclear@0 41
nuclear@0 42 void ds3_load_identity(void)
nuclear@0 43 {
nuclear@0 44 REG_MTX_IDENTITY = 0;
nuclear@0 45 }
nuclear@0 46
nuclear@0 47 void ds3_load_matrix(int32_t *m)
nuclear@0 48 {
nuclear@0 49 int i;
nuclear@0 50 for(i=0; i<16; i++) {
nuclear@0 51 int16_t val = (int16_t)(*m++ >> 4);
nuclear@0 52 REG_MTX_LOAD_4X4 = val;
nuclear@0 53 }
nuclear@0 54 }
nuclear@0 55
nuclear@1 56 void ds3_load_matrix4x3(int32_t *m)
nuclear@1 57 {
nuclear@1 58 int i;
nuclear@1 59 for(i=0; i<12; i++) {
nuclear@1 60 int16_t val = (int16_t)(*m++ >> 4);
nuclear@1 61 REG_MTX_LOAD_4X3 = val;
nuclear@1 62 }
nuclear@1 63 }
nuclear@1 64
nuclear@1 65 void ds3_mult_matrix(int32_t *m)
nuclear@1 66 {
nuclear@1 67 int i;
nuclear@1 68 for(i=0; i<16; i++) {
nuclear@1 69 int16_t val = (int16_t)(*m++ >> 4);
nuclear@1 70 REG_MTX_MULT_4X4 = val;
nuclear@1 71 }
nuclear@1 72 }
nuclear@1 73
nuclear@1 74 void ds3_mult_matrix4x3(int32_t *m)
nuclear@1 75 {
nuclear@1 76 int i;
nuclear@1 77 for(i=0; i<12; i++) {
nuclear@1 78 int16_t val = (int16_t)(*m++ >> 4);
nuclear@1 79 REG_MTX_MULT_4X3 = val;
nuclear@1 80 }
nuclear@1 81 }
nuclear@1 82
nuclear@1 83 void ds3_mult_matrix3x3(int32_t *m)
nuclear@1 84 {
nuclear@1 85 int i;
nuclear@1 86 for(i=0; i<9; i++) {
nuclear@1 87 int16_t val = (int16_t)(*m++ >> 4);
nuclear@1 88 REG_MTX_MULT_3X3 = val;
nuclear@1 89 }
nuclear@1 90 }
nuclear@1 91
nuclear@0 92 void ds3_push_matrix(void)
nuclear@0 93 {
nuclear@0 94 REG_MTX_PUSH = 0;
nuclear@0 95 }
nuclear@0 96
nuclear@0 97 void ds3_pop_matrix(void)
nuclear@0 98 {
nuclear@0 99 REG_MTX_POP = 1;
nuclear@0 100 }
nuclear@0 101
nuclear@0 102 void ds3_translate(int32_t x, int32_t y, int32_t z)
nuclear@0 103 {
nuclear@0 104 REG_MTX_TRANS = (int16_t)(x >> 4);
nuclear@0 105 REG_MTX_TRANS = (int16_t)(y >> 4);
nuclear@0 106 REG_MTX_TRANS = (int16_t)(z >> 4);
nuclear@0 107 }
nuclear@0 108
nuclear@0 109 void ds3_scale(int32_t x, int32_t y, int32_t z)
nuclear@0 110 {
nuclear@0 111 REG_MTX_SCALE = (int16_t)(x >> 4);
nuclear@0 112 REG_MTX_SCALE = (int16_t)(y >> 4);
nuclear@0 113 REG_MTX_SCALE = (int16_t)(z >> 4);
nuclear@0 114 }
nuclear@0 115
nuclear@0 116 void ds3_swap_buffers(void)
nuclear@0 117 {
nuclear@0 118 REG_SWAP_BUFFERS = 0;
nuclear@0 119 }
nuclear@0 120
nuclear@0 121 void ds3_begin(int prim)
nuclear@0 122 {
nuclear@0 123 REG_BEGIN_VTXS = prim;
nuclear@0 124 }
nuclear@0 125
nuclear@0 126 void ds3_end(void)
nuclear@0 127 {
nuclear@0 128 REG_END_VTXS = 0;
nuclear@0 129 }
nuclear@0 130
nuclear@0 131 void ds3_vertex3(int32_t x, int32_t y, int32_t z)
nuclear@0 132 {
nuclear@0 133 REG_VTX_16 = ((x >> 4) & 0xffff) | ((y << 12) & 0xffff0000);
nuclear@0 134 REG_VTX_16 = (z >> 4) & 0xffff;
nuclear@0 135 }
nuclear@0 136
nuclear@1 137 void ds3_vertex3f(float x, float y, float z)
nuclear@1 138 {
nuclear@1 139 ds3_vertex3((int32_t)(x * 65536.0f), (int32_t)(y * 65536.0f), (int32_t)(z * 65536.0f));
nuclear@1 140 }
nuclear@1 141
nuclear@1 142 void ds3_vertex2(int32_t x, int32_t y)
nuclear@1 143 {
nuclear@1 144 REG_VTX_XY = ((x >> 4) & 0xffff) | ((y << 12) & 0xffff0000);
nuclear@1 145 }
nuclear@1 146
nuclear@1 147 void ds3_vertex2f(float x, float y)
nuclear@1 148 {
nuclear@1 149 ds3_vertex2((int32_t)(x * 65536.0f), (int32_t)(y * 65536.0f));
nuclear@1 150 }
nuclear@1 151
nuclear@0 152 void ds3_color(uint16_t color)
nuclear@0 153 {
nuclear@0 154 REG_COLOR = color;
nuclear@0 155 }
nuclear@0 156
nuclear@0 157 void ds3_color3b(unsigned char r, unsigned char g, unsigned char b)
nuclear@0 158 {
nuclear@0 159 REG_COLOR = RGB15(r >> 3, g >> 3, b >> 3);
nuclear@0 160 }
nuclear@1 161
nuclear@1 162 void ds3_color3f(float r, float g, float b)
nuclear@1 163 {
nuclear@1 164 uint16_t ir = r * 31.0f;
nuclear@1 165 uint16_t ig = g * 31.0f;
nuclear@1 166 uint16_t ib = b * 31.0f;
nuclear@1 167 REG_COLOR = RGB15(ir, ig, ib);
nuclear@1 168 }
nuclear@1 169
nuclear@1 170 void ds3_normal(int32_t x, int32_t y, int32_t z)
nuclear@1 171 {
nuclear@1 172 REG_NORMAL = ((x >> 7) & 0x3ff) | ((y << 17) & 0xffc00) | ((z << 27) & 0x3ff00000);
nuclear@1 173 }
nuclear@1 174
nuclear@1 175 void ds3_normal3f(float x, float y, float z)
nuclear@1 176 {
nuclear@1 177 ds3_normal((int32_t)(x * 65536.0f), (int32_t)(y * 65536.0f), (int32_t)(z * 65536.0f));
nuclear@1 178 }
nuclear@1 179
nuclear@1 180 void ds3_texcoord2(int32_t s, int32_t t)
nuclear@1 181 {
nuclear@1 182 REG_TEXCOORD = (((s) >> 12) & 0xffff) | (((t) << 4) & 0xffff0000);
nuclear@1 183 }
nuclear@1 184
nuclear@1 185 void ds3_texcoord2f(float s, float t)
nuclear@1 186 {
nuclear@1 187 ds3_texcoord2((int32_t)(s * 65536.0f), (int32_t)(t * 65536.0f));
nuclear@1 188 }
nuclear@1 189
nuclear@1 190 void ds3_ortho(int32_t left, int32_t right, int32_t top, int32_t bottom, int32_t znear, int32_t zfar)
nuclear@1 191 {
nuclear@1 192 int32_t m[16] = {0};
nuclear@1 193 int32_t dx = right - left;
nuclear@1 194 int32_t dy = top - bottom;
nuclear@1 195 int32_t dz = zfar - znear;
nuclear@1 196
nuclear@1 197 m[0] = 0x2000000 / (dx << 8);
nuclear@1 198 m[5] = 0x2000000 / (dy << 8);
nuclear@1 199 m[10] = -0x2000000 / (dz << 8);
nuclear@1 200 m[12] = -((right + left) << 8) / (dx << 8);
nuclear@1 201 m[13] = -((top + bottom) << 8) / (dy << 8);
nuclear@1 202 m[14] = -((zfar + znear) << 8) / (dz << 8);
nuclear@1 203
nuclear@1 204 ds3_mult_matrix(m);
nuclear@1 205 }
nuclear@1 206
nuclear@1 207 void ds3_orthof(float left, float right, float top, float bottom, float znear, float zfar)
nuclear@1 208 {
nuclear@1 209 int32_t m[16] = {0};
nuclear@1 210 float dx = right - left;
nuclear@1 211 float dy = top - bottom;
nuclear@1 212 float dz = zfar - znear;
nuclear@1 213
nuclear@1 214 m[0] = (int32_t)(2.0f / dx * 65536.0f);
nuclear@1 215 m[5] = (int32_t)(2.0f / dy * 65536.0f);
nuclear@1 216 m[10] = (int32_t)(-2.0f / dz * 65536.0f);
nuclear@1 217 m[12] = (int32_t)(-(right + left) / dx);
nuclear@1 218 m[13] = (int32_t)(-(top + bottom) / dy);
nuclear@1 219 m[14] = (int32_t)(-(zfar + znear) / dz);
nuclear@1 220
nuclear@1 221 ds3_mult_matrix(m);
nuclear@1 222 }
nuclear@1 223
nuclear@1 224 void ds3_frustum(int32_t left, int32_t right, int32_t top, int32_t bottom, int32_t znear, int32_t zfar)
nuclear@1 225 {
nuclear@1 226 int32_t m[16] = {0};
nuclear@1 227
nuclear@1 228 int32_t dx = right - left;
nuclear@1 229 int32_t dy = top - bottom;
nuclear@1 230 int32_t dz = zfar - znear;
nuclear@1 231
nuclear@1 232 int32_t a = ((right + left) << 8) / (dx << 8);
nuclear@1 233 int32_t b = ((top + bottom) << 8) / (dy << 8);
nuclear@1 234 int32_t c = (-(zfar + znear) << 8) / (dz << 8);
nuclear@1 235 int32_t d = -(((zfar >> 8) * znear) << 1) / (dz << 8);
nuclear@1 236
nuclear@1 237 m[0] = (znear << 9) / (dx << 8);
nuclear@1 238 m[5] = (znear << 9) / (dy << 8);
nuclear@1 239 m[8] = a;
nuclear@1 240 m[9] = b;
nuclear@1 241 m[10] = c;
nuclear@1 242 m[11] = -65536;
nuclear@1 243 m[14] = d;
nuclear@1 244
nuclear@1 245 ds3_mult_matrix(m);
nuclear@1 246 }
nuclear@1 247
nuclear@1 248 void g3d_frustum(float left, float right, float bottom, float top, float nr, float fr)
nuclear@1 249 {
nuclear@1 250 int32_t m[16] = {0};
nuclear@1 251
nuclear@1 252 float dx = right - left;
nuclear@1 253 float dy = top - bottom;
nuclear@1 254 float dz = fr - nr;
nuclear@1 255
nuclear@1 256 float a = (right + left) / dx;
nuclear@1 257 float b = (top + bottom) / dy;
nuclear@1 258 float c = -(fr + nr) / dz;
nuclear@1 259 float d = -2.0 * fr * nr / dz;
nuclear@1 260
nuclear@1 261 m[0] = (int32_t)(2.0 * nr / dx * 65536.0f);
nuclear@1 262 m[5] = (int32_t)(2.0 * nr / dy * 65536.0f);
nuclear@1 263 m[8] = (int32_t)(a * 65536.0f);
nuclear@1 264 m[9] = (int32_t)(b * 65536.0f);
nuclear@1 265 m[10] = (int32_t)(c * 65536.0f);
nuclear@1 266 m[11] = -65536;
nuclear@1 267 m[14] = (int32_t)(d * 65536.0f);
nuclear@1 268
nuclear@1 269 ds3_mult_matrix(m);
nuclear@1 270 }
nuclear@1 271
nuclear@1 272 void ds3_perspective(float vfov_deg, float aspect, float znear, float zfar)
nuclear@1 273 {
nuclear@1 274 int32_t m[16] = {0};
nuclear@1 275
nuclear@1 276 float vfov = M_PI * vfov_deg / 180.0f;
nuclear@1 277 float s = 1.0f / tan(vfov * 0.5f);
nuclear@1 278 float range = znear - zfar;
nuclear@1 279
nuclear@1 280 m[0] = (int32_t)(s / aspect * 65536.0f);
nuclear@1 281 m[5] = (int32_t)(s * 65536.0f);
nuclear@1 282 m[10] = (int32_t)((znear + zfar) / range * 65536.0f);
nuclear@1 283 m[11] = -65536;
nuclear@1 284 m[14] = (int32_t)(2.0f * znear * zfar / range * 65536.0f);
nuclear@1 285
nuclear@1 286 ds3_mult_matrix(m);
nuclear@1 287 }