Low Swap Gps-Denied Navigation For Uavs Via Lidar Informed Flight Trajectories