First working attempt at C66x UKF port