3D self-positioning algorithm based on joint DDoA-ToA