Edson Alcala / Mbed OS StepTracking

Simple step tracking

Dependencies:   MPU9250 mbed-os

Fork of ST by alonso palomino

ButtonService.h@5:2fbd60a970d6, 2017-10-19 (annotated)

Committer:
EdsonAlcala
Date:
Thu Oct 19 21:43:19 2017 +0000
Revision:
5:2fbd60a970d6
Parent:
4:b741278722c1
Child:
7:eff79b4c37ab
working well

Who changed what in which revision?

UserRevisionLine numberNew contents of line
alonsopg 2:02175845b24c 1 /* mbed Microcontroller Library
alonsopg 2:02175845b24c 2 * Copyright (c) 2006-2013 ARM Limited
alonsopg 2:02175845b24c 3 *
alonsopg 2:02175845b24c 4 * Licensed under the Apache License, Version 2.0 (the "License");
alonsopg 2:02175845b24c 5 * you may not use this file except in compliance with the License.
alonsopg 2:02175845b24c 6 * You may obtain a copy of the License at
alonsopg 2:02175845b24c 7 *
alonsopg 2:02175845b24c 8 * http://www.apache.org/licenses/LICENSE-2.0
alonsopg 2:02175845b24c 9 *
alonsopg 2:02175845b24c 10 * Unless required by applicable law or agreed to in writing, software
alonsopg 2:02175845b24c 11 * distributed under the License is distributed on an "AS IS" BASIS,
alonsopg 2:02175845b24c 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
alonsopg 2:02175845b24c 13 * See the License for the specific language governing permissions and
alonsopg 2:02175845b24c 14 * limitations under the License.
alonsopg 2:02175845b24c 15 */
alonsopg 2:02175845b24c 16
alonsopg 2:02175845b24c 17 #ifndef __BLE_BUTTON_SERVICE_H__
alonsopg 2:02175845b24c 18 #define __BLE_BUTTON_SERVICE_H__
alonsopg 2:02175845b24c 19
alonsopg 2:02175845b24c 20 class ButtonService
alonsopg 2:02175845b24c 21 {
alonsopg 2:02175845b24c 22 public:
alonsopg 2:02175845b24c 23 const static uint16_t BUTTON_SERVICE_UUID = 0xA000;
alonsopg 2:02175845b24c 24 const static uint16_t BUTTON_STATE_CHARACTERISTIC_UUID = 0xA001;
alonsopg 2:02175845b24c 25
alonsopg 2:02175845b24c 26 ButtonService(BLE &_ble, bool buttonPressedInitial) :
alonsopg 2:02175845b24c 27 ble(_ble), buttonState(BUTTON_STATE_CHARACTERISTIC_UUID,
alonsopg 3:3157e61f2bfd 28 (uint8_t []) {
alonsopg 3:3157e61f2bfd 29 0,0
alonsopg 3:3157e61f2bfd 30 },
alonsopg 2:02175845b24c 31 GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY) {
alonsopg 2:02175845b24c 32 GattCharacteristic *charTable[] = {&buttonState};
alonsopg 2:02175845b24c 33 GattService buttonService(ButtonService::BUTTON_SERVICE_UUID, charTable, sizeof(charTable) / sizeof(GattCharacteristic *));
alonsopg 2:02175845b24c 34 ble.gattServer().addService(buttonService);
alonsopg 2:02175845b24c 35 }
alonsopg 2:02175845b24c 36
alonsopg 3:3157e61f2bfd 37 void updateButtonState(float roll, float pitch, float yaw, float gx, float gy, float gz) {
EdsonAlcala 4:b741278722c1 38 //4 * 6 = 24
EdsonAlcala 4:b741278722c1 39 //convert to 4 bytes
EdsonAlcala 4:b741278722c1 40 //union all
EdsonAlcala 5:2fbd60a970d6 41 //uint8_t sensorValues[24] = {0};
EdsonAlcala 4:b741278722c1 42 //float rollTest = 94.2425f;
EdsonAlcala 4:b741278722c1 43 //uint16_t rollValue = (uint16_t)roll;
EdsonAlcala 4:b741278722c1 44 //uint16_t pitchValue = (uint16_t)pitch;
EdsonAlcala 4:b741278722c1 45 //uint16_t yawValue = (uint16_t)yaw;
alonsopg 3:3157e61f2bfd 46
EdsonAlcala 4:b741278722c1 47 //uint16_t gxValue = (uint16_t)gx;
EdsonAlcala 4:b741278722c1 48 //uint16_t gyValue = (uint16_t)gy;
EdsonAlcala 4:b741278722c1 49 //uint16_t gzValue = (uint16_t)gz;
EdsonAlcala 4:b741278722c1 50
EdsonAlcala 4:b741278722c1 51 //sensorValues[0]= rollValue & 0xff;
EdsonAlcala 4:b741278722c1 52 //sensorValues[1]= (rollValue >> 8);
EdsonAlcala 4:b741278722c1 53
EdsonAlcala 4:b741278722c1 54 //sensorValues[2]= pitchValue & 0xff;
EdsonAlcala 4:b741278722c1 55 //sensorValues[3]= (pitchValue >> 8);
EdsonAlcala 4:b741278722c1 56
EdsonAlcala 4:b741278722c1 57 //sensorValues[4]= yawValue & 0xff;
EdsonAlcala 4:b741278722c1 58 //sensorValues[5]= (yawValue >> 8);
EdsonAlcala 4:b741278722c1 59
EdsonAlcala 4:b741278722c1 60 //sensorValues[6]= gxValue & 0xff;
EdsonAlcala 4:b741278722c1 61 //sensorValues[7]= (gxValue >> 8);
alonsopg 3:3157e61f2bfd 62
EdsonAlcala 4:b741278722c1 63 //sensorValues[8]= gyValue & 0xff;
EdsonAlcala 4:b741278722c1 64 //sensorValues[9]= (gyValue >> 8);
alonsopg 3:3157e61f2bfd 65
EdsonAlcala 4:b741278722c1 66 //sensorValues[10]= gzValue & 0xff;
EdsonAlcala 4:b741278722c1 67 //sensorValues[11]= (gzValue >> 8);
EdsonAlcala 4:b741278722c1 68
EdsonAlcala 4:b741278722c1 69 //converted:00 00 00 00 00 00 02 00 00 00 00 00
EdsonAlcala 4:b741278722c1 70 uint8_t *rollValue;
EdsonAlcala 4:b741278722c1 71 rollValue = reinterpret_cast<uint8_t*>(&roll);
EdsonAlcala 4:b741278722c1 72
EdsonAlcala 5:2fbd60a970d6 73 uint8_t *pitchValue;
EdsonAlcala 5:2fbd60a970d6 74 pitchValue = reinterpret_cast<uint8_t*>(&pitch);
EdsonAlcala 5:2fbd60a970d6 75
EdsonAlcala 5:2fbd60a970d6 76 uint8_t *yawValue;
EdsonAlcala 5:2fbd60a970d6 77 yawValue = reinterpret_cast<uint8_t*>(&yaw);
EdsonAlcala 4:b741278722c1 78
EdsonAlcala 5:2fbd60a970d6 79 uint8_t *gxValue;
EdsonAlcala 5:2fbd60a970d6 80 gxValue = reinterpret_cast<uint8_t*>(&gx);
EdsonAlcala 5:2fbd60a970d6 81
EdsonAlcala 5:2fbd60a970d6 82 uint8_t *gyValue;
EdsonAlcala 5:2fbd60a970d6 83 gyValue = reinterpret_cast<uint8_t*>(&gy);
EdsonAlcala 5:2fbd60a970d6 84
EdsonAlcala 5:2fbd60a970d6 85 uint8_t *gzValue;
EdsonAlcala 5:2fbd60a970d6 86 gzValue = reinterpret_cast<uint8_t*>(&gz);
EdsonAlcala 4:b741278722c1 87
EdsonAlcala 5:2fbd60a970d6 88 //sensorValues =
EdsonAlcala 5:2fbd60a970d6 89 int * result = new int[24];
EdsonAlcala 5:2fbd60a970d6 90 copy(rollValue, rollValue + 4, result);
EdsonAlcala 5:2fbd60a970d6 91 copy(pitchValue, pitchValue + 4, result + 4);
EdsonAlcala 5:2fbd60a970d6 92 copy(yawValue, yawValue + 4, result + 8);
EdsonAlcala 4:b741278722c1 93
EdsonAlcala 5:2fbd60a970d6 94 copy(gxValue, gxValue + 4, result + 12);
EdsonAlcala 5:2fbd60a970d6 95 copy(gyValue, gyValue + 4, result + 16);
EdsonAlcala 5:2fbd60a970d6 96 copy(gzValue, gzValue + 4, result + 20);
EdsonAlcala 4:b741278722c1 97
EdsonAlcala 5:2fbd60a970d6 98 for(int i = 0; i < result.length; i++){
EdsonAlcala 5:2fbd60a970d6 99
EdsonAlcala 5:2fbd60a970d6 100 }
EdsonAlcala 5:2fbd60a970d6 101 //union all arrays
EdsonAlcala 5:2fbd60a970d6 102
EdsonAlcala 5:2fbd60a970d6 103 ble.gattServer().write(buttonState.getValueHandle(), (uint8_t *)rollValue, sizeof(rollValue));
alonsopg 2:02175845b24c 104 //ble.updateCharacteristicValue(buttonState.getValueHandle(), (uint8_t *)v ,sizeof(v));
alonsopg 2:02175845b24c 105 }
alonsopg 2:02175845b24c 106
alonsopg 2:02175845b24c 107 private:
alonsopg 2:02175845b24c 108 BLE &ble;
EdsonAlcala 5:2fbd60a970d6 109 ReadOnlyArrayGattCharacteristic<uint8_t, sizeof(uint8_t[8])> buttonState;
alonsopg 2:02175845b24c 110 };
alonsopg 2:02175845b24c 111
alonsopg 2:02175845b24c 112 #endif /* #ifndef __BLE_BUTTON_SERVICE_H__ */