There are filtering methods that are designed to ignore some data points that are much different than the previous datapoints that would get around the tall weed (a simple low pass to the more advanced Kalman) and to keep the boom from going above a certain level a simple heightmax can be set in the code so the boom does not exceed heightmax.