找到个基于气压传感器开伞的代码
极度深寒2014/03/28喷气推进 IP:美国
XXXXXXXXXXXXXXXXXX/bdureau/AltiUno/blob/master/AltiUno_attiny85_XXXXXXXXXo


BMP085或BMP180通过卡尔曼滤波得出高度数据。在最高点时开伞,并有扬声器播出高度数据。 我觉得火箭项目去年就是用这个代码控制开伞的。 那两个库文件google一下很容易找到的。
/*
  Model Rocket single deployment altimeter Ver 1.0
Copyright Boris du Reau 2012-2013

This is using a BMP085 presure sensor and an Attiny 85
The following should fire the main at apogee if it is at least 50m above ground of the launch site

  
For the BMP085 pressure sensor
Connect VCC of the BMP085 sensor to 5.0V! make sure that you are using the 5V sensor (GY-65 model)
Connect GND to Ground
Connect SCL to i2c clock - pin 7 (PB2) of the ATtiny 85
Connect SDA to i2c data - pin 5 (PB0) of the ATtiny 85
EOC is not used, it signifies an end of conversion
XCLR is a reset pin, also not used here

The apogee is connected to pin 2 (PB3)
The apogee continuity test is connected to pin 3 (PB4)
The speaker/buzzer is connected to pin 6 (PB1)
*/

#include <TinyWireM.h>
#include <tinyBMP085.h>

#define DEBUG //=true

BMP085 bmp;

//ground level altitude
long initialAltitude;
//current altitude
long currAltitude;
//Apogee altitude
long apogeeAltitude;
long liftoffAltitude;
long lastAltitude;
//Our drogue has been ejected i.e: apogee has been detected
boolean apogeeHasFired =false;
//nbr of measures to do so that we are sure that apogee has been reached
unsigned long measures;


// those have been changed for the ATtiny 85
const int pinApogee = 3;
const int pinApogeeContinuity = 4;
const int pinSpeaker = 1;

int nbrLongBeep=0;
int nbrShortBeep=0;

boolean NoBeep=false;

//Kalman Variables
float f_1=1.00000;  //cast as float
float kalman_x;
float kalman_x_last;
float kalman_p;
float kalman_p_last;
float kalman_k;
float kalman_q;
float kalman_r;
float kalman_x_temp;
float kalman_p_temp;
//float KAlt;
//end of Kalman Variables

void setup()
{
  //Initialise the output pin
  pinMode(pinApogee, OUTPUT);
  pinMode(pinSpeaker, OUTPUT);
  pinMode(pinApogeeContinuity, INPUT);
  //Make sure that the output are turned off
  digitalWrite(pinApogee, LOW);
  digitalWrite(pinSpeaker, LOW);

  //init Kalman filter
  KalmanInit();
  //XXXXXXXgin();
  XXXXXXXXXXXXgin();
  //Presure Sensor Initialisation
  XXXXXXgin();
  
  //initialisation
  beginBeepSeq();
  //our drogue has not been fired
  apogeeHasFired=false;
  //let's read the lauch site altitude
  long sum = 0;
  for (int i=0; i<10; i++){
      sum += KalmanCalc(XXXXXXadAltitude());
    delay(500); }
  initialAltitude = (sum / 10.0);
  
  lastAltitude = initialAltitude;
  liftoffAltitude = initialAltitude + 20;
  //number of measures to do to detect Apogee
  measures = 10;
//if (liftoffAltitude <0) {initialAltitude=liftoffAltitude*(-1);}
//beepAltitude(initialAltitude);
}

void loop()
{
  //read current altitude
  currAltitude = (KalmanCalc(XXXXXXadAltitude())- initialAltitude);
  if (( currAltitude > liftoffAltitude) != true)
  {
    continuityCheck(pinApogeeContinuity);
  }
  
  //detect apogee
  if(currAltitude > liftoffAltitude)
  {

    if (currAltitude < lastAltitude)
    {
      measures = measures - 1;
      if (measures == 0)
      {
        //fire drogue
        digitalWrite(pinApogee, HIGH);
        delay (2000);
        apogeeHasFired=true;
        digitalWrite(pinApogee, LOW);
        apogeeAltitude = currAltitude;
      }  
    }
    else
    {
      lastAltitude = currAltitude;
      measures = 10;
    }
  }

  if(apogeeHasFired == true)
  {
    beepAltitude(apogeeAltitude);
  }
}

void continuityCheck(int pin)
{
  int val = 0;     // variable to store the read value
  // read the input pin to check the continuity if apogee has not fired
  if (apogeeHasFired == false )
  {
    val = digitalRead(pin);  
    if (val == 0)
    {
      //no continuity long beep
      longBeep();
    }
    else
    {
      //continuity short beep
      shortBeep();
    }
  }
}



