Fixed initialization of HRP-2