ClassiCube/ClassicalSharp/Particles/CollidableParticle.cs

using System;
using ClassicalSharp.Entities;
using OpenTK;

namespace ClassicalSharp.Particles {

	public abstract class CollidableParticle : Particle {
		
		const float gravity = 3.4f; 
		//const float gravity = 0.7f; // TODO: temp debug
		
		public CollidableParticle( Game game, Vector3 pos, Vector3 velocity, double lifetime )
			: base( game, pos, velocity, lifetime ) {
		}

		public override bool Tick( double delta ) {
			lastPos = Position = nextPos;
			byte curBlock = game.World.SafeGetBlock( (int)Position.X, (int)Position.Y, (int)Position.Z );
			if( !CanPassThrough( curBlock ) ) return true;
			
			Velocity.Y -= gravity * (float)delta;
			int startY = (int)Math.Floor( Position.Y );
			Position += Velocity * (float)delta * 3;
			int endY = (int)Math.Floor( Position.Y );
			Utils.Clamp( ref Position.X, 0, game.World.Width - 0.01f );
			Utils.Clamp( ref Position.Z, 0, game.World.Length - 0.01f );
			
			if( Velocity.Y > 0 ) {
				for( int y = startY; y <= endY && TestY( y, false ); y++ );
			} else {
				for( int y = startY; y >= endY && TestY( y, true ); y-- );
			}
			nextPos = Position;
			Position = lastPos;
			return base.Tick( delta );
		}
		
		bool TestY( int y, bool topFace ) {
			if( y < 0 ) {
				Position.Y = nextPos.Y = lastPos.Y = 0 + Entity.Adjustment;
				Velocity = Vector3.Zero;
				return false;
			}
			
			byte block = game.World.SafeGetBlock( (int)Position.X, y, (int)Position.Z );
			if( CanPassThrough( block ) ) return true;
			
			float collideY = y;
			if( topFace )
				collideY += game.BlockInfo.Height[block];
			
			bool collide = topFace ? (Position.Y < collideY) : (Position.Y > collideY );
			if( collide ) {
				float adjust = topFace ? Entity.Adjustment : -Entity.Adjustment;
				Position.Y = nextPos.Y = lastPos.Y = collideY + adjust;
				Velocity = Vector3.Zero;
				return false;
			}
			return true;
		}
		
		bool CanPassThrough( byte block ) {
			return block == 0 || game.BlockInfo.IsSprite[block] || game.BlockInfo.IsLiquid[block];
		}
	}
}