c3point.m

无线传感器网络路由算法

%求三个圆所相交部分的三个交点坐标(fn1x,fn1y),(fn2x,fn2y),(fn3x,fn3y)
%三个圆(圆心为x1,y1半径为r1。圆心为x2,y2半径为r2。圆心为x3,y3半径为r3)
function [fn1x,fn1y,fn2x,fn2y,fn3x,fn3y]=c3point(x1,y1,r1,x2,y2,r2,x3,y3,r3)
    %求第一个交点坐标
    [rp1x,rp1y,rp2x,rp2y]=c2point(x1,y1,r1,x2,y2,r2);
    if dist(rp1x,rp1y,x3,y3)<dist(rp2x,rp2y,x3,y3)
        fn1x=rp1x;
        fn1y=rp1y;
    else
        fn1x=rp2x;
        fn1y=rp2y;
    end
    %求第二个交点坐标
    [rp1x,rp1y,rp2x,rp2y]=c2point(x1,y1,r1,x3,y3,r3);
    if dist(rp1x,rp1y,x2,y2)<dist(rp2x,rp2y,x2,y2)
        fn2x=rp1x;
        fn2y=rp1y;
    else
        fn2x=rp2x;
        fn2y=rp2y;
    end
    %求第三个交点坐标
    [rp1x,rp1y,rp2x,rp2y]=c2point(x2,y2,r2,x3,y3,r3);
    if dist(rp1x,rp1y,x1,y1)<dist(rp2x,rp2y,x1,y1)
        fn3x=rp1x;
        fn3y=rp1y;
    else
        fn3x=rp2x;
        fn3y=rp2y;
    end