Changed identity matrix function
diagMatrix function added
Matrix addition added
Added Prolog-C bridge demo files