diff --git a/main.c b/main.c index f0b684bbd4fdcb7a41a0884d38ced27bcec9307c..45296d4d892b7f12786a4554ef8e5b4dd19d774e 100644 --- a/main.c +++ b/main.c @@ -82,16 +82,20 @@ int main(int argc, char const *argv[]) { scanf("%d %d %d", &tuplas[i].x, &tuplas[i].y, &tuplas[i].t); } + int frame = 0; + for(int i=0; i < t_size; ++i) { // Pega o ângulo entre a posição do robô e o próximo ponto + frame += tuplas[i].t; double angle = angleFromOrigin(tuplas[i].x, tuplas[i].y); - fprintf(graph, "r %f\n", angle - r.theta); + //printf("DEBUG: %f %f\n", angle, r.theta); + fprintf(graph, "%d %d %d %f\n", tuplas[i].x, tuplas[i].y, frame, angle - r.theta); // Gira o robô r.theta = angle; // calcula a velocidade para as rodas distancia = distance(r.x, r.y, tuplas[i].x, tuplas[i].y); velocidade = velocity(distancia, tuplas[i].t); - fprintf(graph, "w %f\n", velocidade); + fprintf(graph, "%f\n", velocidade); moverRobo(&r,tuplas[i].x,tuplas[i].y); }