add color to pedestal_link_collision and base_link_collision