Use norm2 where appropriate

Description

Replace the calculations on norms by norm2 intrinsic functions when possible.

The same applies for the dot products of a vector with itself.

Closes #532 (closed)