new function to normalize quaternions and major clean up (subfolder, naming and removed not used functions)