embox

1
/**
2
 * @file
3
 * @brief
4
 * @author Denis Deryugin <deryugin.denis@gmail.com>
5
 * @version
6
 * @date 13.08.2022
7
 */
8

9
#include <drivers/servo/servo.h>
10

11
ARRAY_SPREAD_DEF(const struct servo_dev, __servo_device_registry);
12

13
struct servo_dev *servo_dev_by_id(int id) {
14
	struct servo_dev *servo_dev;
15
	int i = 0;
16

17
	if (id < 0 || id >= ARRAY_SPREAD_SIZE(__servo_device_registry)) {
18
		return NULL;
19
	}
20

21
	array_spread_foreach_ptr(servo_dev, __servo_device_registry) {
22
		if (i++ == id) {
23
			return servo_dev;
24
		}
25
	}
26

27
	return NULL;
28
}
29