Added quat. addition. Added clamp function. General const correctness