[fix] use Angles.h in kalman angle diff