Add function code

Added code to cache solve a matrix