Fixed fdcan 64 byte sending issue (#515)

* Fixed fdcan 64 byte sending issue

* Added an if for modifying the Tx element size depending on the CAN format

---------

Co-authored-by: jdmarmen <jdmarmen@upv.edu.es>

Author: Cantonplas

Inc/HALAL/Services/Communication/FDCAN/FDCAN.hpp

@@ -226,7 +226,13 @@ uint8_t FDCAN::inscribe(FDCAN::Peripheral& fdcan){
 	fdcan_instance->hfdcan->Init.TxBuffersNbr = 0;
 	fdcan_instance->hfdcan->Init.TxFifoQueueElmtsNbr = 16;
 	fdcan_instance->hfdcan->Init.TxFifoQueueMode = FDCAN_TX_FIFO_OPERATION;
-	fdcan_instance->hfdcan->Init.TxElmtSize = FDCAN_DATA_BYTES_8;
+
+    if constexpr(format == CANFormat::CAN_NORMAL_FORMAT){
+        fdcan_instance->hfdcan->Init.TxElmtSize = FDCAN_DATA_BYTES_8;
+    }
+    else{
+        fdcan_instance->hfdcan->Init.TxElmtSize = FDCAN_DATA_BYTES_64;
+    }
 
 	Pin::inscribe(fdcan_instance->TX, ALTERNATIVE);
 	Pin::inscribe(fdcan_instance->RX, ALTERNATIVE);