sensor_init.cpp

来自「一个很棒的网络控制系统仿真软件」· C++ 代码 · 共 45 行

#define S_FUNCTION_NAME sensor_init

#include "ttkernel.cpp"

// Periodic Sensor Node 

// code function
double sensor_code(int seg, void *data) {
  static double *y;
  switch (seg) {
  case 1:
    y = new double;
    *y = ttAnalogIn(1);
    return 0.0005;
  case 2:
    ttSendMsg(1, 4, y, 10); // Send measurement (10 bytes) to node 4 (controller)
    return 0.0004;
  case 3:
    return FINISHED;
  }
}

double msgRcvhandler(int seg, void *data)
{
  printf("ERROR: sensor received a message!\n");
  return FINISHED;
}

void init()
{
  ttInitKernel(1,0,FP);

  // Sensor task
  ttCreatePeriodicTask("sensor_task", 0.0, 0.010, 1, sensor_code);

  // Initialize network
  ttCreateInterruptHandler("msgRcv", 1, msgRcvhandler);
  ttInitNetwork(3, "msgRcv"); // I am node 3
}


void cleanup() {

}