Moving smoothly in discrete units

function cPlayer::onLevelLoaded(%this, %scenegraph)
{
//	echo("cPlayer::onLevelLoaded(%this, %scenegraph);");
	$player = %this;

	moveMap.bindCmd(keyboard, "w", "playerUp();", "playerUpStop();");
	moveMap.bindCmd(keyboard, "s", "playerDown();", "playerDownStop();");
	moveMap.bindCmd(keyboard, "a", "playerLeft();", "playerLeftStop();");
	moveMap.bindCmd(keyboard, "d", "playerRight();", "playerRightStop();");

	%this.gridSize = 2;
	%this.ready = true;
}

function cPlayer::onWorldLimit(%this)
{
	%this.ready = true;
	%this.updateMovement();
}

function cPlayer::onPositionTarget(%this)
{
	// Called when target reaches moveTo destination
//	echo("cPlayer::onPositionTarget(%this);");
//	echo("Position:" SPC %this.getPosition());
	%this.ready = true;
	%this.updateMovement();
}

function cPlayer::updateMovement(%this)
{
//	echo("cPlayer::updateMovement();");
//	echo("Ready:" SPC %this.ready);
	if(%this.ready && %this.key1 !$= "")
	{
		%this.ready = false;
		$pos = %this.getPosition();
		$X = mFloor(getWord($pos, 0) / %this.gridSize) * %this.gridSize;
		$Y = mFloor(getWord($pos, 1) / %this.gridSize) * %this.gridSize;
//		echo("Position:" SPC $pos SPC "-" SPC $X SPC $Y);
//		echo("Direction:" SPC %this.key);
		switch$ (%this.key1)
		{
			case "up":
				$Y -= %this.gridSize;
			case "down":
				$Y += %this.gridSize;
			case "left":
				$X -= %this.gridSize;
			case "right":
				$X += %this.gridSize;
			default:
				// Note, moveTo's callback does not fire if you are already AT the target location
				%this.ready = true;
		}
//		echo("moveTo:" SPC $X SPC $Y);
		%this.moveTo($X, $Y, %this.speed, true, true);
	}
}


function cPlayer::addKey(%this, %key)
{
	// Adds key to beginning of buffer
	%this.removeKey(%key);
//	echo("cPlayer::addKey(%this, " @ %key @ ");");
	%this.key4 = %this.key3;
	%this.key3 = %this.key2;
	%this.key2 = %this.key1;
	%this.key1 = %key;
}

function cPlayer::removeKey(%this, %key)
{
//	echo("cPlayer::removeKey(%this, " @ %key @ ");");
	// removes key from buffer, and shifts later keys to the beginning
	switch$ (%key)
	{
		case %this.key1:
			%this.key1 = %this.key2;
			%this.key2 = %this.key3;
			%this.key3 = %this.key4;
			%this.key4 = "stop";
		case %this.key2:
			%this.key2 = %this.key3;
			%this.key3 = %this.key4;
			%this.key4 = "stop";
		case %this.key3:
			%this.key3 = %this.key4;
			%this.key4 = "stop";
		case %this.key4:
			%this.key4 = "stop";
	}		
}


function playerUp()
{
//	echo("playerUp();");
	$player.addKey("up");
	$player.updateMovement();
}

function playerDown()
{
//	echo("playerDown();");
	$player.addKey("down");
	$player.updateMovement();
}

function playerLeft()
{
//	echo("playerLeft();");
	$player.addKey("left");
	$player.updateMovement();
}

function playerRight()
{
//	echo("playerRight();");
	$player.addKey("right");
	$player.updateMovement();
}

function playerUpStop()
{
//	echo("playerUpStop();");
	$player.removeKey("up");
	$player.updateMovement();
}

function playerDownStop()
{
//	echo("playerDownStop();");
	$player.removeKey("down");
	$player.updateMovement();
}

function playerLeftStop()
{
//	echo("playerLeftStop();");
	$player.removeKey("left");
	$player.updateMovement();
}

function playerRightStop()
{
//	echo("playerRightStop();");
	$player.removeKey("right");
	$player.updateMovement();
}