Assuming it’s the controller and not your altitude estimate start by setting the parameter MPC_THR_HOVER appropriately and you may also need to change MPC_THR_MIN depending on your vehicle. After that look at tuning the altitude controller (MPC_Z_*).
Give that a try and if you’re still having trouble please post a flight log (http://logs.px4.io/).