calculateFinalVectors is no longer thread safe
adding RETFIE to ISRs