mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-02-06 16:03:58 -04:00
AP_HAL: Add support for an Optflow driver
This is meant to be used for onboard optical flow
This commit is contained in:
parent
d003e24189
commit
2b681f2f13
@ -20,6 +20,7 @@
|
|||||||
#include "Scheduler.h"
|
#include "Scheduler.h"
|
||||||
#include "Semaphores.h"
|
#include "Semaphores.h"
|
||||||
#include "Util.h"
|
#include "Util.h"
|
||||||
|
#include "OpticalFlow.h"
|
||||||
|
|
||||||
#include "utility/Print.h"
|
#include "utility/Print.h"
|
||||||
#include "utility/Stream.h"
|
#include "utility/Stream.h"
|
||||||
|
@ -26,6 +26,7 @@ namespace AP_HAL {
|
|||||||
class RCOutput;
|
class RCOutput;
|
||||||
class Scheduler;
|
class Scheduler;
|
||||||
class Semaphore;
|
class Semaphore;
|
||||||
|
class OpticalFlow;
|
||||||
|
|
||||||
class Util;
|
class Util;
|
||||||
|
|
||||||
|
@ -12,6 +12,7 @@
|
|||||||
#include "Storage.h"
|
#include "Storage.h"
|
||||||
#include "UARTDriver.h"
|
#include "UARTDriver.h"
|
||||||
#include "system.h"
|
#include "system.h"
|
||||||
|
#include "OpticalFlow.h"
|
||||||
|
|
||||||
class AP_HAL::HAL {
|
class AP_HAL::HAL {
|
||||||
public:
|
public:
|
||||||
@ -31,7 +32,8 @@ public:
|
|||||||
AP_HAL::RCInput* _rcin,
|
AP_HAL::RCInput* _rcin,
|
||||||
AP_HAL::RCOutput* _rcout,
|
AP_HAL::RCOutput* _rcout,
|
||||||
AP_HAL::Scheduler* _scheduler,
|
AP_HAL::Scheduler* _scheduler,
|
||||||
AP_HAL::Util* _util)
|
AP_HAL::Util* _util,
|
||||||
|
AP_HAL::OpticalFlow* _opticalflow)
|
||||||
:
|
:
|
||||||
uartA(_uartA),
|
uartA(_uartA),
|
||||||
uartB(_uartB),
|
uartB(_uartB),
|
||||||
@ -49,7 +51,8 @@ public:
|
|||||||
rcin(_rcin),
|
rcin(_rcin),
|
||||||
rcout(_rcout),
|
rcout(_rcout),
|
||||||
scheduler(_scheduler),
|
scheduler(_scheduler),
|
||||||
util(_util)
|
util(_util),
|
||||||
|
opticalflow(_opticalflow)
|
||||||
{
|
{
|
||||||
AP_HAL::init();
|
AP_HAL::init();
|
||||||
}
|
}
|
||||||
@ -89,6 +92,7 @@ public:
|
|||||||
AP_HAL::RCOutput* rcout;
|
AP_HAL::RCOutput* rcout;
|
||||||
AP_HAL::Scheduler* scheduler;
|
AP_HAL::Scheduler* scheduler;
|
||||||
AP_HAL::Util* util;
|
AP_HAL::Util* util;
|
||||||
|
AP_HAL::OpticalFlow* opticalflow;
|
||||||
};
|
};
|
||||||
|
|
||||||
#endif // __AP_HAL_HAL_H__
|
#endif // __AP_HAL_HAL_H__
|
||||||
|
34
libraries/AP_HAL/OpticalFlow.h
Normal file
34
libraries/AP_HAL/OpticalFlow.h
Normal file
@ -0,0 +1,34 @@
|
|||||||
|
/*
|
||||||
|
This program 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 3 of the License, or
|
||||||
|
(at your option) any later version.
|
||||||
|
|
||||||
|
This program 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 this program. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
#ifndef __AP_HAL_OPTICALFLOW_H__
|
||||||
|
#define __AP_HAL_OPTICALFLOW_H__
|
||||||
|
|
||||||
|
class AP_HAL::OpticalFlow {
|
||||||
|
public:
|
||||||
|
FUNCTOR_TYPEDEF(Gyro_Cb, void, float&, float&, float&);
|
||||||
|
virtual void init(Gyro_Cb) = 0;
|
||||||
|
class Data_Frame {
|
||||||
|
public:
|
||||||
|
float pixel_flow_x_integral;
|
||||||
|
float pixel_flow_y_integral;
|
||||||
|
float gyro_x_integral;
|
||||||
|
float gyro_y_integral;
|
||||||
|
uint32_t delta_time;
|
||||||
|
uint8_t quality;
|
||||||
|
};
|
||||||
|
virtual bool read(Data_Frame& frame) = 0;
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
Loading…
Reference in New Issue
Block a user