Incomplete device settings sending

device/idevicesettings.cpp

@@ -1,4 +1,6 @@
 #include "device/include/idevicesettings.h"
+#include "communication/message/filter/include/main51messagefilter.h"
+#include <cstring>
 
 using namespace icsneo;
 
@@ -72,5 +74,120 @@ void IDeviceSettings::refresh() {
 		
 		settings = std::move(rxSettings);
 		settingsLoaded = true;
+
+		if(settings.size() != structSize) {
+			std::cout << "Settings size was " << settings.size() << " bytes but it should be " << structSize << " bytes for this device" << std::endl;
+			settingsLoaded = false;
+		}
+	}
+}
+
+bool IDeviceSettings::send() {
+	constexpr uint16_t GS_VERSION = 5;
+	std::vector<uint8_t> bytestream;
+	bytestream.resize(6 + structSize);
+	bytestream[0] = GS_VERSION;
+	bytestream[1] = GS_VERSION >> 8;
+	bytestream[2] = structSize;
+	bytestream[3] = structSize >> 8;
+	uint16_t gs_checksum = CalculateGSChecksum(settings);
+	bytestream[4] = gs_checksum;
+	bytestream[5] = gs_checksum >> 8;
+	memcpy(bytestream.data() + 6, getRawStructurePointer(), structSize);
+	com->sendCommand(Command::SetSettings, bytestream);
+	std::shared_ptr<Message> msg = com->waitForMessageSync(Main51MessageFilter(Command::SetSettings), std::chrono::milliseconds(500));
+	if(!msg || msg->data[1] != 1) { // The second byte of the response carries the result, 1 being success
+		refresh(); // Refresh our buffer with what the device has
+		return false;
+	}
+	
+	return true;
+}
+
+bool IDeviceSettings::commit() {
+	if(!send())
+		return false;
+
+	com->sendCommand(Command::SaveSettings);
+	std::shared_ptr<Message> msg = com->waitForMessageSync(Main51MessageFilter(Command::SaveSettings), std::chrono::milliseconds(500));
+	if(!msg || msg->data[1] != 1) { // The second byte of the response carries the result, 1 being success
+		refresh(); // Refresh our buffer with what the device has
+		return false;
+	}
+	
+	return true;
+}
+
+bool IDeviceSettings::setBaudrateFor(Network net, uint32_t baudrate) {
+	switch(net.getType()) {
+		case Network::Type::CAN: {
+			CAN_SETTINGS* settings = getCANSettingsFor(net);
+			if(settings == nullptr)
+				return false;
+				
+			uint8_t newBaud = getEnumValueForBaudrate(baudrate);
+			if(newBaud == 0xFF)
+				return false;
+			settings->Baudrate = newBaud;
+			settings->auto_baud = false;
+			settings->SetBaudrate = AUTO; // Use the baudrate values instead of the TQ values
+			return true;
+		}
+		default:
+			return false;
+	}
+}
+
+template<typename T> bool IDeviceSettings::setStructure(const T& newStructure) {
+	if(sizeof(T) != structSize)
+		return false; // The wrong structure was passed in for the current device
+	
+	if(settings.size() != structSize)
+		settings.resize(structSize);
+	
+	memcpy(settings.data(), &newStructure, structSize);
+	return true;
+}
+
+uint8_t IDeviceSettings::getEnumValueForBaudrate(uint32_t baudrate) {
+	switch(baudrate) {
+		case 20000:
+			return BPS20;
+		case 33000:
+			return BPS33;
+		case 50000:
+			return BPS50;
+		case 62000:
+			return BPS62;
+		case 83000:
+			return BPS83;
+		case 100000:
+			return BPS100;
+		case 125000:
+			return BPS125;
+		case 250000:
+			return BPS250;
+		case 500000:
+			return BPS500;
+		case 800000:
+			return BPS800;
+		case 1000000:
+			return BPS1000;
+		case 666000:
+			return BPS666;
+		case 2000000:
+			return BPS2000;
+		case 4000000:
+			return BPS4000;
+		case 5000000:
+			return CAN_BPS5000;
+		case 6667000:
+			return CAN_BPS6667;
+		case 8000000:
+			return CAN_BPS8000;
+		case 10000000:
+			return CAN_BPS10000;
+		default:
+			return 0xFF;
 	}
 }