SyncHome/trunk/Arduino/libraries/IRremote/src/irPronto.cpp

/**
 * @file irPronto.cpp
 * @brief In this file, the functions IRrecv::dumpPronto and
 * IRsend::sendPronto are defined.
 */

#include "IRremote.h"

// DO NOT EXPORT from this file
static const uint16_t MICROSECONDS_T_MAX = 0xFFFFU;
static const uint16_t learnedToken = 0x0000U;
static const uint16_t learnedNonModulatedToken = 0x0100U;
static const unsigned int bitsInHexadecimal = 4U;
static const unsigned int digitsInProntoNumber = 4U;
static const unsigned int numbersInPreamble = 4U;
static const unsigned int hexMask = 0xFU;
static const uint32_t referenceFrequency = 4145146UL;
static const uint16_t fallbackFrequency = 64767U; // To use with frequency = 0;
static const uint32_t microsecondsInSeconds = 1000000UL;
static const unsigned int RESULT_JUNK_COUNT = 1U;

static unsigned int toFrequencyKHz(uint16_t code) {
    return ((referenceFrequency / code) + 500) / 1000;
}

void IRsend::sendPronto(const uint16_t *data, unsigned int size, unsigned int times) {
    unsigned int timebase = (microsecondsInSeconds * data[1] + referenceFrequency / 2) / referenceFrequency;
    unsigned int khz;
    switch (data[0]) {
        case learnedToken: // normal, "learned"
            khz = toFrequencyKHz(data[1]);
            break;
        case learnedNonModulatedToken: // non-demodulated, "learned"
            khz = 0U;
            break;
        default:
            return; // There are other types, but they are not handled yet.
    }
    unsigned int intros = 2*data[2];
    unsigned int repeats = 2*data[3];
    if (numbersInPreamble + intros + repeats != size) // inconsistent sizes
        return;

    unsigned int durations[intros + repeats];
    for (unsigned int i = 0; i < intros + repeats; i++) {
        uint32_t duration = ((uint32_t) data[i + numbersInPreamble]) * timebase;
        durations[i] = (unsigned int) ((duration <= MICROSECONDS_T_MAX) ? duration : MICROSECONDS_T_MAX);
    }

    unsigned int numberRepeats = intros > 0 ? times - 1 : times;
    if (intros > 0) {
        sendRaw(durations, intros - 1, khz);
    }

    if (numberRepeats == 0)
        return;

    delay(durations[intros - 1] / 1000U);
    for (unsigned int i = 0; i < numberRepeats; i++) {
        sendRaw(durations + intros, repeats - 1, khz);
        if (i < numberRepeats - 1) { // skip last wait
            delay(durations[intros + repeats - 1] / 1000U);
        }
    }
}


void IRsend::sendPronto(const char *str, unsigned int times) {
    size_t len = strlen(str)/(digitsInProntoNumber + 1) + 1;
    uint16_t data[len];
    const char *p = str;
    char *endptr[1];
    for (unsigned int i = 0; i < len; i++) {
        long x = strtol(p, endptr, 16);
        if (x == 0 && i >= numbersInPreamble) {
            // Alignment error?, bail immediately (often right result).
            len = i;
            break;
        }
        data[i] = static_cast<uint16_t>(x); // If input is conforming, there can be no overflow!
        p = *endptr;
    }
    sendPronto(data, len, times);
}

#if HAS_FLASH_READ
void IRsend::sendPronto_PF(uint_farptr_t str, unsigned int times) {
    size_t len = strlen_PF(STRCPY_PF_CAST(str));
    char work[len + 1];
    strncpy_PF(work, STRCPY_PF_CAST(str), len);
    sendPronto(work, times);
}

void IRsend::sendPronto_PF(const char *str, unsigned int times) {
    sendPronto_PF(reinterpret_cast<uint_farptr_t>(str), times); // to avoid infinite recursion
};

void IRsend::sendPronto(const __FlashStringHelper *str, unsigned int times) {
    return sendPronto_PF(reinterpret_cast<uint_farptr_t>(str), times);
}
#endif

static uint16_t effectiveFrequency(uint16_t frequency) {
    return frequency > 0 ? frequency : fallbackFrequency;
}

static uint16_t toTimebase(uint16_t frequency) {
    return microsecondsInSeconds / effectiveFrequency(frequency);
}

static uint16_t toFrequencyCode(uint16_t frequency) {
    return referenceFrequency / effectiveFrequency(frequency);
}

static char hexDigit(unsigned int x) {
    return (char) (x <= 9 ? ('0' + x) : ('A' + (x - 10)));
}

static void dumpDigit(Stream& stream, unsigned int number) {
    stream.print(hexDigit(number));
}

static void dumpNumber(Stream& stream, uint16_t number) {
    for (unsigned int i = 0; i < digitsInProntoNumber; i++) {
        unsigned int shifts = bitsInHexadecimal * (digitsInProntoNumber - 1 - i);
        dumpDigit(stream, (number >> shifts) & hexMask);
    }
    stream.print(' ');
}

static void dumpDuration(Stream& stream, uint16_t duration, uint16_t timebase) {
    dumpNumber(stream, (duration * MICROS_PER_TICK + timebase / 2) / timebase);
}

static void dumpSequence(Stream& stream, const volatile unsigned int *data, size_t length, uint16_t timebase) {
    for (unsigned int i = 0; i < length; i++)
        dumpDuration(stream, data[i], timebase);

    dumpDuration(stream, _GAP, timebase);
}

void IRrecv::dumpPronto(Stream& stream, unsigned int frequency) {
    dumpNumber(stream, frequency > 0 ? learnedToken : learnedNonModulatedToken);
    dumpNumber(stream, toFrequencyCode(frequency));
    dumpNumber(stream, (results.rawlen + 1) / 2);
    dumpNumber(stream, 0);
    unsigned int timebase = toTimebase(frequency);
    dumpSequence(stream, results.rawbuf + RESULT_JUNK_COUNT, results.rawlen - RESULT_JUNK_COUNT, timebase);
}