Add optional initialization of base pose and feet pose in the Unicycle Trajectory Generator

Add optional initialization of base pose and feet pose in the Unicycle Trajectory Generator #6691