GIRRT Motion Planning Algorithm for Humanoid Robot