mavlink: Add manual SP subscription