Signed-off-by: Aleksander Morgado <aleksan...@aleksander.es>
---
 common/ratp/Makefile |  1 +
 common/ratp/reset.c  | 55 ++++++++++++++++++++++++++++++++++++++++++++++++++++
 include/ratp_bb.h    |  1 +
 3 files changed, 57 insertions(+)
 create mode 100644 common/ratp/reset.c

diff --git a/common/ratp/Makefile b/common/ratp/Makefile
index d4cfdf95f..2c6d674f6 100644
--- a/common/ratp/Makefile
+++ b/common/ratp/Makefile
@@ -3,3 +3,4 @@ obj-y += ping.o
 obj-y += getenv.o
 obj-y += md.o
 obj-y += mw.o
+obj-y += reset.o
diff --git a/common/ratp/reset.c b/common/ratp/reset.c
new file mode 100644
index 000000000..ca8be4e62
--- /dev/null
+++ b/common/ratp/reset.c
@@ -0,0 +1,55 @@
+/*
+ * reset.c - reset the cpu
+ *
+ * Copyright (c) 2007 Sascha Hauer <s.ha...@pengutronix.de>, Pengutronix
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2
+ * as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ */
+
+#include <common.h>
+#include <command.h>
+#include <ratp_bb.h>
+#include <complete.h>
+#include <getopt.h>
+#include <restart.h>
+
+struct ratp_bb_reset {
+       struct ratp_bb header;
+       uint8_t        force;
+} __attribute__((packed));
+
+static int ratp_cmd_reset(const struct ratp_bb *req, int req_len,
+                         struct ratp_bb **rsp, int *rsp_len)
+{
+       struct ratp_bb_reset *reset_req = (struct ratp_bb_reset *)req;
+
+       if (req_len < sizeof (*reset_req)) {
+               printf ("ratp reset ignored: size mismatch (%d < %zu)\n", 
req_len, sizeof (*reset_req));
+               return 2;
+       }
+
+       debug("running reset %s\n", reset_req->force ? "(forced)" : "");
+
+       if (!reset_req->force)
+               shutdown_barebox();
+
+       restart_machine();
+       /* Not reached */
+       return 1;
+}
+
+BAREBOX_RATP_CMD_START(RESET)
+       .request_id = BB_RATP_TYPE_RESET,
+       .cmd = ratp_cmd_reset
+BAREBOX_RATP_CMD_END
diff --git a/include/ratp_bb.h b/include/ratp_bb.h
index 00b165f77..3a80cf6ae 100644
--- a/include/ratp_bb.h
+++ b/include/ratp_bb.h
@@ -16,6 +16,7 @@
 #define BB_RATP_TYPE_MD_RETURN         11
 #define BB_RATP_TYPE_MW                        12
 #define BB_RATP_TYPE_MW_RETURN         13
+#define BB_RATP_TYPE_RESET             14

 struct ratp_bb {
        uint16_t type;
--
2.15.1

_______________________________________________
barebox mailing list
barebox@lists.infradead.org
http://lists.infradead.org/mailman/listinfo/barebox

Reply via email to