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 //TODO: Surely we'll need to do something here?
52 // 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 if (s->id >= pow(10, FILENAMESIZE))
69 Fatal("Too many sensors! FILENAMESIZE is %d; increase it and recompile.", FILENAMESIZE);
71 sprintf(s->filename, "%d", s->id);
72 unlink(s->filename); //TODO: Move old files somewhere
74 Log(LOGDEBUG, "Initialised sensor %d; binary file is \"%s\"", id, s->filename);
79 * Run the main sensor polling loop
80 * @param arg - Cast to Sensor* - Sensor that the thread will handle
81 * @returns NULL (void* required to use the function with pthreads)
83 void * Sensor_Main(void * arg)
85 Sensor * s = (Sensor*)(arg);
87 while (true) //TODO: Exit condition
89 // The sensor will write data to a buffer until it is full
90 // Then it will open a file and dump the buffer to the end of it.
93 // The reason I've added the buffer is because locks are expensive
94 // But maybe it's better to just write data straight to the file
95 // I'd like to do some tests by changing SENSOR_DATABUFSIZ
97 while (s->write_index < SENSOR_DATABUFSIZ)
99 s->buffer[s->write_index] = GetData(s->id);
103 //Log(LOGDEBUG, "Filled buffer");
105 // CRITICAL SECTION (no threads should be able to read/write the file at the same time)
106 pthread_mutex_lock(&(s->mutex));
108 // Open binary file and dump buffer into it
109 FILE * file = fopen(s->filename, "wb");
112 Fatal("Couldn't open file \"%s\" mode wb - %s", s->filename, strerror(errno));
114 fseek(file, 0, SEEK_END);
115 int amount_written = fwrite(s->buffer, sizeof(DataPoint), SENSOR_DATABUFSIZ, file);
116 if (amount_written != SENSOR_DATABUFSIZ)
118 Fatal("Wrote %d data points and expected to write %d to \"%s\" - %s", amount_written, SENSOR_DATABUFSIZ, strerror(errno));
121 Log(LOGDEBUG, "Wrote %d data points for sensor %d", amount_written, s->id);
125 pthread_mutex_unlock(&(s->mutex));
126 // End of critical section
128 s->write_index = 0; // reset position in buffer