banban/ql-config/soc_platform/preboot_boot2/sys/property/property.c

#include <string.h>
#include <stdint.h>
#include <stdio.h>
#include "property.h"

#include "log.h"
#define LOG_MODULE "Prop"
#define LOG_LEVEL LOG_LEVEL_MAIN

/**************************************
 *  for the execution image before B33,
 *  those RO properties could be cached into BTCM only
 *  before B33 jump to CP.bin , load all the properties into PSRAM.
 *
 **************************************/
extern unsigned char __scratch2_start;
static asr_prop_area *__system_property_area__;
static asr_prop_info *pa_info_array = 0;
static int asr_property_area_inited = 0;

static const asr_prop_info *
__system_property_find(const char *name)
{
  asr_prop_area *pa = __system_property_area__;
  unsigned count = pa->count;
  unsigned *toc = pa->toc;
  unsigned len = strlen(name);
  asr_prop_info *pi;

  while(count--) {
    unsigned entry = *toc++;
    if(TOC_NAME_LEN(entry) != len) {
      continue;
    }

    pi = TOC_TO_INFO(pa, entry);
    if(strcmp(name, pi->name)) {
      continue;
    }

    return pi;
  }

  return NULL;
}
static int
__system_property_read(const asr_prop_info *pi, char *name, unsigned name_size, char *value, unsigned value_size)
{
  unsigned serial, valuelen;

  for(;;) {
    serial = pi->serial;
#if 0/*NO MUTEX */
    while(SERIAL_DIRTY(serial)) {
      __futex_wait((volatile void *)&pi->serial, serial, 0);
      serial = pi->serial;
    }
#endif
    strncpy(value, pi->value, value_size - 1);
    value[value_size - 1] = '\0';
    valuelen = strlen(value);

    if(serial == pi->serial) {
      if(name != NULL) {
        strncpy(name, pi->name, name_size - 1);
        name[name_size - 1] = '\0';
      }
      return valuelen;
    }
  }
}
static const asr_prop_info *
__system_property_find_nth(unsigned n)
{
  asr_prop_area *pa = __system_property_area__;

  if(n >= pa->count) {
    return 0;
  } else {
    return TOC_TO_INFO(pa, pa->toc[n]);
  }
}
static void
update_prop_info(asr_prop_info *pi, const char *value)
{
  pi->serial = pi->serial | 1;
  strncpy(pi->value, value, (sizeof(pi->value) - 1));
  pi->value[sizeof(pi->value) - 1] = '\0';
  unsigned len = strlen(pi->value);

  pi->serial = (len << 24) | ((pi->serial + 1) & 0xffffff);
#if 0/*NO MUTEX */
  __futex_wake(&pi->serial, INT32_MAX);
#endif
}
/**
** COMMON_API
** NOTICE: for arg force_init
** TRUE  : should be invoke by preboot.
** FALSE : should be the other exec bin
**/
int
asr_property_area_init(int force_init)
{
  __system_property_area__ = (asr_prop_area *)((uintptr_t)&__scratch2_start + ASR_PROP_AREA_OFFSET);
  asr_prop_area *pa = __system_property_area__;
  pa_info_array = (void *)(((char *)pa) + ASR_PA_INFO_START);
  char *m_anchor;

  if(!force_init) {
    if(pa->magic == ASR_PROP_AREA_MAGIC) {
      /* property info already set from pervois exec period */
      /*LOG_INFO("ASR_PROP_AREA_MAGIC detect\r\n"); */

      /* force reset the reset of unused memory ,as preboot/boot2 may use the 1K [TINY_PROP_AREA], */
      /* the next exec bin like boot33 ,should force init the append 3K unused area. */
      m_anchor = (char *)__system_property_find_nth(pa->count - 1) + sizeof(asr_prop_info);
      memset(m_anchor, 0, ((unsigned)pa + ASR_PA_SIZE - (int)m_anchor));

      asr_property_area_inited = 1;
      return -1;
    }
  }

  /*clean zero init */
  memset(pa, 0, ASR_PA_SIZE);
  pa->magic = ASR_PROP_AREA_MAGIC;
  pa->version = ASR_PROP_AREA_VERSION;

  asr_property_area_inited = 1;

  return 0;
}
/**
** COMMON_API
** load the <value> into [arg=buffer] with index key <name>
**/
int
asr_property_get_buffer(const char *name, char *buffer, unsigned buffer_size)
{
  if(name == NULL || buffer == NULL || buffer_size == 0) {
    return 0;
  }

  const asr_prop_info *pi = __system_property_find(name);

  if(!asr_property_area_inited) {
    asr_property_area_init(0);
  }

  if(pi != NULL) {
    return __system_property_read(pi, NULL, 0, buffer, buffer_size);
  } else {
    buffer[0] = 0;
    return 0;
  }
}
/**
** COMMON_API
** queue the <value> with index key <name>
**/
const char *
asr_property_get(const char *name)
{
  asr_prop_info *pi;

  if(!asr_property_area_inited) {
    asr_property_area_init(0);
  }

  pi = (asr_prop_info *)__system_property_find(name);

  if(pi != 0) {
    return pi->value;
  } else {
    return 0;
  }
}
/**
** COMMON_API
** create or udpate the property <name> with <value>
**/
int
asr_property_set(const char *name, const char *value)
{
  asr_prop_area *pa;
  asr_prop_info *pi;
  int namelen;
  int valuelen;

  if(strlen(name) < 1) {
    return -1;
  }

  if(!asr_property_area_inited) {
    asr_property_area_init(0);
  }

  pi = (asr_prop_info *)__system_property_find(name);

  if(pi != 0) {
    pa = __system_property_area__;
    update_prop_info(pi, value);
#if 0/*NO MUTEX */
    pa->serial++;
    __futex_wake(&pa->serial, INT32_MAX);
#endif
  } else {
    pa = __system_property_area__;
    if(pa->count == ASR_PA_COUNT_MAX) {
      return -1;
    }

    pi = pa_info_array + pa->count;

    strncpy(pi->name, name, (sizeof(pi->name) - 1));
    pi->name[sizeof(pi->name) - 1] = '\0';
    namelen = strlen(pi->name);

    strncpy(pi->value, value, (sizeof(pi->value) - 1));
    pi->value[sizeof(pi->value) - 1] = '\0';
    valuelen = strlen(pi->value);

    pi->serial = (valuelen << 24);

    pa->toc[pa->count] =
      (namelen << 24) | (((unsigned)pi) - ((unsigned)pa));

    pa->count++;
#if 0 /*NO MUTEX */
    pa->serial++;
    __futex_wake(&pa->serial, INT32_MAX);
#endif
  }

  return 0;
}
/**
** COMMON_API
** uart dump all configed property with [<name>]=[<value>] format
**/
int
asr_property_dump(void)
{
  char name[PROP_NAME_MAX];
  char value[PROP_VALUE_MAX];
  const asr_prop_info *pi;
  unsigned n;

  if(!asr_property_area_inited) {
    asr_property_area_init(0);
  }

  LOG_INFO("[ver_%x][%s]\r\n", ASR_PROP_AREA_VERSION, __func__);

  for(n = 0; ((pi = __system_property_find_nth(n)) != 0); n++) {
    __system_property_read(pi, name, PROP_NAME_MAX, value, PROP_VALUE_MAX);
    LOG_INFO("[%s]=[%s]\r\n", name, value);
  }
  return 0;
}