void beepAltitude(long altitude)
{
  int i;
  // this is the laste thing that I need to write, some code to beep the altitude
  //altitude is in meters
  //find how many digits
  if(altitude > 99)
  {
    // 1 long beep per hundred meter
    nbrLongBeep= int(altitude /100);
    //then calculate the number of short beep
    nbrShortBeep = (altitude - (nbrLongBeep * 100)) / 10;
  }
  else
  {
    nbrLongBeep = 0;
    nbrShortBeep = (altitude/10);
  }

  if (nbrLongBeep > 0)
  for (i = 1; i <  nbrLongBeep +1 ; i++)
  {
    longBeep();
    delay(50);
  }

  if (nbrShortBeep > 0)
  for (i = 1; i <  nbrShortBeep +1 ; i++)
  {
    shortBeep();
    delay(50);
  }

  delay(5000);

}

void beginBeepSeq()
{
  int i=0;
  if (NoBeep == false)
  {
    for (i=0; i<10;i++)
    {
      tone(pinSpeaker, 1600,1000);
      delay(50);
      noTone(pinSpeaker);
    }
    delay(1000);
  }
}
void longBeep()
{
  if (NoBeep == false)
  {
    tone(pinSpeaker, 600,1000);
    delay(1500);
    noTone(pinSpeaker);
  }
}
void shortBeep()
{
  if (NoBeep == false)
  {
    tone(pinSpeaker, 600,25);
    delay(300);
    noTone(pinSpeaker);
  }
}
//================================================================
// Kalman functions in your code
//================================================================

//Call KalmanInit() once.  

//KalmanInit() - Call before any iterations of KalmanCalc()
void KalmanInit()
{
   kalman_q=4.0001;  //filter parameters, you can play around with them
   kalman_r=.20001;  // but these values appear to be fairly optimal

   kalman_x = 0;
   kalman_p = 0;
   kalman_x_temp = 0;
   kalman_p_temp = 0;
  
   kalman_x_last = 0;
   kalman_p_last = 0;
  
}

//KalmanCalc() - Calculates new Kalman values from float value \"altitude\"
// This will be the ASL altitude during the flight, and the AGL altitude during dumps
float KalmanCalc (float altitude)
{
  
   //Predict kalman_x_temp, kalman_p_temp
   kalman_x_temp = kalman_x_last;
   kalman_p_temp = kalman_p_last + kalman_r;
  
   //Update kalman values
   kalman_k = (f_1/(kalman_p_temp + kalman_q)) * kalman_p_temp;
   kalman_x = kalman_x_temp + (kalman_k * (altitude - kalman_x_temp));
   kalman_p = (f_1 - kalman_k) * kalman_p_temp;
  
   //Save this state for next time
   kalman_x_last = kalman_x;
   kalman_p_last = kalman_p;
  
   //Assign current Kalman filtered altitude to working variables
   //KAlt = kalman_x; //FLOAT Kalman-filtered altitude value
  return kalman_x;
}  
+1  科创币    zzlzhang    2014/03/29 默默地点个赞...话说...你是用啥开伞?NANO么?
来自:航空航天 / 喷气推进
1
已屏蔽 原因:{{ notice.reason }}已屏蔽
{{notice.noticeContent}}
~~空空如也

想参与大家的讨论?现在就 登录 或者 注册

所属专业
所属分类
上级专业
同级专业
极度深寒
学者 机友 笔友
文章
50
回复
452
学术分
5
2009/10/23注册,2年8个月前活动

炼丹师

主体类型:个人
所属领域:无
认证方式:手机号
IP归属地:未同步
文件下载
加载中...
{{errorInfo}}
{{downloadWarning}}
你在 {{downloadTime}} 下载过当前文件。
文件名称:{{resource.defaultFile.name}}
下载次数:{{resource.hits}}
上传用户:{{uploader.username}}
所需积分:{{costScores}},{{holdScores}}下载当前附件免费{{description}}
积分不足,去充值
文件已丢失

当前账号的附件下载数量限制如下:
时段 个数
{{f.startingTime}}点 - {{f.endTime}}点 {{f.fileCount}}
视频暂不能访问,请登录试试
仅供内部学术交流或培训使用,请先保存到本地。本内容不代表科创观点,未经原作者同意,请勿转载。
音频暂不能访问,请登录试试
支持的图片格式:jpg, jpeg, png
插入公式
评论控制
加载中...
文号:{{pid}}
投诉或举报
加载中...
{{tip}}
请选择违规类型:
{{reason.type}}

空空如也

加载中...
详情
详情
推送到专栏从专栏移除
设为匿名取消匿名
查看作者
回复
只看作者
加入收藏取消收藏
收藏
取消收藏
折叠回复
置顶取消置顶
评学术分
鼓励
设为精选取消精选
管理提醒
编辑
通过审核
评论控制
退修或删除
历史版本
违规记录
投诉或举报
加入黑名单移除黑名单
查看IP
{{format('YYYY/MM/DD HH:mm:ss', toc)}}