MtConnect04S Bike Proximity Lock

File content as of revision 1:9f5ecbaa7606:

#include "mbed.h"
#include "ble/BLE.h"
#include "BMA250.h"


/* UART printf */
Serial pc(p5, p4);

/* Rear light */
DigitalOut rl(p16, 0);

/* Buzzer */
PwmOut bz(p1);

/* Sensor */
BMA250 bma250(p14, p13, p0, NC);

/* UUID, Device name */
uint16_t syncServUUID = 0x180A; /* Synchronize the status of Rear light with Head light */
uint16_t syncCharUUID = 0x2B03;
static const char     DEVICE_NAME[] = "ASE_proximity";   //"mbed Proximity";
static const uint16_t uuid16_list[] = { 0x180A };

/* Setup custom characteristics */
uint8_t syncPayload[1];
GattCharacteristic  syncChar(   syncCharUUID, syncPayload,
                                sizeof(syncPayload), sizeof(syncPayload),
                                GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE);

/* Setup custom service */
GattCharacteristic *characteristics[] = {&syncChar};
GattService syncServ(syncServUUID, characteristics, sizeof(characteristics) / sizeof(GattCharacteristic *));


void rl_on(void)
{
    rl = 1;
}

void rl_off(void)
{
    rl = 0;
}

void bz_on_494hz(void)
{
    bz.period(1.0f / 494);
    bz.write(0.5);
}

void bz_on_988hz(void)
{
    bz.period(1.0f / 988);
    bz.write(0.5);
}

void bz_off(void)
{
    bz.period(0);
    bz.write(1);    // output low
}

void connectionCallback(const Gap::ConnectionCallbackParams_t *params)
{
    pc.printf("connection\n");

    bma250.EnterStandbyMode();  // sensor enters standby mode

    /* flash and beep 1 times */
    rl_on();
    bz_on_988hz();
    wait(0.5);
    rl_off();
    bz_off();
    wait(0.5);
}

void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params)
{
    BLE::Instance(BLE::DEFAULT_INSTANCE).gap().startAdvertising(); // restart advertising
    
    pc.printf("disconnection\n");
    
    /* flash and beep 2 times */
    rl_off();
    bz_off();
    wait(0.5);
    rl_on();
    bz_on_988hz();
    wait(0.5);
    rl_off();
    bz_off();
    wait(0.5);
    rl_on();
    bz_on_988hz();
    wait(0.5);
    rl_off();
    bz_off();

    bma250.LeaveStandbyMode();  // sensor leaves standby mode (enters normal mode)
}
    
void dataWrittenCallback(const GattWriteCallbackParams *params)
{
    pc.printf("dataWritten\n");
    
    if ((params->handle == syncChar.getValueHandle()) && (params->len == 1)) {
        pc.printf("data(%d)\n", *(params->data));

        uint8_t head_light_status = *(params->data);
        if (head_light_status)  rl_on();
        else                    rl_off();        
    }        
}

void _alarm(void)
{    
    for(int i=0; i<3; i++){
        rl_on();
        bz_on_494hz();
        wait(0.5);
        
        rl_off();
        bz_on_988hz();
        wait(0.5);
    }
}

void _two_tiger(void)
{
    bz.period(1.0f / 262);  //do
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 294);  //re
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 330);  //mi
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 262);  //do
    bz.write(0.5);
    wait(0.4);
    
    bz.period(1.0f / 262);  //do
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 294);  //re
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 330);  //mi
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 262);  //do
    bz.write(0.5);
    wait(0.4);

    
    bz.period(1.0f / 330);  //mi
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 349);  //fa
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 392);  //so
    bz.write(0.5);
    wait(0.8);
    
    bz.period(1.0f / 330);  //mi
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 349);  //fa
    bz.write(0.5);
    wait(0.4);
    bz.period(1.0f / 392);  //so
    bz.write(0.5);
    wait(0.8);
}

void BMA250_int1Callback() {
    pc.printf("BMA250_int1\n");

#if 1
    _alarm();
#else
    _two_tiger();
#endif

    rl_off();
    bz_off();
}

void bleInitComplete(BLE::InitializationCompleteCallbackContext *params)
{
    BLE &ble          = params->ble;
    ble_error_t error = params->error;

    if (error != BLE_ERROR_NONE) {
        return;
    }

    ble.gap().onConnection(connectionCallback);
    ble.gap().onDisconnection(disconnectionCallback);
    ble.gattServer().onDataWritten(dataWrittenCallback);

    /* Setup primary service. */
    ble.addService(syncServ);

    /* Setup advertising. */
    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED | GapAdvertisingData::LE_GENERAL_DISCOVERABLE);
    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS, (uint8_t *)uuid16_list, sizeof(uuid16_list));
    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::GENERIC_TAG);
    ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
    ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
    ble.gap().setAdvertisingInterval(500); /* 500ms */
    ble.gap().startAdvertising();
}

int main(void)
{
    /* Force to disable the hardware flow control of Serial */
    *((uint32_t *)(0x40002000+0x56C)) = 0;
    pc.printf("~ Hell World ~\n");

    /* Init BLE */
    BLE& ble = BLE::Instance(BLE::DEFAULT_INSTANCE);
    ble.init(bleInitComplete);
    while (ble.hasInitialized()  == false) { /* spin loop */ }

    /* Init I/O */
    rl_off();
    bz_off();

    /* Config sensor */
    bma250.ShakeDetection(&BMA250_int1Callback, 1);

    /* Main loop */
    while (1) {
        /* low power wait for event */
        pc.printf("sleep\n");
        ble.waitForEvent();
        pc.printf("wakeup\n");
    }
}