Added implementations and unit tests for further vector and matrix functions. Note not all tests currently passing. Added BSD Licence and copyright notice headers to files.