Shadow mapping working

TODO: Refactor, and clean code, like ASAP