Quelle  komeda_event.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * (C) COPYRIGHT 2019 ARM Limited. All rights reserved.
 * Author: James.Qian.Wang <james.qian.wang@arm.com>
 *
 */
#include <drm/drm_atomic.h>
#include <drm/drm_print.h>

#include "komeda_dev.h"

struct komeda_str {
 char *str;
 u32 sz;
 u32 len;
};

/* return 0 on success,  < 0 on no space.
 */
__printf(2, 3)
static int komeda_sprintf(struct komeda_str *str, const char *fmt, ...)
{
 va_list args;
 int num, free_sz;
 int err;

 free_sz = str->sz - str->len - 1;
 if (free_sz <= 0)
  return -ENOSPC;

 va_start(args, fmt);

 num = vsnprintf(str->str + str->len, free_sz, fmt, args);

 va_end(args);

 if (num < free_sz) {
  str->len += num;
  err = 0;
 } else {
  str->len = str->sz - 1;
  err = -ENOSPC;
 }

 return err;
}

static void evt_sprintf(struct komeda_str *str, u64 evt, const char *msg)
{
 if (evt)
  komeda_sprintf(str, msg);
}

static void evt_str(struct komeda_str *str, u64 events)
{
 if (events == 0ULL) {
  komeda_sprintf(str, "None");
  return;
 }

 evt_sprintf(str, events & KOMEDA_EVENT_VSYNC, "VSYNC|");
 evt_sprintf(str, events & KOMEDA_EVENT_FLIP, "FLIP|");
 evt_sprintf(str, events & KOMEDA_EVENT_EOW, "EOW|");
 evt_sprintf(str, events & KOMEDA_EVENT_MODE, "OP-MODE|");

 evt_sprintf(str, events & KOMEDA_EVENT_URUN, "UNDERRUN|");
 evt_sprintf(str, events & KOMEDA_EVENT_OVR, "OVERRUN|");

 /* GLB error */
 evt_sprintf(str, events & KOMEDA_ERR_MERR, "MERR|");
 evt_sprintf(str, events & KOMEDA_ERR_FRAMETO, "FRAMETO|");

 /* DOU error */
 evt_sprintf(str, events & KOMEDA_ERR_DRIFTTO, "DRIFTTO|");
 evt_sprintf(str, events & KOMEDA_ERR_FRAMETO, "FRAMETO|");
 evt_sprintf(str, events & KOMEDA_ERR_TETO, "TETO|");
 evt_sprintf(str, events & KOMEDA_ERR_CSCE, "CSCE|");

 /* LPU errors or events */
 evt_sprintf(str, events & KOMEDA_EVENT_IBSY, "IBSY|");
 evt_sprintf(str, events & KOMEDA_EVENT_EMPTY, "EMPTY|");
 evt_sprintf(str, events & KOMEDA_EVENT_FULL, "FULL|");
 evt_sprintf(str, events & KOMEDA_ERR_AXIE, "AXIE|");
 evt_sprintf(str, events & KOMEDA_ERR_ACE0, "ACE0|");
 evt_sprintf(str, events & KOMEDA_ERR_ACE1, "ACE1|");
 evt_sprintf(str, events & KOMEDA_ERR_ACE2, "ACE2|");
 evt_sprintf(str, events & KOMEDA_ERR_ACE3, "ACE3|");

 /* LPU TBU errors*/
 evt_sprintf(str, events & KOMEDA_ERR_TCF, "TCF|");
 evt_sprintf(str, events & KOMEDA_ERR_TTNG, "TTNG|");
 evt_sprintf(str, events & KOMEDA_ERR_TITR, "TITR|");
 evt_sprintf(str, events & KOMEDA_ERR_TEMR, "TEMR|");
 evt_sprintf(str, events & KOMEDA_ERR_TTF, "TTF|");

 /* CU errors*/
 evt_sprintf(str, events & KOMEDA_ERR_CPE, "COPROC|");
 evt_sprintf(str, events & KOMEDA_ERR_ZME, "ZME|");
 evt_sprintf(str, events & KOMEDA_ERR_CFGE, "CFGE|");
 evt_sprintf(str, events & KOMEDA_ERR_TEMR, "TEMR|");

 if (str->len > 0 && (str->str[str->len - 1] == '|')) {
  str->str[str->len - 1] = 0;
  str->len--;
 }
}

static bool is_new_frame(struct komeda_events *a)
{
 return (a->pipes[0] | a->pipes[1]) &
        (KOMEDA_EVENT_FLIP | KOMEDA_EVENT_EOW);
}

void komeda_print_events(struct komeda_events *evts, struct drm_device *dev)
{
 u64 print_evts = 0;
 static bool en_print = true;
 struct komeda_dev *mdev = dev->dev_private;
 u16 const err_verbosity = mdev->err_verbosity;
 u64 evts_mask = evts->global | evts->pipes[0] | evts->pipes[1];

 /* reduce the same msg print, only print the first evt for one frame */
 if (evts->global || is_new_frame(evts))
  en_print = true;
 if (!(err_verbosity & KOMEDA_DEV_PRINT_DISABLE_RATELIMIT) && !en_print)
  return;

 if (err_verbosity & KOMEDA_DEV_PRINT_ERR_EVENTS)
  print_evts |= KOMEDA_ERR_EVENTS;
 if (err_verbosity & KOMEDA_DEV_PRINT_WARN_EVENTS)
  print_evts |= KOMEDA_WARN_EVENTS;
 if (err_verbosity & KOMEDA_DEV_PRINT_INFO_EVENTS)
  print_evts |= KOMEDA_INFO_EVENTS;

 if (evts_mask & print_evts) {
  char msg[256];
  struct komeda_str str;
  struct drm_printer p = drm_info_printer(dev->dev);

  str.str = msg;
  str.sz  = sizeof(msg);
  str.len = 0;

  komeda_sprintf(&str, "gcu: ");
  evt_str(&str, evts->global);
  komeda_sprintf(&str, ", pipes[0]: ");
  evt_str(&str, evts->pipes[0]);
  komeda_sprintf(&str, ", pipes[1]: ");
  evt_str(&str, evts->pipes[1]);

  DRM_ERROR("err detect: %s\n", msg);
  if ((err_verbosity & KOMEDA_DEV_PRINT_DUMP_STATE_ON_EVENT) &&
      (evts_mask & (KOMEDA_ERR_EVENTS | KOMEDA_WARN_EVENTS)))
   drm_state_dump(dev, &p);

  en_print = false;
 }
}