proximitysensor.m

来自「用于matlab仿真程序。可用在无线传感器网络中。」· M 代码 · 共 39 行

function [obst, nodePos, ballSeen, ballPos] = proximitySensor(nodeID)

global xPos yPos xBall yBall noticeBall

moteradius = 0.8;
tol = 2*moteradius;
nodePos.xPos=100;
nodePos.yPos=100;
ballPos.xBall=100;
ballPos.yBall=100;
ballSeen = 0;
myX = xPos(nodeID);
myY = yPos(nodeID);
distToBall=sqrt((xBall-myX)^2+(yBall-myY)^2);
%Noden kan se bollen om den 鋜 innom dess synf鋖t vilket 鋜 8*toll.
if(distToBall<8*tol)
  ballSeen = 1;
  ballPos.xBall=xBall;
  ballPos.yBall=yBall;
end

for k=1:length(xPos)
  if (k~=nodeID)
    dist = sqrt( (myX-xPos(k))^2 + (myY-yPos(k))^2 );
    
    if dist < tol
      obst = 1;
      return;
    end
    if (dist < 6*tol)
      nodePos.xPos = xPos(k);
      nodePos.yPos = yPos(k);
    end
    
  end
end

obst = 0;