Simple step tracking

Dependencies:   MPU9250 mbed-os

Fork of ST by alonso palomino

ButtonService.h

Committer:
EdsonAlcala
Date:
2017-10-19
Revision:
5:2fbd60a970d6
Parent:
4:b741278722c1
Child:
7:eff79b4c37ab

File content as of revision 5:2fbd60a970d6:

/* 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) {
        //4 * 6 = 24
        //convert to 4 bytes
        //union all        
        //uint8_t sensorValues[24] = {0};
        //float rollTest = 94.2425f;
        //uint16_t rollValue = (uint16_t)roll;
        //uint16_t pitchValue = (uint16_t)pitch;
        //uint16_t yawValue = (uint16_t)yaw;

        //uint16_t gxValue = (uint16_t)gx;
        //uint16_t gyValue = (uint16_t)gy;
        //uint16_t gzValue = (uint16_t)gz;
        
        //sensorValues[0]= rollValue & 0xff;
        //sensorValues[1]= (rollValue >> 8);

        //sensorValues[2]= pitchValue & 0xff;
        //sensorValues[3]= (pitchValue >> 8);

        //sensorValues[4]= yawValue & 0xff;
        //sensorValues[5]= (yawValue >> 8);

        //sensorValues[6]= gxValue & 0xff;
        //sensorValues[7]= (gxValue >> 8);

        //sensorValues[8]= gyValue & 0xff;
        //sensorValues[9]= (gyValue >> 8);

        //sensorValues[10]= gzValue & 0xff;
        //sensorValues[11]= (gzValue >> 8);
        
        //converted:00 00 00 00 00 00 02 00 00 00 00 00
        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 = 
        int * result = new int[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);
        
        for(int i = 0; i < result.length; i++){
            
        }
        //union all arrays
        
        ble.gattServer().write(buttonState.getValueHandle(), (uint8_t *)rollValue, sizeof(rollValue));
        //ble.updateCharacteristicValue(buttonState.getValueHandle(), (uint8_t *)v ,sizeof(v));
    }

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

#endif /* #ifndef __BLE_BUTTON_SERVICE_H__ */