node_red_init.m

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

function node_red_init(argument)

% Slave, gets reference from Base station

global xPos yPos xVel yVel Kx Ky

nodeID = argument;

% Initialize TrueTime kernel
ttInitKernel(4, 2, 'prioFP'); % nbrOfInputs, nbrOfOutputs, fixed priority

% Position controller in timer handler
data.u1 = 0;
data.u2 = 0;
data.Ix = 0;
data.Iy = 0;
data.xvel=0;
data.yvel=0;
data.Tix = 0.7;
data.Tiy = 0.7;
data.K1 = Kx(nodeID);
data.K2 = Ky(nodeID);
data.xref = xPos(nodeID);
data.yref = yPos(nodeID);
data.nodeID = nodeID;
data.waiting = 0;
data.master = 1; % node 1 is my master

ttCreateEvent('nodePacket');
ttCreateTask('Ctrl',0.05,1,'redCtrlcode',data);
ttCreateJob('Ctrl');

prio = 1; % higher priority to get new refs through while
          % controller in segment 3
% Initialize network
ttCreateInterruptHandler('nw_handler', 1, 'redMsgRcvSlave');
ttInitNetwork(nodeID, 'nw_handler');

ttCreateMailbox('packets', 10);