early version of 3d angle computation for position - NOT STABLE [fix]
early version of 3d angle computation for position - NOT STABLE [fix]

KevinHCChen/wireless-aoa,KevinHCChen/wireless-aoa,KevinHCChen/wireless-aoa