Suga koubou / Mbed 2 deprecated Drone_air

DJI NAZA-M controller (multi copter side) see: https://developer.mbed.org/users/okini3939/notebook/drone/

Dependencies:   FutabaSBUS NECnfc mbed

NazaSBus.cpp

Committer:
okini3939
Date:
2016-05-19
Revision:
1:32cd1cf5d5b1
Parent:
0:4a37291f07ca

File content as of revision 1:32cd1cf5d5b1:

#include "mbed.h"
#include "drone.h"
#include "FutabaSBUS.h"

#define STICK_CENTER 0x400
#define STICK_TILT   0x294

FutabaSBUS sbus(p9, p10);

void setFailsafeSBus (int flg) {
    sbus.failsafe(flg ? SBUS_SIGNAL_FAILSAFE : SBUS_SIGNAL_OK);
}

void setSBus (int ch, int num) {
    sbus.servo(ch, num);
}

void initSBus () {
    sbus.failsafe(SBUS_SIGNAL_FAILSAFE);
    sbus.passthrough(false);
    sbus.start();
}