Some fixes, unit_vector almost done but matrix-input doesnt work yet