Fix unnormed vector in post-crash collision detection

• The norm of a vector was being calculated but not assigned
• Optimize inefficient zero length test of a vector

Closes #259 (closed)