solver code optimization
step() code optimizations
changed default settings for quaternion normalization to the safest possible.