1
0
Fork 0

Math c library & fixes for graphics

This commit is contained in:
Pabloader 2025-05-20 09:57:19 +00:00
parent 1aa082a156
commit 7a60d9d0bd
7 changed files with 634 additions and 37 deletions

View File

@ -25,12 +25,12 @@ typedef struct {
image_data_t image_create(uint16_t width, uint16_t height);
void image_free(image_data_t image);
void image_draw_point(image_data_t image, uint16_t x, uint16_t y, image_color_t color);
void image_draw_hline(image_data_t image, uint16_t x1, uint16_t x2, uint16_t y, image_color_t color);
void image_draw_vline(image_data_t image, uint16_t x, uint16_t y1, uint16_t y2, image_color_t color);
void image_draw_line(image_data_t image, uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, image_color_t color);
void image_draw_rect(image_data_t image, uint16_t x, uint16_t y, uint16_t w, uint16_t h, image_color_t color);
void image_fill_rect(image_data_t image, uint16_t x, uint16_t y, uint16_t w, uint16_t h, image_color_t color);
void image_draw_point(image_data_t image, int16_t x, int16_t y, image_color_t color);
void image_draw_hline(image_data_t image, int16_t x1, int16_t x2, int16_t y, image_color_t color);
void image_draw_vline(image_data_t image, int16_t x, int16_t y1, int16_t y2, image_color_t color);
void image_draw_line(image_data_t image, int16_t x1, int16_t y1, int16_t x2, int16_t y2, image_color_t color);
void image_draw_rect(image_data_t image, int16_t x, int16_t y, uint16_t w, uint16_t h, image_color_t color);
void image_fill_rect(image_data_t image, int16_t x, int16_t y, uint16_t w, uint16_t h, image_color_t color);
#ifdef __cplusplus
}

View File

@ -1,5 +1,35 @@
#pragma once
#define abs(x) (((x) < 0) ? -(x): (x))
#define max(a, b) (((a) > (b)) ? (a): (b))
#define min(a, b) (((a) < (b)) ? (a): (b))
#include <stdbool.h>
#define M_PI 3.14159265359
#define M_PI_2 1.57079632679
#define abs(x) (((x) < 0) ? -(x) : (x))
#define max(a, b) (((a) > (b)) ? (a) : (b))
#define min(a, b) (((a) < (b)) ? (a) : (b))
#ifdef __cplusplus
extern "C" {
#endif
static inline bool isnan(double x) {
return x != x;
}
static inline bool isinf(double x) {
return !isnan(x) && isnan(x - x);
}
float sinf(float x);
static inline float cosf(float x) {
return sinf(x + M_PI_2);
}
static inline float tanf(float x) {
return sinf(x) / cosf(x);
}
float fmodf(float x, float y);
#ifdef __cplusplus
}
#endif

View File

@ -6,7 +6,11 @@ extern "C" {
#include <stdbool.h>
#include <stdint.h>
#include <limits.h>
#include <stddef.h>
#define RAND_MAX INT_MAX
extern unsigned char __heap_base;
#define IMPORT(name) __attribute__((import_module("env"), import_name(#name)))
@ -23,7 +27,7 @@ int memcmp(const void* s1, const void* s2, size_t n);
IMPORT(log) void printf(const char* format, ...);
EXPORT(__srand) void srand(uint64_t seed);
uint64_t rand(void);
int rand(void);
#ifdef __cplusplus
}

View File

