Cleaned up and figured out how to multiple matrix