Hey there. I’m facing an issue - using offboard mode and suddenly as the drone trying to reach a different altitude, the velocity and altitude will sudden increase drastically to the ceiling.
1 - What is your setup? If you are not using DJI ESCs please change ur airframe to Generic Quad.
2 - I see that you are having lots of vibrations. Try to fix it.
3 - What are you relying on for your altitude? If it is a sonar sensor, then try a lidar or another range sensor.