#include <math.h>
#include "vacuum.h"
#include "SceneGraphRoot.h"
#include "SGList.h"
#define ENCOUNT 55
using namespace std;

static float vacuum_speed = 10.0f;


/*オブジェクト毎にファイルを分けてみた
 *
 *
 */



void
no_move_idle(SceneGraphPtr node, int screen_w, int screen_h)
{

}

void
no_collision_idle(SceneGraphPtr node, int screen_w, int screen_h,SceneGraphPtr tree)
{

}

void
vacuum_coll(SceneGraphPtr node, int screen_w, int screen_h,
            SceneGraphPtr tree)
{
    Pad *pad = sgroot->getController();

    if(node->frame%ENCOUNT == ENCOUNT-1) {
      if(random()%2) {
      add_cubecollision_object(REDCUBE,node,screen_w,screen_h);
      }
      else {
      add_cubecollision_object(ENEMY,node,screen_w,screen_h);
      }
    }

    if (pad->cross.isHold()) {
      SceneGraphIteratorPtr it = sgroot->getIterator(tree);
      collision_red(it,node);
      it = sgroot->getIterator(tree);
      collision_purple(it,node,screen_w,screen_h);
    }

    else if(pad->circle.isHold()) {
      SceneGraphIteratorPtr it = sgroot->getIterator(tree);
      lock_attack(node,it);
    }

}

void
lock_attack(SceneGraphPtr node,SceneGraphIteratorPtr it)
{

  SceneGraphPtr enemy;
  SceneGraphPtr near_enemy = NULL;
  float dx,dy,r,range = 100;
  // Pad *pad = sgroot->getController();

  for(;it->hasNext(ENEMY);) {

      it->next(ENEMY);
      enemy = it->get();
      dx = enemy->xyz[0] - node->xyz[0];
      dy = enemy->xyz[1] - node->xyz[1];
      r = sqrt(dx*dx+dy*dy);

      if(range > r && enemy->stack_xyz[2] == 0) {
        range = r;
        near_enemy = enemy;
      }
  }


  if(near_enemy != NULL) {
    /*stack_xyz[2]をlockonフラグとして使うかな?*/
    SceneGraphPtr lockon;
    //    SceneGraphPtr near_enemy_common_move = near_enemy->parent;
    near_enemy->stack_xyz[2] = 1;
    lockon = sgroot->createSceneGraph(LOCK);
    lockon->set_move_collision(no_move_idle,lockon_collision);
    //near_enemy_common_move->addChild(lockon);
    near_enemy->addChild(lockon);
    }

}

void
lockon_collision(SceneGraphPtr node,int w,int h,SceneGraphPtr tree) {

  Pad *pad = sgroot->getController();
  SceneGraphPtr lockon_enemy = node->parent;

  /* node->angle[0] = -lockon_enemy->angle[0];
  node->angle[1] = -lockon_enemy->angle[1];
  node->angle[2] = -lockon_enemy->angle[2];*/

  if(pad->circle.isRelease()) {
    lockon_enemy->remove();
  }

}


void
vacuum_move(SceneGraphPtr node , int w, int h)
{
    Pad *pad = sgroot->getController();

    if (pad->right.isHold() && w > node->xyz[0]) {
      node->xyz[0] += vacuum_speed;
      node->angle[0] += 2;
    } else if (pad->left.isHold() && 0 < node->xyz[0]) {
      node->xyz[0] -= vacuum_speed;
      node->angle[0] -= 2;
    }

    if (pad->up.isHold() && 0 < node->xyz[1]) {
      node->xyz[1] -= vacuum_speed;
      node->angle[1] -= 2;
    } else if (pad->down.isHold() && h > node->xyz[1]) {
      node->xyz[1] += vacuum_speed;
      node->angle[1] += 2;
    }

    if (pad->start.isPush()) {
      node->xyz[0] = w/2;
      node->xyz[1] = h*0.8;
    }
}



/*cubeをランダムな場所に生成*/
void
add_cubecollision_object(int id,SceneGraphPtr root,int w,int h)
{
    SceneGraphPtr object;
    SceneGraphPtr common_move;

    common_move = sgroot->createSceneGraph();
    object = sgroot->createSceneGraph(id);
    object->xyz[0] = random()%w;
    object->xyz[1] = random()%h;
    object->set_move_collision(no_move_idle,cube_collision);
    //common_move->addChild(object);
    root->addBrother(object);
}


void
vacuum_init2(TaskManager *manager, int w, int h)
{
    SceneGraphPtr title;

    sgroot->createFromXMLfile(manager, "xml_file/gamecube.xml");
    sgroot->createFromXMLfile(manager, "xml_file/title.xml");
    sgroot->createFromXMLfile(manager, "xml_file/gameover.xml");

    title = sgroot->createSceneGraph(TITLE);
    title->xyz[0] = w/2;
    title->xyz[1] = h/2;
    title->set_move_collision(no_move_idle, title_collision);

    sgroot->setSceneData(title);
}