add euler angle function

add quat2euler.m
add quatnorm