#include "Robot.h"

//用戶設(shè)置的想要轉(zhuǎn)動的轉(zhuǎn)角
static double angle = 0;
//用戶設(shè)置的要發(fā)射炮彈的能量
static double power = 0;
//當前方向
static double heading = 0;
//當前的發(fā)單準備時間
static long prepareTime = 0;

//最大轉(zhuǎn)動速度
static const double MAX_VELOCITY_TURN = (25 * 3.14 / 180);

///////////////////////////////////////////////////////////////////
//設(shè)置所要轉(zhuǎn)動的度數(shù),用于控制炮管的方向
void turnGun(double a){ angle = a; }

// 發(fā)射炮彈
void fire(double p){ power = p; }
	
// 得到用戶想用轉(zhuǎn)動的度數(shù)的剩余量
double getGunTurnRemaining(){ return angle; }

// 得到用戶將要發(fā)射的炮彈的能量
double getFirePower(){ return power;	}

// 得到當前的炮管方向
double getGunHeading(){ return heading;	}
	
// 得到準備發(fā)彈的時間
long getGunPrepareTime(){ return prepareTime; }

// 設(shè)置當前方向
void setGunHeading(double h)
{
	heading = h;
    
	//重新計算要轉(zhuǎn)的角度
    if (angle >= 0)
	{
	    if( angle < MAX_VELOCITY_TURN )
			angle = 0;
		else angle -= MAX_VELOCITY_TURN;
	}else{
		if( angle > - MAX_VELOCITY_TURN )
		    angle = 0;
		else angle += MAX_VELOCITY_TURN;
	}
 }
	
// 設(shè)置發(fā)單的準備時間
void setGunPrepareTime(long t)
{
	prepareTime = t;
    power = 0;
}