zephyr/drivers/counter/counter_timer_shell.c

213 lines
5.3 KiB
C

/*
* Copyright (c) 2023 Intel Corporation.
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <zephyr/drivers/counter.h>
#include <zephyr/shell/shell.h>
#include <stdio.h>
#include <ctype.h>
#include <stdlib.h>
#define ARGV_DEV 1
#define ARGV_CHN 2
#define ARGV_PERIODIC_TIME 2
#define ARGV_ONESHOT_TIME 3
/* number of periodic interrupts */
#define PERIODIC_CYCLES 10
#define MAX_DELAY UINT32_MAX
#define MAX_CHANNEL 255U
static struct k_sem timer_sem;
void timer_top_handler(const struct device *counter_dev, void *user_data)
{
ARG_UNUSED(counter_dev);
k_sem_give(&timer_sem);
}
void timer_alarm_handler(const struct device *counter_dev, uint8_t chan_id,
uint32_t ticks, void *user_data)
{
ARG_UNUSED(counter_dev);
k_sem_give(&timer_sem);
}
static int cmd_timer_free_running(const struct shell *shctx, size_t argc, char **argv)
{
ARG_UNUSED(argc);
int err = 0;
const struct device *timer_dev;
timer_dev = device_get_binding(argv[ARGV_DEV]);
if (!timer_dev) {
shell_error(shctx, "Timer: Device %s not found", argv[ARGV_DEV]);
return -ENODEV;
}
/* start timer in free running mode */
err = counter_start(timer_dev);
if (err != 0) {
shell_error(shctx, "%s is not available err:%d", argv[ARGV_DEV], err);
return err;
}
shell_info(shctx, "%s: Timer is freerunning", argv[ARGV_DEV]);
return 0;
}
static int cmd_timer_stop(const struct shell *shctx, size_t argc, char **argv)
{
ARG_UNUSED(argc);
uint32_t ticks1 = 0, ticks2 = 0;
const struct device *timer_dev;
timer_dev = device_get_binding(argv[ARGV_DEV]);
if (!timer_dev) {
shell_error(shctx, "Timer: Device %s not found", argv[ARGV_DEV]);
return -ENODEV;
}
counter_stop(timer_dev);
counter_get_value(timer_dev, &ticks1);
counter_get_value(timer_dev, &ticks2);
if (ticks1 == ticks2) {
shell_info(shctx, "Timer Stopped");
} else {
shell_error(shctx, "Failed to stop timer");
return -EIO;
}
return 0;
}
static int cmd_timer_oneshot(const struct shell *shctx, size_t argc, char **argv)
{
ARG_UNUSED(argc);
int err = 0;
unsigned long delay = 0;
unsigned long channel = 0;
const struct device *timer_dev;
struct counter_alarm_cfg alarm_cfg;
k_sem_init(&timer_sem, 0, 1);
timer_dev = device_get_binding(argv[ARGV_DEV]);
if (!timer_dev) {
shell_error(shctx, "Timer: Device %s not found", argv[ARGV_DEV]);
return -ENODEV;
}
delay = shell_strtoul(argv[ARGV_ONESHOT_TIME], 10, &err);
if (err != 0) {
shell_error(shctx, "invalid delay parameter");
return err;
} else if (delay > MAX_DELAY) {
shell_error(shctx, "delay out of range");
return -ERANGE;
}
channel = shell_strtoul(argv[ARGV_CHN], 10, &err);
if (err != 0) {
shell_error(shctx, "invalid channel parameter");
return err;
} else if (channel > MAX_CHANNEL) {
shell_error(shctx, "channel out of range");
return -ERANGE;
}
alarm_cfg.flags = 0;
alarm_cfg.ticks = counter_us_to_ticks(timer_dev, (uint64_t)delay);
alarm_cfg.callback = timer_alarm_handler;
alarm_cfg.user_data = NULL;
/* set an alarm */
err = counter_set_channel_alarm(timer_dev, (uint8_t)channel, &alarm_cfg);
if (err != 0) {
shell_error(shctx, "%s:Failed to set channel alarm, err:%d", argv[ARGV_DEV], err);
return err;
}
k_sem_take(&timer_sem, K_FOREVER);
shell_info(shctx, "%s: Alarm triggered", argv[ARGV_DEV]);
return 0;
}
static int cmd_timer_periodic(const struct shell *shctx, size_t argc, char **argv)
{
ARG_UNUSED(argc);
uint32_t count = 0;
int err = 0;
unsigned long delay = 0;
const struct device *timer_dev;
struct counter_top_cfg top_cfg;
k_sem_init(&timer_sem, 0, 1);
timer_dev = device_get_binding(argv[ARGV_DEV]);
if (!timer_dev) {
shell_error(shctx, "Timer: Device %s not found", argv[ARGV_DEV]);
return -ENODEV;
}
delay = shell_strtoul(argv[ARGV_PERIODIC_TIME], 10, &err);
if (err != 0) {
shell_error(shctx, "invalid delay parameter");
return err;
} else if (delay > MAX_DELAY) {
shell_error(shctx, "delay out of range");
return -ERANGE;
}
top_cfg.flags = 0;
top_cfg.ticks = counter_us_to_ticks(timer_dev, (uint64_t)delay);
/* interrupt will be triggered periodically */
top_cfg.callback = timer_top_handler;
top_cfg.user_data = NULL;
/* set top value */
err = counter_set_top_value(timer_dev, &top_cfg);
if (err != 0) {
shell_error(shctx, "%s: failed to set top value, err: %d", argv[ARGV_DEV], err);
return err;
}
/* Checking periodic interrupt for PERIODIC_CYCLES times and then unblocking shell.
* Timer is still running and interrupt is triggered periodically.
*/
while (++count < PERIODIC_CYCLES) {
k_sem_take(&timer_sem, K_FOREVER);
}
shell_info(shctx, "%s: periodic timer triggered for %d times", argv[ARGV_DEV], count);
return 0;
}
SHELL_STATIC_SUBCMD_SET_CREATE(sub_timer,
SHELL_CMD_ARG(periodic, NULL,
"timer periodic <timer_instance_node_id> <time_in_us>",
cmd_timer_periodic, 3, 0),
SHELL_CMD_ARG(oneshot, NULL,
"timer oneshot <timer_instance_node_id> <channel_id> <time_in_us>",
cmd_timer_oneshot, 4, 0),
SHELL_CMD_ARG(freerun, NULL,
"timer freerun <timer_instance_node_id>",
cmd_timer_free_running, 2, 0),
SHELL_CMD_ARG(stop, NULL,
"timer stop <timer_instance_node_id>",
cmd_timer_stop, 2, 0),
SHELL_SUBCMD_SET_END /* array terminated. */
);
SHELL_CMD_REGISTER(timer, &sub_timer, "Timer commands", NULL);