diff options
author | Sascha Hauer <s.hauer@pengutronix.de> | 2018-10-09 12:00:43 +0200 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2018-10-09 12:00:43 +0200 |
commit | 7f071269ddb8f3786f6c5ec1d4b91ae928833c96 (patch) | |
tree | 06e1586a503baad326e381e93b2d8cc6b6e57d9f /scripts | |
parent | fee477f487b246490e7167acc3331e43fbeff901 (diff) | |
parent | fb6fd3128c11653b7990b16887b37ddab6d1bae3 (diff) | |
download | barebox-7f071269ddb8f3786f6c5ec1d4b91ae928833c96.tar.gz barebox-7f071269ddb8f3786f6c5ec1d4b91ae928833c96.tar.xz |
Merge branch 'for-next/ratp'
Diffstat (limited to 'scripts')
-rw-r--r-- | scripts/remote/controller.py | 60 | ||||
-rw-r--r-- | scripts/remote/main.py | 74 | ||||
-rw-r--r-- | scripts/remote/messages.py | 179 |
3 files changed, 313 insertions, 0 deletions
diff --git a/scripts/remote/controller.py b/scripts/remote/controller.py index 1a83909042..b4493591dd 100644 --- a/scripts/remote/controller.py +++ b/scripts/remote/controller.py @@ -61,6 +61,36 @@ def unpack(data): elif p_type == BBType.reset: logging.debug("received: reset") return BBPacketReset(raw=data) + elif p_type == BBType.i2c_read: + logging.debug("received: i2c_read") + return BBPacketI2cRead(raw=data) + elif p_type == BBType.i2c_read_return: + logging.debug("received: i2c_read_return") + return BBPacketI2cReadReturn(raw=data) + elif p_type == BBType.i2c_write: + logging.debug("received: i2c_write") + return BBPacketI2cWrite(raw=data) + elif p_type == BBType.i2c_write_return: + logging.debug("received: i2c_write_return") + return BBPacketI2cWriteReturn(raw=data) + elif p_type == BBType.gpio_get_value: + logging.debug("received: gpio_get_value") + return BBPacketGpioGetValue(raw=data) + elif p_type == BBType.gpio_get_value_return: + logging.debug("received: gpio_get_value_return") + return BBPacketGpioGetValueReturn(raw=data) + elif p_type == BBType.gpio_set_value: + logging.debug("received: gpio_set_value") + return BBPacketGpioSetValue(raw=data) + elif p_type == BBType.gpio_set_value_return: + logging.debug("received: gpio_set_value_return") + return BBPacketGpioSetValueReturn(raw=data) + elif p_type == BBType.gpio_set_direction: + logging.debug("received: gpio_set_direction") + return BBPacketGpioSetDirection(raw=data) + elif p_type == BBType.gpio_set_direction_return: + logging.debug("received: gpio_set_direction_return") + return BBPacketGpioSetDirectionReturn(raw=data) else: logging.debug("received: UNKNOWN") return BBPacket(raw=data) @@ -139,6 +169,36 @@ class Controller(Thread): logging.info("Mw return: %r", r) return (r.exit_code,r.written) + def i2c_read(self, bus, addr, reg, flags, size): + self._send(BBPacketI2cRead(bus=bus, addr=addr, reg=reg, flags=flags, size=size)) + r = self._expect(BBPacketI2cReadReturn) + logging.info("i2c read return: %r", r) + return (r.exit_code,r.data) + + def i2c_write(self, bus, addr, reg, flags, data): + self._send(BBPacketI2cWrite(bus=bus, addr=addr, reg=reg, flags=flags, data=data)) + r = self._expect(BBPacketI2cWriteReturn) + logging.info("i2c write return: %r", r) + return (r.exit_code,r.written) + + def gpio_get_value(self, gpio): + self._send(BBPacketGpioGetValue(gpio=gpio)) + r = self._expect(BBPacketGpioGetValueReturn) + logging.info("gpio get value return: %r", r) + return r.value + + def gpio_set_value(self, gpio, value): + self._send(BBPacketGpioSetValue(gpio=gpio, value=value)) + r = self._expect(BBPacketGpioSetValueReturn) + logging.info("gpio set value return: %r", r) + return 0 + + def gpio_set_direction(self, gpio, direction, value): + self._send(BBPacketGpioSetDirection(gpio=gpio, direction=direction, value=value)) + r = self._expect(BBPacketGpioSetDirectionReturn) + logging.info("gpio set direction return: %r", r) + return r.exit_code + def reset(self, force): self._send(BBPacketReset(force=force)) diff --git a/scripts/remote/main.py b/scripts/remote/main.py index 38d280bfee..cef5d92ee2 100644 --- a/scripts/remote/main.py +++ b/scripts/remote/main.py @@ -98,6 +98,49 @@ def handle_mw(args): return res +def handle_i2c_read(args): + ctrl = get_controller(args) + (res,data) = ctrl.i2c_read(args.bus, args.address, args.reg, args.flags, args.size) + if res == 0: + print(binascii.hexlify(data)) + ctrl.close() + return res + + +def handle_i2c_write(args): + ctrl = get_controller(args) + data=args.data + if ((len(data) % 2) != 0): + data="0"+data + (res,written) = ctrl.i2c_write(args.bus, args.address, args.reg, args.flags, binascii.unhexlify(data)) + if res == 0: + print("%i bytes written" % written) + ctrl.close() + return res + + +def handle_gpio_get_value(args): + ctrl = get_controller(args) + value = ctrl.gpio_get_value(args.gpio) + print ("%u" % value); + ctrl.close() + return 0 + + +def handle_gpio_set_value(args): + ctrl = get_controller(args) + ctrl.gpio_set_value(args.gpio, args.value) + ctrl.close() + return 0 + + +def handle_gpio_set_direction(args): + ctrl = get_controller(args) + res = ctrl.gpio_set_direction(args.gpio, args.direction, args.value) + ctrl.close() + return res + + def handle_reset(args): ctrl = get_controller(args) ctrl.reset(args.force) @@ -188,6 +231,37 @@ parser_mw.add_argument('address', type=auto_int, help="address") parser_mw.add_argument('data', help="data") parser_mw.set_defaults(func=handle_mw) +parser_i2c_read = subparsers.add_parser('i2c-read', help="run i2c read command") +parser_i2c_read.add_argument('bus', type=auto_int, help="bus") +parser_i2c_read.add_argument('address', type=auto_int, help="address") +parser_i2c_read.add_argument('reg', type=auto_int, help="reg") +parser_i2c_read.add_argument('flags', type=auto_int, help="flags") +parser_i2c_read.add_argument('size', type=auto_int, help="size") +parser_i2c_read.set_defaults(func=handle_i2c_read) + +parser_i2c_write = subparsers.add_parser('i2c-write', help="run i2c write command") +parser_i2c_write.add_argument('bus', type=auto_int, help="bus") +parser_i2c_write.add_argument('address', type=auto_int, help="address") +parser_i2c_write.add_argument('reg', type=auto_int, help="reg") +parser_i2c_write.add_argument('flags', type=auto_int, help="flags") +parser_i2c_write.add_argument('data', help="data") +parser_i2c_write.set_defaults(func=handle_i2c_write) + +parser_gpio_get_value = subparsers.add_parser('gpio-get-value', help="run gpio get value command") +parser_gpio_get_value.add_argument('gpio', type=auto_int, help="gpio") +parser_gpio_get_value.set_defaults(func=handle_gpio_get_value) + +parser_gpio_set_value = subparsers.add_parser('gpio-set-value', help="run gpio set value command") +parser_gpio_set_value.add_argument('gpio', type=auto_int, help="gpio") +parser_gpio_set_value.add_argument('value', type=auto_int, help="value") +parser_gpio_set_value.set_defaults(func=handle_gpio_set_value) + +parser_gpio_set_direction = subparsers.add_parser('gpio-set-direction', help="run gpio set direction command") +parser_gpio_set_direction.add_argument('gpio', type=auto_int, help="gpio") +parser_gpio_set_direction.add_argument('direction', type=auto_int, help="direction (0: input, 1: output)") +parser_gpio_set_direction.add_argument('value', type=auto_int, help="value (if output)") +parser_gpio_set_direction.set_defaults(func=handle_gpio_set_direction) + 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') diff --git a/scripts/remote/messages.py b/scripts/remote/messages.py index 729f2e6177..abd331c8b6 100644 --- a/scripts/remote/messages.py +++ b/scripts/remote/messages.py @@ -22,6 +22,16 @@ class BBType(object): mw = 12 mw_return = 13 reset = 14 + i2c_read = 15 + i2c_read_return = 16 + i2c_write = 17 + i2c_write_return = 18 + gpio_get_value = 19 + gpio_get_value_return = 20 + gpio_set_value = 21 + gpio_set_value_return = 22 + gpio_set_direction = 23 + gpio_set_direction_return = 24 class BBPacket(object): @@ -257,3 +267,172 @@ class BBPacketReset(BBPacket): def _pack_payload(self): return struct.pack("?", self.force) + + +class BBPacketI2cRead(BBPacket): + def __init__(self, raw=None, bus=None, addr=None, reg=None, flags=None, size=None): + self.bus = bus + self.addr = addr + self.reg = reg + self.flags = flags + self.size = size + super(BBPacketI2cRead, self).__init__(BBType.i2c_read, raw=raw) + + def __repr__(self): + return "BBPacketI2cRead(bus=0x%x,addr=0x%x,reg=0x%x,flags=0x%x,size=%u)" % (self.bus, self.addr, self.reg, self.flags, self.size) + + def _unpack_payload(self, payload): + buffer_offset, self.bus, self.addr, self.reg, self.flags, self.size = struct.unpack("!HBBHBH", payload[:9]) + + def _pack_payload(self): + # header size is always 4 bytes (HH) and we have 9 bytes of fixed data (HBBHBH), so buffer offset is 13 + return struct.pack("!HBBHBH", 13, self.bus, self.addr, self.reg, self.flags, self.size) + + +class BBPacketI2cReadReturn(BBPacket): + def __init__(self, raw=None, exit_code=None, data=None): + self.exit_code = exit_code + self.data = data + super(BBPacketI2cReadReturn, self).__init__(BBType.i2c_read_return, raw=raw) + + def __repr__(self): + return "BBPacketI2cReadReturn(exit_code=%i, data=%s)" % (self.exit_code, binascii.hexlify(self.data)) + + def _unpack_payload(self, payload): + buffer_offset, self.exit_code, data_size, data_offset = struct.unpack("!HLHH", payload[:10]) + # header size is always 4 bytes (HH), so adjust the absolute data offset without the header size + absolute_data_offset = buffer_offset + data_offset - 4 + self.data = payload[absolute_data_offset:absolute_data_offset + data_size] + + def _pack_payload(self): + # header size is always 4 bytes (HH) and we have 10 bytes of fixed data (HLHH), so buffer offset is 14 + return struct.pack("!HLHH%ds" % len(self.data), 14, self.exit_code, len(self.data), 0, self.data) + return self.text + + +class BBPacketI2cWrite(BBPacket): + def __init__(self, raw=None, bus=None, addr=None, reg=None, flags=None, data=None): + self.bus = bus + self.addr = addr + self.reg = reg + self.flags = flags + self.data = data + super(BBPacketI2cWrite, self).__init__(BBType.i2c_write, raw=raw) + + def __repr__(self): + return "BBPacketI2cWrite(bus=0x%x,addr=0x%x,reg=0x%x,flags=0x%x,data=%r)" % (self.bus, self.addr, self.reg, self.flags, self.data) + + def _unpack_payload(self, payload): + buffer_offset, self.bus, self.addr, self.reg, self.flags, data_size, data_offset = struct.unpack("!HBBHBHH", payload[:11]) + # header size is always 4 bytes (HH), so adjust the absolute data offset without the header size + absolute_data_offset = buffer_offset + data_offset - 4 + self.data = payload[absolute_data_offset:absolute_data_offset+data_size] + + def _pack_payload(self): + # header size is always 4 bytes (HH) and we have 11 bytes of fixed data (HBBHBHH), so buffer offset is 15 + data_size = len(self.data) + return struct.pack("!HBBHBHH%ds" % data_size, 15, self.bus, self.addr, self.reg, self.flags, data_size, 0, self.data) + + +class BBPacketI2cWriteReturn(BBPacket): + def __init__(self, raw=None, exit_code=None, written=None): + self.exit_code = exit_code + self.written = written + super(BBPacketI2cWriteReturn, self).__init__(BBType.i2c_write_return, raw=raw) + + def __repr__(self): + return "BBPacketI2cWriteReturn(exit_code=%i, written=%i)" % (self.exit_code, self.written) + + def _unpack_payload(self, payload): + buffer_offset, self.exit_code, self.written = struct.unpack("!HLH", payload[:8]) + + 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 BBPacketGpioGetValue(BBPacket): + def __init__(self, raw=None, gpio=None): + self.gpio = gpio + super(BBPacketGpioGetValue, self).__init__(BBType.gpio_get_value, raw=raw) + + def __repr__(self): + return "BBPacketGpioGetValue(gpio=%u)" % (self.gpio) + + def _unpack_payload(self, payload): + self.gpio = struct.unpack("!L", payload[:4]) + + def _pack_payload(self): + return struct.pack("!L", self.gpio) + + +class BBPacketGpioGetValueReturn(BBPacket): + def __init__(self, raw=None, value=None): + self.value = value + super(BBPacketGpioGetValueReturn, self).__init__(BBType.gpio_get_value_return, raw=raw) + + def __repr__(self): + return "BBPacketGpioGetValueReturn(value=%u)" % (self.value) + + def _unpack_payload(self, payload): + self.value = struct.unpack("!B", payload[:1]) + + def _pack_payload(self): + return struct.pack("!B", self.value) + + +class BBPacketGpioSetValue(BBPacket): + def __init__(self, raw=None, gpio=None, value=None): + self.gpio = gpio + self.value = value + super(BBPacketGpioSetValue, self).__init__(BBType.gpio_set_value, raw=raw) + + def __repr__(self): + return "BBPacketGpioSetValue(gpio=%u,value=%u)" % (self.gpio, self.value) + + def _unpack_payload(self, payload): + self.gpio = struct.unpack("!LB", payload[:5]) + + def _pack_payload(self): + return struct.pack("!LB", self.gpio, self.value) + + +class BBPacketGpioSetValueReturn(BBPacket): + def __init__(self, raw=None, value=None): + self.value = value + super(BBPacketGpioSetValueReturn, self).__init__(BBType.gpio_set_value_return, raw=raw) + + def __repr__(self): + return "BBPacketGpioSetValueReturn()" + + +class BBPacketGpioSetDirection(BBPacket): + def __init__(self, raw=None, gpio=None, direction=None, value=None): + self.gpio = gpio + self.direction = direction + self.value = value + super(BBPacketGpioSetDirection, self).__init__(BBType.gpio_set_direction, raw=raw) + + def __repr__(self): + return "BBPacketGpioSetDirection(gpio=%u,direction=%u,value=%u)" % (self.gpio, self.direction, self.value) + + def _unpack_payload(self, payload): + self.gpio = struct.unpack("!LBB", payload[:6]) + + def _pack_payload(self): + return struct.pack("!LBB", self.gpio, self.direction, self.value) + + +class BBPacketGpioSetDirectionReturn(BBPacket): + def __init__(self, raw=None, exit_code=None): + self.exit_code = exit_code + super(BBPacketGpioSetDirectionReturn, self).__init__(BBType.gpio_set_direction_return, raw=raw) + + def __repr__(self): + return "BBPacketGpioSetDirectionReturn(exit_code=%u)" % (self.exit_code) + + def _unpack_payload(self, payload): + self.exit_code = struct.unpack("!L", payload[:4]) + + def _pack_payload(self): + return struct.pack("!L", self.exit_code) |