Updated Block Piece Code

Ugh too much maths.