Extract BaroPID calculation into separate method.

This reduces indentation level, separates method concerns, keeps logic
with method intent, removes the need for a comment and makes it
testable.