@ -24,46 +24,54 @@ static inline void set_point(image_data_t image, uint16_t x, uint16_t y, image_c
image.pixels[x + y * image.width] = color;
}
void image_draw_point(image_data_t image, uint16_t x, uint16_t y, image_color_t color) {
if (x >= image.width || y >= image.height) {
void image_draw_point(image_data_t image, int16_t x, int16_t y, image_color_t color) {
if (x >= image.width || y >= image.height || x < 0 || y < 0) {
return;
}
set_point(image, x, y, color);
}
void image_draw_hline(image_data_t image, uint16_t x1, uint16_t x2, uint16_t y, image_color_t color) {
void image_draw_hline(image_data_t image, int16_t x1, int16_t x2, int16_t y, image_color_t color) {
if (y < 0 || y >= image.height) {
return;
}
if (x1 > x2) {
uint16_t temp = x1;
x1 = x2;
x2 = temp;
}
if (x1 > image.width) {
if (x1 > image.width || x2 < 0) {
return;
}
x1 = max(0, x1);
x2 = min(x2, image.width);
do {
image_draw_point(image, x1++, y, color);
set_point(image, x1++, y, color);
} while (x1 < x2);
}
void image_draw_vline(image_data_t image, uint16_t x, uint16_t y1, uint16_t y2, image_color_t color) {
void image_draw_vline(image_data_t image, int16_t x, int16_t y1, int16_t y2, image_color_t color) {
if (x < 0 || x >= image.width) {
return;
}
if (y1 > y2) {
uint16_t temp = y1;
y1 = y2;
y2 = temp;
}
if (y1 > image.width) {
if (y1 > image.width || y2 < 0) {
return;
}
y1 = max(0, y1);
y2 = min(y2, image.height);
do {
image_draw_point(image, x, y1++, color);
set_point(image, x, y1++, color);
} while (y1 < y2);
}
void image_draw_line(image_data_t image, uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2, image_color_t color) {
void image_draw_line(image_data_t image, int16_t x1, int16_t y1, int16_t x2, int16_t y2, image_color_t color) {
int dx = abs(x2 - x1);
int dy = abs(y2 - y1);
int sx = (x1 < x2) ? 1 : -1;
@ -72,10 +80,13 @@ void image_draw_line(image_data_t image, uint16_t x1, uint16_t y1, uint16_t x2,
int e2;
while (1) {
if (x1 >= image.width || y1 >= image.height) {
if ((x1 >= image.width && x2 >= image.width) || (y1 >= image.height && y2 >= image.height)) {
break;
}
set_point(image, x1, y1, color);
if ((x1 < 0 && x2 < 0) || (y1 < 0 && y2 < 0)) {
break;
}
image_draw_point(image, x1, y1, color);
if (x1 == x2 && y1 == y2) {
break;
}
@ -91,7 +102,14 @@ void image_draw_line(image_data_t image, uint16_t x1, uint16_t y1, uint16_t x2,
}
}
void image_draw_rect(image_data_t image, uint16_t x, uint16_t y, uint16_t w, uint16_t h, image_color_t color) {
void image_draw_rect(image_data_t image, int16_t x, int16_t y, uint16_t w, uint16_t h, image_color_t color) {
if (w == 0 || h == 0) {
return;
}
w = min(image.width - x, w);
h = min(image.height - y, h);
image_draw_hline(image, x, x + w - 1, y, color);
image_draw_hline(image, x, x + w, y + h - 1, color);
@ -99,7 +117,15 @@ void image_draw_rect(image_data_t image, uint16_t x, uint16_t y, uint16_t w, uin
image_draw_vline(image, x + w - 1, y, y + h - 1, color);
}
void image_fill_rect(image_data_t image, uint16_t x, uint16_t y, uint16_t w, uint16_t h, image_color_t color) {
void image_fill_rect(image_data_t image, int16_t x, int16_t y, uint16_t w, uint16_t h, image_color_t color) {
if (w == 0 || h == 0) {
return;
}
x = max(0, x);
y = max(0, y);
w = min(image.width - x, w);
h = min(image.height - y, h);
while (h--) {
image_draw_hline(image, x, x + w, y++, color);
};

327
build/assets/lib/math.c Normal file
View File

@ -0,0 +1,327 @@
#include <math.h>
#include <stdbool.h>
float sinf(float x) {
static const float lookup_table[256] = {
0.0f, // 0
0.0061599463f, // 1
0.012319659f, // 2
0.018478904f, // 3
0.024637448f, // 4
0.030795058f, // 5
0.036951497f, // 6
0.043106537f, // 7
0.049259938f, // 8
0.055411477f, // 9
0.061560903f, // 10
0.067708001f, // 11
0.073852524f, // 12
0.079994254f, // 13
0.086132944f, // 14
0.092268363f, // 15
0.098400272f, // 16
0.10452846f, // 17
0.11065269f, // 18
0.1167727f, // 19
0.12288829f, // 20
0.12899922f, // 21
0.13510525f, // 22
0.14120616f, // 23
0.14730169f, // 24
0.15339166f, // 25
0.1594758f, // 26
0.16555387f, // 27
0.17162569f, // 28
0.17769097f, // 29
0.18374951f, // 30
0.1898011f, // 31
0.19584547f, // 32
0.20188241f, // 33
0.2079117f, // 34
0.21393308f, // 35
0.21994635f, // 36
0.2259513f, // 37
0.23194765f, // 38
0.2379352f, // 39
0.24391371f, // 40
0.24988301f, // 41
0.25584278f, // 42
0.26179287f, // 43
0.26773301f, // 44
0.27366298f, // 45
0.27958259f, // 46
0.28549159f, // 47
0.29138973f, // 48
0.29727685f, // 49
0.30315268f, // 50
0.309017f, // 51
0.31486961f, // 52
0.32071021f, // 53
0.32653871f, // 54
0.33235481f, // 55
0.33815828f, // 56
0.34394893f, // 57
0.3497265f, // 58
0.35549083f, // 59
0.36124167f, // 60
0.36697879f, // 61
0.372702f, // 62
0.37841105f, // 63
0.38410574f, // 64
0.38978586f, // 65
0.39545122f, // 66
0.40110153f, // 67
0.40673664f, // 68
0.41235632f, // 69
0.41796035f, // 70
0.42354852f, // 71
0.4291206f, // 72
0.43467644f, // 73
0.44021577f, // 74
0.44573835f, // 75
0.45124406f, // 76
0.45673263f, // 77
0.46220389f, // 78
0.4676576f, // 79
0.47309354f, // 80
0.47851157f, // 81
0.48391145f, // 82
0.48929292f, // 83
0.49465582f, // 84
0.5f, // 85
0.5053252f, // 86
0.5106312f, // 87
0.51591784f, // 88
0.52118486f, // 89
0.52643216f, // 90
0.53165948f, // 91
0.53686661f, // 92
0.54205334f, // 93
0.54721951f, // 94
0.55236501f, // 95
0.55748945f, // 96
0.56259274f, // 97
0.5676747f, // 98
0.57273513f, // 99
0.57777381f, // 100
0.58279061f, // 101
0.58778524f, // 102
0.59275758f, // 103
0.59770751f, // 104
0.60263467f, // 105
0.60753894f, // 106
0.6124202f, // 107
0.61727822f, // 108
0.62211281f, // 109
0.6269238f, // 110
0.63171101f, // 111
0.63647425f, // 112
0.6412133f, // 113
0.64592808f, // 114
0.65061831f, // 115
0.65528381f, // 116
0.65992457f, // 117
0.66454017f, // 118
0.66913062f, // 119
0.67369562f, // 120
0.67823511f, // 121
0.68274885f, // 122
0.68723667f, // 123
0.69169843f, // 124
0.69613391f, // 125
0.70054305f, // 126
0.70492554f, // 127
0.70928127f, // 128
0.71361017f, // 129
0.7179119f, // 130
0.72218645f, // 131
0.72643358f, // 132
0.73065311f, // 133
0.73484498f, // 134
0.7390089f, // 135
0.74314487f, // 136
0.74725252f, // 137
0.75133187f, // 138
0.75538272f, // 139
0.7594049f, // 140
0.76339829f, // 141
0.76736265f, // 142
0.77129793f, // 143
0.775204f, // 144
0.77908057f, // 145
0.78292763f, // 146
0.78674495f, // 147
0.79053241f, // 148
0.79428989f, // 149
0.7980172f, // 150
0.8017143f, // 151
0.80538094f, // 152
0.809017f, // 153
0.81262237f, // 154
0.81619692f, // 155
0.81974047f, // 156
0.82325292f, // 157
0.82673419f, // 158
0.83018404f, // 159
0.83360237f, // 160
0.8369891f, // 161
0.84034407f, // 162
0.84366715f, // 163
0.84695822f, // 164
0.8502171f, // 165
0.8534438f, // 166
0.85663807f, // 167
0.8597998f, // 168
0.86292899f, // 169
0.86602545f, // 170
0.86908895f, // 171
0.87211949f, // 172
0.875117f, // 173
0.87808126f, // 174
0.8810122f, // 175
0.8839097f, // 176
0.88677371f, // 177
0.88960397f, // 178
0.89240056f, // 179
0.8951633f, // 180
0.89789206f, // 181
0.90058666f, // 182
0.90324718f, // 183
0.90587342f, // 184
0.90846527f, // 185
0.91102266f, // 186
0.91354549f, // 187
0.91603357f, // 188
0.91848695f, // 189
0.92090553f, // 190
0.92328912f, // 191
0.92563766f, // 192
0.9279511f, // 193
0.93022931f, // 194
0.93247223f, // 195
0.93467975f, // 196
0.93685186f, // 197
0.93898833f, // 198
0.94108927f, // 199
0.94315445f, // 200
0.94518387f, // 201
0.94717735f, // 202
0.94913495f, // 203
0.95105654f, // 204
0.95294201f, // 205
0.95479131f, // 206
0.95660442f, // 207
0.95838124f, // 208
0.96012163f, // 209
0.96182567f, // 210
0.96349317f, // 211
0.96512407f, // 212
0.96671838f, // 213
0.96827602f, // 214
0.9697969f, // 215
0.97128105f, // 216
0.97272825f, // 217
0.97413862f, // 218
0.97551197f, // 219
0.9768483f, // 220
0.97814763f, // 221
0.97940975f, // 222
0.98063475f, // 223
0.98182255f, // 224
0.9829731f, // 225
0.98408633f, // 226
0.98516226f, // 227
0.98620075f, // 228
0.98720181f, // 229
0.9881655f, // 230
0.98909163f, // 231
0.98998022f, // 232
0.99083126f, // 233
0.99164468f, // 234
0.99242049f, // 235
0.99315864f, // 236
0.99385911f, // 237
0.99452192f, // 238
0.99514693f, // 239
0.99573416f, // 240
0.99628365f, // 241
0.9967953f, // 242
0.99726915f, // 243
0.99770516f, // 244
0.99810332f, // 245
0.99846363f, // 246
0.99878597f, // 247
0.99907047f, // 248
0.99931705f, // 249
0.99952573f, // 250
0.99969643f, // 251
0.99982923f, // 252
0.99992412f, // 253
0.99998105f, // 254
1.0f // 255
};
x = fmodf(x, 2.0f * (float)M_PI);
if (x < 0) x += 2.0f * (float)M_PI;
float reference_angle;
int sign = 1;
if (x <= (float)M_PI_2) {
reference_angle = x;
} else if (x <= (float)M_PI) {
reference_angle = (float)M_PI - x;
} else if (x <= 3.0f * (float)M_PI_2) {
reference_angle = x - (float)M_PI;
sign = -1;
} else {
reference_angle = 2.0f * (float)M_PI - x;
sign = -1;
}
float position = reference_angle * (255.0f / ((float)M_PI / 2.0f));
int i = (int)position;
float interpolated;
if (i >= 255) {
interpolated = lookup_table[255];
} else {
float fractional = position - i;
interpolated = lookup_table[i] + fractional * (lookup_table[i + 1] - lookup_table[i]);
}
return sign * interpolated;
}
float fmodf(float x, float y) {
if (y == 0.0 || isnan(x) || isnan(y)) {
return (0.0 / 0.0);
}
bool neg = x < 0.0;
float ax = neg ? -x : x;
float ay = (y < 0.0) ? -y : y;
if (ax < ay) {
return x;
}
float tmp = ay;
while (tmp <= ax) {
tmp *= 2.0f;
}
if (isinf(tmp)) {
return 0;
}
while (tmp > ay) {
tmp *= 0.5f;
if (ax >= tmp) {
ax -= tmp;
}
}
return neg ? -ax : ax;
}

View File

@ -122,12 +122,14 @@ void* realloc(void* block, size_t size) {
header_t* header;
void* ret;
if (!block || !size)
if (!block || !size) {
return malloc(size);
}
header = (header_t*)block - 1;
if (header->size >= size)
if (header->size >= size) {
return block;
}
ret = malloc(size);
if (ret) {
@ -171,11 +173,14 @@ int memcmp(const void* s1, const void* s2, size_t n) {
static uint64_t rand_state;
void srand(uint64_t seed) { rand_state = seed; }
void srand(uint64_t seed) {
rand_state = seed;
}
uint64_t rand(void) {
int rand(void) {
uint64_t z = (rand_state += 0x9e3779b97f4a7c15);
z = (z ^ (z >> 30)) * 0xbf58476d1ce4e5b9;
z = (z ^ (z >> 27)) * 0x94d049bb133111eb;
return z ^ (z >> 31);
int r = (int)(z ^ (z >> 31));
return r < 0 ? -r : r;
}

View File

@ -1,23 +1,228 @@
#include <graphics.h>
#include <math.h>
#include <stdlib.h>
static image_data_t image;
static image_color_t color;
static uint16_t current_x;
static uint16_t current_y;
EXPORT(step) void step() {
// for (int i = 0; i < 1; i++) {
// int x1 = rand() % image.width;
// int y1 = rand() % image.height;
// int x2 = rand() % image.width;
// int y2 = rand() % image.height;
// image_fill_rect(image, x1, y1, x2 - x1, y2 - y1, {(uint32_t)(rand() | 0xFF000000)});
// }
static void _moveto(uint16_t x, uint16_t y) {
current_x = x;
current_y = y;
}
static void _lineto(uint16_t x, uint16_t y) {
image_draw_line(image, current_x, current_y, x, y, color);
_moveto(x, y);
}
// D E F I N E S ///////////////////////////////////////////////////////////
#define NUM_ASTEROIDS 10
#define ERASE 0
#define DRAW 1
// T Y P E D E F S ///////////////////////////////////////////////////////////
// the structure for a vertex
typedef struct vertex_typ {
float x, y; // a single point in the 2-D plane.
} vertex, *vertex_ptr;
// the structure for an object
typedef struct object_typ {
int num_vertices; // number of vertices in this object
uint32_t color; // color of object
float xo, yo; // position of object
float x_velocity; // x velocity of object
float y_velocity; // y velocity of object
float scale; // scale factor
float angle; // rotation rate
vertex vertices[16]; // 16 vertices
} object, *object_ptr;
object asteroids[NUM_ASTEROIDS];
void Scale_Object(object_ptr object, float scale) {
int index;
// for all vertices scale the x and y component
for (index = 0; index < object->num_vertices; index++) {
object->vertices[index].x *= scale;
object->vertices[index].y *= scale;
} // end for index
} // end Scale_Object
//////////////////////////////////////////////////////////////////////////////
void Rotate_Object(object_ptr object, float angle) {
int index;
float x_new, y_new, cs, sn;
// pre-compute sin and cos
cs = cosf(angle);
sn = sinf(angle);
// for each vertex rotate it by angle
for (index = 0; index < object->num_vertices; index++) {
// rotate the vertex
x_new = object->vertices[index].x * cs - object->vertices[index].y * sn;
y_new = object->vertices[index].y * cs + object->vertices[index].x * sn;
// store the rotated vertex back into structure
object->vertices[index].x = x_new;
object->vertices[index].y = y_new;
} // end for index
} // end Rotate_Object
//////////////////////////////////////////////////////////////////////////////
void Create_Field(void) {
int index;
for (index = 0; index < NUM_ASTEROIDS; index++) {
// fill in the fields
asteroids[index].num_vertices = 6;
asteroids[index].color = 0xFF000000 | (rand());
asteroids[index].xo = 41 + rand() % (image.width - 82);
asteroids[index].yo = 41 + rand() % (image.height - 82);
asteroids[index].x_velocity = -3 + rand() % 6;
asteroids[index].y_velocity = -3 + rand() % 6;
asteroids[index].scale = (float)(rand() % 30) / 10;
asteroids[index].angle = (float)(-5 + (float)(rand() % 10)) / 100;
printf("xo=%f, yo=%f, xv=%f, yv=%f, r=%d\n", asteroids[index].xo, asteroids[index].yo, asteroids[index].x_velocity, asteroids[index].y_velocity, rand() % 6);
asteroids[index].vertices[0].x = 4.0;
asteroids[index].vertices[0].y = 3.5;
asteroids[index].vertices[1].x = 8.5;
asteroids[index].vertices[1].y = -3.0;
asteroids[index].vertices[2].x = 6;
asteroids[index].vertices[2].y = -5;
asteroids[index].vertices[3].x = 2;
asteroids[index].vertices[3].y = -3;
asteroids[index].vertices[4].x = -4;
asteroids[index].vertices[4].y = -6;
asteroids[index].vertices[5].x = -3.5;
asteroids[index].vertices[5].y = 5.5;
// now scale the asteroid to proper size
Scale_Object((object_ptr)&asteroids[index], asteroids[index].scale);
} // end for index
} // end Create_Field
//////////////////////////////////////////////////////////////////////////////
void Draw_Asteroids(int erase) {
int index, vertex;
float xo, yo;
for (index = 0; index < NUM_ASTEROIDS; index++) {
// draw the asteroid
if (erase == ERASE) {
color.color = 0xFF000000;
} else {
color.color = asteroids[index].color;
}
// get position of object
xo = asteroids[index].xo;
yo = asteroids[index].yo;
// moveto first vertex
_moveto((int)(xo + asteroids[index].vertices[0].x), (int)(yo + asteroids[index].vertices[0].y));
for (vertex = 1; vertex < asteroids[index].num_vertices; vertex++) {
_lineto((int)(xo + asteroids[index].vertices[vertex].x), (int)(yo + asteroids[index].vertices[vertex].y));
} // end for vertex
// close object
_lineto((int)(xo + asteroids[index].vertices[0].x), (int)(yo + asteroids[index].vertices[0].y));
} // end for index
} // end Draw_Asteroids
//////////////////////////////////////////////////////////////////////////////
void Translate_Asteroids() {
int index;
for (index = 0; index < NUM_ASTEROIDS; index++) {
// translate current asteroid
asteroids[index].xo += asteroids[index].x_velocity;
asteroids[index].yo += asteroids[index].y_velocity;
// collision detection i.e. bounds check
if (asteroids[index].xo > image.width - 40 || asteroids[index].xo < 40) {
asteroids[index].x_velocity = -asteroids[index].x_velocity;
asteroids[index].xo += asteroids[index].x_velocity;
}
if (asteroids[index].yo > image.height - 40 || asteroids[index].yo < 40) {
asteroids[index].y_velocity = -asteroids[index].y_velocity;
asteroids[index].yo += asteroids[index].y_velocity;
}
} // end for index
} // end Translate_Asteroids
//////////////////////////////////////////////////////////////////////////////
void Rotate_Asteroids(void) {
int index;
for (index = 0; index < NUM_ASTEROIDS; index++) {
// rotate current asteroid
Rotate_Object((object_ptr)&asteroids[index], asteroids[index].angle);
} // end for index
} // end Rotate_Asteroids
EXPORT(cpptest) image_data_t* cpptest(uint16_t w, uint16_t h) {
image = image_create(w, h);
image_fill_rect(image, 0, 0, w, h, {0xFF000000});
Create_Field();
return &image;
}
EXPORT(step) void step() {
Draw_Asteroids(ERASE);
// transform field
Rotate_Asteroids();
Translate_Asteroids();
// draw field
Draw_Asteroids(DRAW);
}