#include <math.h>
#include <stdlib.h>
#include "SceneGraphRoot.h"
#include "MainLoop.h"
#include "ball_bound.h"


// prototype
static void ball_move(SceneGraphPtr node, void *sgroot_, int screen_w, int screen_h);
static void ball_collision(SceneGraphPtr node, void *sgroot_, int screen_w, int screen_h, SceneGraphPtr tree);
static void ball_collision_idle(SceneGraphPtr, void *sgroot_, int w, int h, SceneGraphPtr tree);


static float vy = 0.0f; // y 方向速度
static float dt = 1.0/1.0f; // frame rate 

static float e = -0.8f;  // 反発係数
static float g = 9.8f;  // 重力加速度
//static float v0 = 0.0f; // 初速は 0

static float h0; // 初期高さ
static float ball_radius = 100.0f;

static float speed = 10.0f;

static void
ball_move_idle2(SceneGraphPtr node, void *sgroot_, int screen_w, int screen_h)
{
    SceneGraphRoot *sgroot = (SceneGraphRoot *)sgroot_;
    Pad *pad = sgroot->getController();

    if (pad->circle.isHold()) {
        if (pad->left.isHold()) {
	    node->xyz[0] -= speed;
	    if(node->xyz[0] < ball_radius)
	        node->xyz[0] = ball_radius;
	} else if (pad->right.isHold()) {
	    node->xyz[0] += speed;
	    if(node->xyz[0] > screen_w  - ball_radius)
	        node->xyz[0] = screen_w - ball_radius;
	}
	
	if (pad->up.isHold()) {
	    node->xyz[1] -= speed;
	} else if (pad->down.isHold()) {
	    node->xyz[1] += speed;
            if(node->xyz[1] > screen_h - ball_radius)
	        node->xyz[1] = screen_h - ball_radius;
	}
    } else {
        node->set_move_collision(ball_move, ball_collision);
    }
}

static int time_val = 0;

static void
ball_move_idle(SceneGraphPtr node, void *sgroot_, int screen_w, int screen_h)
{
    SceneGraphRoot *sgroot = (SceneGraphRoot *)sgroot_;
    Pad *pad = sgroot->getController();

    if (pad->circle.isPush()) {
        node->set_move_collision(ball_move_idle2, ball_collision_idle);
	time_val = 0;
    }

    time_val++;

    if (time_val > 90) {
        float w = (float)random();
	
	w = fmodf(w, screen_w - ball_radius*2);
	node->xyz[0] = w + ball_radius;
	node->xyz[1] = h0;
	node->set_move_collision(ball_move, ball_collision);
	time_val = 0;
    }
}

static void
ball_move(SceneGraphPtr node, void *sgroot_, int screen_w, int screen_h)
{
    vy += g * dt;
    node->xyz[1] += vy * dt;
    //    node->xyz[0] += 10.0f;
}

static void
ball_collision_idle(SceneGraphPtr, void *sgroot_, int w, int h, SceneGraphPtr tree)
{
}

static void
ball_collision(SceneGraphPtr node, void *sgroot_, int screen_w, int screen_h,
			   SceneGraphPtr tree)
{
    if (node->xyz[1] > screen_h - ball_radius) {
        node->xyz[1] = screen_h - ball_radius;
	
	vy *= e;
	if (vy > -g && vy < 0) {
	    vy = 0.0;
	    node->set_move_collision(ball_move_idle, ball_collision_idle);
	}
    }
}

static const char *collada_file="collada_file/sample.dae";//"collada_file/ball.dae";
static const char *name="Cube";

MainLoopPtr 
ball_bound::init(Viewer *sgroot, int screen_w, int screen_h)
{
    SceneGraphPtr ball;
    
    // 固定した値で srandom すると、毎回同じ、random() 列が生成される
    // random な値が欲しいなら、man random に方法が書いてあります。
    srandom(100);

    sgroot->createFromCOLLADAfile(collada_file);

    //sgroot->OnLightSysSwitch();

    SceneGraphPtr light = sgroot->getLight(0);
    sgroot->OnLightSwitch(0);
    light->xyz[0] = screen_w / 2;
    light->xyz[1] = screen_h / 2;
    light->xyz[2] = -100;
    ball = sgroot->createSceneGraph(name);
    ball->set_move_collision(ball_move, ball_collision);

    h0 = screen_h/2;
    h0 = -1000;

    ball->xyz[0] = screen_w/2;
    //ball->xyz[0] = 0.0f;
    ball->xyz[1] = h0;
    ball->xyz[2] = 30.0f;

    sgroot->setSceneData(ball);

    return sgroot;
}

extern Application *
application() {
    return new ball_bound();
}

const char *usr_help_str = "Usage: ./test_nogl [OPTION]\n";

extern int init(TaskManager *manager, int argc, char *argv[]);
extern void task_initialize();
static void TMend(TaskManager *manager);

int
TMmain(TaskManager *manager, int argc, char *argv[])
{
    for(int i=1; i<argc; i++){
        if (argv[i][0] == '-' && argv[i][1] == 's') {
	    i++;
	    collada_file=argv[i];
	} else if (argv[i][0] == '-' && argv[i][1] == 'n') {
	    i++;
	    name = argv[i];
	}
    }
    task_initialize();
    manager->set_TMend(TMend);
    return init(manager, argc, argv);

}

void
TMend(TaskManager *manager)
{
    printf("test_nogl end\n");
}

/* end */