Added Anton's matrix code as separate file
Written lots of functions