CAN2B corrected packet length

Author: Ultrawipf

Firmware/FFBoard/Inc/CANPort2B.h

@@ -69,7 +69,7 @@ class CANPort_2B : public CANPort, public CommandHandler,public CanHandler{
 	static const uint32_t sendTimeout = 20;
 
 	CAN_TxHeaderTypeDef header = {0,0,0,CAN_RTR_DATA,8,(FunctionalState)0};
-
+	uint8_t nextLen = 8;
 
 };
 #endif

Firmware/FFBoard/Src/CANPort2B.cpp

@@ -356,15 +356,16 @@ CommandStatus CANPort_2B::command(const ParsedCommand& cmd,std::vector<CommandRe
 			CAN_tx_msg msg;
 			memcpy(msg.data,&cmd.val,8);
 			msg.header.id = cmd.adr;
+			msg.header.length = nextLen;
 			sendMessage(msg);
 		}else{
 			return CommandStatus::NOT_FOUND;
 		}
 		break;
 	}
 	case CanPort_commands::len:
-		handleGetSet(cmd, replies, header.DLC);
-		header.DLC = std::min<uint32_t>(header.DLC,8);
+		handleGetSet(cmd, replies, nextLen);
+		nextLen = std::min<uint32_t>(nextLen,8);
 		break;
 	default:
 		return CommandStatus::NOT_FOUND;