File content as of revision 0:c80e972b4c59:

// Frame Level Language
// implementation

#include "mbed.h"
#include "rtos.h"
#include <stdint.h>
#include <vector>
#include "fll.h"

// ------
// Source
// ------
Source::Source(std::vector<button>* bs, bool l)
{
    button_seq = bs;
    loop = l;
    i = 0;
}

// TODO: without loop
button Source::await()
{
    int size = button_seq->size();
    if (size == 0) {
        return 0;
    } else if (i >= size) {
        i = 0;
        return button_seq->at(0);
    } else {
        return button_seq->at(i++);
    }
}

// ----
// Flow
// ----
button Flow::await()
{
    std::vector<button> bs;
    for (int k = 0; k < sources.size(); k++) {
        button b = sources[k]->await();
        bs.push_back(b);
    }
    return fold(bs);
}

// -----
// Carry
// -----
Carry::Carry()
{
    btn = Carry::none;
}

bool Carry::is_empty()
{
    if (btn & Carry::none) { // TODO: 冗長
        return true;
    } else {
        return false;
    }
}
button Carry::get()
{
    return btn;
}
void Carry::set(button b)
{
    btn = b;
}
void Carry::empty()
{
    btn = Carry::none;
}

// ----
// Sink
// ----
Sink::Sink(Source* src, rtos::Mail<button, QUEUE_SIZE>* q, Mutex* mut)
{
    source = src;
    carry = new Carry();
    queue = q;
    queueMutex = mut;
}

// 何ミリ秒かごとに呼ばれる
void Sink::run()
{
    for (int i = 0; i < 8; i++) { // FIXME: 8?
        button* btn = queue->alloc();
        // carry がないならストリームから Pull
        if (carry->is_empty()) {
            *btn = source->await();
        } else {
            *btn = carry->get();
        }
        queueMutex->lock();
        osStatus status = queue->put(btn);
        queueMutex->unlock();
        if (status != osOK) {
            carry->set(*btn);
            break;
        }
    }
}

void Sink::reset(Source* src)
{
    queueMutex->lock();
    // queue を空にする
    osEvent e;
    do {
        e = queue->get();
    } while (e.status == osOK);
    // source の更新
    source = src;
    queueMutex->unlock();
}

// ------
// Output
// ------
Output::Output(rtos::Mail<button, QUEUE_SIZE>* q)
{
    queue = q;
}

void Output::run()
{
    osEvent e = queue->get();
    if (e.status == osEventMessage) {
        button b = (button)e.value.v;
        press(b);
    } else {
        press(0); // Mail になかった
    }
}

// fll_keymap.cpp
//
// | uint16 bit | button | mbed pin | low/high |
// +------------+--------+----------+----------+
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// |     0x0000 |        |          |          |
// +------------+--------+----------+----------+
//
// Examples:
//   0000 0000 0000 0000 === nothing is pressed
//   0010 0100 1000 0001 === ?, ?, ? and ? are pressed
typedef struct _table {
    button mask; // 0000 0000 0000 0001 ~ 0010 0000 0000 0000
    DigitalOut *pin; // pin5~pin19
    int on; // 1 or 0
} table;

DigitalOut pinR2(p10);
DigitalOut pinR1(p5);
DigitalOut pinTriangle(p6);
DigitalOut pinCircle(p7);
DigitalOut pinCross(p8);
DigitalOut pinSquare(p9);
DigitalOut pinStart(p11);
DigitalOut pinAnalog(p12);
DigitalOut pinSelect(p13);
DigitalOut pinRight(p18);
DigitalOut pinDown(p16);
DigitalOut pinLeft(p17);
DigitalOut pinUp(p15);
DigitalOut pinL1(p19);
DigitalOut pinL2(p14);

table tables[] = {
    { R1, &pinR1, 0 },
    { B_TRIANGLE, &pinTriangle, 0 },
    { B_CIRCLE, &pinCircle, 0 },
    { B_CROSS, &pinCross, 0 },
    { B_SQUARE, &pinSquare, 0 },
    { B_R2, &pinR2, 0 },
    { B_START, &pinStart, 0 },
    { B_ANALOG, &pinAnalog, 0 },
    { B_SELECT, &pinSelect, 0 },
    { B_L2, &pinL2, 0 },
    { B_UP, &pinUp, 0 },
    { B_DOWN, &pinDown, 0 },
    { B_LEFT, &pinLeft, 0 },
    { B_RIGHT, &pinRight, 0 },
    { B_L1, &pinL1, 0 }
};

// Serial pc(USBTX, USBRX);
// pc.printf("0x%02x\n", btn);

// 押されるボタンを押す
void press(button btn)
{
    for (int i = 0; i < sizeof(tables)/sizeof(table); i++) {
        table t = tables[i];
        if (btn & t.mask) {
            t.pin->write(t.on);
        } else {
            t.pin->write(1 - t.on);
        }
    }
}