Simple step tracking

Dependencies:   MPU9250 mbed-os

Fork of ST by alonso palomino

Committer:
EdsonAlcala
Date:
Fri Oct 20 18:28:34 2017 +0000
Revision:
9:e265a634306d
Parent:
8:1bac78ab3acc
Child:
10:f5cd99dd9efa
with giroscope data uint16

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
EdsonAlcala 9:e265a634306d 37 void updateButtonState(float roll, float pitch, float yaw, int16_t gx, int16_t gy, int16_t gz) {
EdsonAlcala 4:b741278722c1 38 uint8_t *rollValue;
EdsonAlcala 4:b741278722c1 39 rollValue = reinterpret_cast<uint8_t*>(&roll);
EdsonAlcala 4:b741278722c1 40
EdsonAlcala 5:2fbd60a970d6 41 uint8_t *pitchValue;
EdsonAlcala 5:2fbd60a970d6 42 pitchValue = reinterpret_cast<uint8_t*>(&pitch);
EdsonAlcala 5:2fbd60a970d6 43
EdsonAlcala 5:2fbd60a970d6 44 uint8_t *yawValue;
EdsonAlcala 5:2fbd60a970d6 45 yawValue = reinterpret_cast<uint8_t*>(&yaw);
EdsonAlcala 4:b741278722c1 46
EdsonAlcala 5:2fbd60a970d6 47 uint8_t *gxValue;
EdsonAlcala 5:2fbd60a970d6 48 gxValue = reinterpret_cast<uint8_t*>(&gx);
EdsonAlcala 5:2fbd60a970d6 49
EdsonAlcala 5:2fbd60a970d6 50 uint8_t *gyValue;
EdsonAlcala 5:2fbd60a970d6 51 gyValue = reinterpret_cast<uint8_t*>(&gy);
EdsonAlcala 5:2fbd60a970d6 52
EdsonAlcala 5:2fbd60a970d6 53 uint8_t *gzValue;
EdsonAlcala 5:2fbd60a970d6 54 gzValue = reinterpret_cast<uint8_t*>(&gz);
EdsonAlcala 4:b741278722c1 55
EdsonAlcala 9:e265a634306d 56 uint8_t result[20];
EdsonAlcala 9:e265a634306d 57
EdsonAlcala 5:2fbd60a970d6 58 copy(rollValue, rollValue + 4, result);
EdsonAlcala 5:2fbd60a970d6 59 copy(pitchValue, pitchValue + 4, result + 4);
EdsonAlcala 8:1bac78ab3acc 60 copy(yawValue, yawValue + 4, result + 8);
EdsonAlcala 4:b741278722c1 61
EdsonAlcala 9:e265a634306d 62 copy(gxValue, gxValue + 2, result + 12);
EdsonAlcala 9:e265a634306d 63 copy(gyValue, gyValue + 2, result + 14);
EdsonAlcala 9:e265a634306d 64 copy(gzValue, gzValue + 2, result + 16);
EdsonAlcala 9:e265a634306d 65
EdsonAlcala 7:eff79b4c37ab 66 ble.gattServer().write(buttonState.getValueHandle(), (uint8_t *)result, sizeof(result));
alonsopg 2:02175845b24c 67 }
alonsopg 2:02175845b24c 68
alonsopg 2:02175845b24c 69 private:
alonsopg 2:02175845b24c 70 BLE &ble;
EdsonAlcala 9:e265a634306d 71 ReadOnlyArrayGattCharacteristic<uint8_t, sizeof(uint8_t[20])> buttonState;
alonsopg 2:02175845b24c 72 };
alonsopg 2:02175845b24c 73
alonsopg 2:02175845b24c 74 #endif /* #ifndef __BLE_BUTTON_SERVICE_H__ */