Do you mean changing:
Code:
incrementV = verticalDestination - verticalPosition;
to
Code:
incrementV = verticalPosition - verticalDestination;
Now I wish I read the comments
Code:
// TODO: Check to see if this needs to be reversed
// you may need to reverse this based on your vertical servo installation