Moved code to start little library. Fixed up poor coding styles. Replaced float arrays with glm vectors