githubmirror/strace

src/rtc.c
249 строк5 KB
Eugene Syromyatnikov
rtc: implement RTC_PARAM_[GS]ET ioctl code decoding
07 июн 2022, 20:42
07 июн 2022, 20:423617d8f
/*
 * Copyright (c) 2004 Ulrich Drepper <drepper@redhat.com>
 * Copyright (c) 2004-2016 Dmitry V. Levin <ldv@strace.io>
 * Copyright (c) 2015-2021 The strace developers.
 * All rights reserved.
 *
 * SPDX-License-Identifier: LGPL-2.1-or-later
 */

#include "defs.h"

#include DEF_MPERS_TYPE(struct_rtc_pll_info)

#include <linux/ioctl.h>
#include <linux/rtc.h>

typedef struct rtc_pll_info struct_rtc_pll_info;

#include MPERS_DEFS

typedef struct {
	uint64_t param;
	union {
		uint64_t uvalue;
		int64_t  svalue;
		uint64_t ptr;
	};
	uint32_t index;
	uint32_t __pad;
} struct_rtc_param;

#define XLAT_MACROS_ONLY
# include "xlat/rtc_ioctl_cmds.h"
# include "xlat/rtc_feature_bits.h"
#undef XLAT_MACROS_ONLY

#include "xlat/rtc_vl_flags.h"
#include "xlat/rtc_params.h"
#include "xlat/rtc_features.h"
#include "xlat/rtc_backup_switch_modes.h"

static void
print_rtc_time(struct tcb *tcp, const struct rtc_time *rt)
{
	tprint_struct_begin();
	PRINT_FIELD_D(*rt, tm_sec);
	tprint_struct_next();
	PRINT_FIELD_D(*rt, tm_min);
	tprint_struct_next();
	PRINT_FIELD_D(*rt, tm_hour);
	tprint_struct_next();
	PRINT_FIELD_D(*rt, tm_mday);
	tprint_struct_next();
	PRINT_FIELD_D(*rt, tm_mon);
	tprint_struct_next();
	PRINT_FIELD_D(*rt, tm_year);
	if (abbrev(tcp)) {
		tprint_struct_next();
		tprint_more_data_follows();
	} else {
		tprint_struct_next();
		PRINT_FIELD_D(*rt, tm_wday);
		tprint_struct_next();
		PRINT_FIELD_D(*rt, tm_yday);
		tprint_struct_next();
		PRINT_FIELD_D(*rt, tm_isdst);
	}
	tprint_struct_end();
}

static void
decode_rtc_time(struct tcb *const tcp, const kernel_ulong_t addr)
{
	struct rtc_time rt;

	if (!umove_or_printaddr(tcp, addr, &rt))
		print_rtc_time(tcp, &rt);
}

static void
decode_rtc_wkalrm(struct tcb *const tcp, const kernel_ulong_t addr)
{
	struct rtc_wkalrm wk;

	if (umove_or_printaddr(tcp, addr, &wk))
		return;

	tprint_struct_begin();
	PRINT_FIELD_U(wk, enabled);
	tprint_struct_next();
	PRINT_FIELD_U(wk, pending);
	tprint_struct_next();
	PRINT_FIELD_OBJ_TCB_PTR(wk, time, tcp, print_rtc_time);
	tprint_struct_end();
}

static void
decode_rtc_pll_info(struct tcb *const tcp, const kernel_ulong_t addr)
{
	struct_rtc_pll_info pll;

	if (umove_or_printaddr(tcp, addr, &pll))
		return;

	tprint_struct_begin();
	PRINT_FIELD_D(pll, pll_ctrl);
	tprint_struct_next();
	PRINT_FIELD_D(pll, pll_value);
	tprint_struct_next();
	PRINT_FIELD_D(pll, pll_max);
	tprint_struct_next();
	PRINT_FIELD_D(pll, pll_min);
	tprint_struct_next();
	PRINT_FIELD_D(pll, pll_posmult);
	tprint_struct_next();
	PRINT_FIELD_D(pll, pll_negmult);
	tprint_struct_next();
	PRINT_FIELD_D(pll, pll_clock);
	tprint_struct_end();
}

