drashna/qmk_firmware
1
0
Fork 0
Code Activity Actions

Working triple buffering

Browse source
This commit is contained in:
Fred Sundvik 2016-02-21 01:07:44 +02:00
parent 8e2d70d11f
commit b7059d35f9
4 changed files with 74 additions and 10 deletions
Download patch file Download diff file Expand all files Collapse all files

37
serial_link/protocol/triple_buffered_object.c
View file

@ -23,6 +23,7 @@ SOFTWARE.
*/
#include "protocol/triple_buffered_object.h"
#include "system/system.h"
#define GET_READ_INDEX() object->state & 3
#define GET_WRITE_INDEX() (object->state >> 2) & 3
@ -42,11 +43,21 @@ void triple_buffer_init(triple_buffer_object_t* object) {
SET_DATA_AVAILABLE(0);
}
static void triple_buffer_begin_read(uint16_t object_size, triple_buffer_object_t* object) {
uint8_t shared_index = GET_SHARED_INDEX();
uint8_t read_index = GET_READ_INDEX();
SET_READ_INDEX(shared_index);
SET_SHARED_INDEX(read_index);
static bool triple_buffer_begin_read(uint16_t object_size, triple_buffer_object_t* object) {
serial_link_lock();
if (GET_DATA_AVAILABLE()) {
uint8_t shared_index = GET_SHARED_INDEX();
uint8_t read_index = GET_READ_INDEX();
SET_READ_INDEX(shared_index);
SET_SHARED_INDEX(read_index);
SET_DATA_AVAILABLE(false);
serial_link_unlock();
return true;
}
else {
serial_link_unlock();
return false;
}
}
static void triple_buffer_actual_read(uint16_t object_size, triple_buffer_object_t* object, void* dst) {
@ -61,13 +72,21 @@ void triple_buffer_write(uint16_t object_size, triple_buffer_object_t* object, v
uint8_t write_index = GET_WRITE_INDEX();
memcpy(object->buffer + object_size * write_index, src, object_size);
serial_link_lock();
uint8_t shared_index = GET_SHARED_INDEX();
SET_SHARED_INDEX(write_index);
SET_WRITE_INDEX(shared_index);
SET_DATA_AVAILABLE(true);
serial_link_unlock();
}
void triple_buffer_read(uint16_t object_size, triple_buffer_object_t* object, void* dst) {
triple_buffer_begin_read(object_size, object);
triple_buffer_actual_read(object_size, object, dst);
triple_buffer_end_read(object_size, object);
bool triple_buffer_read(uint16_t object_size, triple_buffer_object_t* object, void* dst) {
if (triple_buffer_begin_read(object_size, object)) {
triple_buffer_actual_read(object_size, object, dst);
triple_buffer_end_read(object_size, object);
return true;
}
else {
return false;
}
}

3
serial_link/protocol/triple_buffered_object.h
View file

@ -30,8 +30,9 @@ typedef struct {
uint8_t buffer[];
}triple_buffer_object_t;
void triple_buffer_init(triple_buffer_object_t* object);
void triple_buffer_write(uint16_t object_size, triple_buffer_object_t* object, void* src);
void triple_buffer_read(uint16_t object_size, triple_buffer_object_t* object, void* dst);
bool triple_buffer_read(uint16_t object_size, triple_buffer_object_t* object, void* dst);
#endif