When you blow towards the drone the drone detects the Pressure difference and the drone automatically takes off and starts hovering, we can take control after it starts hovering.
// Do not remove the include below
#include "PlutoPilot.h"
#include "Control.h"
#include "Sensor.h"
#include "Utils.h"
#include "User.h"
#define ABS(x) ((x) > 0 ? (x) : -(x))
int16_t initPressure;
int16_t currPressure;
//The setup function is called once at Pluto's hardware startup
void plutoInit()
{
// Add your hardware initialization code here
}
//The function is called once before plutoLoop when you activate Developer Mode
void onLoopStart()
{
// do your one time stuff here
initPressure=Barometer.get(PRESSURE);
LED.flightStatus(DEACTIVATE);
}
// The loop function is called in an endless loop
void plutoLoop()
{
currPressure=Barometer.get(PRESSURE);
//Add your repeated code here
if(ABS(currPressure-initPressure)>4)
{LED.set(RED, ON);
Command.arm();
DesiredPosition.set(Z,100);
}
initPressure = initPressure*0.9 + currPressure*0.1;
Monitor.println("oldPressure",initPressure);
Monitor.println("newPressure",currPressure);
Graph.red(currPressure);
}
//The function is called once after plutoLoop when you deactivate Developer Mode
void onLoopFinish()
{
LED.flightStatus(ACTIVATE);
// do your cleanup stuffs here
}