Updated so that updateHeading normalizes the Ucmd to a PWM duty cycle within 0 - 100 percent

Normalization occurs given the maximum Actuator Command (Ucmd) that can occur, so that all Ucmd will lie within a 0 - 100 percent duty cycle.