strace/evdev_mpers.c at master · 506124204/strace · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
/*
 * Copyright (c) 2015 Etienne Gemsa <etienne.gemsa@lse.epita.fr>
 * Copyright (c) 2015-2016 Dmitry V. Levin <ldv@altlinux.org>
 * Copyright (c) 2015-2020 The strace developers.
 * All rights reserved.
 *
 * SPDX-License-Identifier: LGPL-2.1-or-later
 */

#include "defs.h"

#ifdef HAVE_LINUX_INPUT_H

# include DEF_MPERS_TYPE(struct_ff_effect)

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

typedef struct ff_effect struct_ff_effect;

#endif /* HAVE_LINUX_INPUT_H */

#include MPERS_DEFS

#ifdef HAVE_LINUX_INPUT_H

# include "print_fields.h"

static void
decode_envelope(void *const data)
{
	const struct ff_envelope *const envelope = data;

	PRINT_FIELD_U(", envelope={", *envelope, attack_length);
	PRINT_FIELD_U(", ", *envelope, attack_level);
	PRINT_FIELD_U(", ", *envelope, fade_length);
	PRINT_FIELD_X(", ", *envelope, fade_level);
	tprints("}");
}

static int
ff_effect_ioctl(struct tcb *const tcp, const kernel_ulong_t arg)
{
	tprints(", ");

	struct_ff_effect ffe;

	if (umove_or_printaddr(tcp, arg, &ffe))
		return RVAL_IOCTL_DECODED;

	tprints("{type=");
	print_evdev_ff_type(ffe.type);
	PRINT_FIELD_D(", ", ffe, id);
	PRINT_FIELD_U(", ", ffe, direction);

	if (abbrev(tcp)) {
		tprints(", ...}");
		return RVAL_IOCTL_DECODED;
	}

	PRINT_FIELD_U(", trigger={", ffe.trigger, button);
	PRINT_FIELD_U(", ", ffe.trigger, interval);
	PRINT_FIELD_U("}, replay={", ffe.replay, length);
	PRINT_FIELD_U(", ", ffe.replay, delay);
	tprints("}");

	switch (ffe.type) {
	case FF_CONSTANT:
		PRINT_FIELD_D(", constant={", ffe.u.constant, level);
		decode_envelope(&ffe.u.constant.envelope);
		tprints("}");
		break;
	case FF_RAMP:
		PRINT_FIELD_D(", ramp={", ffe.u.ramp, start_level);
		PRINT_FIELD_D(", ", ffe.u.ramp, end_level);
		decode_envelope(&ffe.u.ramp.envelope);
		tprints("}");
		break;
	case FF_PERIODIC:
		PRINT_FIELD_U(", periodic={", ffe.u.periodic, waveform);
		PRINT_FIELD_U(", ", ffe.u.periodic, period);
		PRINT_FIELD_D(", ", ffe.u.periodic, magnitude);
		PRINT_FIELD_D(", ", ffe.u.periodic, offset);
		PRINT_FIELD_U(", ", ffe.u.periodic, phase);
		decode_envelope(&ffe.u.periodic.envelope);
		PRINT_FIELD_U(", ", ffe.u.periodic, custom_len);
		tprints(", custom_data=");
		printaddr(ptr_to_kulong(ffe.u.periodic.custom_data));
		tprints("}");
		break;
	case FF_RUMBLE:
		PRINT_FIELD_U(", rumble={", ffe.u.rumble, strong_magnitude);
		PRINT_FIELD_U(", ", ffe.u.rumble, weak_magnitude);
		tprints("}");
		break;
	default:
		break;
	}

	tprints("}");

	return RVAL_IOCTL_DECODED;
}

MPERS_PRINTER_DECL(int, evdev_write_ioctl_mpers, struct tcb *const tcp,
		   const unsigned int code, const kernel_ulong_t arg)
{
	switch (code) {
	case EVIOCSFF:
		return ff_effect_ioctl(tcp, arg);
	default:
		return RVAL_DECODED;
	}
}

#endif /* HAVE_LINUX_INPUT_H */