Beginning to fill out the matrix/vector maths