(C++) INPC

/*
 * Desenvolvimento de INPC
 * Por Bruno da Silva
 *
 * Baseado no projeto RNPC de Mauzen, e Procedural .rec Generator de Joe Staff
 *
*/

#include <cstdlib>
#include <iostream>
#include <stdio.h>
#include <cmath>

using namespace std;

#define sendeg(a)                                          todeg(sin (a))

#define cosdeg(a)                                          todeg(cos (a))

#define PI 3.14159265

#define pow2(a)                                            ((a) * (a))

#define distance(aa,ab,ac,ba,bb,bc)                        sqrt(pow2(aa - ba) + pow2(ab - bb) + pow2(ac - bc))




void EscreverRota(char * c, int tempo, short leftright, short updown, short addkey, float x, float y, float z, float wq, float zq, int vida, int colete, int armaid, int acao, float velocidadex, float velocidadey, float velocidadez, float surfx, float surfy, float surfz, short surfid, short animeid, short animeidx) {


    c[0] = (tempo & 0x000000FF);
    c[1] = (tempo & 0x0000FF00) >> 8;
    c[2] = (tempo & 0x00FF0000) >> 16;
    c[3] = (tempo & 0xFF000000) >> 24;

    c[4] = (leftright & 0x00FF);
    c[5] = (leftright & 0xFF00) >> 8;

    c[6] = (updown & 0x00FF);
    c[7] = (updown & 0xFF00) >> 8;

    c[8] = (addkey & 0x00FF);
    c[9] = (addkey & 0xFF00) >> 8;


    char * fstrx = (char*) &x;

    c[10] = fstrx[0];
    c[11] = fstrx[1];
    c[12] = fstrx[2];
    c[13] = fstrx[3];

    char * fstry = (char*) &y;

    c[14] = fstry[0];
    c[15] = fstry[1];
    c[16] = fstry[2];
    c[17] = fstry[3];

    char * fstrz = (char*) &z;

    c[18] = fstrz[0];
    c[19] = fstrz[1];
    c[20] = fstrz[2];
    c[21] = fstrz[3];

    char * fstrw = (char*) &wq;

    c[22] = fstrw[0];
    c[23] = fstrw[1];
    c[24] = fstrw[2];
    c[25] = fstrw[3];
    float null = 0.0;

    char * fstrn = (char*) &null;

    c[26] = fstrn[0];
    c[27] = fstrn[1];
    c[28] = fstrn[2];
    c[29] = fstrn[3];

    c[30] = fstrn[0];
    c[31] = fstrn[1];
    c[32] = fstrn[2];
    c[33] = fstrn[3];

    char * fstrzq = (char*) &zq;

    c[34] = fstrzq[0];
    c[35] = fstrzq[1];
    c[36] = fstrzq[2];
    c[37] = fstrzq[3];

    c[38] = vida;
    c[39] = colete;
    c[40] = armaid;
    c[41] = acao;

    char * fstrvx = (char*) &velocidadex;
    c[42] = fstrvx[0];
    c[43] = fstrvx[1];
    c[44] = fstrvx[2];
    c[45] = fstrvx[3];


    char * fstrvy = (char*) &velocidadey;
    c[46] = fstrvy[0];
    c[47] = fstrvy[1];
    c[48] = fstrvy[2];
    c[49] = fstrvy[3];

    char * fstrvz = (char*) &velocidadez;
    c[50] = fstrvz[0];
    c[51] = fstrvz[1];
    c[52] = fstrvz[2];
    c[53] = fstrvz[3];

    for(int i = 54; i <68; i++) c[i] = 0;

    c[68] = (animeid & 0x00FF);
    c[69] = (animeid & 0xFF00) >> 8;
    c[70] = (animeidx & 0x00FF);
    c[71] = (animeidx & 0xFF00) >> 8;



}

int main(int argc, char *argv[])
{

    /////////// CONFIGURAÇÕES ///////////////////////////////////

    float FOOT_RATE = 130.0;

    float objetivoX = 2158.33;
    float objetivoY = 1343.12;
    float objetivoZ = 15.36;

    float origemX  = 1958.33;
    float origemY = 1343.12;
    float origemZ = 15.36;

    float velocidade = 0.0015;

    //////////////////////////////////////////////////

    float distancia = distance(origemX, origemY, origemZ, objetivoX, objetivoY, objetivoZ);

    float angulo =   (atan2(objetivoY - origemY,  objetivoX - origemX));


    float tempo = distancia / velocidade ;

    float blocos =   tempo / FOOT_RATE  ;

    float velocidadeX =  cos(angulo) * velocidade;
    float velocidadeY =  sin(angulo) * velocidade;

    float velocidadeZ =  0.0;

    angulo = (-angulo) / 0.01745329251 + 90.0F;

    float passosX  = (objetivoX - origemX) /  blocos;
    float passosY  = (objetivoY - origemY) /  blocos;

    float passosZ  = (objetivoZ - origemZ) /  blocos;


    angulo = angulo / 114.591559157;

    float x, y;
    float wq = cos(angulo);
    float zq = sin(angulo);

    char header[8] = {
        (char)
        0xE8 ,
        0x03 ,
        0x00 ,
        0x00 ,

        0x01 ,

        0x00 ,
        0x00 ,
        0x00
    } ;

    FILE * npcFile = fopen("npc.rec", "wb");


    fwrite(header, 1, 8, npcFile);

    float passoAtual = 0.0 ;

    tempo = tempo / blocos;

    int correr = velocidade > 0.0020 ? 0x00FF : 0xFFFF;

    if(blocos > 500) {
        printf("ATENCAO. Arquivos maiores que 500 blocos podem não funcionar corretamente \n\nFaça seu NPC andar distancias mais curtas\n\n");

    }
    while(blocos) {

        char script[73];

        float x = origemX + (passosX * passoAtual);
        float y = origemY + (passosY * passoAtual);
        float z = origemZ + (passosZ * passoAtual);

        int vida = 100;
        int colete = 0;
        int arma = 0;
        int acao = 0;



        EscreverRota(script, (short)round(tempo * passoAtual), 0,  correr, 0, x, y, z, wq, zq, vida, colete, arma, acao, velocidadeX, velocidadeY, velocidadeZ,  0.0, 0.0,0.0, 0, 0, 0);

        passoAtual += 1.0;

        fwrite(script, 1, 72, npcFile);


        if(passoAtual > blocos - 2) break;

    }

    fclose(npcFile);




    system("PAUSE");


    return EXIT_SUCCESS;

}