tools/crypto/ccp/dbc_cli.py

   1 #!/usr/bin/python3
   2 # SPDX-License-Identifier: GPL-2.0
   3 import argparse
   4 import binascii
   5 import os
   6 import errno
   7 from dbc import *
   8
   9 ERRORS = {
  10     errno.EACCES: "Access is denied",
  11     errno.E2BIG: "Excess data provided",
  12     errno.EINVAL: "Bad parameters",
  13     errno.EAGAIN: "Bad state",
  14     errno.ENOENT: "Not implemented or message failure",
  15     errno.EBUSY: "Busy",
  16     errno.ENFILE: "Overflow",
  17     errno.EPERM: "Signature invalid",
  18 }
  19
  20 messages = {
  21     "get-fmax-cap": PARAM_GET_FMAX_CAP,
  22     "set-fmax-cap": PARAM_SET_FMAX_CAP,
  23     "get-power-cap": PARAM_GET_PWR_CAP,
  24     "set-power-cap": PARAM_SET_PWR_CAP,
  25     "get-graphics-mode": PARAM_GET_GFX_MODE,
  26     "set-graphics-mode": PARAM_SET_GFX_MODE,
  27     "get-current-temp": PARAM_GET_CURR_TEMP,
  28     "get-fmax-max": PARAM_GET_FMAX_MAX,
  29     "get-fmax-min": PARAM_GET_FMAX_MIN,
  30     "get-soc-power-max": PARAM_GET_SOC_PWR_MAX,
  31     "get-soc-power-min": PARAM_GET_SOC_PWR_MIN,
  32     "get-soc-power-cur": PARAM_GET_SOC_PWR_CUR,
  33 }
  34
  35
  36 def _pretty_buffer(ba):
  37     return str(binascii.hexlify(ba, " "))
  38
  39
  40 def parse_args():
  41     parser = argparse.ArgumentParser(
  42         description="Dynamic Boost control command line interface"
  43     )
  44     parser.add_argument(
  45         "command",
  46         choices=["get-nonce", "get-param", "set-param", "set-uid"],
  47         help="Command to send",
  48     )
  49     parser.add_argument("--device", default="/dev/dbc", help="Device to operate")
  50     parser.add_argument("--signature", help="File containing signature for command")
  51     parser.add_argument("--message", choices=messages.keys(), help="Message index")
  52     parser.add_argument("--data", help="Argument to pass to message")
  53     parser.add_argument("--uid", help="File containing UID to pass")
  54     return parser.parse_args()
  55
  56
  57 def pretty_error(code):
  58     if code in ERRORS:
  59         print(ERRORS[code])
  60     else:
  61         print("failed with return code %d" % code)
  62
  63
  64 if __name__ == "__main__":
  65     args = parse_args()
  66     data = 0
  67     sig = None
  68     uid = None
  69     if not os.path.exists(args.device):
  70         raise IOError("Missing device {device}".format(device=args.device))
  71     if args.signature:
  72         if not os.path.exists(args.signature):
  73             raise ValueError("Invalid signature file %s" % args.signature)
  74         with open(args.signature, "rb") as f:
  75             sig = f.read()
  76         if len(sig) != DBC_SIG_SIZE:
  77             raise ValueError(
  78                 "Invalid signature length %d (expected %d)" % (len(sig), DBC_SIG_SIZE)
  79             )
  80     if args.uid:
  81         if not os.path.exists(args.uid):
  82             raise ValueError("Invalid uid file %s" % args.uid)
  83         with open(args.uid, "rb") as f:
  84             uid = f.read()
  85         if len(uid) != DBC_UID_SIZE:
  86             raise ValueError(
  87                 "Invalid UID length %d (expected %d)" % (len(uid), DBC_UID_SIZE)
  88             )
  89     if args.data:
  90         try:
  91             data = int(args.data, 10)
  92         except ValueError:
  93             data = int(args.data, 16)
  94
  95     with open(args.device) as d:
  96         if args.command == "get-nonce":
  97             try:
  98                 nonce = get_nonce(d, sig)
  99                 print("Nonce: %s" % _pretty_buffer(bytes(nonce)))
 100             except OSError as e:
 101                 pretty_error(e.errno)
 102         elif args.command == "set-uid":
 103             try:
 104                 result = set_uid(d, uid, sig)
 105                 if result:
 106                     print("Set UID")
 107             except OSError as e:
 108                 pretty_error(e.errno)
 109         elif args.command == "get-param":
 110             if not args.message or args.message.startswith("set"):
 111                 raise ValueError("Invalid message %s" % args.message)
 112             try:
 113                 param, signature = process_param(d, messages[args.message], sig)
 114                 print(
 115                     "Parameter: {par}, response signature {sig}".format(
 116                         par=param,
 117                         sig=_pretty_buffer(bytes(signature)),
 118                     )
 119                 )
 120             except OSError as e:
 121                 pretty_error(e.errno)
 122         elif args.command == "set-param":
 123             if not args.message or args.message.startswith("get"):
 124                 raise ValueError("Invalid message %s" % args.message)
 125             try:
 126                 param, signature = process_param(d, messages[args.message], sig, data)
 127                 print(
 128                     "Parameter: {par}, response signature {sig}".format(
 129                         par=param,
 130                         sig=_pretty_buffer(bytes(signature)),
 131                     )
 132                 )
 133             except OSError as e:
 134                 pretty_error(e.errno)