Costs;Legged Locomotion;Trajectory;Dynamics;Collision Avoidance;Stability Analysis;Predictive Control;Quadrupedal Robots;Full-Body MPC;collision Avoidance;DDP