Add pose correction for Z element using a depth image.
Using the median of a 3x3 neighborhood instead of the exact spot
Only apply Z correction from depth when there is a depth image
Update launch file