Colours and other small updates

Added colours, scaling, and fixed some mistakes in the code, aswell as cleaned up code and wrote missing javadocs.

In addition finshed the 3D solution.