Added entities and matrix stacks.
Fixed lighting bug and cleaned up mesh.cpp