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
|
/* Copyright 2017 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.
*
* Sync event driver.
* Useful for recording the exact time a gpio interrupt happened in the
* context of sensors. Originally created for a camera vsync signal.
*/
#include "accelgyro.h"
#include "config.h"
#include "console.h"
#include "driver/sync.h"
#include "hwtimer.h"
#include "motion_sense_fifo.h"
#include "queue.h"
#include "task.h"
#include "util.h"
#define CPRINTS(format, args...) cprints(CC_MOTION_SENSE, format, ## args)
#define CPRINTF(format, args...) cprintf(CC_MOTION_SENSE, format, ## args)
#ifndef CONFIG_ACCEL_FIFO
#error This driver needs CONFIG_ACCEL_FIFO
#endif
#ifndef CONFIG_ACCEL_INTERRUPTS
#error This driver needs CONFIG_ACCEL_INTERRUPTS
#endif
struct sync_event_t {
uint32_t timestamp;
int counter;
};
static struct queue const sync_event_queue =
QUEUE_NULL(CONFIG_SYNC_QUEUE_SIZE, struct sync_event_t);
struct sync_event_t next_event;
struct ec_response_motion_sensor_data vector = {
.flags = MOTIONSENSE_SENSOR_FLAG_BYPASS_FIFO,
.data = {0, 0, 0}
};
int sync_enabled;
static int sync_read(const struct motion_sensor_t *s, intv3_t v)
{
v[0] = next_event.counter;
return EC_SUCCESS;
}
/*
* Since there's no such thing as data rate for this sensor, but the framework
* still depends on being able to set this to 0 to disable it, we'll just use
* non 0 rate values as an enable boolean.
*/
static int sync_set_data_rate(const struct motion_sensor_t *s,
int rate, int roundup)
{
sync_enabled = !!rate;
CPRINTF("sync event driver enabling=%d\n", sync_enabled);
return EC_SUCCESS;
}
static int sync_get_data_rate(const struct motion_sensor_t *s)
{
return sync_enabled;
}
/* Upper half of the irq handler */
void sync_interrupt(enum gpio_signal signal)
{
next_event.timestamp = __hw_clock_source_read();
if (!sync_enabled)
return;
next_event.counter++;
queue_add_unit(&sync_event_queue, &next_event);
task_set_event(TASK_ID_MOTIONSENSE, CONFIG_SYNC_INT_EVENT);
}
/* Bottom half of the irq handler */
static int motion_irq_handler(struct motion_sensor_t *s, uint32_t *event)
{
struct sync_event_t sync_event;
if (!(*event & CONFIG_SYNC_INT_EVENT))
return EC_ERROR_NOT_HANDLED;
while (queue_remove_unit(&sync_event_queue, &sync_event)) {
vector.data[X] = sync_event.counter;
motion_sense_fifo_stage_data(
&vector, s, 1, sync_event.timestamp);
}
motion_sense_fifo_commit_data();
return EC_SUCCESS;
}
static int sync_init(struct motion_sensor_t *s)
{
vector.sensor_num = s - motion_sensors;
sync_enabled = 0;
next_event.counter = 0;
queue_init(&sync_event_queue);
return 0;
}
#ifdef CONFIG_SYNC_COMMAND
static int command_sync(int argc, char **argv)
{
int count = 1, i;
if (argc > 1)
count = strtoi(argv[1], 0, 0);
for (i = 0; i < count; i++)
sync_interrupt(GPIO_SYNC_INT);
return EC_SUCCESS;
}
DECLARE_CONSOLE_COMMAND(sync, command_sync,
"[count]",
"Simulates sync events");
#endif
const struct accelgyro_drv sync_drv = {
.init = sync_init,
.read = sync_read,
.set_data_rate = sync_set_data_rate,
.get_data_rate = sync_get_data_rate,
.irq_handler = motion_irq_handler,
};
|
