Fixed mat_multiply, now fully functional