Added auxilary functions to replace matrix multiplication
Added MeshPoint and CollocationPoint