Add bts tajectory feedback control