Edson Alcala
/
StepTracking
Simple step tracking
Fork of ST by
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__ */