static void
decode_rtc_vl(struct tcb *const tcp, const kernel_ulong_t addr)
{
	unsigned int val;

	if (umove_or_printaddr(tcp, addr, &val))
		return;

	tprint_indirect_begin();
	printflags(rtc_vl_flags, val, "RTC_VL_???");
	tprint_indirect_end();
}

static long
decode_rtc_param(struct tcb *const tcp, const kernel_ulong_t addr, const bool get)
{
	struct_rtc_param param;

	if (umove_or_printaddr(tcp, addr, &param))
		return RVAL_IOCTL_DECODED;

	tprint_struct_begin();
	if (entering(tcp))
		PRINT_FIELD_XVAL(param, param, rtc_params, "RTC_PARAM_???");
	if (entering(tcp) ^ get) {
		if (entering(tcp))
			tprint_struct_next();
		switch (param.param) {
		case RTC_PARAM_FEATURES:
			PRINT_FIELD_FLAGS(param, uvalue, rtc_features,
					  "1<<RTC_FEATURE_???");
			break;
		case RTC_PARAM_CORRECTION:
			PRINT_FIELD_D(param, svalue);
			break;
		case RTC_PARAM_BACKUP_SWITCH_MODE:
			PRINT_FIELD_XVAL(param, uvalue, rtc_backup_switch_modes,
					 "RTC_BSM_???");
			break;
		default:
			PRINT_FIELD_X(param, uvalue);
		}
	}
	if (entering(tcp)) {
		tprint_struct_next();
		PRINT_FIELD_U(param, index);
	}
	if (param.__pad) {
		tprint_struct_next();
		PRINT_FIELD_X(param, __pad);
	}
	tprint_struct_end();

	return entering(tcp) && get ? 0 : RVAL_IOCTL_DECODED;
}

MPERS_PRINTER_DECL(int, rtc_ioctl, struct tcb *const tcp,
		   const unsigned int code, const kernel_ulong_t arg)
{
	switch (code) {
	case RTC_ALM_READ:
	case RTC_RD_TIME:
		if (entering(tcp))
			return 0;
		ATTRIBUTE_FALLTHROUGH;
	case RTC_ALM_SET:
	case RTC_SET_TIME:
		tprint_arg_next();
		decode_rtc_time(tcp, arg);
		break;
	case RTC_IRQP_SET:
	case RTC_EPOCH_SET:
		tprint_arg_next();
		PRINT_VAL_U(arg);
		break;
	case RTC_IRQP_READ:
	case RTC_EPOCH_READ:
		if (entering(tcp))
			return 0;
		tprint_arg_next();
		printnum_ulong(tcp, arg);
		break;
	case RTC_WKALM_RD:
		if (entering(tcp))
			return 0;
		ATTRIBUTE_FALLTHROUGH;
	case RTC_WKALM_SET:
		tprint_arg_next();
		decode_rtc_wkalrm(tcp, arg);
		break;
	case RTC_PLL_GET:
		if (entering(tcp))
			return 0;
		ATTRIBUTE_FALLTHROUGH;
	case RTC_PLL_SET:
		tprint_arg_next();
		decode_rtc_pll_info(tcp, arg);
		break;
	case RTC_VL_READ:
		if (entering(tcp))
			return 0;
		tprint_arg_next();
		decode_rtc_vl(tcp, arg);
		break;
	case RTC_PARAM_GET:
	case RTC_PARAM_SET:
		if (entering(tcp))
			tprint_arg_next();
		else
			tprint_value_changed();
		return decode_rtc_param(tcp, arg, code == RTC_PARAM_GET);
	case RTC_AIE_ON:
	case RTC_AIE_OFF:
	case RTC_UIE_ON:
	case RTC_UIE_OFF:
	case RTC_PIE_ON:
	case RTC_PIE_OFF:
	case RTC_WIE_ON:
	case RTC_WIE_OFF:
	case RTC_VL_CLR:
		/* no args */
		break;
	default:
		return RVAL_DECODED;
	}

	return RVAL_IOCTL_DECODED;
}