Angle math

maybe correct?
Merge branch 'master' of https://github.com/vincerp/KinectUnityProject