Add vector constants for axis units
Fix tests
Use Matrix::{identity,zero} functions instead of MatN::{identity,zero}