#include <string.h>
#include <math.h>
#include "scene_graph_pack.h"
#include "sys.h"
using namespace std;

#include "error.h"

int
update_sgp(SceneGraphPack *sgp, SceneGraphPack *_sgp)
{
    SceneGraphNodePtr node;
    float y_angle;

    __debug("[%s]\n", __FUNCTION__);

    for (int i = 0; i < sgp->info.size; i++) {
	//(*my_func[node->move])(node);
	//(*my_func[node->interaction])(node, sgp);

	node = &sgp->node[i];

	// 本当は、ここは上の my_func で行う
	y_angle = node->angle[1];
	y_angle += 1.0f;
	if (y_angle > 360.0f) y_angle = 0.0f;
	node->angle[1] = y_angle;
	//node->obj_pos[0] += 0.5f;
	//node->obj_pos[1] += 0.5f;
	//node->obj_pos[2] += 0.5f;

	if (node->pn != -1) {
	    get_matrix(node->translation,
		       node->angle, node->obj_pos,
		       sgp->node[node->pn].translation);
	} else {
	    get_matrix(node->translation,
		       node->angle, node->obj_pos,
		       NULL);
	}
    }

    // まあこれは多分駄目なんだけど。
    // in/out と update は分ける必要ある？
    // それはユーザ側で in/out になるように書かせるもの？
    memcpy(_sgp, sgp, sizeof(SceneGraphPack));
  
    //return sizeof(SceneGraphPack);
    return 0;
}