Doing some code cleanup
Added some Tests and basic piece movement