src/main/pg/pg.c

   1 /*
   2  * This file is part of Cleanflight and Betaflight.
   3  *
   4  * Cleanflight and Betaflight are free software. You can redistribute
   5  * this software and/or modify this software under the terms of the
   6  * GNU General Public License as published by the Free Software
   7  * Foundation, either version 3 of the License, or (at your option)
   8  * any later version.
   9  *
  10  * Cleanflight and Betaflight are distributed in the hope that they
  11  * will be useful, but WITHOUT ANY WARRANTY; without even the implied
  12  * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  13  * See the GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this software.
  17  *
  18  * If not, see <http://www.gnu.org/licenses/>.
  19  */
  20
  21 #include <stddef.h>
  22 #include <string.h>
  23 #include <stdint.h>
  24
  25 #include "platform.h"
  26
  27 #include "common/crc.h"
  28 #include "common/maths.h"
  29
  30 #include "pg.h"
  31
  32 const pgRegistry_t* pgFind(pgn_t pgn)
  33 {
  34     PG_FOREACH(reg) {
  35         if (pgN(reg) == pgn) {
  36             return reg;
  37         }
  38     }
  39     return NULL;
  40 }
  41
  42 static uint8_t *pgOffset(const pgRegistry_t* reg)
  43 {
  44     return reg->address;
  45 }
  46
  47 void pgResetInstance(const pgRegistry_t *reg, uint8_t *base)
  48 {
  49     const uint16_t regSize = pgSize(reg);
  50
  51     memset(base, 0, regSize);
  52     if (reg->reset.ptr >= (void*)__pg_resetdata_start && reg->reset.ptr < (void*)__pg_resetdata_end) {
  53         // pointer points to resetdata section, to it is data template
  54         memcpy(base, reg->reset.ptr, regSize);
  55     } else if (reg->reset.fn) {
  56         // reset function, call it
  57         reg->reset.fn(base);
  58     }
  59 }
  60
  61 void pgReset(const pgRegistry_t* reg)
  62 {
  63     pgResetInstance(reg, pgOffset(reg));
  64 }
  65
  66 bool pgResetCopy(void *copy, pgn_t pgn)
  67 {
  68     const pgRegistry_t *reg = pgFind(pgn);
  69     if (reg) {
  70         pgResetInstance(reg, copy);
  71         return true;
  72     }
  73     return false;
  74 }
  75
  76 bool pgLoad(const pgRegistry_t* reg, const void *from, int size, int version)
  77 {
  78     pgResetInstance(reg, pgOffset(reg));
  79     // restore only matching version, keep defaults otherwise
  80     if (version == pgVersion(reg)) {
  81         const int take = MIN(size, pgSize(reg));
  82         memcpy(pgOffset(reg), from, take);
  83
  84         *reg->fnv_hash = fnv_update(FNV_OFFSET_BASIS, from, take);
  85
  86         return true;
  87     }
  88
  89     return false;
  90 }
  91
  92 int pgStore(const pgRegistry_t* reg, void *to, int size)
  93 {
  94     const int take = MIN(size, pgSize(reg));
  95     memcpy(to, pgOffset(reg), take);
  96     return take;
  97 }
  98
  99 void pgResetAll(void)
 100 {
 101     PG_FOREACH(reg) {
 102         pgReset(reg);
 103     }
 104 }