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
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
|
/* Copyright 2018 The Chromium OS Authors. All rights reserved.
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*
* Common test code to test lid angle calculation.
*/
#include "accelgyro.h"
#include "driver/accelgyro_bmi_common.h"
#include "host_command.h"
#include "motion_common.h"
#include "motion_sense.h"
#include "task.h"
#include "timer.h"
/*****************************************************************************/
/* Mock functions */
static int accel_init(struct motion_sensor_t *s)
{
return sensor_init_done(s);
}
static int accel_read(const struct motion_sensor_t *s, intv3_t v)
{
rotate(s->xyz, *s->rot_standard_ref, v);
return EC_SUCCESS;
}
static int accel_set_range(struct motion_sensor_t *s, int range, int rnd)
{
s->current_range = range;
return EC_SUCCESS;
}
static int accel_get_resolution(const struct motion_sensor_t *s)
{
#ifdef TEST_BODY_DETECTION
/* Assume we are using BMI160 */
return BMI_RESOLUTION;
#endif
return 0;
}
int test_data_rate[2] = { 0 };
static int accel_set_data_rate(const struct motion_sensor_t *s,
const int rate,
const int rnd)
{
test_data_rate[s - motion_sensors] = rate | (rnd ? ROUND_UP_FLAG : 0);
return EC_SUCCESS;
}
static int accel_get_data_rate(const struct motion_sensor_t *s)
{
return test_data_rate[s - motion_sensors];
}
#ifdef TEST_BODY_DETECTION
static int accel_get_rms_noise(const struct motion_sensor_t *s)
{
/* Assume we are using BMI160 */
fp_t rate = INT_TO_FP(accel_get_data_rate(s) / 1000);
fp_t noise_100hz = INT_TO_FP(BMI160_ACCEL_RMS_NOISE_100HZ);
fp_t sqrt_rate_ratio = fp_sqrtf(fp_div(rate,
INT_TO_FP(BMI_ACCEL_100HZ)));
return FP_TO_INT(fp_mul(noise_100hz, sqrt_rate_ratio));
}
#endif
const struct accelgyro_drv test_motion_sense = {
.init = accel_init,
.read = accel_read,
.set_range = accel_set_range,
.get_resolution = accel_get_resolution,
.set_data_rate = accel_set_data_rate,
.get_data_rate = accel_get_data_rate,
#ifdef CONFIG_BODY_DETECTION
.get_rms_noise = accel_get_rms_noise,
#endif
};
struct motion_sensor_t motion_sensors[] = {
[BASE] = {
.name = "base",
.active_mask = SENSOR_ACTIVE_S0_S3_S5,
.chip = MOTIONSENSE_CHIP_LSM6DS0,
.type = MOTIONSENSE_TYPE_ACCEL,
.location = MOTIONSENSE_LOC_BASE,
.drv = &test_motion_sense,
.rot_standard_ref = NULL,
.default_range = 2, /* g, enough for laptop. */
.config = {
/* EC use accel for angle detection */
[SENSOR_CONFIG_EC_S0] = {
.odr = TEST_LID_FREQUENCY,
},
},
},
[LID] = {
.name = "lid",
.active_mask = SENSOR_ACTIVE_S0,
.chip = MOTIONSENSE_CHIP_KXCJ9,
.type = MOTIONSENSE_TYPE_ACCEL,
.location = MOTIONSENSE_LOC_LID,
.drv = &test_motion_sense,
.rot_standard_ref = NULL,
.default_range = 2, /* g, enough for laptop. */
.config = {
/* EC use accel for angle detection */
[SENSOR_CONFIG_EC_S0] = {
.odr = TEST_LID_FREQUENCY,
},
},
},
};
const unsigned int motion_sensor_count = ARRAY_SIZE(motion_sensors);
/* Read 6 samples from array to sensor vectors, convert units if necessary. */
void feed_accel_data(const float *array, int *idx,
int (filler)(const struct motion_sensor_t*, const float))
{
int i, j;
for (i = 0; i < motion_sensor_count; i++) {
struct motion_sensor_t *s = &motion_sensors[i];
for (j = X; j <= Z; j++)
s->xyz[j] = filler(s, array[*idx + i * 3 + j]);
}
*idx += 6;
}
void wait_for_valid_sample(void)
{
uint8_t sample;
uint8_t *lpc_status = host_get_memmap(EC_MEMMAP_ACC_STATUS);
sample = *lpc_status & EC_MEMMAP_ACC_STATUS_SAMPLE_ID_MASK;
usleep(TEST_LID_EC_RATE);
while ((*lpc_status & EC_MEMMAP_ACC_STATUS_SAMPLE_ID_MASK) == sample)
usleep(TEST_LID_SLEEP_RATE);
}
|
