[FIX] Fix angular speed reference