capsule_init Function

    function capsule_init(a, b, r, optProp, layer, transform) result(out)
        !! Initalising function for capsule SDF.

        type(capsule) :: out
        
        !> Capsule startpoint
        type(vector),            intent(IN) :: a
        !> Capsule endpoint
        type(vector),            intent(IN) :: b
        !> Capsule radius
        real(kind=wp),           intent(IN) :: r
        !> ID number of sdf
        integer,                  intent(IN) :: layer
        !> Optional transform to apply to SDF
        real(kind=wp),  optional, intent(IN) :: transform(4, 4)
        !> Optical properties of the SDF
        type(opticalProp_t),      intent(in) :: optProp

        real(kind=wp) :: t(4, 4)

        if(present(transform))then
            t = transform
        else
            t = identity()
        end if

        out%a = a
        out%b = b
        out%r = r
        out%layer = layer
        out%transform = t

        out%optProps = optProp

    end function capsule_init