alexander/gobot
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Added Transmission Sucess

Browse Source
This commit is contained in:
AlexanderHD27
2025-01-03 20:10:15 +01:00
parent aa9d00bf6e
commit db464efa36
15 changed files with 171 additions and 42 deletions
Download Patch File Download Diff File Expand all files Collapse all files

43
i2c-hub/firmware/i2c-hub-firmware/src/gobotrpc/ctrl_interface/ci_instruction.cpp
View File

@@ -17,11 +17,44 @@ void GobotRPC_CI::txCIInstructionTask() {
xQueueReceive(ciInstructionQueue, &ciInstruction, portMAX_DELAY);
switch (ciInstruction.type) {
case CI_INSTRUCTION_SEND_TRANMISSION_ERROR:
uint32_t addr = ciInstruction.data[1] | (ciInstruction.data[2] << 8) | (ciInstruction.data[3] << 16) | (ciInstruction.data[4] << 24);
uint8_t rx = ciInstruction.data[0];
send_ErrorTransmission(rx, addr);
break;
case CI_INSTRUCTION_SEND_TRANMISSION_ERROR: {
uint32_t addr = ciInstruction.data[1] | (ciInstruction.data[2] << 8) | (ciInstruction.data[3] << 16) | (ciInstruction.data[4] << 24);
uint8_t rx = ciInstruction.data[0];
send_ErrorTransmission(rx, addr);
break;
}
case CI_INSTRUCTION_SEND_TRANMISSION_SUCCESS: {
uint32_t addr = ciInstruction.data[1] | (ciInstruction.data[2] << 8) | (ciInstruction.data[3] << 16) | (ciInstruction.data[4] << 24);
send_SuccessTransmission(addr);
break;
}
}
}
}
void GobotRPC_CI::send_ErrorTransmission(bool rx, uint64_t addr) {
char errorPacket[7];
errorPacket[0] = ERROR_TRANMISSION;
errorPacket[1] = 7;
errorPacket[2] = rx ? 0x01 : 0x00;
errorPacket[3] = (addr >> 24) & 0xff;
errorPacket[4] = (addr >> 16) & 0xff;
errorPacket[5] = (addr >> 8) & 0xff;
errorPacket[6] = addr & 0xff;
this->hardware->send(errorPacket, 7);
}
void GobotRPC_CI::send_SuccessTransmission(uint64_t addr) {
char successPacket[6];
successPacket[0] = SUCESS_TRANMISSION;
successPacket[1] = 6;
successPacket[2] = (addr >> 24) & 0xff;
successPacket[3] = (addr >> 16) & 0xff;
successPacket[4] = (addr >> 8) & 0xff;
successPacket[5] = addr & 0xff;
this->hardware->send(successPacket, 6);
}