summaryrefslogtreecommitdiff
path: root/src/components/ble
diff options
context:
space:
mode:
authorMichele Bini <michele.bini@gmail.com>2022-03-26 01:19:51 (GMT)
committerMichele Bini <michele.bini@gmail.com>2022-03-26 01:37:03 (GMT)
commit9acd3ff0f8d12d2e97095ac562cbff3c7e8647ac (patch)
tree9d0e69a9ce4a38733cf1bdc5a150ecef5d73e8e2 /src/components/ble
parent268ddbdc7622ab2a6b0490701064ffdde13fee51 (diff)
sans fs; sans settings persist
Diffstat (limited to 'src/components/ble')
-rw-r--r--src/components/ble/FSService.cpp330
-rw-r--r--src/components/ble/FSService.h191
-rw-r--r--src/components/ble/NimbleController.cpp7
-rw-r--r--src/components/ble/NimbleController.h7
4 files changed, 2 insertions, 533 deletions
diff --git a/src/components/ble/FSService.cpp b/src/components/ble/FSService.cpp
deleted file mode 100644
index 8dc9ed6..0000000
--- a/src/components/ble/FSService.cpp
+++ /dev/null
@@ -1,330 +0,0 @@
-#include <nrf_log.h>
-#include "FSService.h"
-#include "components/ble/BleController.h"
-#include "systemtask/SystemTask.h"
-
-using namespace Pinetime::Controllers;
-
-constexpr ble_uuid16_t FSService::fsServiceUuid;
-constexpr ble_uuid128_t FSService::fsVersionUuid;
-constexpr ble_uuid128_t FSService::fsTransferUuid;
-
-int FSServiceCallback(uint16_t conn_handle, uint16_t attr_handle, struct ble_gatt_access_ctxt* ctxt, void* arg) {
- auto* fsService = static_cast<FSService*>(arg);
- return fsService->OnFSServiceRequested(conn_handle, attr_handle, ctxt);
-}
-
-FSService::FSService(Pinetime::System::SystemTask& systemTask, Pinetime::Controllers::FS& fs)
- : systemTask {systemTask},
- fs {fs},
- characteristicDefinition {{.uuid = &fsVersionUuid.u,
- .access_cb = FSServiceCallback,
- .arg = this,
- .flags = BLE_GATT_CHR_F_READ,
- .val_handle = &versionCharacteristicHandle},
- {
- .uuid = &fsTransferUuid.u,
- .access_cb = FSServiceCallback,
- .arg = this,
- .flags = BLE_GATT_CHR_F_WRITE | BLE_GATT_CHR_F_READ | BLE_GATT_CHR_F_NOTIFY,
- .val_handle = &transferCharacteristicHandle,
- },
- {0}},
- serviceDefinition {
- {/* Device Information Service */
- .type = BLE_GATT_SVC_TYPE_PRIMARY,
- .uuid = &fsServiceUuid.u,
- .characteristics = characteristicDefinition},
- {0},
- } {
-}
-
-void FSService::Init() {
- int res = 0;
- res = ble_gatts_count_cfg(serviceDefinition);
- ASSERT(res == 0);
-
- res = ble_gatts_add_svcs(serviceDefinition);
- ASSERT(res == 0);
-}
-
-int FSService::OnFSServiceRequested(uint16_t connectionHandle, uint16_t attributeHandle, ble_gatt_access_ctxt* context) {
- if (attributeHandle == versionCharacteristicHandle) {
- NRF_LOG_INFO("FS_S : handle = %d", versionCharacteristicHandle);
- int res = os_mbuf_append(context->om, &fsVersion, sizeof(fsVersion));
- return (res == 0) ? 0 : BLE_ATT_ERR_INSUFFICIENT_RES;
- }
- if (attributeHandle == transferCharacteristicHandle) {
- return FSCommandHandler(connectionHandle, context->om);
- }
- return 0;
-}
-
-int FSService::FSCommandHandler(uint16_t connectionHandle, os_mbuf* om) {
- auto command = static_cast<commands>(om->om_data[0]);
- NRF_LOG_INFO("[FS_S] -> FSCommandHandler Command %d", command);
- // Just always make sure we are awake...
- systemTask.PushMessage(Pinetime::System::Messages::StartFileTransfer);
- vTaskDelay(10);
- while (systemTask.IsSleeping()) {
- vTaskDelay(100); // 50ms
- }
- lfs_dir_t dir = {0};
- lfs_info info = {0};
- lfs_file f = {0};
- switch (command) {
- case commands::READ: {
- NRF_LOG_INFO("[FS_S] -> Read");
- auto* header = (ReadHeader*) om->om_data;
- uint16_t plen = header->pathlen;
- if (plen > maxpathlen) { //> counts for null term
- return -1;
- }
- memcpy(filepath, header->pathstr, plen);
- filepath[plen] = 0; // Copy and null teminate string
- ReadResponse resp;
- os_mbuf* om;
- resp.command = commands::READ_DATA;
- resp.status = 0x01;
- resp.chunkoff = header->chunkoff;
- int res = fs.Stat(filepath, &info);
- if (res == LFS_ERR_NOENT && info.type != LFS_TYPE_DIR) {
- resp.status = (int8_t) res;
- resp.chunklen = 0;
- resp.totallen = 0;
- om = ble_hs_mbuf_from_flat(&resp, sizeof(ReadResponse));
- } else {
- resp.chunklen = std::min(header->chunksize, info.size); // TODO add mtu somehow
- resp.totallen = info.size;
- fs.FileOpen(&f, filepath, LFS_O_RDONLY);
- fs.FileSeek(&f, header->chunkoff);
- uint8_t fileData[resp.chunklen] = {0};
- resp.chunklen = fs.FileRead(&f, fileData, resp.chunklen);
- om = ble_hs_mbuf_from_flat(&resp, sizeof(ReadResponse));
- os_mbuf_append(om, fileData, resp.chunklen);
- fs.FileClose(&f);
- }
-
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- }
- case commands::READ_PACING: {
- NRF_LOG_INFO("[FS_S] -> Readpacing");
- auto* header = (ReadHeader*) om->om_data;
- ReadResponse resp;
- resp.command = commands::READ_DATA;
- resp.status = 0x01;
- resp.chunkoff = header->chunkoff;
- int res = fs.Stat(filepath, &info);
- if (res == LFS_ERR_NOENT && info.type != LFS_TYPE_DIR) {
- resp.status = (int8_t) res;
- resp.chunklen = 0;
- resp.totallen = 0;
- } else {
- resp.chunklen = std::min(header->chunksize, info.size); // TODO add mtu somehow
- resp.totallen = info.size;
- fs.FileOpen(&f, filepath, LFS_O_RDONLY);
- fs.FileSeek(&f, header->chunkoff);
- }
- os_mbuf* om;
- if (resp.chunklen > 0) {
- uint8_t fileData[resp.chunklen] = {0};
- resp.chunklen = fs.FileRead(&f, fileData, resp.chunklen);
- om = ble_hs_mbuf_from_flat(&resp, sizeof(ReadResponse));
- os_mbuf_append(om, fileData, resp.chunklen);
- } else {
- resp.chunklen = 0;
- om = ble_hs_mbuf_from_flat(&resp, sizeof(ReadResponse));
- }
- fs.FileClose(&f);
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- }
- case commands::WRITE: {
- NRF_LOG_INFO("[FS_S] -> Write");
- auto* header = (WriteHeader*) om->om_data;
- uint16_t plen = header->pathlen;
- if (plen > maxpathlen) { //> counts for null term
- return -1; // TODO make this actually return a BLE notif
- }
- memcpy(filepath, header->pathstr, plen);
- filepath[plen] = 0; // Copy and null teminate string
- fileSize = header->totalSize;
- WriteResponse resp;
- resp.command = commands::WRITE_PACING;
- resp.offset = header->offset;
- resp.modTime = 0;
-
- int res = fs.FileOpen(&f, filepath, LFS_O_RDWR | LFS_O_CREAT);
- if (res == 0) {
- fs.FileClose(&f);
- resp.status = (res == 0) ? 0x01 : (int8_t) res;
- }
- resp.freespace = std::min(fs.getSize() - (fs.GetFSSize() * fs.getBlockSize()), fileSize - header->offset);
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(WriteResponse));
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- }
- case commands::WRITE_DATA: {
- NRF_LOG_INFO("[FS_S] -> WriteData");
- auto* header = (WritePacing*) om->om_data;
- WriteResponse resp;
- resp.command = commands::WRITE_PACING;
- resp.offset = header->offset;
- int res = 0;
-
- if (!(res = fs.FileOpen(&f, filepath, LFS_O_RDWR | LFS_O_CREAT))) {
- if ((res = fs.FileSeek(&f, header->offset)) >= 0) {
- res = fs.FileWrite(&f, header->data, header->dataSize);
- }
- fs.FileClose(&f);
- }
- if (res < 0) {
- resp.status = (int8_t) res;
- }
- resp.freespace = std::min(fs.getSize() - (fs.GetFSSize() * fs.getBlockSize()), fileSize - header->offset);
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(WriteResponse));
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- }
- case commands::DELETE: {
- NRF_LOG_INFO("[FS_S] -> Delete");
- auto* header = (DelHeader*) om->om_data;
- uint16_t plen = header->pathlen;
- char path[plen + 1] = {0};
- memcpy(path, header->pathstr, plen);
- path[plen] = 0; // Copy and null teminate string
- DelResponse resp {};
- resp.command = commands::DELETE_STATUS;
- int res = fs.FileDelete(path);
- resp.status = (res == 0) ? 0x01 : (int8_t) res;
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(DelResponse));
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- }
- case commands::MKDIR: {
- NRF_LOG_INFO("[FS_S] -> MKDir");
- auto* header = (MKDirHeader*) om->om_data;
- uint16_t plen = header->pathlen;
- char path[plen + 1] = {0};
- memcpy(path, header->pathstr, plen);
- path[plen] = 0; // Copy and null teminate string
- MKDirResponse resp {};
- resp.command = commands::MKDIR_STATUS;
- resp.modification_time = 0;
- int res = fs.DirCreate(path);
- resp.status = (res == 0) ? 0x01 : (int8_t) res;
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(MKDirResponse));
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- }
- case commands::LISTDIR: {
- NRF_LOG_INFO("[FS_S] -> ListDir");
- ListDirHeader* header = (ListDirHeader*) om->om_data;
- uint16_t plen = header->pathlen;
- char path[plen + 1] = {0};
- path[plen] = 0; // Copy and null teminate string
- memcpy(path, header->pathstr, plen);
-
- ListDirResponse resp {};
-
- resp.command = commands::LISTDIR_ENTRY;
- resp.status = 0x01;
- resp.totalentries = 0;
- resp.entry = 0;
- resp.modification_time = 0;
- int res = fs.DirOpen(path, &dir);
- if (res != 0) {
- resp.status = (int8_t) res;
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(ListDirResponse));
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- };
- while (fs.DirRead(&dir, &info)) {
- resp.totalentries++;
- }
- fs.DirRewind(&dir);
- while (true) {
- res = fs.DirRead(&dir, &info);
- if (res <= 0) {
- break;
- }
- switch (info.type) {
- case LFS_TYPE_REG: {
- resp.flags = 0;
- resp.file_size = info.size;
- break;
- }
- case LFS_TYPE_DIR: {
- resp.flags = 1;
- resp.file_size = 0;
- break;
- }
- }
-
- // strcpy(resp.path, info.name);
- resp.path_length = strlen(info.name);
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(ListDirResponse));
- os_mbuf_append(om, info.name, resp.path_length);
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- /*
- * Todo Figure out how to know when the previous Notify was TX'd
- * For now just delay 100ms to make sure that the data went out...
- */
- vTaskDelay(100); // Allow stuff to actually go out over the BLE conn
- resp.entry++;
- }
- assert(fs.DirClose(&dir) == 0);
- resp.file_size = 0;
- resp.path_length = 0;
- resp.flags = 0;
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(ListDirResponse));
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- break;
- }
- case commands::MOVE: {
- NRF_LOG_INFO("[FS_S] -> Move");
- MoveHeader* header = (MoveHeader*) om->om_data;
- uint16_t plen = header->OldPathLength;
- // Null Terminate string
- header->pathstr[plen] = 0;
- char path[header->NewPathLength + 1] = {0};
- memcpy(path, &header->pathstr[plen + 1], header->NewPathLength);
- path[header->NewPathLength] = 0; // Copy and null teminate string
- MoveResponse resp {};
- resp.command = commands::MOVE_STATUS;
- int8_t res = (int8_t) fs.Rename(header->pathstr, path);
- resp.status = (res == 0) ? 1 : res;
- auto* om = ble_hs_mbuf_from_flat(&resp, sizeof(MoveResponse));
- ble_gattc_notify_custom(connectionHandle, transferCharacteristicHandle, om);
- }
- default:
- break;
- }
- NRF_LOG_INFO("[FS_S] -> done ");
- systemTask.PushMessage(Pinetime::System::Messages::StopFileTransfer);
- return 0;
-}
-
-// Loads resp with file data given a valid filepath header and resp
-void FSService::prepareReadDataResp(ReadHeader* header, ReadResponse* resp) {
- // uint16_t plen = header->pathlen;
- resp->command = commands::READ_DATA;
- resp->chunkoff = header->chunkoff;
- resp->status = 0x01;
- struct lfs_info info = {};
- int res = fs.Stat(filepath, &info);
- if (res == LFS_ERR_NOENT && info.type != LFS_TYPE_DIR) {
- resp->status = 0x03;
- resp->chunklen = 0;
- resp->totallen = 0;
- } else {
- lfs_file f;
- resp->chunklen = std::min(header->chunksize, info.size);
- resp->totallen = info.size;
- fs.FileOpen(&f, filepath, LFS_O_RDONLY);
- fs.FileSeek(&f, header->chunkoff);
- resp->chunklen = fs.FileRead(&f, resp->chunk, resp->chunklen);
- fs.FileClose(&f);
- }
-}
diff --git a/src/components/ble/FSService.h b/src/components/ble/FSService.h
deleted file mode 100644
index 828925a..0000000
--- a/src/components/ble/FSService.h
+++ /dev/null
@@ -1,191 +0,0 @@
-#pragma once
-#define min // workaround: nimble's min/max macros conflict with libstdc++
-#define max
-#include <host/ble_gap.h>
-#undef max
-#undef min
-
-#include "components/fs/FS.h"
-
-namespace Pinetime {
- namespace System {
- class SystemTask;
- }
- namespace Controllers {
- class Ble;
- class FSService {
- public:
- FSService(Pinetime::System::SystemTask& systemTask, Pinetime::Controllers::FS& fs);
- void Init();
-
- int OnFSServiceRequested(uint16_t connectionHandle, uint16_t attributeHandle, ble_gatt_access_ctxt* context);
- void NotifyFSRaw(uint16_t connectionHandle);
-
- private:
- Pinetime::System::SystemTask& systemTask;
- Pinetime::Controllers::FS& fs;
- static constexpr uint16_t FSServiceId {0xFEBB};
- static constexpr uint16_t fsVersionId {0x0100};
- static constexpr uint16_t fsTransferId {0x0200};
- uint16_t fsVersion = {0x0004};
- static constexpr uint16_t maxpathlen = 256;
- static constexpr ble_uuid16_t fsServiceUuid {
- .u {.type = BLE_UUID_TYPE_16},
- .value = {0xFEBB}}; // {0x72, 0x65, 0x66, 0x73, 0x6e, 0x61, 0x72, 0x54, 0x65, 0x6c, 0x69, 0x46, 0xBB, 0xFE, 0xAF, 0xAD}};
-
- static constexpr ble_uuid128_t fsVersionUuid {
- .u {.type = BLE_UUID_TYPE_128},
- .value = {0x72, 0x65, 0x66, 0x73, 0x6e, 0x61, 0x72, 0x54, 0x65, 0x6c, 0x69, 0x46, 0x00, 0x01, 0xAF, 0xAD}};
-
- static constexpr ble_uuid128_t fsTransferUuid {
- .u {.type = BLE_UUID_TYPE_128},
- .value = {0x72, 0x65, 0x66, 0x73, 0x6e, 0x61, 0x72, 0x54, 0x65, 0x6c, 0x69, 0x46, 0x00, 0x02, 0xAF, 0xAD}};
-
- struct ble_gatt_chr_def characteristicDefinition[3];
- struct ble_gatt_svc_def serviceDefinition[2];
- uint16_t versionCharacteristicHandle;
- uint16_t transferCharacteristicHandle;
-
- enum class commands : uint8_t {
- INVALID = 0x00,
- READ = 0x10,
- READ_DATA = 0x11,
- READ_PACING = 0x12,
- WRITE = 0x20,
- WRITE_PACING = 0x21,
- WRITE_DATA = 0x22,
- DELETE = 0x30,
- DELETE_STATUS = 0x31,
- MKDIR = 0x40,
- MKDIR_STATUS = 0x41,
- LISTDIR = 0x50,
- LISTDIR_ENTRY = 0x51,
- MOVE = 0x60,
- MOVE_STATUS = 0x61
- };
- enum class FSState : uint8_t {
- IDLE = 0x00,
- READ = 0x01,
- WRITE = 0x02,
- };
- FSState state;
- char filepath[maxpathlen]; // TODO ..ugh fixed filepath len
- int fileSize;
- using ReadHeader = struct __attribute__((packed)) {
- commands command;
- uint8_t padding;
- uint16_t pathlen;
- uint32_t chunkoff;
- uint32_t chunksize;
- char pathstr[];
- };
-
- using ReadResponse = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- uint16_t padding;
- uint32_t chunkoff;
- uint32_t totallen;
- uint32_t chunklen;
- uint8_t chunk[];
- };
- using ReadPacing = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- uint16_t padding;
- uint32_t chunkoff;
- uint32_t chunksize;
- };
-
- using WriteHeader = struct __attribute__((packed)) {
- commands command;
- uint8_t padding;
- uint16_t pathlen;
- uint32_t offset;
- uint64_t modTime;
- uint32_t totalSize;
- char pathstr[];
- };
-
- using WriteResponse = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- uint16_t padding;
- uint32_t offset;
- uint64_t modTime;
- uint32_t freespace;
- };
-
- using WritePacing = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- uint16_t padding;
- uint32_t offset;
- uint32_t dataSize;
- uint8_t data[];
- };
- using ListDirHeader = struct __attribute__((packed)) {
- commands command;
- uint8_t padding;
- uint16_t pathlen;
- char pathstr[];
- };
-
- using ListDirResponse = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- uint16_t path_length;
- uint32_t entry;
- uint32_t totalentries;
- uint32_t flags;
- uint64_t modification_time;
- uint32_t file_size;
- char path[];
- };
-
- using MKDirHeader = struct __attribute__((packed)) {
- commands command;
- uint8_t padding;
- uint16_t pathlen;
- uint32_t padding2;
- uint64_t time;
- char pathstr[];
- };
-
- using MKDirResponse = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- uint32_t padding1;
- uint16_t padding2;
- uint64_t modification_time;
- };
-
- using DelHeader = struct __attribute__((packed)) {
- commands command;
- uint8_t padding;
- uint16_t pathlen;
- char pathstr[];
- };
-
- using DelResponse = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- };
- using MoveHeader = struct __attribute__((packed)) {
- commands command;
- uint8_t padding;
- uint16_t OldPathLength;
- uint16_t NewPathLength;
- char pathstr[];
- };
-
- using MoveResponse = struct __attribute__((packed)) {
- commands command;
- uint8_t status;
- };
-
- int FSCommandHandler(uint16_t connectionHandle, os_mbuf* om);
- void prepareReadDataResp(ReadHeader* header, ReadResponse* resp);
- };
- }
-}
diff --git a/src/components/ble/NimbleController.cpp b/src/components/ble/NimbleController.cpp
index a1597e2..a5bc41b 100644
--- a/src/components/ble/NimbleController.cpp
+++ b/src/components/ble/NimbleController.cpp
@@ -18,7 +18,6 @@
#include "components/ble/BleController.h"
#include "components/ble/NotificationManager.h"
#include "components/datetime/DateTimeController.h"
-#include "components/fs/FS.h"
#include "systemtask/SystemTask.h"
using namespace Pinetime::Controllers;
@@ -30,14 +29,12 @@ NimbleController::NimbleController(Pinetime::System::SystemTask& systemTask,
Battery& batteryController,
Pinetime::Drivers::SpiNorFlash& spiNorFlash,
HeartRateController& heartRateController,
- MotionController& motionController,
- FS& fs)
+ MotionController& motionController)
: systemTask {systemTask},
bleController {bleController},
dateTimeController {dateTimeController},
notificationManager {notificationManager},
spiNorFlash {spiNorFlash},
- fs {fs},
dfuService {systemTask, bleController, spiNorFlash},
currentTimeClient {dateTimeController},
@@ -48,7 +45,6 @@ NimbleController::NimbleController(Pinetime::System::SystemTask& systemTask,
immediateAlertService {systemTask, notificationManager},
heartRateService {systemTask, heartRateController},
motionService {systemTask, motionController},
- fsService {systemTask, fs},
serviceDiscovery({&currentTimeClient, &alertNotificationClient}) {
}
@@ -93,7 +89,6 @@ void NimbleController::Init() {
immediateAlertService.Init();
heartRateService.Init();
motionService.Init();
- fsService.Init();
int rc;
rc = ble_hs_util_ensure_addr(0);
diff --git a/src/components/ble/NimbleController.h b/src/components/ble/NimbleController.h
index dfa42f7..263d498 100644
--- a/src/components/ble/NimbleController.h
+++ b/src/components/ble/NimbleController.h
@@ -14,12 +14,10 @@
#include "components/ble/CurrentTimeService.h"
#include "components/ble/DeviceInformationService.h"
#include "components/ble/DfuService.h"
-#include "components/ble/FSService.h"
#include "components/ble/HeartRateService.h"
#include "components/ble/ImmediateAlertService.h"
#include "components/ble/ServiceDiscovery.h"
#include "components/ble/MotionService.h"
-#include "components/fs/FS.h"
namespace Pinetime {
namespace Drivers {
@@ -45,8 +43,7 @@ namespace Pinetime {
Battery& batteryController,
Pinetime::Drivers::SpiNorFlash& spiNorFlash,
HeartRateController& heartRateController,
- MotionController& motionController,
- FS& fs);
+ MotionController& motionController);
void Init();
void StartAdvertising();
int OnGAPEvent(ble_gap_event* event);
@@ -70,7 +67,6 @@ namespace Pinetime {
DateTime& dateTimeController;
NotificationManager& notificationManager;
Pinetime::Drivers::SpiNorFlash& spiNorFlash;
- FS& fs;
DfuService dfuService;
DeviceInformationService deviceInformationService;
@@ -82,7 +78,6 @@ namespace Pinetime {
ImmediateAlertService immediateAlertService;
HeartRateService heartRateService;
MotionService motionService;
- FSService fsService;
ServiceDiscovery serviceDiscovery;
uint8_t addrType;