Added navdata stream and fixed some memory errors