mirrors/hdpv_ble
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

update emulator

Browse Source
This commit is contained in:
patman15
2024-11-20 20:15:44 +01:00
parent e0185f19e7
commit 9ee1b6c6d2
2 changed files with 90 additions and 69 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
.gitignore vendored
View File

@@ -150,3 +150,5 @@ cython_debug/
# and can be added to the global gitignore or merged into this file. For a more nuclear # and can be added to the global gitignore or merged into this file. For a more nuclear
# option (not recommended) you can uncomment the following to ignore the entire idea folder. # option (not recommended) you can uncomment the following to ignore the entire idea folder.
#.idea/ #.idea/
aes.py
*.bak

157
emu/PV_BLE_cover/PV_BLE_cover.ino
View File

@@ -45,30 +45,20 @@ struct position {
uint8_t velocity; uint8_t velocity;
}; };
struct notification {
uint8_t *data;
BLECharacteristic *characteristic;
};
BLECharacteristic *pCharacteristic_cover, *pCharacteristic_fw, *pCharacteristic_unknown, *pCharacteristic_bat; BLECharacteristic *pCharacteristic_cover, *pCharacteristic_fw, *pCharacteristic_unknown, *pCharacteristic_bat;
BLEServer *pServer = NULL; BLEServer *pServer = NULL;
bool deviceConnected = false; bool deviceConnected = false;
bool oldDeviceConnected = false; bool oldDeviceConnected = false;
struct notification rx_data;
volatile bool data_available = false;
uint8_t buffer[20];
void Serialprintln(const char* input...) { const char* dec_cmd(uint16_t cmd) {
va_list args;
va_start(args, input);
for(const char* i=input; *i!=0; ++i) {
if(*i!='%') { Serial.print(*i); continue; }
switch(*(++i)) {
case '%': Serial.print('%'); break;
case 's': Serial.print(va_arg(args, char*)); break;
case 'd': Serial.print(va_arg(args, int), DEC); break;
case 'b': Serial.print(va_arg(args, int), BIN); break;
case 'x': Serial.print(va_arg(args, int), HEX); break;
case 'f': Serial.print(va_arg(args, double), 2); break;
}
}
Serial.println();
va_end(args);
}
const char* decode_cmd(uint16_t cmd) {
switch(cmd) { switch(cmd) {
case 0x01: case 0x01:
return "set position"; return "set position";
@@ -106,27 +96,26 @@ class MyServerCallbacks: public BLEServerCallbacks {
} }
void onMtuChanged(BLEServer* pServer, esp_ble_gatts_cb_param_t* param) { void onMtuChanged(BLEServer* pServer, esp_ble_gatts_cb_param_t* param) {
Serialprintln("MTU changed: %d", pServer->getPeerMTU(pServer->getConnId())); Serial.printf("MTU changed: %d\n", pServer->getPeerMTU(pServer->getConnId()));
} }
}; };
class coverCallbacks: public BLECharacteristicCallbacks { void decode() {
void onWrite(BLECharacteristic *pCharacteristic) { Serial.printf("Cover write %s:\n\t", rx_data.characteristic->toString().c_str());
uint8_t *value = pCharacteristic->getData(); print_hex(rx_data.characteristic->getData(), rx_data.characteristic->getLength());
Serialprintln("Cover write %s:", pCharacteristic->toString().c_str()); if (rx_data.characteristic->getLength() < 4) return;
print_hex(value, pCharacteristic->getLength());
struct header data; struct header data;
memcpy((void *) &data, value, 4); memcpy((void *) &data, rx_data.characteristic->getData(), 4);
Serialprintln("SRV: %x, CMD %x, SEQ %x, LEN %x", data.serviceID, data.cmdID, data.sequence, data.data_len); Serial.printf("SRV: %x, CMD %x, SEQ %x, LEN %x\n", data.serviceID, data.cmdID, data.sequence, data.data_len);
switch ((data.serviceID << 8) | data.cmdID) { switch ((data.serviceID << 8) | data.cmdID) {
case 0xF701: case 0xF701:
// set position // set position
struct position pos; struct position pos;
memcpy((void *) &pos, &value[4], data.data_len); memcpy((void *) &pos, &rx_data.data[4], data.data_len);
Serialprintln("\tset position\tpos1 %f%%, pos2 %d, pos3 %d, tilt %d, velocity %d", pos.pos1/100.0, pos.pos2, pos.pos3, pos.tilt, pos.velocity); Serial.printf("\tset position\tpos1 %f%%, pos2 %d, pos3 %d, tilt %d, velocity %d\n", pos.pos1/100.0, pos.pos2, pos.pos3, pos.tilt, pos.velocity);
break; break;
case 0xF7B8: case 0xF7B8:
// stop movement // stop movement
@@ -134,30 +123,46 @@ class coverCallbacks: public BLECharacteristicCallbacks {
break; break;
case 0xF7BA: case 0xF7BA:
// activate scene // activate scene
Serialprintln("\tactivate scene\tscene #%d", (uint16_t) value[4]); Serial.printf("\tactivate scene\tscene #%d\n", (uint16_t) rx_data.data[4]);
break; break;
case 0xFA5B: case 0xFA5B:
// get scene // get scene
Serialprintln("\tget scene\tscene #%d", (uint16_t) value[4]); Serial.printf("\tget scene\tscene #%d\n", (uint16_t) rx_data.data[4]);
break; break;
case 0xFAEA: case 0xFAEA:
// Reset Scene Automations // Reset Scene Automations
// FIXME! wrong return value! // FIXME! wrong return value!
Serialprintln("\treset scene automations\t"); const uint8_t ret_val[] = {0xEA, 0xEA, data.sequence, 0x1, 0x0};
uint8_t ret[]={0xFA, 0xEA, data.sequence, 0x1, 0x0}; Serial.println("\treset scene automations:");
Serial.print("ret: "); memcpy(&buffer, ret_val, 5);
print_hex(ret, 5); delay(100);
pCharacteristic->setValue(ret, 5); Serial.print("\t\tret value: ");
pCharacteristic->indicate(); print_hex(buffer, 5);
rx_data.characteristic->setValue((uint8_t *) &buffer, 5);
rx_data.characteristic->notify();
break; break;
} }
Serial.println(); Serial.println();
}
class coverCallbacks: public BLECharacteristicCallbacks {
void onWrite(BLECharacteristic *pCharacteristic) {
rx_data.characteristic = pCharacteristic;
data_available = true;
} }
void onRead(BLECharacteristic *pCharacteristic) { void onRead(BLECharacteristic *pCharacteristic) {
Serialprintln("Cover read: %s", pCharacteristic->toString().c_str()); Serial.printf("Cover read: %s\n", pCharacteristic->toString().c_str());
Serial.println(); }
}
void onNotify(BLECharacteristic *pCharacteristic){
Serial.println("onNotify()");
} // not used
void onStatus(BLECharacteristic *pCharacteristic, Status s, uint32_t code){
Serial.println("onStatus()");
}; // not used
}; };
class batteryCallbacks: public BLECharacteristicCallbacks { class batteryCallbacks: public BLECharacteristicCallbacks {
@@ -165,31 +170,42 @@ class batteryCallbacks: public BLECharacteristicCallbacks {
void onWrite(BLECharacteristic *pCharacteristic) { void onWrite(BLECharacteristic *pCharacteristic) {
uint8_t *value = pCharacteristic->getData(); uint8_t *value = pCharacteristic->getData();
Serialprintln("Battery write: %s:", pCharacteristic->toString().c_str()); Serial.printf("Battery write: %s:", pCharacteristic->toString().c_str());
print_hex(value, pCharacteristic->getLength()); print_hex(value, pCharacteristic->getLength());
Serial.println(); Serial.println();
} }
void onRead(BLECharacteristic *pCharacteristic) { void onRead(BLECharacteristic *pCharacteristic) {
Serialprintln("Battery read: %s", pCharacteristic->toString().c_str()); Serial.printf("Battery read: %s\n", pCharacteristic->toString().c_str());
Serial.println();
} }
void onNotify(BLECharacteristic *pCharacteristic){
Serial.println("Battery onNotify()");
} // not used
void onStatus(BLECharacteristic *pCharacteristic, Status s, uint32_t code){
Serial.println("Battery onStatus()");
}; // not used
}; };
class genericCallbacks: public BLECharacteristicCallbacks { class genericCallbacks: public BLECharacteristicCallbacks {
void onWrite(BLECharacteristic *pCharacteristic) { void onWrite(BLECharacteristic *pCharacteristic) {
uint8_t *value = pCharacteristic->getData(); //uint8_t *value = pCharacteristic->getData();
Serialprintln("generic write %s:", pCharacteristic->toString().c_str()); Serial.printf("generic write %s:", pCharacteristic->toString().c_str());
print_hex(value, pCharacteristic->getLength()); //print_hex(value, pCharacteristic->getLength());
Serial.println(); Serial.println();
} }
void onRead(BLECharacteristic *pCharacteristic) { void onRead(BLECharacteristic *pCharacteristic) {
Serialprintln("generic read %s.", pCharacteristic->toString().c_str()); Serial.printf("generic read %s.\n", pCharacteristic->toString().c_str());
Serial.println();
} }
void onNotify(BLECharacteristic *pCharacteristic){
Serial.println("generic onNotify()");
} // not used
void onStatus(BLECharacteristic *pCharacteristic, Status s, uint32_t code){
Serial.println("generic onStatus()");
}; // not used
}; };
void setup() { void setup() {
@@ -197,8 +213,6 @@ void setup() {
Serial.println(NAME " initializing ..."); Serial.println(NAME " initializing ...");
BLEDevice::init(NAME); BLEDevice::init(NAME);
Serialprintln("MTU: %d", BLEDevice::getMTU());
// Create the BLE Server // Create the BLE Server
pServer = BLEDevice::createServer(); pServer = BLEDevice::createServer();
pServer->setCallbacks(new MyServerCallbacks()); pServer->setCallbacks(new MyServerCallbacks());
@@ -214,31 +228,31 @@ void setup() {
); );
pCharacteristic_cover->setCallbacks(new coverCallbacks()); pCharacteristic_cover->setCallbacks(new coverCallbacks());
// Create a BLE Descriptor // Create a BLE Descriptor
BLEDescriptor *pDesc1 = new BLEDescriptor("2901", 10); /* BLEDescriptor *pDesc1 = new BLEDescriptor("2901", 10);
pDesc1->setValue("cover"); pDesc1->setValue("cover");*/
//pCharacteristic_cover->addDescriptor(pDesc1);
pCharacteristic_cover->addDescriptor(new BLE2902()); pCharacteristic_cover->addDescriptor(new BLE2902());
pCharacteristic_cover->addDescriptor(pDesc1);
pCharacteristic_unknown = pCovService->createCharacteristic( pCharacteristic_unknown = pCovService->createCharacteristic(
XXX_CHAR_UUID, XXX_CHAR_UUID,
BLECharacteristic::PROPERTY_INDICATE | BLECharacteristic::PROPERTY_NOTIFY |
BLECharacteristic::PROPERTY_WRITE | BLECharacteristic::PROPERTY_WRITE |
BLECharacteristic::PROPERTY_WRITE_NR BLECharacteristic::PROPERTY_WRITE_NR
); );
pCharacteristic_unknown->setCallbacks(new genericCallbacks()); pCharacteristic_unknown->setCallbacks(new genericCallbacks());
pCharacteristic_unknown->addDescriptor(new BLE2902());
BLEService *pBatService = pServer->createService(BAT_SERVICE_UUID);
pCharacteristic_bat = pBatService->createCharacteristic( // BLEService *pBatService = pServer->createService(BAT_SERVICE_UUID);
BAT_CHAR_UUID,
BLECharacteristic::PROPERTY_READ // pCharacteristic_bat = pBatService->createCharacteristic(
); // BAT_CHAR_UUID,
pCharacteristic_bat->setCallbacks(new batteryCallbacks()); // BLECharacteristic::PROPERTY_READ
pBatService->addCharacteristic(pCharacteristic_bat); // );
uint8_t battery_level = 42; // pCharacteristic_bat->setCallbacks(new batteryCallbacks());
pCharacteristic_bat->setValue(&battery_level, 1); // uint8_t battery_level = 42;
pCharacteristic_bat->addDescriptor(new BLE2902()); // pCharacteristic_bat->setValue(&battery_level, 1);
// pCharacteristic_bat->addDescriptor(new BLE2902());
// BLEService *pFWService = pServer->createService(FW_SERVICE_UUID); // BLEService *pFWService = pServer->createService(FW_SERVICE_UUID);
// pCharacteristic_fw = pCovService->createCharacteristic( // pCharacteristic_fw = pCovService->createCharacteristic(
@@ -270,7 +284,7 @@ void setup() {
pAdvertising->setAdvertisementData(AdvertisementData); pAdvertising->setAdvertisementData(AdvertisementData);
BLEDevice::startAdvertising(); BLEDevice::startAdvertising();
Serial.println("Device " NAME " ready."); Serial.println("Device " NAME " ready.");
} }
@@ -287,5 +301,10 @@ void loop() {
if (deviceConnected && !oldDeviceConnected) { if (deviceConnected && !oldDeviceConnected) {
// do stuff here on connecting // do stuff here on connecting
oldDeviceConnected = deviceConnected; oldDeviceConnected = deviceConnected;
} }
if (deviceConnected && data_available) {
data_available = false;
decode();
delay(100);
}
} }