Got homing sequenc to work, ....again
This commit is contained in:
@@ -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);
|
||||
|
||||
@@ -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);
|
||||
}
|
||||
|
||||
|
||||
@@ -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());
|
||||
|
||||
Reference in New Issue
Block a user