Marine Navigation in 3D with AIS Powered Collision Avoidance