Remote control code for https://developer.mbed.org/users/ivo_david_michelle/code/QuadTrio/

Dependencies:   Analog_Joystick Sender mbed

Fork of ESE350-Whack-a-Mole by Eric Berdinis

rc.cpp

Committer:
ivo_david_michelle
Date:
2016-04-07
Revision:
9:2a3b3e067847
Parent:
8:ff7cd3525c32
Child:
10:8981152753a6

File content as of revision 9:2a3b3e067847:

#include "mbed.h"
#include "MRF24J40.h"
#include "sender.h"
#include "analog_joystick.h"

#include <string.h>

// RF tranceiver to link with handheld.
MRF24J40 mrf(p11, p12, p13, p14, p21);

// LEDs you can treat these as variables (led2 = 1 will turn led2 on!)
DigitalOut led1(LED1);
DigitalOut led2(LED2);
DigitalOut led3(LED3);
DigitalOut led4(LED4);

// Timer
Timer timer;

// Serial port for showing RX data.
Serial pc(USBTX, USBRX);

int main (void)
{
    long long id = 0;
    uint8_t channel = 3;

    //Set the Channel. 0 is default, 15 is max
    mrf.SetChannel(channel);

    //Start the timer
    timer.start();

    pc.printf("START\r\n");

    char txBuffer[250];

    while(1) {
        sprintf(txBuffer, "%lld,%f,%f,%f,%f", id, read_thrust(), read_yaw(), read_pitch(), read_roll());
        rf_send(mrf, txBuffer, strlen(txBuffer) + 1);
        pc.printf("RC Sent: %s \r\n", txBuffer);

        id++;
    }
}