File content as of revision 8:1bac78ab3acc:

/* mbed Microcontroller Library
 * Copyright (c) 2006-2013 ARM Limited
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *     http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

#ifndef __BLE_BUTTON_SERVICE_H__
#define __BLE_BUTTON_SERVICE_H__

class ButtonService
{
public:
    const static uint16_t BUTTON_SERVICE_UUID              = 0xA000;
    const static uint16_t BUTTON_STATE_CHARACTERISTIC_UUID = 0xA001;

    ButtonService(BLE &_ble, bool buttonPressedInitial) :
        ble(_ble), buttonState(BUTTON_STATE_CHARACTERISTIC_UUID,
                               (uint8_t []) {
        0,0
    },
    GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) {
        GattCharacteristic *charTable[] = {&buttonState};
        GattService         buttonService(ButtonService::BUTTON_SERVICE_UUID, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
        ble.gattServer().addService(buttonService);
    }

    void updateButtonState(float roll, float pitch, float yaw, float gx, float gy, float gz) {      
        uint8_t *rollValue;
        rollValue = reinterpret_cast<uint8_t*>(&roll);
        
        uint8_t *pitchValue;
        pitchValue = reinterpret_cast<uint8_t*>(&pitch);
        
        uint8_t *yawValue;
        yawValue = reinterpret_cast<uint8_t*>(&yaw);
        
        uint8_t *gxValue;
        gxValue = reinterpret_cast<uint8_t*>(&gx);
        
        uint8_t *gyValue;
        gyValue = reinterpret_cast<uint8_t*>(&gy);
        
        uint8_t *gzValue;
        gzValue = reinterpret_cast<uint8_t*>(&gz);
        
        //sensorValues = 
        uint8_t * result = new uint8_t[24];
        copy(rollValue, rollValue + 4, result);
        copy(pitchValue, pitchValue + 4, result + 4);
        copy(yawValue, yawValue + 4, result + 8);
        
        copy(gxValue, gxValue + 4, result + 12);
        copy(gyValue, gyValue + 4, result + 16);
        copy(gzValue, gzValue + 4, result + 20);
        
        
        //union all arrays
        
        ble.gattServer().write(buttonState.getValueHandle(), (uint8_t *)result, sizeof(result));
        //ble.updateCharacteristicValue(buttonState.getValueHandle(), (uint8_t *)v ,sizeof(v));
    }

private:
    BLE                              &ble;
    ReadOnlyArrayGattCharacteristic<uint8_t, sizeof(uint8_t[24])>  buttonState;
};

#endif /* #ifndef __BLE_BUTTON_SERVICE_H__ */