Shutdown serial port in pony_spi
Implement serial port shutdown both for regular termination and error
conditions in pony_spi.
Corresponding to flashrom svn r1952.
Signed-off-by: Carl-Daniel Hailfinger <c-d.hailfinger.devel.2006@gmx.net>
Acked-by: Stefan Tauner <stefan.tauner@alumni.tuwien.ac.at>
diff --git a/pony_spi.c b/pony_spi.c
index 8a0f340..f8faeb3 100644
--- a/pony_spi.c
+++ b/pony_spi.c
@@ -103,6 +103,18 @@
.half_period = 0,
};
+static int pony_spi_shutdown(void *data)
+{
+ /* Shut down serial port communication */
+ int ret = serialport_shutdown(NULL);
+ if (ret)
+ msg_pdbg("Pony SPI shutdown failed.\n");
+ else
+ msg_pdbg("Pony SPI shutdown completed.\n");
+
+ return ret;
+}
+
int pony_spi_init(void)
{
int i, data_out;
@@ -120,6 +132,11 @@
free(arg);
return 1;
}
+ if (register_shutdown(pony_spi_shutdown, NULL) != 0) {
+ free(arg);
+ serialport_shutdown(NULL);
+ return 1;
+ }
have_device++;
}
free(arg);