Gigastar(2): Fix bootloaders steps

include/icsneo/device/bootloaderpipeline.h

@@ -28,7 +28,8 @@ struct BootloaderPhase {
 		Finalize,
 		Reconnect,
 		EnterBootloader,
-		Wait
+		Wait,
+		EnterApplication
 	};
 
 	virtual Type getType() const = 0;
@@ -70,6 +71,16 @@ struct EnterBootloaderPhase : public BootloaderPhase {
 	}
 };
 
+struct EnterApplicationPhase : public BootloaderPhase {
+	Type getType() const override {
+		return Type::EnterApplication;
+	}
+
+	ChipID chip;
+
+	EnterApplicationPhase(ChipID chip) : chip(chip) {}
+};
+
 struct FlashPhase : public BootloaderPhase {
 	Type getType() const override {
 		return Type::Flash;

include/icsneo/device/tree/radgigastar/radgigastar.h

@@ -67,10 +67,23 @@ public:
 				}				
 			}
 			if(useNewBootloader) {
+				auto mainChip = std::find_if(chipVersions.begin(), chipVersions.end(), [](const auto& chip) { return chip.name == "ZCHIP"; });
+				auto usbChip = std::find_if(chipVersions.begin(), chipVersions.end(), [](const auto& chip) { return chip.name == "USB ZCHIP"; });
+
+				ChipID mainChipID;
+				if(mainChip != chipVersions.end()) {
+					mainChipID = mainChip->id;
+				} else if(usbChip != chipVersions.end()) {
+					mainChipID = usbChip->id;
+				} else {
+					return {};
+				}
+
 				BootloaderPipeline pipeline;
 				for(const auto& version : chipVersions) {
 					pipeline.add<FlashPhase>(version.id, BootloaderCommunication::RADMultiChip);
 				}
+				pipeline.add<EnterApplicationPhase>(mainChipID);
 				pipeline.add<ReconnectPhase>();
 				pipeline.add<WaitPhase>(std::chrono::milliseconds(3000));
 				return pipeline;

include/icsneo/device/tree/radgigastar2/radgigastar2.h

@@ -146,10 +146,23 @@ public:
 
 	BootloaderPipeline getBootloader() override {
 		auto chipVersions = getChipVersions();
+		auto mainChip = std::find_if(chipVersions.begin(), chipVersions.end(), [](const auto& chip) { return chip.name == "ZCHIP"; });
+		auto usbChip = std::find_if(chipVersions.begin(), chipVersions.end(), [](const auto& chip) { return chip.name == "USB ZCHIP"; });
+
+		ChipID mainChipID;
+		if(mainChip != chipVersions.end()) {
+			mainChipID = mainChip->id;
+		} else if(usbChip != chipVersions.end()) {
+			mainChipID = usbChip->id;
+		} else {
+			return {};
+		}
+
 		BootloaderPipeline pipeline;
 		for(const auto& version : chipVersions) {
 			pipeline.add<FlashPhase>(version.id, BootloaderCommunication::RADMultiChip);
 		}
+		pipeline.add<EnterApplicationPhase>(mainChipID);
 		pipeline.add<ReconnectPhase>();
 		pipeline.add<WaitPhase>(std::chrono::milliseconds(3000));
 		return pipeline;