Got homing sequenc to work, ....again

This commit is contained in:
AlexanderHD27
2025-01-01 16:47:53 +01:00
parent edc2dd6294
commit c136056ed2
36 changed files with 2464 additions and 9 deletions

View File

@@ -6,7 +6,7 @@ void GobotRPC_CtrlInterface::pushPacket(RPCPackage package) {
char buffer[MAX_PAGE_SIZES + 7];
buffer[0] = GOBOTRPC_CTRL_CMD_PACKET;
buffer[1] = package.length;
buffer[1] = package.length - 7;
buffer[2] = package.type | (package.rpcNum << 4);
memcpy(&buffer[3], &package.addr, 4);
memcpy(&buffer[7], package.buffer, package.length);

View File

@@ -56,7 +56,7 @@ FrameSubmitionResult GobotRPCParser::submit_frame(char *data, size_t length, uin
// Push the update to the control interface
ctrlInterface->pushPackageSlotUpdate(res == COMPLEATE, this->buffer[slotNum].is_in_use, slotNum, addr, timestamp, this->buffer[slotNum].used_bit_masked);
if (res == COMPLEATE) {
y if (res == COMPLEATE) {
this->buffer[slotNum].is_complete = true;
}
@@ -118,6 +118,7 @@ void GobotRPCParser::retrivePackage(RPCPackage *dest, int index) {
dest->type = buffer[index].type;
dest->length = buffer[index].length;
this->ctrlInterface->pushPacket(*dest);
freePackageSlot(index);
}

View File

@@ -12,7 +12,7 @@
#include "ctrl_interface_hardware.hpp"
void vTaskMain(void * args) {
GobotRPC_CtrlInterface_HardwareHandler_RP2040 uartHandler(uart0, 115200, 500, 0, 1);
GobotRPC_CtrlInterface_HardwareHandler_RP2040 uartHandler(uart0, 9600, 1500, 0, 1);
GobotRPC_CtrlInterface ctrlInterface(&uartHandler);
GobotRPCParser rpcRXParser(&ctrlInterface);
@@ -27,6 +27,9 @@ void vTaskMain(void * args) {
rpcRXParser.submit_frame(data3, 7, 0x43, xTaskGetTickCount());
rpcRXParser.submit_frame(data1, 7, 0x42, xTaskGetTickCount());
ctrlInterface.printf("This is Random Text\n");
vTaskDelay(10 / portTICK_PERIOD_MS);
rpcRXParser.submit_frame(data3, 7, 0x43, xTaskGetTickCount());