Revision 0:1f985a7c0a8b, committed 2014-06-03

Comitter:

devsar

Date:

Tue Jun 03 04:25:33 2014 +0000

Commit message:

Working code!

Changed in this revision

diff -r 000000000000 -r 1f985a7c0a8b BLE_API.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/BLE_API.lib	Tue Jun 03 04:25:33 2014 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/teams/Bluetooth-Low-Energy/code/BLE_API/#2c30cb482915

diff -r 000000000000 -r 1f985a7c0a8b README.txt
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/README.txt	Tue Jun 03 04:25:33 2014 +0000
@@ -0,0 +1,122 @@
+INTRODUCTION
+============
+This is a POC (Proof of Concept) for implementing
+ANCS (Apple Notification Center Service)with 
+NRF51822-mKit (mbed) platform.
+
+The code is not meant to be use for implementation,
+whatsoever.
+
+I'm not intent to further enhancing this code.
+The sole purpose is to show that we can use
+SoftDevice client api for doing ANCS with NRF51822-mkit.
+(At this time, BLE API doesn't expose Gatt Client API)
+
+This program code are bypassing mbed BLE API and use
+Soft Device (S110) Gatt Client API directly.
+
+If you want to explore the code, S110 API Reference will
+be handy.
+
+I know, there are many bugs, and things not implemented
+correctly. But again, the purpose of this code is just
+to show thant Gatt Client API is indeed doable. 
+
+
+WHAT NEXT?
+==========
+Since with this code, ANCS with mbed (NRF51822-mkit) is
+doable, the next step is to implement GATT CLIENT API on 
+mbed BLE API. 
+That should make programming more understandable (and
+perhaps portable to other platform) than using SD API
+directly.
+
+
+HOW TO TEST THIS OUT?
+=====================
+You gonna need:
+1. iOS7 (iPhone/iPad)
+   *recomended: iPush Test, free app to generate test notification.
+    but if you can generate notification by yourself
+    anything will be sufficient.
+2. NRF51822-mKIT, connected to PC
+   (debug log and the notification itself will
+     be print out via usb com port).
+   *teraterm etc is needed to access com port.
+    (depend on your platform) 
+     
+Ready for the action!
+1. Compile the code, transfer the binary file to mkit.
+2. Use teraterm etc, to connect to mkit com port. 
+3. Press reset. LED1(advertise) should turn on.
+   You should see Appendix 1 Log.
+4. On iOS7, select "Settings", "Bluetooth".
+   You should see "ANCC" on the devices list.
+   Click it to connect. LED2(connected) should turn on.
+5. A Dialog will appear: "Bluetooth Pairing Request"
+   Press "Pair"
+   You should see Appendix 2 Log.
+
+   That's it you ready to receive notification.
+   There's a free app on app store for generating
+   push notification. Search "push test" on app store.
+ 
+6. Run iPush Test app
+7. Click "Local Push Test"
+8. You will receive notification in about 1 minute.
+
+ 
+
+Appendix 1 (Program Start Log)
+==============================
+Program started
+timers_init()
+ble_stack_init()
+gap_params_init()
+set_128_uuid()
+advertising_init()
+conn_params_init()
+sec_params_init()
+advertising_start()
+
+Appendix 2 (iOS Connect and Pairing)
+====================================
+Event: BLE_GAP_EVT_CONNECTED (Connection established.)
+Event: BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP  (Primary Service Discovery Response event.)
+Found ANCS service, start handle: 15, end handle: 24
+Event: BLE_GATTC_EVT_CHAR_DISC_RSP  (Characteristic Discovery Response event.)
+Found char: Control PointEvent: BLE_GATTS_EVT_WRITE  (Write operation performed.)
+Event: BLE_GATTC_EVT_CHAR_DISC_RSP  (Characteristic Discovery Response event.)
+Found char: Notification SourceEvent: BLE_GATTC_EVT_CHAR_DISC_RSP  (Characteristic Discovery Response event.)
+Found char: Data SourceEvent: BLE_GATTC_EVT_CHAR_DISC_RSP  (Characteristic Discovery Response event.)
+Event: BLE_GATTC_EVT_DESC_DISC_RSP  (Descriptor Discovery Response event.)
+Found NS CCC
+Event: BLE_GATTC_EVT_DESC_DISC_RSP  (Descriptor Discovery Response event.)
+Found DS CCC
+Event: BLE_GAP_EVT_SEC_PARAMS_REQUEST  (Request to provide security parameters.)
+Event: BLE_GAP_EVT_AUTH_STATUS  (Authentication procedure completed with status.)
+Event: BLE_GAP_EVT_CONN_SEC_UPDATE  (Connection security updated.)
+Event: BLE_GATTC_EVT_WRITE_RSP (Write Response event.)
+NS subscribe success.
+Event: BLE_GATTC_EVT_WRITE_RSP (Write Response event.)
+DS subscribe success.
+
+Appendix 3 (Receiving Notification)
+===================================
+Event: BLE_GATTC_EVT_HVX  (Handle Value Notification or Indication event.)
+Event ID: 0 (Notification Added)
+Event Flags: 0 ((no flags))
+Category ID: 0 (Other)
+Category Count: 1
+Notification ID: 6 0 0 0
+Event: BLE_GATTC_EVT_WRITE_RSP (Write Response event.)
+CP write success.
+Event: BLE_GATTC_EVT_HVX  (Handle Value Notification or Indication event.)
+Title:(10)iPush Test
+
+Link
+====
+1. ANCS
+   https://developer.apple.com/library/ios/documentation/CoreBluetooth/Reference/AppleNotificationCenterServiceSpecification/Introduction/Introduction.html
+   

diff -r 000000000000 -r 1f985a7c0a8b debug.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/debug.cpp	Tue Jun 03 04:25:33 2014 +0000
@@ -0,0 +1,338 @@
+
+// Set error string based on error number for
+// convinience debugging purpose.
+// See: API Reference>S110>SofDevice Global Error Codes
+#include <stdint.h>
+#include <stdio.h>
+
+#include "nRF51822n.h"
+
+#define MAX_BUFFER 100
+char m_error_string[MAX_BUFFER];
+char m_event_string[MAX_BUFFER];
+char m_nrfevent_string[MAX_BUFFER];
+char m_ancs_string[MAX_BUFFER];
+
+
+char *get_error_unknown(uint32_t error_num) {
+    snprintf(m_error_string, MAX_BUFFER, "Unknown");
+    return m_error_string;
+}
+
+// Global error base.
+char *get_error_global(uint32_t error_num) {
+    if(error_num == NRF_ERROR_BASE_NUM + 0){
+        snprintf(m_error_string, MAX_BUFFER, "Successful command. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 1){
+        snprintf(m_error_string, MAX_BUFFER, "SVC handler is missing. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 2){
+        snprintf(m_error_string, MAX_BUFFER, "SoftDevice has not been enabled. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 3){
+        snprintf(m_error_string, MAX_BUFFER, "Internal Error. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 4){
+        snprintf(m_error_string, MAX_BUFFER, "No Memory for operation. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 5){
+        snprintf(m_error_string, MAX_BUFFER, "Not found. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 6){
+        snprintf(m_error_string, MAX_BUFFER, "Not supported. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 7){
+        snprintf(m_error_string, MAX_BUFFER, "Invalid Parameter. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 8){
+        snprintf(m_error_string, MAX_BUFFER, "Invalid state, operation disallowed in this state. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 9){
+        snprintf(m_error_string, MAX_BUFFER, "Invalid Length. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 10){
+        snprintf(m_error_string, MAX_BUFFER, "Invalid Flags. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 11){
+        snprintf(m_error_string, MAX_BUFFER, "Invalid Data. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 12){
+        snprintf(m_error_string, MAX_BUFFER, "Data size exceeds limit. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 13){
+        snprintf(m_error_string, MAX_BUFFER, "Operation timed out. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 14){
+        snprintf(m_error_string, MAX_BUFFER, "Null Pointer. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 15){
+        snprintf(m_error_string, MAX_BUFFER, "Forbidden Operation. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 16){
+        snprintf(m_error_string, MAX_BUFFER, "Bad Memory Address. ");
+    } else if(error_num == NRF_ERROR_BASE_NUM + 17){
+        snprintf(m_error_string, MAX_BUFFER, "Busy. ");        
+    } else {
+        return get_error_unknown(error_num);
+    }
+    return m_error_string;
+}
+
+// SDM error base.
+char *get_error_sdm(uint32_t error_num) {
+    if(error_num == NRF_ERROR_SDM_BASE_NUM + 0){
+        snprintf(m_error_string, MAX_BUFFER, "Unknown lfclk source. ");
+    } else if(error_num == NRF_ERROR_SDM_BASE_NUM + 1){
+        snprintf(m_error_string, MAX_BUFFER, "Incorrect interrupt configuration (can be caused by using illegal priority levels, or having enabled SoftDevice interrupts) ");
+    } else if(error_num == NRF_ERROR_SDM_BASE_NUM + 2){
+        snprintf(m_error_string, MAX_BUFFER, "Incorrect CLENR0 (can be caused by erronous SoftDevice flashing) ");
+    } else {
+        return get_error_unknown(error_num);
+    }    
+    return m_error_string;
+}
+
+// SoC error base.
+char *get_error_soc(uint32_t error_num) {
+    if(error_num == NRF_ERROR_SOC_BASE_NUM + 0){
+        snprintf(m_error_string, MAX_BUFFER, "Mutex already taken. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 1){
+        snprintf(m_error_string, MAX_BUFFER, "NVIC interrupt not available. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 2){
+        snprintf(m_error_string, MAX_BUFFER, "NVIC interrupt priority not allowed. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 3){
+        snprintf(m_error_string, MAX_BUFFER, "NVIC should not return. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 4){
+        snprintf(m_error_string, MAX_BUFFER, "Power mode unknown. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 5){
+        snprintf(m_error_string, MAX_BUFFER, "Power POF threshold unknown. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 6){
+        snprintf(m_error_string, MAX_BUFFER, "Power off should not return. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 7){
+        snprintf(m_error_string, MAX_BUFFER, "RAND not enough values. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 8){
+        snprintf(m_error_string, MAX_BUFFER, "Invalid PPI Channel. ");        
+    } else if(error_num == NRF_ERROR_SOC_BASE_NUM + 9){
+        snprintf(m_error_string, MAX_BUFFER, "Invalid PPI Group. ");        
+    } else {
+        return get_error_unknown(error_num);
+    }
+    return m_error_string;
+}
+
+// STK error base.
+char *get_error_stk(uint32_t error_num) {
+    snprintf(m_error_string, MAX_BUFFER, "stk error.");
+    return m_error_string;
+}
+
+char *error2string(uint32_t error_num) {
+    
+    if(error_num<NRF_ERROR_SDM_BASE_NUM) {
+        return get_error_global(error_num);
+    } else if(error_num<NRF_ERROR_SDM_BASE_NUM) {
+        return get_error_sdm(error_num);
+    } else if(error_num<NRF_ERROR_SOC_BASE_NUM) {
+        return get_error_soc(error_num);
+    } else if(error_num<NRF_ERROR_STK_BASE_NUM) {
+        return get_error_stk(error_num);
+    } else {
+        return get_error_unknown(error_num);
+    }
+     
+}
+
+char *event2string(ble_evt_t * p_ble_evt) {
+    switch (p_ble_evt->header.evt_id) { 
+        // GAP
+        case BLE_GAP_EVT_CONNECTED:
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_CONNECTED", "Connection established.");
+            break;
+        case BLE_GAP_EVT_DISCONNECTED :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_DISCONNECTED ", "Disconnected from peer.");
+            break;
+        case BLE_GAP_EVT_CONN_PARAM_UPDATE:
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_CONN_PARAM_UPDATE", "Connection Parameters updated.");
+            break;
+        case BLE_GAP_EVT_SEC_PARAMS_REQUEST :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_SEC_PARAMS_REQUEST ", "Request to provide security parameters.");
+            break;
+        case BLE_GAP_EVT_SEC_INFO_REQUEST :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_SEC_INFO_REQUEST ", "Request to provide security information.");
+            break;
+        case BLE_GAP_EVT_PASSKEY_DISPLAY:
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_PASSKEY_DISPLAY", "Request to display a passkey to the user.");
+            break;
+        case BLE_GAP_EVT_AUTH_KEY_REQUEST:
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_AUTH_KEY_REQUEST", "Request to provide an authentication key.");
+            break;
+        case BLE_GAP_EVT_AUTH_STATUS :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_AUTH_STATUS ", "Authentication procedure completed with status.");
+            break;
+        case BLE_GAP_EVT_CONN_SEC_UPDATE:
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_CONN_SEC_UPDATE ", "Connection security updated.");
+            break;
+        case BLE_GAP_EVT_TIMEOUT :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_TIMEOUT ", "Timeout expired.");
+            break;
+        case BLE_GAP_EVT_RSSI_CHANGED :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GAP_EVT_RSSI_CHANGED ", "Signal strength measurement report.");
+            break;
+        // GATTC
+        case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP ", "Primary Service Discovery Response event.");
+            break;
+        case BLE_GATTC_EVT_REL_DISC_RSP  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_REL_DISC_RSP ", "Relationship Discovery Response event.");
+            break;
+        case BLE_GATTC_EVT_CHAR_DISC_RSP  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_CHAR_DISC_RSP ", "Characteristic Discovery Response event.");
+            break;
+        case BLE_GATTC_EVT_DESC_DISC_RSP  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_DESC_DISC_RSP ", "Descriptor Discovery Response event.");
+            break;
+        case BLE_GATTC_EVT_CHAR_VAL_BY_UUID_READ_RSP :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_CHAR_VAL_BY_UUID_READ_RSP", "Read By UUID Response event.");
+            break;
+        case BLE_GATTC_EVT_READ_RSP  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_READ_RSP ", "Read Response event.");
+            break;
+        case BLE_GATTC_EVT_CHAR_VALS_READ_RSP  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_CHAR_VALS_READ_RSP ", "Read multiple Response event.");
+            break;
+        case BLE_GATTC_EVT_WRITE_RSP  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_WRITE_RSP", "Write Response event.");
+            break;
+        case BLE_GATTC_EVT_HVX  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_HVX ", "Handle Value Notification or Indication event.");
+            break;
+        case BLE_GATTC_EVT_TIMEOUT  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTC_EVT_TIMEOUT ", "Timeout event.");
+            break;
+        // GATTS
+        case BLE_GATTS_EVT_WRITE  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTS_EVT_WRITE ", "Write operation performed.");
+            break;
+        case BLE_GATTS_EVT_RW_AUTHORIZE_REQUEST  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTS_EVT_RW_AUTHORIZE_REQUEST ", "Read/Write Authorization request.");
+            break;
+        case BLE_GATTS_EVT_SYS_ATTR_MISSING  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTS_EVT_SYS_ATTR_MISSING ", "A persistent system attribute access is pending, awaiting a sd_ble_gatts_sys_attr_set().");
+            break;
+        case BLE_GATTS_EVT_HVC  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTS_EVT_HVC ", "Handle Value Confirmation.");
+            break;
+        case BLE_GATTS_EVT_SC_CONFIRM  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTS_EVT_SC_CONFIRM ", "Service Changed Confirmation.");
+            break;
+        case BLE_GATTS_EVT_TIMEOUT  :
+            snprintf(m_event_string, MAX_BUFFER, "%s (%s)", "BLE_GATTS_EVT_TIMEOUT ", "Timeout.");
+            break;
+        //
+        default:
+            snprintf(m_event_string, MAX_BUFFER, "Event: Unknown (%d)", p_ble_evt->header.evt_id);
+            break;
+    }        
+
+    return m_event_string;    
+}
+
+
+char *nrfevent2string(uint32_t evt_id) {
+    switch (evt_id) { 
+//        case NRF_EVT_HFCLKSTARTED   :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_HFCLKSTARTED", "Event indicating that the HFCLK has started.");
+//            break;
+//        case NRF_EVT_POWER_FAILURE_WARNING   :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_POWER_FAILURE_WARNING", "Event indicating that a power failure warning has occurred.");
+//            break;
+//        case NRF_EVT_FLASH_OPERATION_SUCCESS   :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_FLASH_OPERATION_SUCCESS", "Event indicating that the ongoing flash operation has completed successfully.");
+//            break;
+//        case NRF_EVT_FLASH_OPERATION_ERROR  :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_FLASH_OPERATION_ERROR", "Event indicating that the ongoing flash operation has timed out with an error.");
+//            break;
+//        case NRF_EVT_HFCLKSTARTED   :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_HFCLKSTARTED ", "Event indicating that the HFCLK has started.");
+//            break;
+//        case NRF_EVT_POWER_FAILURE_WARNING  :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_POWER_FAILURE_WARNING", "Event indicating that a power failure warning has occurred.");
+//            break;
+//        case NRF_EVT_FLASH_OPERATION_SUCCESS  :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_FLASH_OPERATION_SUCCESS", "Event indicating that the ongoing flash operation has completed successfully.");
+//            break;
+//        case NRF_EVT_FLASH_OPERATION_ERROR   :
+//            snprintf(m_nrfevent_string, MAX_BUFFER, "%s (%s)", "NRF_EVT_FLASH_OPERATION_ERROR ", "Event indicating that the ongoing flash operation has timed out with an error.");
+//            break;
+        default:
+            snprintf(m_nrfevent_string, MAX_BUFFER, "Event: Unknown (%d)", evt_id);
+            break;
+    }        
+
+    return m_nrfevent_string;
+}
+
+char *eventid2string(uint8_t d) {
+    switch (d) {   
+        case 0 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Notification Added");
+            break;
+        case 1 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Notification Modified");
+            break;
+        case 2 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Notification Removed");
+            break;            
+        default:
+            snprintf(m_ancs_string, MAX_BUFFER, "Reserved (%d)", d);
+            break;
+    }        
+
+    return m_ancs_string;
+}
+
+char *eventflags2string(uint8_t d) {
+    snprintf(m_ancs_string, MAX_BUFFER, "(no flags)");
+    if(d & 3) {
+        snprintf(m_ancs_string, MAX_BUFFER, "%s", "Silent & Important");
+    } else if(d & 1) {
+        snprintf(m_ancs_string, MAX_BUFFER, "%s", "Silent");
+    } else if(d & 2) {
+        snprintf(m_ancs_string, MAX_BUFFER, "%s", "Important");
+    }
+
+    return m_ancs_string;
+}
+
+char *categoryid2string(uint8_t d) {
+    switch (d) {   
+        case 0 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Other");
+            break;
+        case 1 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Incomming Call");
+            break;
+        case 2 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Missed Call");
+            break;            
+        case 3 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Voice Mail");
+            break;
+        case 4 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Social");
+            break;
+        case 5 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Schedule");
+            break;            
+        case 6 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Email");
+            break;
+        case 7 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "News");
+            break;
+        case 8 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Health And Fitness");
+            break;            
+        case 9 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Business And Finance");
+            break;
+        case 10 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Location"); // iBeacon?
+            break;
+        case 11 :
+            snprintf(m_ancs_string, MAX_BUFFER, "%s", "Entertainment");
+            break;            
+        default:
+            snprintf(m_ancs_string, MAX_BUFFER, "Reserved (%d)", d);
+            break;
+    }        
+
+    return m_ancs_string;
+}
+
+

diff -r 000000000000 -r 1f985a7c0a8b debug.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/debug.h	Tue Jun 03 04:25:33 2014 +0000
@@ -0,0 +1,10 @@
+extern char *error2string(uint32_t error_num);
+extern char *event2string(ble_evt_t * p_ble_evt);
+extern char *nrfevent2string(uint32_t evt_id);
+
+
+// ANCS
+extern char *eventid2string(uint8_t d);
+extern char *eventflags2string(uint8_t d);
+extern char *categoryid2string(uint8_t d);
+

diff -r 000000000000 -r 1f985a7c0a8b main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Jun 03 04:25:33 2014 +0000
@@ -0,0 +1,773 @@
+#include <stdbool.h>
+#include <stdint.h>
+#include <string.h>
+
+#include "mbed.h"
+#include "nRF51822n.h"
+
+#include "nordic_common.h"
+//#include "nrf.h"
+#include "app_error.h"
+#include "ble_hci.h"
+#include "ble_gap.h"
+#include "ble_advdata.h"
+#include "ble_error_log.h"
+#include "nrf_gpio.h"
+#include "ble_srv_common.h"
+#include "ble_conn_params.h"
+#include "nrf51_bitfields.h"
+#include "ble_bondmngr.h"
+#include "app_timer.h"
+#include "ble_radio_notification.h"
+#include "ble_flash.h"
+#include "ble_debug_assert_handler.h"
+#include "pstorage.h"
+#include "nrf_soc.h"
+#include "softdevice_handler.h"
+
+#include "debug.h"
+
+
+#define DEVICE_NAME                     "ANCC"                                               /**< Name of device. Will be included in the advertising data. */
+#define APP_ADV_INTERVAL                40                                                   /**< The advertising interval (in units of 0.625 ms. This value corresponds to 25 ms). */
+#define APP_ADV_INTERVAL_SLOW           3200                                                 /**< Slow advertising interval (in units of 0.625 ms. This value corresponds to 2 seconds). */
+#define APP_ADV_TIMEOUT_IN_SECONDS      180                                                  /**< The advertising timeout in units of seconds. */
+#define ADV_INTERVAL_FAST_PERIOD        30                                                   /**< The duration of the fast advertising period (in seconds). */
+
+#define APP_TIMER_PRESCALER             0                                                    /**< Value of the RTC1 PRESCALER register. */
+#define APP_TIMER_MAX_TIMERS            2                                                    /**< Maximum number of simultaneously created timers. */
+#define APP_TIMER_OP_QUEUE_SIZE         4                                                    /**< Size of timer operation queues. */
+
+#define MIN_CONN_INTERVAL               MSEC_TO_UNITS(500, UNIT_1_25_MS)                     /**< Minimum acceptable connection interval (0.5 seconds). */
+#define MAX_CONN_INTERVAL               MSEC_TO_UNITS(1000, UNIT_1_25_MS)                    /**< Maximum acceptable connection interval (1 second). */
+#define SLAVE_LATENCY                   0                                                    /**< Slave latency. */
+#define CONN_SUP_TIMEOUT                MSEC_TO_UNITS(4000, UNIT_10_MS)                      /**< Connection supervisory timeout (4 seconds). */
+
+#define FIRST_CONN_PARAMS_UPDATE_DELAY  APP_TIMER_TICKS(20 * 1000, APP_TIMER_PRESCALER)      /**< Time from initiating event (connect or start of notification) to first time sd_ble_gap_conn_param_update is called (20 seconds). */
+#define NEXT_CONN_PARAMS_UPDATE_DELAY   APP_TIMER_TICKS(5 * 1000, APP_TIMER_PRESCALER)       /**< Time between each call to sd_ble_gap_conn_param_update after the first (5 seconds). */
+#define MAX_CONN_PARAMS_UPDATE_COUNT    3                                                    /**< Number of attempts before giving up the connection parameter negotiation. */
+
+
+#define SEC_PARAM_TIMEOUT               30                                                   /**< Timeout for Pairing Request or Security Request (in seconds). */
+#define SEC_PARAM_BOND                  0                                                    /**< Perform bonding. */
+#define SEC_PARAM_MITM                  0                                                    /**< Man In The Middle protection not required. */
+#define SEC_PARAM_IO_CAPABILITIES       BLE_GAP_IO_CAPS_NONE                                 /**< No I/O capabilities. */
+#define SEC_PARAM_OOB                   0                                                    /**< Out Of Band data not available. */
+#define SEC_PARAM_MIN_KEY_SIZE          7                                                    /**< Minimum encryption key size. */
+#define SEC_PARAM_MAX_KEY_SIZE          16                                                   /**< Maximum encryption key size. */
+
+#define BLE_UUID_APPLE_NOTIFICATION_CENTER_SERVICE  0xf431                               /*<< ANCS service UUID. */
+#define BLE_UUID_ANCS_CONTROL_POINT_CHAR            0xd8f3                               /*<< Control point UUID. */
+#define BLE_UUID_ANCS_NOTIFICATION_SOURCE_CHAR      0x120d                               /*<< Notification source UUID. */
+#define BLE_UUID_ANCS_DATA_SOURCE_CHAR              0xc6e9                               /*<< Data source UUID. */
+
+#define BLE_CCCD_NOTIFY_BIT_MASK         0x0001                                            /**< Enable Notification bit. */
+
+
+typedef enum
+{
+    BLE_NO_ADVERTISING,                                                                      /**< No advertising running. */
+    BLE_SLOW_ADVERTISING,                                                                    /**< Slow advertising running. */
+    BLE_FAST_ADVERTISING                                                                     /**< Fast advertising running. */
+} ble_advertising_mode_t;
+
+typedef enum
+{
+    STATE_UNINITIALIZED,                    // Program start.
+    STATE_ADVERTISING,                      // Advertising. See Settings>Bluetooth on iPhone then connect to "ANCC"
+    STATE_CONNECTED,                        // iPhone connected to us.
+    STATE_DISCOVERY_SERVICE,                // Searching for ANCS Service.
+    STATE_DISCOVERY_CHARACTERISTICS,        // Searching for ANCS Characteristics.
+    STATE_PAIRING,                          // Got all we need. Now pair before subscribe. Should see pairing dialog on iPhone
+    STATE_SUBSCRIBING,                      // Subscribe to CCC, for notification.
+    STATE_LISTENING,                        // Listening...
+    STATE_NOTIFIED,                         // Got notification, now retrieve other info and print log out. back to listening.
+    STATE_DISCONNECTED,                     // Disconnected?
+    STATE_ERROR
+} state_t;
+
+
+
+DigitalOut led_adv(LED1);
+DigitalOut led_conn(LED2);
+
+Serial     pc(USBTX, USBRX);
+
+const ble_uuid128_t ble_ancs_base_uuid128 =
+{
+   {
+    // 7905F431-B5CE-4E99-A40F-4B1E122D00D0
+    0xd0, 0x00, 0x2d, 0x12, 0x1e, 0x4b, 0x0f, 0xa4,
+    0x99, 0x4e, 0xce, 0xb5, 0x31, 0xf4, 0x05, 0x79
+   }
+};
+
+
+const ble_uuid128_t ble_ancs_cp_base_uuid128 =
+{
+   {
+    // 69d1d8f3-45e1-49a8-9821-9bbdfdaad9d9
+    0xd9, 0xd9, 0xaa, 0xfd, 0xbd, 0x9b, 0x21, 0x98,
+    0xa8, 0x49, 0xe1, 0x45, 0xf3, 0xd8, 0xd1, 0x69
+
+   }
+};
+
+const ble_uuid128_t ble_ancs_ns_base_uuid128 =
+{
+   {
+    // 9FBF120D-6301-42D9-8C58-25E699A21DBD
+    0xbd, 0x1d, 0xa2, 0x99, 0xe6, 0x25, 0x58, 0x8c,
+    0xd9, 0x42, 0x01, 0x63, 0x0d, 0x12, 0xbf, 0x9f
+
+   }
+};
+
+const ble_uuid128_t ble_ancs_ds_base_uuid128 =
+{
+   {
+    // 22EAC6E9-24D6-4BB5-BE44-B36ACE7C7BFB
+    0xfb, 0x7b, 0x7c, 0xce, 0x6a, 0xb3, 0x44, 0xbe,
+    0xb5, 0x4b, 0xd6, 0x24, 0xe9, 0xc6, 0xea, 0x22
+
+   }
+};
+
+static state_t                          m_state = STATE_UNINITIALIZED;
+
+static ble_gap_adv_params_t             m_adv_params;                                        /**< Parameters to be passed to the stack when starting advertising. */
+static ble_advertising_mode_t           m_advertising_mode;                                  /**< Variable to keep track of when we are advertising. */
+
+static ble_gap_sec_params_t             m_sec_params;                                        /**< Security requirements for this application. */
+
+// ANCS Characteristic...
+static uint16_t m_notification_source_handle = 0;
+static uint16_t m_notification_source_handle_cccd = 0;
+static uint16_t m_control_point_handle = 0;
+static uint16_t m_data_source_handle = 0;
+static uint16_t m_data_source_handle_cccd = 0;
+
+static void err_check(uint32_t error_code, char *method)
+{
+    if(error_code != NRF_SUCCESS) {
+        pc.printf("ERROR: %d (%s) on %s\r\n", error_code, error2string(error_code), method);
+//    } else {
+//        pc.printf("SUCCESS: %s\r\n", method);
+    }
+    APP_ERROR_CHECK(error_code);
+}
+
+
+static void advertising_start(void)
+{
+    uint32_t err_code;
+
+    if (m_advertising_mode == BLE_NO_ADVERTISING)
+    {
+        m_advertising_mode = BLE_FAST_ADVERTISING;
+    }
+    else
+    {
+        m_advertising_mode = BLE_SLOW_ADVERTISING;
+    }
+
+    memset(&m_adv_params, 0, sizeof(m_adv_params));
+    
+    m_adv_params.type        = BLE_GAP_ADV_TYPE_ADV_IND;
+    m_adv_params.p_peer_addr = NULL;                           // Undirected advertisement.
+    m_adv_params.fp          = BLE_GAP_ADV_FP_ANY;
+
+    if (m_advertising_mode == BLE_FAST_ADVERTISING)
+    {
+        m_adv_params.interval = APP_ADV_INTERVAL;
+        m_adv_params.timeout  = ADV_INTERVAL_FAST_PERIOD;
+    }
+    else
+    {
+        m_adv_params.interval = APP_ADV_INTERVAL_SLOW;
+        m_adv_params.timeout  = APP_ADV_TIMEOUT_IN_SECONDS;
+    }
+
+    err_code = sd_ble_gap_adv_start(&m_adv_params);
+    err_check(err_code, "sd_ble_gap_adv_start");
+
+    led_adv = 1;
+    m_state = STATE_ADVERTISING;
+}
+
+
+
+
+static void ble_event_handler(ble_evt_t * p_ble_evt)
+{
+    uint32_t        err_code = NRF_SUCCESS;
+    static uint16_t m_conn_handle = BLE_CONN_HANDLE_INVALID;
+    ble_uuid_t ancs_uuid;
+    static ble_gattc_handle_range_t handle_range;
+
+    pc.printf("Event: %s\r\n", event2string(p_ble_evt));
+//    ble_bondmngr_on_ble_evt(p_ble_evt);
+//    ble_conn_params_on_ble_evt(p_ble_evt);
+    
+    switch (p_ble_evt->header.evt_id)
+    {
+        case BLE_GAP_EVT_CONNECTED:
+        {
+            m_state = STATE_CONNECTED;
+
+            m_advertising_mode = BLE_NO_ADVERTISING;
+            m_conn_handle = p_ble_evt->evt.gap_evt.conn_handle;
+            led_conn = 1;
+            
+            m_state = STATE_DISCOVERY_SERVICE;
+
+            BLE_UUID_BLE_ASSIGN(ancs_uuid, BLE_UUID_APPLE_NOTIFICATION_CENTER_SERVICE);
+            ancs_uuid.type = BLE_UUID_TYPE_VENDOR_BEGIN;
+
+            err_code = sd_ble_gattc_primary_services_discover(m_conn_handle, 0x0001, &ancs_uuid);
+            err_check(err_code, "sd_ble_gattc_primary_services_discover");            
+            
+
+            break;
+        }        
+        case BLE_GAP_EVT_AUTH_STATUS:
+        {                
+            m_state = STATE_SUBSCRIBING;
+
+            // Subscribe to NS
+            uint16_t       cccd_val = true ? BLE_CCCD_NOTIFY_BIT_MASK : 0;
+            static ble_gattc_write_params_t m_write_params;
+            uint8_t gattc_value[2];
+                     
+            gattc_value[0] = LSB(cccd_val);
+            gattc_value[1] = MSB(cccd_val);
+
+            m_write_params.handle = m_notification_source_handle_cccd;
+            m_write_params.len  = 2;
+            m_write_params.p_value = &gattc_value[0];
+            m_write_params.offset = 0;
+            m_write_params.write_op = BLE_GATT_OP_WRITE_REQ;
+                        
+
+            err_code = sd_ble_gattc_write(m_conn_handle, &m_write_params);
+            err_check(err_code, "sd_ble_gattc_write");
+
+            break;
+        }   
+        case BLE_GAP_EVT_DISCONNECTED:
+        {
+            m_conn_handle = BLE_CONN_HANDLE_INVALID;
+
+            advertising_start();
+            led_conn = 0;
+            break;
+        }    
+        case BLE_GAP_EVT_SEC_PARAMS_REQUEST:
+        {
+            err_code = sd_ble_gap_sec_params_reply(m_conn_handle, 
+                                                   BLE_GAP_SEC_STATUS_SUCCESS, 
+                                                   &m_sec_params);
+            err_check(err_code, "sd_ble_gap_sec_params_reply");
+            break;
+        }
+        case BLE_GAP_EVT_TIMEOUT:
+        {
+            if (p_ble_evt->evt.gap_evt.params.timeout.src == BLE_GAP_TIMEOUT_SRC_ADVERTISEMENT)
+            { 
+                if (m_advertising_mode == BLE_FAST_ADVERTISING)
+                {
+                    advertising_start();
+                }
+                else
+                {
+                    err_code = sd_power_system_off();
+                }
+            }
+            break;
+        }   
+        case BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP:
+        {
+             if (p_ble_evt->evt.gattc_evt.gatt_status != BLE_GATT_STATUS_SUCCESS) {
+                // Error.
+                pc.printf("Error: %s\r\n", "BLE_GATTC_EVT_PRIM_SRVC_DISC_RSP");
+            } else {
+                if (p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.count > 0) {
+                    const ble_gattc_service_t * p_service;
+
+                    p_service = &(p_ble_evt->evt.gattc_evt.params.prim_srvc_disc_rsp.services[0]);
+
+                    pc.printf("Found ANCS service, start handle: %d, end handle: %d\r\n", 
+                        p_service->handle_range.start_handle, p_service->handle_range.end_handle);
+
+                    handle_range.start_handle = p_service->handle_range.start_handle;
+                    handle_range.end_handle   = p_service->handle_range.end_handle;
+
+                    err_code = sd_ble_gattc_characteristics_discover(m_conn_handle, &handle_range);
+                    err_check(err_code, "sd_ble_gattc_characteristics_discover");
+                    
+                    m_state = STATE_DISCOVERY_CHARACTERISTICS;
+
+                } else {
+                    pc.printf("Error: discovery failure, no ANCS\r\n");
+                }
+            }
+
+            break;
+        }
+        case BLE_GATTC_EVT_CHAR_DISC_RSP:
+        {    
+            // End of characteristics searching...no more attribute or no more handle.
+            // We got error as response, but this is normal for gatt attribute searching.
+            if (p_ble_evt->evt.gattc_evt.gatt_status == BLE_GATT_STATUS_ATTERR_ATTRIBUTE_NOT_FOUND ||
+                p_ble_evt->evt.gattc_evt.gatt_status == BLE_GATT_STATUS_ATTERR_INVALID_HANDLE) {
+                
+                if(m_notification_source_handle == 0) {
+                    pc.printf("Error: NS not found.\r\n");
+                } else if(m_control_point_handle == 0) {
+                    pc.printf("Error: CP not found.\r\n");
+                } else if(m_data_source_handle == 0) {
+                    pc.printf("Error: DS not found.\r\n");
+                } 
+                // OK, we got all char handles. Next, find CCC.
+                else {
+                    // Start with NS CCC
+                    handle_range.start_handle = m_notification_source_handle + 1;
+                    handle_range.end_handle = m_notification_source_handle + 1;
+                    
+                    err_code = sd_ble_gattc_descriptors_discover(m_conn_handle, &handle_range);
+                    err_check(err_code, "sd_ble_gattc_descriptors_discover");
+                }        
+            
+            } else if (p_ble_evt->evt.gattc_evt.gatt_status != BLE_GATT_STATUS_SUCCESS) {
+                pc.printf("Error: %s\r\n", "BLE_GATTC_EVT_CHAR_DISC_RSP");
+            } else {
+                uint32_t                 i;
+                const ble_gattc_char_t * p_char_resp = NULL;
+
+                // Iterate trough the characteristics and find the correct one.
+                 for (i = 0; i < p_ble_evt->evt.gattc_evt.params.char_disc_rsp.count; i++) {
+                    p_char_resp = &(p_ble_evt->evt.gattc_evt.params.char_disc_rsp.chars[i]);
+                    switch (p_char_resp->uuid.uuid) {
+                        case BLE_UUID_ANCS_CONTROL_POINT_CHAR:
+                            pc.printf("Found char: Control Point");
+                            m_control_point_handle = p_char_resp->handle_value;
+                        break;
+
+                        case BLE_UUID_ANCS_NOTIFICATION_SOURCE_CHAR:
+                            pc.printf("Found char: Notification Source");
+                            m_notification_source_handle = p_char_resp->handle_value;
+                        break;
+
+                        case BLE_UUID_ANCS_DATA_SOURCE_CHAR:
+                            pc.printf("Found char: Data Source");
+                            m_data_source_handle = p_char_resp->handle_value;
+                        break;
+
+                        default:
+                        break;
+                    }
+                }
+                
+                if(p_char_resp!=NULL) {
+
+                    handle_range.start_handle = p_char_resp->handle_value + 1;
+
+                    err_code = sd_ble_gattc_characteristics_discover(m_conn_handle, &handle_range);
+                    err_check(err_code, "sd_ble_gattc_characteristics_discover");
+                    
+                } else {
+                    err_code = sd_ble_gattc_characteristics_discover(m_conn_handle, &handle_range);
+                    err_check(err_code, "sd_ble_gattc_characteristics_discover");
+                }
+        
+            }
+        
+            break;
+        }
+        case BLE_GATTC_EVT_DESC_DISC_RSP:
+        {
+            if (p_ble_evt->evt.gattc_evt.gatt_status != BLE_GATT_STATUS_SUCCESS) {
+                pc.printf("Error: %s\r\n", "BLE_GATTC_EVT_DESC_DISC_RSP");        
+            } else {
+                if (p_ble_evt->evt.gattc_evt.params.desc_disc_rsp.count > 0) {
+                    const ble_gattc_desc_t * p_desc_resp = &(p_ble_evt->evt.gattc_evt.params.desc_disc_rsp.descs[0]);
+                    if (p_desc_resp->uuid.uuid == BLE_UUID_DESCRIPTOR_CLIENT_CHAR_CONFIG) {
+                        if(p_desc_resp->handle == m_notification_source_handle + 1) {
+                                                                          
+                            m_notification_source_handle_cccd = p_desc_resp->handle;
+                            pc.printf("Found NS CCC\r\n");
+                            
+                            // Next, find CCC for data source.
+                            handle_range.start_handle = m_data_source_handle + 1;
+                            handle_range.end_handle = m_data_source_handle + 1;
+                    
+                            err_code = sd_ble_gattc_descriptors_discover(m_conn_handle, &handle_range);
+                            err_check(err_code, "sd_ble_gattc_descriptors_discover");
+
+                        } else if(p_desc_resp->handle == m_data_source_handle + 1) {
+                            
+                            m_data_source_handle_cccd = p_desc_resp->handle;
+                            pc.printf("Found DS CCC\r\n");
+                                                                  
+                            // Got all we need, now before subscribing we'll do pairing.
+                            // request encryption...., we are in peripheral role.
+                            
+                            m_state = STATE_PAIRING;
+                            
+                            err_code = sd_ble_gap_authenticate(m_conn_handle, &m_sec_params);
+                            err_check(err_code, "sd_ble_gap_authenticate");
+                        }
+                    }
+                }
+            }
+            break;
+        }
+        case BLE_GATTC_EVT_WRITE_RSP:
+        {
+            if (p_ble_evt->evt.gattc_evt.gatt_status != BLE_GATT_STATUS_SUCCESS) {
+                pc.printf("Error: %s\r\n", "BLE_GATTC_EVT_WRITE_RSP"); 
+
+                if(p_ble_evt->evt.gattc_evt.params.write_rsp.handle == m_control_point_handle) {
+                    m_state = STATE_LISTENING;
+                }
+            } else {
+                if(p_ble_evt->evt.gattc_evt.params.write_rsp.handle == m_notification_source_handle_cccd) {
+                    pc.printf("NS subscribe success.\r\n");
+
+                    // Next, subscribe to DS.
+                    uint16_t       cccd_val = true ? BLE_CCCD_NOTIFY_BIT_MASK : 0;
+                    static ble_gattc_write_params_t m_write_params;
+                    uint8_t gattc_value[2];
+                     
+                    gattc_value[0] = LSB(cccd_val);
+                    gattc_value[1] = MSB(cccd_val);
+
+                    m_write_params.handle = m_data_source_handle_cccd;
+                    m_write_params.len  = 2;
+                    m_write_params.p_value = &gattc_value[0];
+                    m_write_params.offset = 0;
+                    m_write_params.write_op = BLE_GATT_OP_WRITE_REQ;
+                        
+                    err_code = sd_ble_gattc_write(m_conn_handle, &m_write_params);
+                    err_check(err_code, "sd_ble_gattc_write");
+                }
+                
+                if(p_ble_evt->evt.gattc_evt.params.write_rsp.handle == m_data_source_handle_cccd) {
+                    pc.printf("DS subscribe success.\r\n");
+                    
+                    // Now, we just waiting for NS notification.
+                    m_state = STATE_LISTENING;
+                }
+                
+                if(p_ble_evt->evt.gattc_evt.params.write_rsp.handle == m_control_point_handle) {
+                    pc.printf("CP write success.\r\n");
+                    // We'll receive data from DS notification
+                }
+
+            }
+        
+            break;
+        }
+        case BLE_GATTC_EVT_HVX:
+        {
+            if (p_ble_evt->evt.gattc_evt.gatt_status != BLE_GATT_STATUS_SUCCESS) {
+                pc.printf("Error: %s\r\n", "BLE_GATTC_EVT_HVX");        
+            } else {
+
+                // Got notification...
+                if(p_ble_evt->evt.gattc_evt.params.hvx.handle == m_notification_source_handle) {
+                    ble_gattc_evt_hvx_t *p_hvx = &p_ble_evt->evt.gattc_evt.params.hvx;
+                    if(p_hvx->len == 8) {
+                        pc.printf("Event ID: %x (%s)\r\n", p_hvx->data[0], eventid2string(p_hvx->data[0]));
+                        pc.printf("Event Flags: %x (%s)\r\n", p_hvx->data[1], eventflags2string(p_hvx->data[1]));
+                        pc.printf("Category ID: %x (%s)\r\n", p_hvx->data[2], categoryid2string(p_hvx->data[2]));
+                        pc.printf("Category Count: %x\r\n", p_hvx->data[3]);
+                        pc.printf("Notification ID: %x %x %x %x\r\n", p_hvx->data[4], p_hvx->data[5], p_hvx->data[6], p_hvx->data[7]);
+                        
+                        // if we are still processing, we can not do another write
+                        // with soft device (limitation?). Real implementation should use
+                        // queue to synchronized operation. Since this is a POC... just ignore.
+                        if(m_state == STATE_NOTIFIED) {
+                            pc.printf("Still retrieving data for another notification. ignoring this one.\r\n");
+                        } else if(p_hvx->data[0] == 0) {
+                            // we only retrieved data for added notification.
+                            m_state = STATE_NOTIFIED;
+                            // write control point to get another data.
+                            
+                            // We only retrieve the title, with 16 bytes buffer... see ANCS spec for more
+                            static ble_gattc_write_params_t m_write_params;
+                            uint8_t gattc_value[8];
+                     
+                            gattc_value[0] = 0; // CommandIDGetNotificationAttributes
+                            gattc_value[1] = p_hvx->data[4];
+                            gattc_value[2] = p_hvx->data[5];
+                            gattc_value[3] = p_hvx->data[6];
+                            gattc_value[4] = p_hvx->data[7];
+                            gattc_value[5] = 1; // Title
+                            gattc_value[6] = 16; // Length, 2 bytes, MSB first.
+                            gattc_value[7] = 0;
+
+                            m_write_params.handle = m_control_point_handle;
+                            m_write_params.len  = 8;
+                            m_write_params.p_value = &gattc_value[0];
+                            m_write_params.offset = 0;
+                            m_write_params.write_op = BLE_GATT_OP_WRITE_REQ;
+                        
+                            err_code = sd_ble_gattc_write(m_conn_handle, &m_write_params);
+                            err_check(err_code, "sd_ble_gattc_write");
+                            
+                        }
+                        
+                    } else {
+                        pc.printf("NS data len not 8\r\n");
+                    }
+                }
+                
+                // Got data
+                if(p_ble_evt->evt.gattc_evt.params.hvx.handle == m_data_source_handle) {
+                    ble_gattc_evt_hvx_t *p_hvx = &p_ble_evt->evt.gattc_evt.params.hvx;
+                    pc.printf("Title:");
+                    // we only set size on MSB...
+                    uint16_t len = p_hvx->data[6];
+                    pc.printf("(%d)", len);
+
+                    // the data itself start from index 8 to 8+len;
+                    uint16_t pos;
+                    for(pos=8; pos<=8+len; pos++) {
+                        pc.printf("%c", p_hvx->data[pos]);
+                    }
+                    pc.printf("\r\n");
+                    
+                    // Back to listening...
+                    m_state = STATE_LISTENING;
+                }
+                
+            }
+            break;
+        }
+        case BLE_GATTC_EVT_TIMEOUT:
+        case BLE_GATTS_EVT_TIMEOUT:
+        {
+            // Disconnect on GATT Server and Client timeout events.
+            err_code = sd_ble_gap_disconnect(m_conn_handle, 
+                                             BLE_HCI_REMOTE_USER_TERMINATED_CONNECTION);
+            err_check(err_code, "sd_ble_gap_disconnect");
+            break;
+        }
+        default:
+        {
+            //No implementation needed
+            break;
+        }
+    }
+
+}
+
+
+static void sys_event_handler(uint32_t sys_evt)
+{
+    pc.printf("Event: system event\r\n");
+    pstorage_sys_event_handler(sys_evt);
+}
+
+
+static void timers_init(void)
+{
+    // Initialize timer module.
+    APP_TIMER_INIT(APP_TIMER_PRESCALER, APP_TIMER_MAX_TIMERS, APP_TIMER_OP_QUEUE_SIZE, false);
+}
+
+
+static void ble_stack_init(void)
+{
+    uint32_t err_code;
+    
+    // Initialize the SoftDevice handler module.
+    SOFTDEVICE_HANDLER_INIT(NRF_CLOCK_LFCLKSRC_XTAL_20_PPM, false);
+    
+
+    // Register with the SoftDevice handler module for BLE events.
+    err_code = softdevice_ble_evt_handler_set(ble_event_handler);
+    err_check(err_code, "softdevice_ble_evt_handler_set");
+    
+    // Register with the SoftDevice handler module for System events.
+    err_code = softdevice_sys_evt_handler_set(sys_event_handler);
+    err_check(err_code, "softdevice_sys_evt_handler_set");
+}
+
+static void set_128_uuid()
+{
+    uint32_t        err_code;
+    uint8_t         temp_type;  // All ANCS is vendor type... so we ignore this.
+
+
+    err_code = sd_ble_uuid_vs_add(&ble_ancs_base_uuid128, &temp_type);
+    err_check(err_code, "sd_ble_uuid_vs_add");
+
+    err_code = sd_ble_uuid_vs_add(&ble_ancs_cp_base_uuid128, &temp_type);
+    err_check(err_code, "sd_ble_uuid_vs_add");
+
+    err_code = sd_ble_uuid_vs_add(&ble_ancs_ns_base_uuid128, &temp_type);
+    err_check(err_code, "sd_ble_uuid_vs_add");
+
+    err_code = sd_ble_uuid_vs_add(&ble_ancs_ds_base_uuid128, &temp_type);
+    err_check(err_code, "sd_ble_uuid_vs_add");
+}
+
+
+static void conn_params_error_handler(uint32_t nrf_error)
+{
+    err_check(nrf_error, "Error: conn params error");
+}
+
+
+static void conn_params_init(void)
+{
+    uint32_t               err_code;
+    ble_conn_params_init_t cp_init;
+
+    memset(&cp_init, 0, sizeof(cp_init));
+
+    cp_init.p_conn_params                  = NULL;
+    cp_init.first_conn_params_update_delay = FIRST_CONN_PARAMS_UPDATE_DELAY;
+    cp_init.next_conn_params_update_delay  = NEXT_CONN_PARAMS_UPDATE_DELAY;
+    cp_init.max_conn_params_update_count   = MAX_CONN_PARAMS_UPDATE_COUNT;
+    cp_init.start_on_notify_cccd_handle    = BLE_GATT_HANDLE_INVALID;
+    cp_init.disconnect_on_fail             = true;
+    cp_init.evt_handler                    = NULL;
+    cp_init.error_handler                  = conn_params_error_handler;
+
+    err_code = ble_conn_params_init(&cp_init);
+    err_check(err_code, "ble_conn_params_init");
+}
+
+
+static void sec_params_init(void)
+{
+    m_sec_params.timeout      = SEC_PARAM_TIMEOUT;
+    m_sec_params.bond         = SEC_PARAM_BOND;
+    m_sec_params.mitm         = SEC_PARAM_MITM;
+    m_sec_params.io_caps      = SEC_PARAM_IO_CAPABILITIES;
+    m_sec_params.oob          = SEC_PARAM_OOB;  
+    m_sec_params.min_key_size = SEC_PARAM_MIN_KEY_SIZE;
+    m_sec_params.max_key_size = SEC_PARAM_MAX_KEY_SIZE;
+}
+
+
+static void gap_params_init(void)
+{
+    uint32_t                err_code;
+    ble_gap_conn_params_t   gap_conn_params;
+    ble_gap_conn_sec_mode_t sec_mode;
+
+    BLE_GAP_CONN_SEC_MODE_SET_OPEN(&sec_mode);
+    
+    err_code = sd_ble_gap_device_name_set(&sec_mode, 
+                                          (const uint8_t *)DEVICE_NAME, 
+                                          strlen(DEVICE_NAME));
+    err_check(err_code, "sd_ble_gap_device_name_set");
+
+    memset(&gap_conn_params, 0, sizeof(gap_conn_params));
+
+    gap_conn_params.min_conn_interval = MIN_CONN_INTERVAL;
+    gap_conn_params.max_conn_interval = MAX_CONN_INTERVAL;
+    gap_conn_params.slave_latency     = SLAVE_LATENCY;
+    gap_conn_params.conn_sup_timeout  = CONN_SUP_TIMEOUT;
+
+    err_code = sd_ble_gap_ppcp_set(&gap_conn_params);
+    err_check(err_code, "sd_ble_gap_ppcp_set");
+}
+
+
+static void advertising_init(void)
+{
+    uint32_t      err_code;
+    ble_advdata_t advdata;
+    uint8_t       flags = BLE_GAP_ADV_FLAGS_LE_ONLY_LIMITED_DISC_MODE;
+    ble_uuid_t    ancs_uuid;
+    
+//    err_code = sd_ble_uuid_vs_add(&ble_ancs_base_uuid128, &m_ancs_uuid_type);
+//    err_check(err_code, "sd_ble_uuid_vs_add");
+
+//    ancs_uuid.uuid = ((ble_ancs_base_uuid128.uuid128[12]) | (ble_ancs_base_uuid128.uuid128[13] << 8));
+//    ancs_uuid.type = m_ancs_uuid_type;
+    BLE_UUID_BLE_ASSIGN(ancs_uuid, BLE_UUID_APPLE_NOTIFICATION_CENTER_SERVICE);
+    ancs_uuid.type = BLE_UUID_TYPE_VENDOR_BEGIN;
+
+    // Build and set advertising data.
+    memset(&advdata, 0, sizeof(advdata));
+    
+    advdata.name_type               = BLE_ADVDATA_FULL_NAME;
+    advdata.include_appearance      = true;
+    advdata.flags.size              = sizeof(flags);
+    advdata.flags.p_data            = &flags;
+    advdata.uuids_complete.uuid_cnt = 0;
+    advdata.uuids_complete.p_uuids  = NULL;
+    advdata.uuids_solicited.uuid_cnt = 1;
+    advdata.uuids_solicited.p_uuids  = &ancs_uuid;    
+    
+    err_code = ble_advdata_set(&advdata, NULL);
+    err_check(err_code, "ble_advdata_set");
+
+}
+
+
+/**************************************************************************/
+/*!
+    @brief  Program entry point
+*/
+/**************************************************************************/
+int main(void)
+{
+    uint32_t err_code;
+//    uint32_t soc_event;
+//    uint32_t evt_id;
+    
+    pc.printf("Program started\n\r");
+
+    led_adv = 0;
+    led_conn = 0;
+
+
+    pc.printf("timers_init()\r\n");
+    timers_init();
+    
+    pc.printf("ble_stack_init()\r\n");
+    ble_stack_init();    
+
+    pc.printf("gap_params_init()\r\n");
+    gap_params_init();
+
+    pc.printf("set_128_uuid()\r\n");
+    set_128_uuid();
+    
+    pc.printf("advertising_init()\r\n");
+    advertising_init();
+    
+
+    pc.printf("conn_params_init()\r\n");
+    conn_params_init();
+    
+    pc.printf("sec_params_init()\r\n");
+    sec_params_init();
+        
+    pc.printf("advertising_start()\r\n");
+    advertising_start();
+
+
+//    while(1) { wait(1.0); };
+
+    for (;;)
+    {
+        err_code = sd_app_evt_wait();
+        err_check(err_code, "sd_app_evt_wait");
+        
+        /*
+        do {
+            soc_event = sd_evt_get(&evt_id);
+            pc.printf("soc_event: %d\r\n", evt_id);
+        } while(soc_event != NRF_ERROR_NOT_FOUND);
+        */
+    }
+    
+}

diff -r 000000000000 -r 1f985a7c0a8b mbed.bld
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/mbed.bld	Tue Jun 03 04:25:33 2014 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/users/mbed_official/code/mbed/builds/0b3ab51c8877
\ No newline at end of file

diff -r 000000000000 -r 1f985a7c0a8b nRF51822.lib
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/nRF51822.lib	Tue Jun 03 04:25:33 2014 +0000
@@ -0,0 +1,1 @@
+http://mbed.org/teams/Nordic-Semiconductor/code/nRF51822/#5ca08f962e4f