DJI NAZA-M controller (multi copter side) see: https://developer.mbed.org/users/okini3939/notebook/drone/
Dependencies: FutabaSBUS NECnfc mbed
Diff: NazaSBus.cpp
- Revision:
- 0:4a37291f07ca
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/NazaSBus.cpp Thu May 19 08:56:47 2016 +0000 @@ -0,0 +1,22 @@ +#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(); +}