Fixed some bugs
Some minor fixes
Added color to point structure