ライントレースとうおーるぼっとチャレンジのコードです。 SW1で操作モードとライントレースモードを切り替えます。 操作モードの時にRCBControllerのSTARTボタンを押すとチャレンジが開始します。 チャレンジの時はiPhoneを傾けてハンドリングする操作しか効かなくなっています。
Dependencies: mbed
BLE_API/services/HeartRateService.h@0:76dfa9657d9d, 2014-11-12 (annotated)
- Committer:
- jksoft
- Date:
- Wed Nov 12 02:40:34 2014 +0000
- Revision:
- 0:76dfa9657d9d
????????
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
jksoft | 0:76dfa9657d9d | 1 | /* mbed Microcontroller Library |
jksoft | 0:76dfa9657d9d | 2 | * Copyright (c) 2006-2013 ARM Limited |
jksoft | 0:76dfa9657d9d | 3 | * |
jksoft | 0:76dfa9657d9d | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
jksoft | 0:76dfa9657d9d | 5 | * you may not use this file except in compliance with the License. |
jksoft | 0:76dfa9657d9d | 6 | * You may obtain a copy of the License at |
jksoft | 0:76dfa9657d9d | 7 | * |
jksoft | 0:76dfa9657d9d | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
jksoft | 0:76dfa9657d9d | 9 | * |
jksoft | 0:76dfa9657d9d | 10 | * Unless required by applicable law or agreed to in writing, software |
jksoft | 0:76dfa9657d9d | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
jksoft | 0:76dfa9657d9d | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
jksoft | 0:76dfa9657d9d | 13 | * See the License for the specific language governing permissions and |
jksoft | 0:76dfa9657d9d | 14 | * limitations under the License. |
jksoft | 0:76dfa9657d9d | 15 | */ |
jksoft | 0:76dfa9657d9d | 16 | |
jksoft | 0:76dfa9657d9d | 17 | #ifndef __BLE_HEART_RATE_SERVICE_H__ |
jksoft | 0:76dfa9657d9d | 18 | #define __BLE_HEART_RATE_SERVICE_H__ |
jksoft | 0:76dfa9657d9d | 19 | |
jksoft | 0:76dfa9657d9d | 20 | #include "BLEDevice.h" |
jksoft | 0:76dfa9657d9d | 21 | |
jksoft | 0:76dfa9657d9d | 22 | /* Heart Rate Service */ |
jksoft | 0:76dfa9657d9d | 23 | /* Service: https://developer.bluetooth.org/gatt/services/Pages/ServiceViewer.aspx?u=org.bluetooth.service.heart_rate.xml */ |
jksoft | 0:76dfa9657d9d | 24 | /* HRM Char: https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.heart_rate_measurement.xml */ |
jksoft | 0:76dfa9657d9d | 25 | /* Location: https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.body_sensor_location.xml */ |
jksoft | 0:76dfa9657d9d | 26 | class HeartRateService { |
jksoft | 0:76dfa9657d9d | 27 | public: |
jksoft | 0:76dfa9657d9d | 28 | enum { |
jksoft | 0:76dfa9657d9d | 29 | LOCATION_OTHER = 0, |
jksoft | 0:76dfa9657d9d | 30 | LOCATION_CHEST, |
jksoft | 0:76dfa9657d9d | 31 | LOCATION_WRIST, |
jksoft | 0:76dfa9657d9d | 32 | LOCATION_FINGER, |
jksoft | 0:76dfa9657d9d | 33 | LOCATION_HAND, |
jksoft | 0:76dfa9657d9d | 34 | LOCATION_EAR_LOBE, |
jksoft | 0:76dfa9657d9d | 35 | LOCATION_FOOT, |
jksoft | 0:76dfa9657d9d | 36 | }; |
jksoft | 0:76dfa9657d9d | 37 | |
jksoft | 0:76dfa9657d9d | 38 | public: |
jksoft | 0:76dfa9657d9d | 39 | /** |
jksoft | 0:76dfa9657d9d | 40 | * Constructor. |
jksoft | 0:76dfa9657d9d | 41 | * |
jksoft | 0:76dfa9657d9d | 42 | * param[in] _ble |
jksoft | 0:76dfa9657d9d | 43 | * Reference to the underlying BLEDevice. |
jksoft | 0:76dfa9657d9d | 44 | * param[in] hrmCounter (8-bit) |
jksoft | 0:76dfa9657d9d | 45 | * initial value for the hrm counter. |
jksoft | 0:76dfa9657d9d | 46 | * param[in] location |
jksoft | 0:76dfa9657d9d | 47 | * Sensor's location. |
jksoft | 0:76dfa9657d9d | 48 | */ |
jksoft | 0:76dfa9657d9d | 49 | HeartRateService(BLEDevice &_ble, uint8_t hrmCounter, uint8_t location) : |
jksoft | 0:76dfa9657d9d | 50 | ble(_ble), |
jksoft | 0:76dfa9657d9d | 51 | valueBytes(hrmCounter), |
jksoft | 0:76dfa9657d9d | 52 | hrmRate(GattCharacteristic::UUID_HEART_RATE_MEASUREMENT_CHAR, valueBytes.getPointer(), |
jksoft | 0:76dfa9657d9d | 53 | valueBytes.getNumValueBytes(), HeartRateValueBytes::MAX_VALUE_BYTES, |
jksoft | 0:76dfa9657d9d | 54 | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY), |
jksoft | 0:76dfa9657d9d | 55 | hrmLocation(GattCharacteristic::UUID_BODY_SENSOR_LOCATION_CHAR, (uint8_t *)&location, sizeof(location), sizeof(location), |
jksoft | 0:76dfa9657d9d | 56 | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ), |
jksoft | 0:76dfa9657d9d | 57 | controlPoint(GattCharacteristic::UUID_HEART_RATE_CONTROL_POINT_CHAR, (uint8_t *)&controlPointValue, |
jksoft | 0:76dfa9657d9d | 58 | sizeof(controlPointValue), sizeof(controlPointValue), GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE) { |
jksoft | 0:76dfa9657d9d | 59 | setupService(); |
jksoft | 0:76dfa9657d9d | 60 | } |
jksoft | 0:76dfa9657d9d | 61 | |
jksoft | 0:76dfa9657d9d | 62 | /** |
jksoft | 0:76dfa9657d9d | 63 | * Same constructor as above, but with a 16-bit HRM Counter value. |
jksoft | 0:76dfa9657d9d | 64 | */ |
jksoft | 0:76dfa9657d9d | 65 | HeartRateService(BLEDevice &_ble, uint16_t hrmCounter, uint8_t location) : |
jksoft | 0:76dfa9657d9d | 66 | ble(_ble), |
jksoft | 0:76dfa9657d9d | 67 | valueBytes(hrmCounter), |
jksoft | 0:76dfa9657d9d | 68 | hrmRate(GattCharacteristic::UUID_HEART_RATE_MEASUREMENT_CHAR, valueBytes.getPointer(), |
jksoft | 0:76dfa9657d9d | 69 | valueBytes.getNumValueBytes(), HeartRateValueBytes::MAX_VALUE_BYTES, |
jksoft | 0:76dfa9657d9d | 70 | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY), |
jksoft | 0:76dfa9657d9d | 71 | hrmLocation(GattCharacteristic::UUID_BODY_SENSOR_LOCATION_CHAR, (uint8_t *)&location, sizeof(location), sizeof(location), |
jksoft | 0:76dfa9657d9d | 72 | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_READ), |
jksoft | 0:76dfa9657d9d | 73 | controlPoint(GattCharacteristic::UUID_HEART_RATE_CONTROL_POINT_CHAR, (uint8_t *)&controlPointValue, |
jksoft | 0:76dfa9657d9d | 74 | sizeof(controlPointValue), sizeof(controlPointValue), GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE) { |
jksoft | 0:76dfa9657d9d | 75 | setupService(); |
jksoft | 0:76dfa9657d9d | 76 | } |
jksoft | 0:76dfa9657d9d | 77 | |
jksoft | 0:76dfa9657d9d | 78 | /** |
jksoft | 0:76dfa9657d9d | 79 | * Set a new 8-bit value for heart rate. |
jksoft | 0:76dfa9657d9d | 80 | */ |
jksoft | 0:76dfa9657d9d | 81 | void updateHeartRate(uint8_t hrmCounter) { |
jksoft | 0:76dfa9657d9d | 82 | valueBytes.updateHeartRate(hrmCounter); |
jksoft | 0:76dfa9657d9d | 83 | ble.updateCharacteristicValue(hrmRate.getValueAttribute().getHandle(), valueBytes.getPointer(), valueBytes.getNumValueBytes()); |
jksoft | 0:76dfa9657d9d | 84 | } |
jksoft | 0:76dfa9657d9d | 85 | |
jksoft | 0:76dfa9657d9d | 86 | /** |
jksoft | 0:76dfa9657d9d | 87 | * Set a new 16-bit value for heart rate. |
jksoft | 0:76dfa9657d9d | 88 | */ |
jksoft | 0:76dfa9657d9d | 89 | void updateHeartRate(uint16_t hrmCounter) { |
jksoft | 0:76dfa9657d9d | 90 | valueBytes.updateHeartRate(hrmCounter); |
jksoft | 0:76dfa9657d9d | 91 | ble.updateCharacteristicValue(hrmRate.getValueAttribute().getHandle(), valueBytes.getPointer(), valueBytes.getNumValueBytes()); |
jksoft | 0:76dfa9657d9d | 92 | } |
jksoft | 0:76dfa9657d9d | 93 | |
jksoft | 0:76dfa9657d9d | 94 | /** |
jksoft | 0:76dfa9657d9d | 95 | * This callback allows the UART service to receive updates to the |
jksoft | 0:76dfa9657d9d | 96 | * txCharacteristic. The application should forward the call to this |
jksoft | 0:76dfa9657d9d | 97 | * function from the global onDataWritten() callback handler; or if that's |
jksoft | 0:76dfa9657d9d | 98 | * not used, this method can be used as a callback directly. |
jksoft | 0:76dfa9657d9d | 99 | */ |
jksoft | 0:76dfa9657d9d | 100 | virtual void onDataWritten(const GattCharacteristicWriteCBParams *params) { |
jksoft | 0:76dfa9657d9d | 101 | if (params->charHandle == controlPoint.getValueAttribute().getHandle()) { |
jksoft | 0:76dfa9657d9d | 102 | /* Do something here if the new value is 1; else you can override this method by |
jksoft | 0:76dfa9657d9d | 103 | * extending this class. |
jksoft | 0:76dfa9657d9d | 104 | * @NOTE: if you are extending this class, be sure to also call |
jksoft | 0:76dfa9657d9d | 105 | * ble.onDataWritten(this, &ExtendedHRService::onDataWritten); in |
jksoft | 0:76dfa9657d9d | 106 | * your constructor. |
jksoft | 0:76dfa9657d9d | 107 | */ |
jksoft | 0:76dfa9657d9d | 108 | } |
jksoft | 0:76dfa9657d9d | 109 | } |
jksoft | 0:76dfa9657d9d | 110 | |
jksoft | 0:76dfa9657d9d | 111 | private: |
jksoft | 0:76dfa9657d9d | 112 | void setupService(void) { |
jksoft | 0:76dfa9657d9d | 113 | static bool serviceAdded = false; /* We should only ever need to add the heart rate service once. */ |
jksoft | 0:76dfa9657d9d | 114 | if (serviceAdded) { |
jksoft | 0:76dfa9657d9d | 115 | return; |
jksoft | 0:76dfa9657d9d | 116 | } |
jksoft | 0:76dfa9657d9d | 117 | |
jksoft | 0:76dfa9657d9d | 118 | GattCharacteristic *charTable[] = {&hrmRate, &hrmLocation, &controlPoint}; |
jksoft | 0:76dfa9657d9d | 119 | GattService hrmService(GattService::UUID_HEART_RATE_SERVICE, charTable, sizeof(charTable) / sizeof(GattCharacteristic *)); |
jksoft | 0:76dfa9657d9d | 120 | |
jksoft | 0:76dfa9657d9d | 121 | ble.addService(hrmService); |
jksoft | 0:76dfa9657d9d | 122 | serviceAdded = true; |
jksoft | 0:76dfa9657d9d | 123 | |
jksoft | 0:76dfa9657d9d | 124 | ble.onDataWritten(this, &HeartRateService::onDataWritten); |
jksoft | 0:76dfa9657d9d | 125 | } |
jksoft | 0:76dfa9657d9d | 126 | |
jksoft | 0:76dfa9657d9d | 127 | private: |
jksoft | 0:76dfa9657d9d | 128 | /* Private internal representation for the bytes used to work with the vaulue of the heart-rate characteristic. */ |
jksoft | 0:76dfa9657d9d | 129 | struct HeartRateValueBytes { |
jksoft | 0:76dfa9657d9d | 130 | static const unsigned MAX_VALUE_BYTES = 3; /* FLAGS + up to two bytes for heart-rate */ |
jksoft | 0:76dfa9657d9d | 131 | static const unsigned FLAGS_BYTE_INDEX = 0; |
jksoft | 0:76dfa9657d9d | 132 | |
jksoft | 0:76dfa9657d9d | 133 | static const unsigned VALUE_FORMAT_BITNUM = 0; |
jksoft | 0:76dfa9657d9d | 134 | static const uint8_t VALUE_FORMAT_FLAG = (1 << VALUE_FORMAT_BITNUM); |
jksoft | 0:76dfa9657d9d | 135 | |
jksoft | 0:76dfa9657d9d | 136 | HeartRateValueBytes(uint8_t hrmCounter) : valueBytes() { |
jksoft | 0:76dfa9657d9d | 137 | updateHeartRate(hrmCounter); |
jksoft | 0:76dfa9657d9d | 138 | } |
jksoft | 0:76dfa9657d9d | 139 | |
jksoft | 0:76dfa9657d9d | 140 | HeartRateValueBytes(uint16_t hrmCounter) : valueBytes() { |
jksoft | 0:76dfa9657d9d | 141 | updateHeartRate(hrmCounter); |
jksoft | 0:76dfa9657d9d | 142 | } |
jksoft | 0:76dfa9657d9d | 143 | |
jksoft | 0:76dfa9657d9d | 144 | void updateHeartRate(uint8_t hrmCounter) { |
jksoft | 0:76dfa9657d9d | 145 | valueBytes[FLAGS_BYTE_INDEX] &= ~VALUE_FORMAT_FLAG; |
jksoft | 0:76dfa9657d9d | 146 | valueBytes[FLAGS_BYTE_INDEX + 1] = hrmCounter; |
jksoft | 0:76dfa9657d9d | 147 | } |
jksoft | 0:76dfa9657d9d | 148 | |
jksoft | 0:76dfa9657d9d | 149 | void updateHeartRate(uint16_t hrmCounter) { |
jksoft | 0:76dfa9657d9d | 150 | valueBytes[FLAGS_BYTE_INDEX] |= VALUE_FORMAT_FLAG; |
jksoft | 0:76dfa9657d9d | 151 | valueBytes[FLAGS_BYTE_INDEX + 1] = (uint8_t)(hrmCounter & 0xFF); |
jksoft | 0:76dfa9657d9d | 152 | valueBytes[FLAGS_BYTE_INDEX + 2] = (uint8_t)(hrmCounter >> 8); |
jksoft | 0:76dfa9657d9d | 153 | } |
jksoft | 0:76dfa9657d9d | 154 | |
jksoft | 0:76dfa9657d9d | 155 | uint8_t *getPointer(void) { |
jksoft | 0:76dfa9657d9d | 156 | return valueBytes; |
jksoft | 0:76dfa9657d9d | 157 | } |
jksoft | 0:76dfa9657d9d | 158 | |
jksoft | 0:76dfa9657d9d | 159 | const uint8_t *getPointer(void) const { |
jksoft | 0:76dfa9657d9d | 160 | return valueBytes; |
jksoft | 0:76dfa9657d9d | 161 | } |
jksoft | 0:76dfa9657d9d | 162 | |
jksoft | 0:76dfa9657d9d | 163 | unsigned getNumValueBytes(void) const { |
jksoft | 0:76dfa9657d9d | 164 | return 1 + ((valueBytes[FLAGS_BYTE_INDEX] & VALUE_FORMAT_FLAG) ? sizeof(uint16_t) : sizeof(uint8_t)); |
jksoft | 0:76dfa9657d9d | 165 | } |
jksoft | 0:76dfa9657d9d | 166 | |
jksoft | 0:76dfa9657d9d | 167 | private: |
jksoft | 0:76dfa9657d9d | 168 | /* First byte = 8-bit values, no extra info, Second byte = uint8_t HRM value */ |
jksoft | 0:76dfa9657d9d | 169 | /* See --> https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.heart_rate_measurement.xml */ |
jksoft | 0:76dfa9657d9d | 170 | uint8_t valueBytes[MAX_VALUE_BYTES]; |
jksoft | 0:76dfa9657d9d | 171 | }; |
jksoft | 0:76dfa9657d9d | 172 | |
jksoft | 0:76dfa9657d9d | 173 | private: |
jksoft | 0:76dfa9657d9d | 174 | BLEDevice &ble; |
jksoft | 0:76dfa9657d9d | 175 | HeartRateValueBytes valueBytes; |
jksoft | 0:76dfa9657d9d | 176 | uint8_t controlPointValue; |
jksoft | 0:76dfa9657d9d | 177 | GattCharacteristic hrmRate; |
jksoft | 0:76dfa9657d9d | 178 | GattCharacteristic hrmLocation; |
jksoft | 0:76dfa9657d9d | 179 | GattCharacteristic controlPoint; |
jksoft | 0:76dfa9657d9d | 180 | }; |
jksoft | 0:76dfa9657d9d | 181 | |
jksoft | 0:76dfa9657d9d | 182 | #endif /* #ifndef __BLE_HEART_RATE_SERVICE_H__*/ |