求助江湖救急，程序设计作业，语法没有问题，程序到底是哪里出错了？

是2023年安徽省机器人大赛程序设计赛道的一个题，计算两点间的距离，同时要求绕过可能在中间的一个球，我的思路是，如果AB不与圆相交，直接输出AB间距离即可，如果与圆相交，那么用联立方程解出两个交点，A到离其最近的交点P1的距离，再使用Haversine公式算出P1,P2在球上的最短距离，再使用B到离其最近点的距离，三者相加即可，可无论怎样都无法输出测试的样例