expm function with taylor series done