smaccmpilot: Add d term to Ivory PID.
smaccmpilot: Update altitude controller after PID update.

- Add d term variables to PID structure.
- Pass in measured rate as well as error to "update_pid".