diff options
| author | Fred Sundvik <fsundvik@gmail.com> | 2016-02-21 21:15:42 +0200 |
|---|---|---|
| committer | Fred Sundvik <fsundvik@gmail.com> | 2016-02-21 21:15:42 +0200 |
| commit | 64b7efeb72ff67d088641bda798226e619601a43 (patch) | |
| tree | 7015d881732c720649d1f699a49f2c18fb0f9147 | |
| parent | 415ab91c9d2ed034bbbabf3cbb8502f525b91abb (diff) | |
| download | firmware-64b7efeb72ff67d088641bda798226e619601a43.tar.gz firmware-64b7efeb72ff67d088641bda798226e619601a43.tar.bz2 firmware-64b7efeb72ff67d088641bda798226e619601a43.zip | |
Add proper initialization of transport buffers
| -rw-r--r-- | serial_link/protocol/transport.c | 34 |
1 files changed, 34 insertions, 0 deletions
diff --git a/serial_link/protocol/transport.c b/serial_link/protocol/transport.c index 55dae9fa2..c4019d7fe 100644 --- a/serial_link/protocol/transport.c +++ b/serial_link/protocol/transport.c @@ -32,6 +32,40 @@ static uint32_t num_remote_objects; void init_transport(remote_object_t** _remote_objects, uint32_t _num_remote_objects) { remote_objects = _remote_objects; num_remote_objects = _num_remote_objects; + int i; + for(i=0;i<num_remote_objects;i++) { + remote_object_t* obj = remote_objects[i]; + if (obj->object_type == MASTER_TO_ALL_SLAVES) { + triple_buffer_object_t* tb = (triple_buffer_object_t*)obj->buffer; + triple_buffer_init(tb); + uint8_t* start = obj->buffer + LOCAL_OBJECT_SIZE(obj->object_size); + tb = (triple_buffer_object_t*)start; + triple_buffer_init(tb); + } + else if(obj->object_type == MASTER_TO_SINGLE_SLAVE) { + uint8_t* start = obj->buffer; + int j; + for (j=0;j<NUM_SLAVES;j++) { + triple_buffer_object_t* tb = (triple_buffer_object_t*)start; + triple_buffer_init(tb); + start += LOCAL_OBJECT_SIZE(obj->object_size); + } + triple_buffer_object_t* tb = (triple_buffer_object_t*)start; + triple_buffer_init(tb); + } + else { + uint8_t* start = obj->buffer; + triple_buffer_object_t* tb = (triple_buffer_object_t*)start; + triple_buffer_init(tb); + start += LOCAL_OBJECT_SIZE(obj->object_size); + int j; + for (j=0;j<NUM_SLAVES;j++) { + tb = (triple_buffer_object_t*)start; + triple_buffer_init(tb); + start += REMOTE_OBJECT_SIZE(obj->object_size); + } + } + } } void transport_recv_frame(uint8_t from, uint8_t* data, uint16_t size) { |