Fix one bug related to alpha and beta order
Fix one bug related to alpha and beta order

1. Fix the order of alpha and beta order in the output arrays
2. Add code reverse calculate the x y z from the alpha beta theta
paul356/calc_angle