Changed calculation of high_step_specification_msg.step_elevation (line 564 of...

Changed calculation of high_step_specification_msg.step_elevation (line 564 of node_vision.py) and removed all delete statements as they were not necessary.

Related to #22