summaryrefslogtreecommitdiff
path: root/test/kasa.c
blob: 222fb2a0cf27be588f984df9976f5ba0852afa79 (plain)
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
/* Copyright 2020 The ChromiumOS Authors
 * Use of this source code is governed by a BSD-style license that can be
 * found in the LICENSE file.
 */

#include "common.h"
#include "kasa.h"
#include "motion_sense.h"
#include "test_util.h"

#include <stdio.h>

struct motion_sensor_t motion_sensors[] = {};
const unsigned int motion_sensor_count = ARRAY_SIZE(motion_sensors);

static int test_kasa_reset(void)
{
	struct kasa_fit kasa;

	kasa_reset(&kasa);

	TEST_EQ(kasa.nsamples, 0, "%u");
	TEST_NEAR(kasa.acc_x, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_y, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_z, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_w, 0.0f, 0.000001f, "%f");

	TEST_NEAR(kasa.acc_xx, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_xy, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_xz, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_xw, 0.0f, 0.000001f, "%f");

	TEST_NEAR(kasa.acc_yy, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_yz, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_yw, 0.0f, 0.000001f, "%f");

	TEST_NEAR(kasa.acc_zz, 0.0f, 0.000001f, "%f");
	TEST_NEAR(kasa.acc_zw, 0.0f, 0.000001f, "%f");

	return EC_SUCCESS;
}

static int test_kasa_calculate(void)
{
	struct kasa_fit kasa;
	fpv3_t bias;
	float radius;

	kasa_reset(&kasa);
	kasa_accumulate(&kasa, 1.01f, 0.01f, 0.01f);
	kasa_accumulate(&kasa, -0.99f, 0.01f, 0.01f);
	kasa_accumulate(&kasa, 0.01f, 1.01f, 0.01f);
	kasa_accumulate(&kasa, 0.01f, -0.99f, 0.01f);
	kasa_accumulate(&kasa, 0.01f, 0.01f, 1.01f);
	kasa_accumulate(&kasa, 0.01f, 0.01f, -0.99f);
	kasa_compute(&kasa, bias, &radius);

	TEST_NEAR(bias[0], 0.01f, 0.0001f, "%f");
	TEST_NEAR(bias[1], 0.01f, 0.0001f, "%f");
	TEST_NEAR(bias[2], 0.01f, 0.0001f, "%f");
	TEST_NEAR(radius, 1.0f, 0.0001f, "%f");

	return EC_SUCCESS;
}

void run_test(int argc, const char **argv)
{
	test_reset();

	RUN_TEST(test_kasa_reset);
	RUN_TEST(test_kasa_calculate);

	test_print_result();
}

/* Mock out mkbp_send_event. Rarely, but occasionally, mkbp_send_event gets
 * called and the coverage is thrown off.
 */
int mkbp_send_event(uint8_t event_type)
{
	return 1;
}