mirror of https://github.com/ArduPilot/ardupilot
176 lines
4.4 KiB
C++
176 lines
4.4 KiB
C++
/*
|
|
* AP_HardwareAbstractionLayer.h
|
|
*
|
|
* Created on: Apr 4, 2011
|
|
*
|
|
*/
|
|
|
|
#ifndef AP_HARDWAREABSTRACTIONLAYER_H_
|
|
#define AP_HARDWAREABSTRACTIONLAYER_H_
|
|
|
|
#include "../AP_Common/AP_Vector.h"
|
|
#include "../GCS_MAVLink/GCS_MAVLink.h"
|
|
|
|
class AP_ADC;
|
|
class IMU;
|
|
class GPS;
|
|
class APM_BMP085_Class;
|
|
class Compass;
|
|
class BetterStream;
|
|
class RangeFinder;
|
|
class FastSerial;
|
|
|
|
namespace apo {
|
|
|
|
class AP_RcChannel;
|
|
class AP_CommLink;
|
|
class AP_BatteryMonitor;
|
|
|
|
// enumerations
|
|
enum halMode_t {
|
|
MODE_LIVE, MODE_HIL_CNTL,
|
|
/*MODE_HIL_NAV*/
|
|
};
|
|
enum board_t {
|
|
BOARD_ARDUPILOTMEGA_1280, BOARD_ARDUPILOTMEGA_2560, BOARD_ARDUPILOTMEGA_2
|
|
};
|
|
enum vehicle_t {
|
|
VEHICLE_CAR, VEHICLE_QUAD, VEHICLE_PLANE, VEHICLE_BOAT, VEHICLE_TANK
|
|
};
|
|
|
|
class AP_HardwareAbstractionLayer {
|
|
|
|
public:
|
|
|
|
// default ctors on pointers called on pointers here, this
|
|
// allows NULL to be used as a boolean for if the device was
|
|
// initialized
|
|
AP_HardwareAbstractionLayer(halMode_t mode, board_t board,
|
|
vehicle_t vehicle, uint8_t heartBeatTimeout) :
|
|
adc(), gps(), baro(), compass(), rangeFinders(), imu(), batteryMonitor(), rc(), gcs(),
|
|
hil(), debug(), load(), lastHeartBeat(),
|
|
_heartBeatTimeout(heartBeatTimeout), _mode(mode),
|
|
_board(board), _vehicle(vehicle), _state(MAV_STATE_UNINIT) {
|
|
|
|
/*
|
|
* Board specific hardware initialization
|
|
*/
|
|
if (board == BOARD_ARDUPILOTMEGA_1280) {
|
|
slideSwitchPin = 40;
|
|
pushButtonPin = 41;
|
|
aLedPin = 37;
|
|
bLedPin = 36;
|
|
cLedPin = 35;
|
|
eepromMaxAddr = 1024;
|
|
pinMode(aLedPin, OUTPUT); // extra led
|
|
pinMode(bLedPin, OUTPUT); // imu ledclass AP_CommLink;
|
|
pinMode(cLedPin, OUTPUT); // gps led
|
|
pinMode(slideSwitchPin, INPUT);
|
|
pinMode(pushButtonPin, INPUT);
|
|
DDRL |= B00000100; // set port L, pint 2 to output for the relay
|
|
} else if (board == BOARD_ARDUPILOTMEGA_2560) {
|
|
slideSwitchPin = 40;
|
|
pushButtonPin = 41;
|
|
aLedPin = 37;
|
|
bLedPin = 36;
|
|
cLedPin = 35;
|
|
eepromMaxAddr = 2048;
|
|
pinMode(aLedPin, OUTPUT); // extra led
|
|
pinMode(bLedPin, OUTPUT); // imu ledclass AP_CommLink;
|
|
pinMode(cLedPin, OUTPUT); // gps led
|
|
pinMode(slideSwitchPin, INPUT);
|
|
pinMode(pushButtonPin, INPUT);
|
|
DDRL |= B00000100; // set port L, pint 2 to output for the relay
|
|
} else if (board == BOARD_ARDUPILOTMEGA_2) {
|
|
slideSwitchPin = 40;
|
|
pushButtonPin = 41;
|
|
aLedPin = 37;
|
|
bLedPin = 36;
|
|
cLedPin = 35;
|
|
eepromMaxAddr = 2048;
|
|
pinMode(aLedPin, OUTPUT); // extra led
|
|
pinMode(bLedPin, OUTPUT); // imu ledclass AP_CommLink;
|
|
pinMode(cLedPin, OUTPUT); // gps led
|
|
pinMode(slideSwitchPin, INPUT);
|
|
pinMode(pushButtonPin, INPUT);
|
|
DDRL |= B00000100; // set port L, pint 2 to output for the relay
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Sensors
|
|
*/
|
|
AP_ADC * adc;
|
|
GPS * gps;
|
|
APM_BMP085_Class * baro;
|
|
Compass * compass;
|
|
Vector<RangeFinder *> rangeFinders;
|
|
IMU * imu;
|
|
AP_BatteryMonitor * batteryMonitor;
|
|
|
|
/**
|
|
* Radio Channels
|
|
*/
|
|
Vector<AP_RcChannel *> rc;
|
|
|
|
/**
|
|
* Communication Channels
|
|
*/
|
|
AP_CommLink * gcs;
|
|
AP_CommLink * hil;
|
|
FastSerial * debug;
|
|
|
|
/**
|
|
* data
|
|
*/
|
|
uint8_t load;
|
|
uint32_t lastHeartBeat;
|
|
|
|
/**
|
|
* settings
|
|
*/
|
|
uint8_t slideSwitchPin;
|
|
uint8_t pushButtonPin;
|
|
uint8_t aLedPin;
|
|
uint8_t bLedPin;
|
|
uint8_t cLedPin;
|
|
uint16_t eepromMaxAddr;
|
|
|
|
// accessors
|
|
halMode_t getMode() {
|
|
return _mode;
|
|
}
|
|
board_t getBoard() {
|
|
return _board;
|
|
}
|
|
vehicle_t getVehicle() {
|
|
return _vehicle;
|
|
}
|
|
MAV_STATE getState() {
|
|
return _state;
|
|
}
|
|
void setState(MAV_STATE state) {
|
|
_state = state;
|
|
}
|
|
|
|
bool heartBeatLost() {
|
|
if (_heartBeatTimeout == 0)
|
|
return false;
|
|
else
|
|
return ((micros() - lastHeartBeat) / 1e6) > _heartBeatTimeout;
|
|
}
|
|
|
|
private:
|
|
|
|
// enumerations
|
|
uint8_t _heartBeatTimeout;
|
|
halMode_t _mode;
|
|
board_t _board;
|
|
vehicle_t _vehicle;
|
|
MAV_STATE _state;
|
|
};
|
|
|
|
}
|
|
|
|
#endif /* AP_HARDWAREABSTRACTIONLAYER_H_ */
|