You are viewing a plain text version of this content. The canonical link for it is here.
Posted to commits@mynewt.apache.org by an...@apache.org on 2018/11/08 10:06:06 UTC
[mynewt-core] branch master updated (06a8102 -> b59629b)
This is an automated email from the ASF dual-hosted git repository.
andk pushed a change to branch master
in repository https://gitbox.apache.org/repos/asf/mynewt-core.git.
from 06a8102 Merge pull request #1490 from kasjer/hal-flash-write-protection
new c8683f7 hw/sensor: Add missing statics
new e04b123 hw/sensor: Refactor "sensor read" command handling
new b59629b hw/sensor: Remove unused semaphore
The 3 revisions listed above as "new" are entirely new to this
repository and will be described in separate emails. The revisions
listed as "add" were already present in the repository and have only
been added to this reference.
Summary of changes:
hw/sensor/src/sensor_shell.c | 259 ++++++++++++++++++++-----------------------
1 file changed, 120 insertions(+), 139 deletions(-)
[mynewt-core] 03/03: hw/sensor: Remove unused semaphore
Posted by an...@apache.org.
This is an automated email from the ASF dual-hosted git repository.
andk pushed a commit to branch master
in repository https://gitbox.apache.org/repos/asf/mynewt-core.git
commit b59629b5df172992edaa2081d6900b469c901393
Author: Andrzej Kaczmarek <an...@codecoup.pl>
AuthorDate: Wed Nov 7 10:49:37 2018 +0100
hw/sensor: Remove unused semaphore
---
hw/sensor/src/sensor_shell.c | 1 -
1 file changed, 1 deletion(-)
diff --git a/hw/sensor/src/sensor_shell.c b/hw/sensor/src/sensor_shell.c
index 64dfc43..5c965d8 100644
--- a/hw/sensor/src/sensor_shell.c
+++ b/hw/sensor/src/sensor_shell.c
@@ -48,7 +48,6 @@ static struct shell_cmd shell_sensor_cmd = {
.sc_cmd_func = sensor_cmd_exec
};
-struct os_sem g_sensor_shell_sem;
struct sensor_poll_data {
int spd_nsamples;
int spd_poll_itvl;
[mynewt-core] 01/03: hw/sensor: Add missing statics
Posted by an...@apache.org.
This is an automated email from the ASF dual-hosted git repository.
andk pushed a commit to branch master
in repository https://gitbox.apache.org/repos/asf/mynewt-core.git
commit c8683f7dfd7404469af5ac63036836e5bdffe6b9
Author: Andrzej Kaczmarek <an...@codecoup.pl>
AuthorDate: Wed Nov 7 14:27:51 2018 +0100
hw/sensor: Add missing statics
---
hw/sensor/src/sensor_shell.c | 4 ++--
1 file changed, 2 insertions(+), 2 deletions(-)
diff --git a/hw/sensor/src/sensor_shell.c b/hw/sensor/src/sensor_shell.c
index 8cce50f..d140388 100644
--- a/hw/sensor/src/sensor_shell.c
+++ b/hw/sensor/src/sensor_shell.c
@@ -560,7 +560,7 @@ sensor_cmd_read(char *name, sensor_type_t type, struct sensor_poll_data *spd)
return rc;
}
-int
+static int
sensor_one_tap_notif(struct sensor *sensor, void *data,
sensor_event_type_t type)
{
@@ -576,7 +576,7 @@ static struct sensor_notifier one_tap = {
.sn_arg = NULL,
};
-int
+static int
sensor_double_tap_notif(struct sensor *sensor, void *data,
sensor_event_type_t type)
{
[mynewt-core] 02/03: hw/sensor: Refactor "sensor read" command
handling
Posted by an...@apache.org.
This is an automated email from the ASF dual-hosted git repository.
andk pushed a commit to branch master
in repository https://gitbox.apache.org/repos/asf/mynewt-core.git
commit e04b123b69d16751a435bd393a40a7becfd4b53d
Author: Andrzej Kaczmarek <an...@codecoup.pl>
AuthorDate: Wed Nov 7 10:23:44 2018 +0100
hw/sensor: Refactor "sensor read" command handling
This commit refactors handling of "sensor read" shell command to make it
more intuitive to use and also fixes few issues found when using it.
Changes include:
- all parameters (except for sensor name and type) can be omitted and
this will trigger single read; previously read command was stuck when
no interval was specified since read timer was never started
- reading multiple samples can be only used when interval is specified
previously when no interval was specified read command was stuck since
read timer was not started
- reads are triggered relatively to read command instead of last read
operation - this means they are triggered exactly every interval and
do not drift over time
- code uses g_spd directly everywhere for accessing read command state;
previously g_spd was also used, but it was used directly in few places
while in other places it was passed as a pointer so it was quite weird
when the same function uses the same structure via different pointers
---
hw/sensor/src/sensor_shell.c | 254 ++++++++++++++++++++-----------------------
1 file changed, 118 insertions(+), 136 deletions(-)
diff --git a/hw/sensor/src/sensor_shell.c b/hw/sensor/src/sensor_shell.c
index d140388..64dfc43 100644
--- a/hw/sensor/src/sensor_shell.c
+++ b/hw/sensor/src/sensor_shell.c
@@ -42,7 +42,6 @@
#include "hal/hal_i2c.h"
#include "parse/parse.h"
-static struct os_event g_sensor_shell_read_ev;
static int sensor_cmd_exec(int, char **);
static struct shell_cmd shell_sensor_cmd = {
.sc_cmd = "sensor",
@@ -50,22 +49,21 @@ static struct shell_cmd shell_sensor_cmd = {
};
struct os_sem g_sensor_shell_sem;
-struct hal_timer g_sensor_shell_timer;
-uint32_t sensor_shell_timer_arg = 0xdeadc0de;
-
struct sensor_poll_data {
int spd_nsamples;
int spd_poll_itvl;
int spd_poll_duration;
- int spd_poll_delay;
- int64_t spd_duration;
- int64_t spd_start_ts;
+
struct sensor *spd_sensor;
sensor_type_t spd_sensor_type;
+
bool spd_read_in_progress;
+ struct os_event spd_read_ev;
+ struct hal_timer spd_read_timer;
+ uint32_t spd_read_start_ticks;
+ uint32_t spd_read_next_msecs_off;
};
-static int g_sensor_shell_num_entries;
static struct sensor_poll_data g_spd;
static void
@@ -258,8 +256,6 @@ sensor_shell_read_listener(struct sensor *sensor, void *arg, void *data,
struct sensor_gyro_data *sgd;
char tmpstr[13];
- ++g_sensor_shell_num_entries;
-
console_printf("ts: [ secs: %ld usecs: %d cputime: %u ]\n",
(long int)sensor->s_sts.st_ostv.tv_sec,
(int)sensor->s_sts.st_ostv.tv_usec,
@@ -428,136 +424,139 @@ sensor_shell_read_listener(struct sensor *sensor, void *arg, void *data,
return (0);
}
-/* Check for number of samples */
-static int
-sensor_shell_chk_nsamples(struct sensor_poll_data *spd)
-{
- /* Condition for number of samples */
- if (spd->spd_nsamples && g_sensor_shell_num_entries >= spd->spd_nsamples) {
- os_cputime_timer_stop(&g_sensor_shell_timer);
- return 0;
- }
-
- return -1;
-}
-
-/*
- * Incrementing duration based on interval if specified or
- * os_time if interval is not specified and checking duration
- */
-static int
-sensor_shell_polling_done(struct sensor_poll_data *spd, int64_t *duration,
- int64_t *start_ts)
-{
-
- if (spd->spd_poll_duration) {
- if (spd->spd_poll_itvl) {
- *duration += spd->spd_poll_itvl * 1000;
- } else {
- if (!*start_ts) {
- *start_ts = os_get_uptime_usec();
- } else {
- *duration = os_get_uptime_usec() - *start_ts;
- }
- }
-
- if (*duration >= spd->spd_poll_duration * 1000) {
- os_cputime_timer_stop(&g_sensor_shell_timer);
- console_printf("Sensor polling done\n");
- return 0;
- }
- }
-
- return -1;
-}
-
static void
sensor_shell_read_ev_cb(struct os_event *ev)
{
- struct sensor_poll_data *spd;
+ uint32_t next_tick;
int rc;
- if (!ev->ev_arg) {
- goto done;
- }
-
- spd = ev->ev_arg;
- rc = sensor_read(spd->spd_sensor, spd->spd_sensor_type,
+ rc = sensor_read(g_spd.spd_sensor, g_spd.spd_sensor_type,
sensor_shell_read_listener, (void *)SENSOR_IGN_LISTENER,
OS_TIMEOUT_NEVER);
if (rc) {
console_printf("Cannot read sensor\n");
- g_spd.spd_read_in_progress = false;
- goto done;
+ goto stop;
}
- /* Check number of samples if provided */
- if (!sensor_shell_chk_nsamples(spd)) {
- g_spd.spd_read_in_progress = false;
- goto done;
+ /* If number of samples were provided, check if we should still read */
+ if (g_spd.spd_nsamples && (--g_spd.spd_nsamples == 0)) {
+ goto stop;
}
- /* Check duration if provided */
- if (!sensor_shell_polling_done(spd, &spd->spd_start_ts,
- &spd->spd_duration)) {
- g_spd.spd_read_in_progress = false;
- goto done;
+ /* Calculate next read time (it should be in future so skip missed ones) */
+ do {
+ g_spd.spd_read_next_msecs_off += g_spd.spd_poll_itvl;
+
+ if (g_spd.spd_poll_duration &&
+ (g_spd.spd_read_next_msecs_off > g_spd.spd_poll_duration)) {
+ goto stop;
+ }
+
+ next_tick = g_spd.spd_read_start_ticks +
+ os_cputime_usecs_to_ticks(g_spd.spd_read_next_msecs_off * 1000);
+ } while (next_tick <= os_cputime_get32());
+
+ rc = os_cputime_timer_start(&g_spd.spd_read_timer, next_tick);
+ if (!rc) {
+ return;
}
- os_cputime_timer_relative(&g_sensor_shell_timer, sensor_shell_timer_arg);
+ console_printf("Failed to setup read timer\n");
+ /* fall through */
-done:
- return;
-}
+stop:
+ g_spd.spd_read_in_progress = false;
+ os_cputime_timer_stop(&g_spd.spd_read_timer);
-void
-sensor_shell_timer_cb(void *arg)
-{
- g_sensor_shell_read_ev.ev_arg = arg;
- g_sensor_shell_read_ev.ev_cb = sensor_shell_read_ev_cb;
- os_eventq_put(os_eventq_dflt_get(), &g_sensor_shell_read_ev);
+ console_printf("Reading done\n");
}
-/* os cputime timer configuration and initialization */
static void
-sensor_shell_config_timer(struct sensor_poll_data *spd)
+sensor_shell_read_timer_cb(void *arg)
{
- sensor_shell_timer_arg = spd->spd_poll_itvl * 1000;
-
- os_cputime_timer_init(&g_sensor_shell_timer, sensor_shell_timer_cb,
- spd);
-
- os_cputime_timer_relative(&g_sensor_shell_timer, sensor_shell_timer_arg);
+ os_eventq_put(os_eventq_dflt_get(), &g_spd.spd_read_ev);
}
static int
-sensor_cmd_read(char *name, sensor_type_t type, struct sensor_poll_data *spd)
+sensor_cmd_read(char **argv, int argc)
{
- int rc;
+ char *sensor_name;
+ sensor_type_t type;
+ int i;
+
+ if (argc < 2) {
+ /* Need at least sensor name and type */
+ console_printf("Too few arguments: %d\n", argc);
+ goto usage;
+ }
- rc = SYS_EOK;
+ sensor_name = argv[0];
+ type = strtol(argv[1], NULL, 0);
+
+ for (i = 2; i < argc; i++) {
+ if (argv[i][0] != '-' || strlen(argv[i]) != 2) {
+ console_printf("Invalid parameter '%s'\n", argv[i]);
+ goto usage;
+ }
+
+ if (argc - i < 2) {
+ console_printf("Missing parameter for '%s'\n", argv[i]);
+ goto usage;
+ }
+
+ switch (argv[i][1]) {
+ case 'n':
+ g_spd.spd_nsamples = atoi(argv[++i]);
+ break;
+ case 'i':
+ g_spd.spd_poll_itvl = atoi(argv[++i]);
+ break;
+ case 'd':
+ g_spd.spd_poll_duration = atoi(argv[++i]);
+ break;
+ default:
+ console_printf("Unknown option '%s'\n", argv[i]);
+ goto usage;
+ }
+ }
+
+ if (!g_spd.spd_nsamples && !g_spd.spd_poll_itvl && !g_spd.spd_poll_duration) {
+ /* Just read single sample by default */
+ g_spd.spd_nsamples = 1;
+ }
+
+ if ((g_spd.spd_nsamples > 1) && !g_spd.spd_poll_itvl) {
+ console_printf("Need to specify poll interval if num_samples > 0\n");
+ goto usage;
+ }
/* Look up sensor by name */
- spd->spd_sensor = sensor_mgr_find_next_bydevname(name, NULL);
- if (!spd->spd_sensor) {
- console_printf("Sensor %s not found!\n", name);
+ g_spd.spd_sensor = sensor_mgr_find_next_bydevname(sensor_name, NULL);
+ if (!g_spd.spd_sensor) {
+ console_printf("Sensor %s not found!\n", sensor_name);
+ return SYS_ENOENT;
}
- if (!(type & spd->spd_sensor->s_types)) {
- rc = SYS_EINVAL;
+ if (!(type & g_spd.spd_sensor->s_types)) {
/* Directly return without trying to unregister */
- console_printf("Read req for wrng type 0x%x from selected sensor: %s\n",
- (int)type, name);
- return rc;
+ console_printf("Read request for wrong type 0x%x from selected sensor: %s\n",
+ (int)type, sensor_name);
+ return SYS_EINVAL;
}
- spd->spd_sensor_type = type;
- if (spd->spd_poll_itvl) {
- sensor_shell_config_timer(spd);
- }
+ g_spd.spd_sensor_type = type;
- g_sensor_shell_num_entries = 0;
- return rc;
+ /* Start 1st read immediately */
+ g_spd.spd_read_start_ticks = os_cputime_get32();
+ sensor_shell_read_timer_cb(NULL);
+
+ return 0;
+
+usage:
+ console_printf("Usage: sensor read <sensor_name> <type> "
+ "[-n num_samples] [-i poll_interval(ms)] [-d poll_duration(ms)]\n");
+
+ return SYS_EINVAL;
}
static int
@@ -655,7 +654,6 @@ sensor_cmd_exec(int argc, char **argv)
{
char *subcmd;
int rc = 0;
- int i;
if (argc <= 1) {
sensor_display_help();
@@ -672,37 +670,12 @@ sensor_cmd_exec(int argc, char **argv)
goto done;
}
- if (argc < 6) {
- console_printf("Too few arguments: %d\n"
- "Usage: sensor read <sensor_name> <type>"
- "[-n nsamples] [-i poll_itvl(ms)] [-d poll_duration(ms)]\n",
- argc - 2);
- rc = SYS_EINVAL;
- goto done;
- }
-
- i = 4;
- memset(&g_spd, 0, sizeof(struct sensor_poll_data));
- if (argv[i] && !strcmp(argv[i], "-n")) {
- g_spd.spd_nsamples = atoi(argv[++i]);
- i++;
- }
- if (argv[i] && !strcmp(argv[i], "-i")) {
- g_spd.spd_poll_itvl = atoi(argv[++i]);
- i++;
- }
- if (argv[i] && !strcmp(argv[i], "-d")) {
- g_spd.spd_poll_duration = atoi(argv[++i]);
- i++;
- }
-
- rc = sensor_cmd_read(argv[2], (sensor_type_t) strtol(argv[3], NULL, 0), &g_spd);
+ rc = sensor_cmd_read(argv + 2, argc - 2);
if (rc) {
goto done;
}
g_spd.spd_read_in_progress = true;
-
} else if (!strcmp(argv[1], "type")) {
rc = sensor_cmd_display_type(argv);
if (rc) {
@@ -724,10 +697,15 @@ sensor_cmd_exec(int argc, char **argv)
argc - 2);
goto done;
}
-
} else if (!strcmp(argv[1], "read_stop")) {
- os_cputime_timer_stop(&g_sensor_shell_timer);
- console_printf("Stop read\n");
+ if (!g_spd.spd_read_in_progress) {
+ console_printf("No read in progress\n");
+ rc = SYS_EINVAL;
+ goto done;
+ }
+
+ console_printf("Reading stopped\n");
+ os_cputime_timer_stop(&g_spd.spd_read_timer);
g_spd.spd_read_in_progress = false;
} else {
console_printf("Unknown sensor command %s\n", subcmd);
@@ -743,6 +721,10 @@ done:
int
sensor_shell_register(void)
{
+ memset(&g_spd, 0, sizeof(g_spd));
+ g_spd.spd_read_ev.ev_cb = sensor_shell_read_ev_cb;
+ os_cputime_timer_init(&g_spd.spd_read_timer, sensor_shell_read_timer_cb, NULL);
+
shell_cmd_register((struct shell_cmd *) &shell_sensor_cmd);
return (0);