src/main/config/config_streamer.c

   1 /*
   2  * This file is part of Cleanflight.
   3  *
   4  * Cleanflight is free software: you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation, either version 3 of the License, or
   7  * (at your option) any later version.
   8  *
   9  * Cleanflight is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with Cleanflight.  If not, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18 #include <string.h>
  19 #include "platform.h"
  20 #include "drivers/system.h"
  21 #include "config/config_streamer.h"
  22 #include "build/build_config.h"
  23
  24 #if !defined(CONFIG_IN_FLASH)
  25 SLOW_RAM uint8_t eepromData[EEPROM_SIZE];
  26 #endif
  27
  28 // Helper functions
  29 extern void config_streamer_impl_unlock(void);
  30 extern void config_streamer_impl_lock(void);
  31 extern int config_streamer_impl_write_word(config_streamer_t *c, config_streamer_buffer_align_type_t *buffer);
  32
  33 void config_streamer_init(config_streamer_t *c)
  34 {
  35     memset(c, 0, sizeof(*c));
  36 }
  37
  38 void config_streamer_start(config_streamer_t *c, uintptr_t base, int size)
  39 {
  40     // base must start at FLASH_PAGE_SIZE boundary when using embedded flash.
  41     c->address = base;
  42     c->size = size;
  43     c->end = base + size;
  44     if (!c->unlocked) {
  45         config_streamer_impl_unlock();
  46         c->unlocked = true;
  47     }
  48     c->err = 0;
  49 }
  50
  51 int config_streamer_write(config_streamer_t *c, const uint8_t *p, uint32_t size)
  52 {
  53     if ((c->address + size) > c->end) {
  54         // trying to write past end of streamer
  55         return -1;
  56     }
  57
  58     for (const uint8_t *pat = p; pat != (uint8_t*)p + size; pat++) {
  59         c->buffer.b[c->at++] = *pat;
  60
  61         if (c->at == sizeof(c->buffer)) {
  62             c->err = config_streamer_impl_write_word(c, &c->buffer.w);
  63             c->at = 0;
  64         }
  65     }
  66     return c->err;
  67 }
  68
  69 int config_streamer_status(config_streamer_t *c)
  70 {
  71     return c->err;
  72 }
  73
  74 int config_streamer_flush(config_streamer_t *c)
  75 {
  76     if (c->at != 0) {
  77         if ((c->address + c->at) > c->end) {
  78             return -1;
  79         }
  80         memset(c->buffer.b + c->at, 0, sizeof(c->buffer) - c->at);
  81         c->err = config_streamer_impl_write_word(c, &c->buffer.w);
  82         c->at = 0;
  83     }
  84     return c-> err;
  85 }
  86
  87 int config_streamer_finish(config_streamer_t *c)
  88 {
  89     if (c->unlocked) {
  90         config_streamer_impl_lock();
  91         c->unlocked = false;
  92     }
  93     return c->err;
  94 }