Sorry for the delayed response.
Are you using the default param file or have you made any changes to it?
I am attaching the default param file. Please verify any differences with the file at
copter.parm (2.0 KB)
I have tested waypoint, position setpoint and velosity setpoint and the vehicle’s roll/pitch and alt performance is just fine.