3 * @purpose Implementation of sensor thread
4 * TODO: Finalise implementation
14 * Read a data value from a sensor; block until value is read
15 * @param sensor_id - The ID of the sensor
16 * @returns The current value of the sensor
18 DataPoint GetData(int sensor_id)
20 // switch based on the sensor_id at the moment for testing;
21 // might be able to just directly access ADC from sensor_id?
22 //TODO: Implement for real sensors
25 //TODO: Deal with time stamps properly
34 d.value = (float)(rand() % 100) / 100;
37 Fatal("Unknown sensor id: %d", sensor_id);
40 usleep(100000); // simulate delay in sensor polling
47 * @param s - Sensor to destroy
49 void Destroy(Sensor * s)
51 // Maybe move the binary file into long term file storage?
59 * @param s - Sensor to initialise
61 void Sensor_Init(Sensor * s, int id)
67 #define FILENAMESIZE 4
68 char filename[FILENAMESIZE];
69 if (s->id >= pow(10, FILENAMESIZE))
71 Fatal("Too many sensors! FILENAMESIZE is %d; increase it and recompile.", FILENAMESIZE);
74 pthread_mutex_init(&(s->mutex), NULL);
76 sprintf(filename, "%d", s->id);
77 unlink(filename); //TODO: Move old files somewhere
79 s->file = fopen(filename, "a+b"); // open binary file
80 Log(LOGDEBUG, "Initialised sensor %d; binary file is \"%s\"", id, filename);
85 * Run the main sensor polling loop
86 * @param arg - Cast to Sensor* - Sensor that the thread will handle
87 * @returns NULL (void* required to use the function with pthreads)
89 void * Sensor_Main(void * arg)
91 Sensor * s = (Sensor*)(arg);
93 while (true) //TODO: Exit condition
95 // The sensor will write data to a buffer until it is full
96 // Then it will open a file and dump the buffer to the end of it.
99 // The reason I've added the buffer is because locks are expensive
100 // But maybe it's better to just write data straight to the file
101 // I'd like to do some tests by changing SENSOR_DATABUFSIZ
103 while (s->write_index < SENSOR_DATABUFSIZ)
105 s->buffer[s->write_index] = GetData(s->id);
109 //Log(LOGDEBUG, "Filled buffer");
111 // CRITICAL SECTION (no threads should be able to read/write the file at the same time)
112 pthread_mutex_lock(&(s->mutex));
113 fseek(s->file, 0, SEEK_END);
114 int amount_written = fwrite(s->buffer, sizeof(DataPoint), SENSOR_DATABUFSIZ, s->file);
115 if (amount_written != SENSOR_DATABUFSIZ)
117 Fatal("Wrote %d data points and expected to write %d to \"%s\" - %s", amount_written, SENSOR_DATABUFSIZ, strerror(errno));
119 Log(LOGDEBUG, "Wrote %d data points for sensor %d", amount_written, s->id);
120 pthread_mutex_unlock(&(s->mutex));
121 // End of critical section
123 s->write_index = 0; // reset position in buffer