Function round_cone 

pub fn round_cone(
    p: [f32; 3],
    a: [f32; 3],
    b: [f32; 3],
    r1: f32,
    r2: f32,
) -> f32