Add toeplitz function

Add a function to create Toeplitz matrix for the given vector.  Unit
test included.