Function add_body 

pub(crate) fn add_body(
    dispatch: &mut Dispatch<'_, Playground>,
    domain: DomainHandle<EuclideanR4>,
    entity: Entity,
    polytope: Polytope4,
    pose: Pose<EuclideanR4>,
) -> Result<(), Rejection>