MAV'RIC
|
00001 /******************************************************************************* 00002 * Copyright (c) 2009-2014, MAV'RIC Development Team 00003 * All rights reserved. 00004 * 00005 * Redistribution and use in source and binary forms, with or without 00006 * modification, are permitted provided that the following conditions are met: 00007 * 00008 * 1. Redistributions of source code must retain the above copyright notice, 00009 * this list of conditions and the following disclaimer. 00010 * 00011 * 2. Redistributions in binary form must reproduce the above copyright notice, 00012 * this list of conditions and the following disclaimer in the documentation 00013 * and/or other materials provided with the distribution. 00014 * 00015 * 3. Neither the name of the copyright holder nor the names of its contributors 00016 * may be used to endorse or promote products derived from this software without 00017 * specific prior written permission. 00018 * 00019 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 00020 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 00021 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 00022 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE 00023 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 00024 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 00025 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 00026 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 00027 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 00028 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 00029 * POSSIBILITY OF SUCH DAMAGE. 00030 ******************************************************************************/ 00031 00032 /******************************************************************************* 00033 * \file airspedd_analog.hpp 00034 * 00035 * \author MAV'RIC Team 00036 * \author Julien Lecoeur 00037 * \author Simon Pyroth 00038 * 00039 * \brief This file is the driver for the DIYdrones airspeed sensor V20 00040 * (old analog version) 00041 * 00042 ******************************************************************************/ 00043 00044 00045 #ifndef AIRSPEED_ANALOG_HPP_ 00046 #define AIRSPEED_ANALOG_HPP_ 00047 00048 #include <cstdint> 00049 #include "hal/common/adc.hpp" 00050 00051 00052 00056 typedef struct 00057 { 00058 float pressure_offset; 00059 float calibration_gain; 00060 float conversion_factor; 00061 float correction_gain; 00062 float correction_offset; 00063 float filter_gain; 00064 } airspeed_analog_conf_t; 00065 00066 static inline airspeed_analog_conf_t airspeed_analog_default_config(); 00067 00068 class Airspeed_analog 00069 { 00070 public: 00077 Airspeed_analog(Adc& adc, airspeed_analog_conf_t config = airspeed_analog_default_config()); 00078 00085 void start_calibration(void); 00086 00093 void stop_calibration(void); 00094 00102 bool update(void); 00103 00109 const float& get_airspeed() const; 00110 00116 const float& get_last_airspeed() const; 00117 00118 private: 00126 float get_raw_differential_pressure(void); 00127 00128 Adc& adc_; 00129 00130 airspeed_analog_conf_t config_; 00131 00132 float voltage; 00133 00134 float differential_pressure; 00135 00136 float raw_airspeed; 00137 float scaled_airspeed; 00138 float airspeed; 00139 float last_airspeed; 00140 00141 bool calibrating; 00142 00143 }; 00144 00145 00146 00147 static inline airspeed_analog_conf_t airspeed_analog_default_config() 00148 { 00149 airspeed_analog_conf_t conf = {}; 00150 00151 conf.pressure_offset = 0.0f; 00152 conf.calibration_gain = 0.9f; 00153 conf.conversion_factor = 0.3945f; 00154 conf.correction_gain = 1.0f; 00155 conf.correction_offset = 0.0f; 00156 conf.filter_gain = 0.7f; 00157 00158 return conf; 00159 } 00160 00161 #endif /* AIRSPEED_ANALOG_HPP_ */