Code changes now so that it takes the current value of heading to hold initially and then the value is changed as the pilot gives stick input