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 sprintf(filename, "%d", s->id);
75 unlink(filename); //TODO: Move old files somewhere
77 s->file = fopen(filename, "a+b"); // open binary file
78 Log(LOGDEBUG, "Initialised sensor %d; binary file is \"%s\"", id, filename);
83 * Run the main sensor polling loop
84 * @param arg - Cast to Sensor* - Sensor that the thread will handle
85 * @returns NULL (void* required to use the function with pthreads)
87 void * Sensor_Main(void * arg)
89 Sensor * s = (Sensor*)(arg);
91 while (true) //TODO: Exit condition
93 // The sensor will write data to a buffer until it is full
94 // Then it will open a file and dump the buffer to the end of it.
97 // The reason I've added the buffer is because locks are expensive
98 // But maybe it's better to just write data straight to the file
99 // I'd like to do some tests by changing SENSOR_DATABUFSIZ
101 while (s->write_index < SENSOR_DATABUFSIZ)
103 s->buffer[s->write_index] = GetData(s->id);
107 //Log(LOGDEBUG, "Filled buffer");
109 // CRITICAL SECTION (no threads should be able to read/write the file at the same time)
110 pthread_mutex_lock(&(s->mutex));
111 fseek(s->file, 0, SEEK_END);
112 int amount_written = fwrite(s->buffer, sizeof(DataPoint), SENSOR_DATABUFSIZ, s->file);
113 if (amount_written != SENSOR_DATABUFSIZ)
115 Fatal("Wrote %d data points and expected to write %d to \"%s\" - %s", amount_written, SENSOR_DATABUFSIZ, strerror(errno));
117 Log(LOGDEBUG, "Wrote %d data points for sensor %d", amount_written, s->id);
118 pthread_mutex_unlock(&(s->mutex));
119 // End of critical section
121 s->write_index = 0; // reset position in buffer