Simulation of a Waist-Trunk System for a Humanoid Robot -- Safe Navigation in Dynamic