File content as of revision 3:6a9f4ea2e7c6:

#include "mbed.h"
#include "BLEDevice.h"
#include "RCBController.h"

#define DBG 1

BLEDevice  ble;
Serial  pc(USBTX, USBRX);
/* LEDs for indication: */
DigitalOut  ConnectStateLed(LED1);
PwmOut  servo1(LED2);


/* RCBController Service */
static const uint16_t RCBController_service_uuid = 0xFFF0;
static const uint16_t RCBController_Characteristic_uuid = 0xFFF1;
uint8_t RCBControllerPayload[10] = {0,};

GattCharacteristic  ControllerChar (RCBController_Characteristic_uuid,RCBControllerPayload,10, 10,
								GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | 
								GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE);
GattCharacteristic *ControllerChars[] = {&ControllerChar};
GattService         RCBControllerService(RCBController_service_uuid, ControllerChars, sizeof(ControllerChars) / sizeof(GattCharacteristic *));

RCBController controller;

void onConnected(uint16_t h)
{
    ConnectStateLed = 0;
#if DBG
	pc.printf("Connected\n\r");
#endif
}

void onDisconnected(uint16_t h)
{
    ble.startAdvertising();
	ConnectStateLed = 1;
#if DBG
	pc.printf("Disconnected\n\r");
#endif
}
const int deg0msec = 600; // msec.
const int deg180msec = 2350; // msec.

void SwOn(void)
{
	float range = (float)(deg180msec - deg0msec)/1000000;  //0.00175
	float pwitdh;
	for(int i=128;i<210;i++){
		pwitdh = (float)(i*range)/256+(float)deg0msec/1000000;
        servo1.pulsewidth(pwitdh);
        wait(0.001);
 	}
    wait(0.5);
	for(int i=210;i>128;i--){
		pwitdh = (float)(i*range)/256+ (float)deg0msec/1000000;
        servo1.pulsewidth(pwitdh);
        wait(0.001);
	}
    servo1.pulsewidth( 0.00140f );

}
void SwOff(void)
{
	float range = (float)(deg180msec - deg0msec)/1000000;  //0.00175
	float pwitdh;
	for(int i=128;i>40;i--){
		pwitdh = (float)(i*range)/256+(float)deg0msec/1000000;
        servo1.pulsewidth(pwitdh);
        wait(0.001);
 	}
    wait(0.5);
	for(int i=40;i<128;i++){
		pwitdh = (float)(i*range)/256+ (float)deg0msec/1000000;
        servo1.pulsewidth(pwitdh);
        wait(0.001);
	}
    servo1.pulsewidth( 0.00140f );
}


// GattEvent
void onDataWritten(uint16_t charHandle)
{
	if (charHandle == ControllerChar.getHandle()) {
		uint16_t bytesRead;
	 	ble.readCharacteristicValue(ControllerChar.getHandle(),RCBControllerPayload, &bytesRead);
        memcpy( &controller.data[0], RCBControllerPayload, sizeof(controller));
#if DBG

		pc.printf("DATA:%02X %02X %d %d %d %d %d %d %d %02X\n\r",controller.data[0],controller.data[1],controller.data[2],controller.data[3],controller.data[4],
															   controller.data[5],controller.data[6],controller.data[7],controller.data[8],controller.data[9]);
#endif

   if (controller.data[0] ==1){
      SwOn();
   }
   else if (controller.data[1] == 0x40){
      SwOff();
   }
/*
//		servo1 = (float)controller.status.LeftAnalogLR / 255.0;		
		float pwitdh = (float)controller.status.LeftAnalogLR / 255.0;		
float range = (float)(deg180msec - deg0msec)/1000000;  //0.00175

pwitdh = pwitdh *range+(float)deg0msec/1000000;
    pc.printf("pwitdh %f\n\r",pwitdh);
        servo1.pulsewidth(pwitdh);
	}
*/
}

}

/**************************************************************************/
/*!
    @brief  Program entry point
*/
/**************************************************************************/
int main(void)
{
#if DBG
		ConnectStateLed = 1;
        pc.baud(115200);  
		pc.printf("Start\n\r");
#endif
	
    ble.init(); 
    ble.onConnection(onConnected);
    ble.onDisconnection(onDisconnected);
    ble.onDataWritten(onDataWritten);
	
    /* setup advertising */
    ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED);
    ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
    ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME,
                                    (const uint8_t *)"mbed HRM1017", sizeof("mbed HRM1017") - 1);
    ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_16BIT_SERVICE_IDS,
                                    (const uint8_t *)RCBController_service_uuid, sizeof(RCBController_service_uuid));

    ble.setAdvertisingInterval(160); /* 100ms; in multiples of 0.625ms. */
    ble.startAdvertising();

    ble.addService(RCBControllerService);
    servo1.period_ms(20);
    servo1.pulsewidth( 0.00140f );

    while (true) {
        ble.waitForEvent();
    }
}