correct error in formula, use radians for angle

seems to work correctly with simple tests