using System;
using System.Collections;
using System.Collections.Generic;
using System.Linq;
using Assets;
using UnityEngine;
using UnityEngine.iOS;
using VinteR.Model.Gen;

public class Tracker : MonoBehaviour
{

	public VinterClient VinterClient;
	public float _xOffset;
	public float _yOffset;
	public float _zOffset;

	private String TrackedObjectName;
	private Vector3 _position;
	private Quaternion _rotation;

	// Use this for initialization
	void Start () {
		VinterClient.MocapFrameReceived += VinterClientOnMocapFrameReceived;
		TrackedObjectName = transform.name;
	}

	private void VinterClientOnMocapFrameReceived(MocapFrame frame)
	{
		var body = frame.Bodies.SingleOrDefault(b => b.Name.Equals(TrackedObjectName));
		if (body != null)
		{
			_position = new Vector3(body.Centroid.Z * 0.001f +_xOffset, body.Centroid.Y * 0.001f +_yOffset, body.Centroid.X * 0.001f + _zOffset);
			transform.position = _position;

			var quaternion = new Quaternion(body.Rotation.Z, body.Rotation.Y, body.Rotation.X, -body.Rotation.W);
			_rotation = Quaterniona.Euler(quaternion.eulerAngles.x, quaternion.eulerAngles.y, quaternion.eulerAngles.z);
			transform.rotation = _rotation;
		}
	}
}