#include "Player.h"

#include <iostream>
#include <sstream>
#include <cstring>
#include <cmath>

#include <allegro5/allegro.h>
#include <allegro5/allegro_primitives.h>

using namespace std;

Player::Player()
{
   this->id = 0;
   this->name = "";
   this->password = "";
   this->pos.x = this->target.x = 0;
   this->pos.y = this->target.y = 0;
   this->timeLastUpdated = 0;
   this->team = 0;   // blue team by default
   this->hasBlueFlag = false;
   this->hasRedFlag = false;
}

Player::Player(const Player& p)
{
   this->id = p.id;
   this->name = p.name;
   this->password = p.password;
   this->pos.x = p.pos.x;
   this->pos.y = p.pos.y;
   this->target.x = p.target.x;
   this->target.y = p.target.y;
   this->addr = p.addr;
      this->team = 0;   // blue team by default
   this->hasBlueFlag = false;
   this->hasRedFlag = false;
}

Player::Player(string name, string password)
{
   this->id = 0;
   this->name = name;
   this->password = password;
   this->pos.x = this->target.x = 200;
   this->pos.y = this->target.y = 200;
   this->team = 0;   // blue team by default
   this->hasBlueFlag = true;
   this->hasRedFlag = true;
}

Player::~Player()
{
}

void Player::serialize(char* buffer)
{
   memcpy(buffer, &this->id, 4);
   memcpy(buffer+4, &this->pos.x, 4);
   memcpy(buffer+8, &this->pos.y, 4);
   memcpy(buffer+12, &this->target.x, 4);
   memcpy(buffer+16, &this->target.y, 4);
   memcpy(buffer+20, &this->team, 4);
   memcpy(buffer+24, &this->hasBlueFlag, 1);
   memcpy(buffer+25, &this->hasRedFlag, 1);
   strcpy(buffer+26, this->name.c_str());
}

void Player::deserialize(char* buffer)
{
   memcpy(&this->id, buffer, 4);
   memcpy(&this->pos.x, buffer+4, 4);
   memcpy(&this->pos.y, buffer+8, 4);
   memcpy(&this->target.x, buffer+12, 4);
   memcpy(&this->target.y, buffer+16, 4);
   memcpy(&this->team, buffer+20, 4);
   memcpy(&this->hasBlueFlag, buffer+24, 1);
   memcpy(&this->hasRedFlag, buffer+25, 1);
   this->name.assign(buffer+26);
}

void Player::setId(int id)
{
   this->id = id;
}

void Player::setAddr(sockaddr_in addr)
{
   this->addr = addr;
}

bool Player::move(WorldMap *map) {
   int speed = 100; // pixels per second
   unsigned long long curTime = getCurrentMillis();
   bool moveCanceled = false;

   // if we're at our target, don't move
   if (pos.x != target.x || pos.y != target.y) {
      float pixels = speed * (curTime-timeLastUpdated) / 1000.0;
      double angle = atan2(target.y-pos.y, target.x-pos.x);
      float dist = sqrt(pow(target.x-pos.x, 2) + pow(target.y-pos.y, 2));
      FLOAT_POSITION newPos;

      //cout << "pos.x: " << pos.x << endl;
      //cout << "pos.y: " << pos.y << endl;
      //cout << "target.x: " << target.x << endl;
      //cout << "target.y: " << target.y << endl;

      if (dist <= pixels) {
         newPos.x = target.x;
         newPos.y = target.y;
      }else {
         newPos.x = pos.x + cos(angle)*pixels;
         newPos.y = pos.y + sin(angle)*pixels;
      }

      //cout << "newPos.x: " << newPos.x << endl;
      //cout << "newPos.y: " << newPos.y << endl;
      //cout << "newPos.x/25: " << newPos.x/25 << endl;
      //cout << "newPos.y/25: " << newPos.y/25 << endl;

      switch(map->getElement(newPos.x/25, newPos.y/25)) {
      case WorldMap::TERRAIN_NONE:
      case WorldMap::TERRAIN_ROCK:
         cout << "Encountered invalid terrain" << endl;
         target.x = pos.x;
         target.y = pos.y;
         moveCanceled = true;
         cout << "move canceled" << endl;
         break;
      default: // if there are no obstacles
         pos.x = newPos.x;
         pos.y = newPos.y;
         break;
      }
   }

   timeLastUpdated = curTime;

   if (moveCanceled)
      cout << "moveCancled == true" << endl;

   return !moveCanceled;
}