First function done

Still need to update cache function for matrix inverse