settings.c

Go to the documentation of this file.

/*
 * Copyright (C) 2009-2014 The Paparazzi Team
 *
 * This file is part of paparazzi.
 *
 * paparazzi is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * paparazzi is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with paparazzi; see the file COPYING.  If not, write to
 * the Free Software Foundation, 59 Temple Place - Suite 330,
 * Boston, MA 02111-1307, USA.
 */
 
#include "modules/core/settings.h"
#include "generated/settings.h"
#include "generated/airframe.h"
#if FLIGHTRECORDER_SDLOG
#include "modules/loggers/flight_recorder.h"
#include "modules/loggers/pprzlog_tp.h"
#endif
#include "pprzlink/messages.h"
#include "pprzlink/dl_protocol.h"
 
struct PersistentSettings pers_settings;
 
bool settings_store_flag;
 
bool settings_clear_flag;
 
 
static void settings_send_dl_value(struct link_device *dev, struct transport_tx *trans,
                                   uint8_t receiver_id, uint8_t index, float value)
{
  struct pprzlink_msg msg;
  msg.trans = trans;
  msg.dev = dev;
  msg.sender_id = AC_ID;
  msg.receiver_id = receiver_id;
  msg.component_id = 0;
  pprzlink_msg_send_DL_VALUE(&msg, &index, &value);
 
#if FLIGHTRECORDER_SDLOG
  pprz_msg_send_DL_VALUE(&pprzlog_tp.trans_tx, &flightrecorder_sdlog.device, AC_ID, &index, &value);
#endif
}
 
 
void settings_init(void)
{
#if USE_PERSISTENT_SETTINGS
  if (persistent_read((void *)&pers_settings, sizeof(struct PersistentSettings))) {
    return;  // return -1 ?
  }
  /* from generated/settings.h */
  persistent_settings_load();
#endif
}
 
int32_t settings_store(void)
{
#if USE_PERSISTENT_SETTINGS
  if (settings_store_flag) {
    /* from generated/settings.h */
    persistent_settings_store();
    if (!persistent_write((void *)&pers_settings, sizeof(struct PersistentSettings))) {
      /* persistent write was successful */
      settings_store_flag = true;
      return 0;
    }
  }
#endif
  settings_store_flag = false;
  return -1;
}
 
int32_t settings_clear(void)
{
#if USE_PERSISTENT_SETTINGS
  if (settings_clear_flag) {
    if (!persistent_clear()) {
      /* clearing all persistent settings was successful */
      settings_clear_flag = true;
      return 0;
    }
  }
#endif
  settings_clear_flag = false;
  return -1;
}
 
void settings_parse_msg_SETTING(struct link_device *dev, struct transport_tx *trans, uint8_t *buf)
{
#ifndef INTERMCU_FBW
  if (DL_SETTING_ac_id(buf) != AC_ID) { return; }
  uint8_t sender_id = pprzlink_get_msg_sender_id(buf);
  uint8_t i = DL_SETTING_index(buf);
  float var = DL_SETTING_value(buf);
  DlSetting(i, var);
  settings_send_dl_value(dev, trans, sender_id, i, var);
#else
  (void)dev;
  (void)trans;
  (void)buf;
#endif
}
 
void settings_parse_msg_GET_SETTING(struct link_device *dev, struct transport_tx *trans, uint8_t *buf)
{
#ifndef INTERMCU_FBW
  if (DL_GET_SETTING_ac_id(buf) != AC_ID) { return; }
  uint8_t sender_id = pprzlink_get_msg_sender_id(buf);
  uint8_t i = DL_GET_SETTING_index(buf);
  float val = settings_get_value(i);
  settings_send_dl_value(dev, trans, sender_id, i, val);
#else
  (void)dev;
  (void)trans;
  (void)buf;
#endif
}