]> granicus.if.org Git - strace/blobdiff - sg_io_v3.c
nlattr: add UID/GID netlink attribute decoders
[strace] / sg_io_v3.c
index a018bdba3ad3139c32313f5969382aaf616e122d..88f9dfc8aebc0ef236eb1e92994438316ad5e18c 100644 (file)
@@ -44,16 +44,29 @@ typedef struct sg_io_hdr struct_sg_io_hdr;
 #include "xlat/sg_io_info.h"
 
 #ifdef HAVE_SCSI_SG_H
+# include "print_fields.h"
 # include "xlat/sg_io_dxfer_direction.h"
 # include "xlat/sg_io_flags.h"
 
 static void
 print_sg_io_buffer(struct tcb *const tcp, const kernel_ulong_t addr,
-                  const unsigned int len)
+                  const unsigned int data_size, const unsigned int iovec_count)
 {
-       printstr_ex(tcp, addr, len, QUOTE_FORCE_HEX);
+       if (iovec_count) {
+               tprint_iov_upto(tcp, iovec_count, addr, IOV_DECODE_STR,
+                               data_size);
+       } else {
+               printstr_ex(tcp, addr, data_size, QUOTE_FORCE_HEX);
+       }
 }
 
+#define PRINT_FIELD_SG_IO_BUFFER(prefix_, where_, field_, size_, count_, tcp_) \
+       do {                                                                    \
+               STRACE_PRINTF("%s%s=", (prefix_), #field_);                     \
+               print_sg_io_buffer((tcp_), (mpers_ptr_t)((where_).field_),      \
+                                  (size_), (count_));                          \
+       } while (0)
+
 static int
 decode_request(struct tcb *const tcp, const kernel_ulong_t arg)
 {
@@ -65,79 +78,84 @@ decode_request(struct tcb *const tcp, const kernel_ulong_t arg)
        if (umoven_or_printaddr(tcp, arg + skip_iid, sizeof(sg_io) - skip_iid,
                                &sg_io.dxfer_direction)) {
                tprints("}");
-               return RVAL_DECODED | 1;
+               return RVAL_IOCTL_DECODED;
        }
 
-       tprints("dxfer_direction=");
-       printxval(sg_io_dxfer_direction, sg_io.dxfer_direction,
-                 "SG_DXFER_???");
-       tprintf(", cmd_len=%u, cmdp=", sg_io.cmd_len);
-       print_sg_io_buffer(tcp, ptr_to_kulong(sg_io.cmdp), sg_io.cmd_len);
-       tprintf(", mx_sb_len=%d", sg_io.mx_sb_len);
-       tprintf(", iovec_count=%d", sg_io.iovec_count);
-       tprintf(", dxfer_len=%u", sg_io.dxfer_len);
-       tprintf(", timeout=%u", sg_io.timeout);
-       tprints(", flags=");
-       printflags(sg_io_flags, sg_io.flags, "SG_FLAG_???");
+       PRINT_FIELD_XVAL("", sg_io, dxfer_direction, sg_io_dxfer_direction,
+                        "SG_DXFER_???");
+       PRINT_FIELD_U(", ", sg_io, cmd_len);
+       PRINT_FIELD_SG_IO_BUFFER(", ", sg_io, cmdp, sg_io.cmd_len, 0, tcp);
+       PRINT_FIELD_U(", ", sg_io, mx_sb_len);
+       PRINT_FIELD_U(", ", sg_io, iovec_count);
+       PRINT_FIELD_U(", ", sg_io, dxfer_len);
+       PRINT_FIELD_U(", ", sg_io, timeout);
+       PRINT_FIELD_FLAGS(", ", sg_io, flags, sg_io_flags, "SG_FLAG_???");
 
        if (sg_io.dxfer_direction == SG_DXFER_TO_DEV ||
            sg_io.dxfer_direction == SG_DXFER_TO_FROM_DEV) {
-               tprints(", dxferp=");
-               if (sg_io.iovec_count)
-                       tprint_iov_upto(tcp, sg_io.iovec_count,
-                                       ptr_to_kulong(sg_io.dxferp),
-                                       IOV_DECODE_STR,
-                                       sg_io.dxfer_len);
-               else
-                       print_sg_io_buffer(tcp, ptr_to_kulong(sg_io.dxferp),
-                                          sg_io.dxfer_len);
+               PRINT_FIELD_SG_IO_BUFFER(", ", sg_io, dxferp, sg_io.dxfer_len, sg_io.iovec_count, tcp);
+       }
+
+       struct_sg_io_hdr *entering_sg_io = malloc(sizeof(*entering_sg_io));
+       if (entering_sg_io) {
+               memcpy(entering_sg_io, &sg_io, sizeof(sg_io));
+               entering_sg_io->interface_id = (unsigned char) 'S';
+               set_tcb_priv_data(tcp, entering_sg_io, free);
        }
-       return 1;
+
+       return 0;
 }
 
 static int
 decode_response(struct tcb *const tcp, const kernel_ulong_t arg)
 {
+       struct_sg_io_hdr *entering_sg_io = get_tcb_priv_data(tcp);
        struct_sg_io_hdr sg_io;
 
        if (umove(tcp, arg, &sg_io) < 0) {
-               tprints(", ???");
-               return RVAL_DECODED | 1;
+               /* print i/o fields fetched on entering syscall */
+               if (entering_sg_io->dxfer_direction == SG_DXFER_FROM_DEV)
+                       PRINT_FIELD_PTR(", ", *entering_sg_io, dxferp);
+               PRINT_FIELD_PTR(", ", *entering_sg_io, sbp);
+               return RVAL_IOCTL_DECODED;
        }
 
-       if (sg_io.interface_id != (unsigned char) 'S') {
-               tprintf(" => interface_id=%u", sg_io.interface_id);
-               return RVAL_DECODED | 1;
+       if (sg_io.interface_id != entering_sg_io->interface_id) {
+               PRINT_FIELD_U(" => ", sg_io, interface_id);
+               return RVAL_IOCTL_DECODED;
        }
 
        if (sg_io.dxfer_direction == SG_DXFER_FROM_DEV ||
            sg_io.dxfer_direction == SG_DXFER_TO_FROM_DEV) {
                uint32_t din_len = sg_io.dxfer_len;
+               const char *prefix = NULL;
 
-               if (sg_io.resid > 0)
+               if (sg_io.resid > 0 && (unsigned int) sg_io.resid <= din_len)
                        din_len -= sg_io.resid;
-               tprints(", dxferp=");
-               if (sg_io.iovec_count)
-                       tprint_iov_upto(tcp, sg_io.iovec_count,
-                                       ptr_to_kulong(sg_io.dxferp),
-                                       syserror(tcp) ? IOV_DECODE_ADDR :
-                                       IOV_DECODE_STR, din_len);
-               else
-                       print_sg_io_buffer(tcp, ptr_to_kulong(sg_io.dxferp),
-                                          din_len);
+
+               if (sg_io.dxfer_direction == SG_DXFER_FROM_DEV)
+                       prefix = ", ";
+               else if (din_len)
+                       prefix = " => ";
+
+               if (prefix) {
+                       tprints(prefix);
+                       PRINT_FIELD_SG_IO_BUFFER("", sg_io, dxferp, din_len,
+                                                sg_io.iovec_count, tcp);
+               }
        }
-       tprintf(", status=%#x", sg_io.status);
-       tprintf(", masked_status=%#x", sg_io.masked_status);
-       tprintf(", sb_len_wr=%u, sbp=", sg_io.sb_len_wr);
-       print_sg_io_buffer(tcp, ptr_to_kulong(sg_io.sbp), sg_io.sb_len_wr);
-       tprintf(", host_status=%#x", sg_io.host_status);
-       tprintf(", driver_status=%#x", sg_io.driver_status);
-       tprintf(", resid=%d", sg_io.resid);
-       tprintf(", duration=%d", sg_io.duration);
-       tprints(", info=");
-       printflags(sg_io_info, sg_io.info, "SG_INFO_???");
-
-       return RVAL_DECODED | 1;
+       PRINT_FIELD_X(", ", sg_io, status);
+       PRINT_FIELD_X(", ", sg_io, masked_status);
+       PRINT_FIELD_X(", ", sg_io, msg_status);
+       PRINT_FIELD_U(", ", sg_io, sb_len_wr);
+       PRINT_FIELD_SG_IO_BUFFER(", ", sg_io, sbp, sg_io.sb_len_wr, 0, tcp);
+       PRINT_FIELD_X(", ", sg_io, host_status);
+       PRINT_FIELD_X(", ", sg_io, driver_status);
+       PRINT_FIELD_D(", ", sg_io, resid);
+       PRINT_FIELD_U(", ", sg_io, duration);
+       PRINT_FIELD_FLAGS(", ", sg_io, info, sg_io_info, "SG_INFO_???");
+
+       return RVAL_IOCTL_DECODED;
 }
 
 #else /* !HAVE_SCSI_SG_H */
@@ -146,7 +164,7 @@ static int
 decode_request(struct tcb *const tcp, const kernel_ulong_t arg)
 {
        tprints("{interface_id='S', ...}");
-       return RVAL_DECODED | 1;
+       return RVAL_IOCTL_DECODED;
 }
 
 static int