LCOM1920-T5G03

#include <lcom/lcf.h>

#include "sprite.h"

#include "graph.h"

#include "utils.h"

#include "fast_math.h"

#include <math.h>

struct sprite{

    int16_t x, y;

    uint16_t w, h;

    int16_t u0, v0;

    float theta;

    uint8_t *map;

};

sprite_t* (sprite_ctor)(const char **xpm, int u0, int v0){

    sprite_t *ret = (sprite_t*)malloc(sizeof(sprite_t));

    if(ret == NULL) return NULL;

    enum xpm_image_type type = XPM_8_8_8_8;

    xpm_image_t img;

    ret->map = xpm_load((xpm_map_t)xpm, type, &img);

    if(ret->map == NULL){

        free(ret);

        return NULL;

    }

    ret->x = 0;

    ret->y = 0;

    ret->w = img.width;

    ret->h = img.height;

    ret->u0 = u0;

    ret->v0 = u0;

    ret->theta = 0;

    return ret;

}

void (sprite_dtor)(sprite_t *p){

    if(p == NULL) return;

    if(p->map) free(p->map);

    free(p);

}

void (sprite_set_x)     (sprite_t *p, int16_t x){ p->x = x; }

void (sprite_set_y)     (sprite_t *p, int16_t y){ p->y = y; }

void (sprite_set_pos)   (sprite_t *p, int16_t x, int16_t y){ sprite_set_x(p, x); sprite_set_y(p, y); }

void (sprite_set_angle) (sprite_t *p, double angle){ p->theta = angle; }

void (sprite_set_center)(sprite_t *p, int16_t u0, int16_t v0){ p->u0 = u0; p->v0 = v0; }

int sprite_get_x(const sprite_t *p){ return p->x; }

int sprite_get_y(const sprite_t *p){ return p->y; }

int sprite_get_w(const sprite_t *p){ return p->w; }

int sprite_get_h(const sprite_t *p){ return p->h; }

void (sprite_src2pic)(const sprite_t *p, int16_t x, int16_t y, int16_t *u, int16_t *v){

    int16_t dx = x - p->x;

    int16_t dy = y - p->y;

    double s = fm_sin(p->theta);

    double c = fm_cos(p->theta);

    *u = dx*c - dy*s + p->u0;

    *v = dx*s + dy*c + p->v0;

}

void (sprite_draw)(const sprite_t *p){

    const int16_t diag = sqrt(p->w*p->w + p->h*p->h)+2;

    int16_t u, v;

    for(int16_t y = max(0,p->y-diag); y < min(p->y+diag,graph_get_YRes()); ++y){

        for(int16_t x = max(0,p->x-diag); x < min(p->x+diag,graph_get_XRes()); ++x){

            sprite_src2pic(p, x, y, &u, &v);

            if(0 <= u && u < p->w && 0 <= v && v < p->h){

                uint8_t *m = p->map + (v*p->w + u)*4;

                uint32_t color = SET_RGB(*(m+2), *(m+1), *(m));

                graph_set_pixel_alpha(p->x + x, p->y + y, color, *(m+3));

            }

        }

    }

}