diff --git a/common/ratp/Makefile b/common/ratp/Makefile index d4cfdf9..2c6d674 100644 --- a/common/ratp/Makefile +++ b/common/ratp/Makefile @@ -3,3 +3,4 @@ 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 0000000..ca8be4e --- /dev/null +++ b/common/ratp/reset.c @@ -0,0 +1,55 @@ +/* + * reset.c - reset the cpu + * + * Copyright (c) 2007 Sascha Hauer , 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 +#include +#include +#include +#include +#include + +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 00b165f..3a80cf6 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; diff --git a/scripts/remote/controller.py b/scripts/remote/controller.py index eaab9f8..2ed8346 100644 --- a/scripts/remote/controller.py +++ b/scripts/remote/controller.py @@ -46,9 +46,6 @@ elif p_type == BBType.fs_return: logging.debug("received: fs_return") return BBPacketFSReturn(raw=data) - elif p_type == BBType.md: - logging.debug("received: md") - return BBPacketMd(raw=data) elif p_type == BBType.md_return: logging.debug("received: md_return") return BBPacketMdReturn(raw=data) @@ -58,6 +55,9 @@ elif p_type == BBType.mw_return: logging.debug("received: mw_return") return BBPacketMwReturn(raw=data) + elif p_type == BBType.reset: + logging.debug("received: reset") + return BBPacketReset(raw=data) else: logging.debug("received: UNKNOWN") return BBPacket(raw=data) @@ -136,6 +136,9 @@ logging.info("Mw return: %r", r) return (r.exit_code,r.written) + def reset(self, force): + self._send(BBPacketReset(force=force)) + def close(self): self.conn.close() diff --git a/scripts/remote/main.py b/scripts/remote/main.py index 29f601e..38d280b 100644 --- a/scripts/remote/main.py +++ b/scripts/remote/main.py @@ -98,6 +98,13 @@ return res +def handle_reset(args): + ctrl = get_controller(args) + ctrl.reset(args.force) + ctrl.close() + return 0 + + def handle_listen(args): port = serial.serial_for_url(args.port, args.baudrate) conn = SerialRatpConnection(port) @@ -181,6 +188,12 @@ parser_mw.add_argument('data', help="data") parser_mw.set_defaults(func=handle_mw) +parser_reset = subparsers.add_parser('reset', help="run reset command") +parser_reset_force = parser_reset.add_mutually_exclusive_group(required=False) +parser_reset_force.add_argument('--force', dest='force', action='store_true') +parser_reset_force.add_argument('--no-force', dest='force', action='store_false') +parser_reset.set_defaults(func=handle_reset,force=False) + parser_listen = subparsers.add_parser('listen', help="listen for an incoming connection") parser_listen.set_defaults(func=handle_listen) diff --git a/scripts/remote/messages.py b/scripts/remote/messages.py index 4f4d8e9..729f2e6 100644 --- a/scripts/remote/messages.py +++ b/scripts/remote/messages.py @@ -21,6 +21,7 @@ md_return = 11 mw = 12 mw_return = 13 + reset = 14 class BBPacket(object): @@ -241,3 +242,18 @@ def _pack_payload(self): # header size is always 4 bytes (HH) and we have 8 bytes of fixed data (HLH), so buffer offset is 14 return struct.pack("!HLH", 12, self.exit_code, self.written) + + +class BBPacketReset(BBPacket): + def __init__(self, raw=None, force=None): + self.force = force + super(BBPacketReset, self).__init__(BBType.reset, raw=raw) + + def __repr__(self): + return "BBPacketReset(force=%c)" % (self.force) + + def _unpack_payload(self, payload): + self.force = struct.unpack("?", payload[:1]) + + def _pack_payload(self): + return struct.pack("?", self.force)