| /**************************************************************************** |
| * apps/examples/dac/dac_main.c |
| * |
| * Licensed to the Apache Software Foundation (ASF) under one or more |
| * contributor license agreements. See the NOTICE file distributed with |
| * this work for additional information regarding copyright ownership. The |
| * ASF licenses this file to you under the Apache License, Version 2.0 (the |
| * "License"); you may not use this file except in compliance with the |
| * License. You may obtain a copy of the License at |
| * |
| * http://www.apache.org/licenses/LICENSE-2.0 |
| * |
| * Unless required by applicable law or agreed to in writing, software |
| * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT |
| * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the |
| * License for the specific language governing permissions and limitations |
| * under the License. |
| * |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Included Files |
| ****************************************************************************/ |
| |
| #include <nuttx/config.h> |
| |
| #include <errno.h> |
| #include <fcntl.h> |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <unistd.h> |
| |
| #include <sys/ioctl.h> |
| #include <sys/param.h> |
| #include <nuttx/analog/dac.h> |
| #include <nuttx/arch.h> |
| |
| /**************************************************************************** |
| * Pre-processor Definitions |
| ****************************************************************************/ |
| |
| #ifndef CONFIG_DAC |
| # error "DAC device support is not enabled (CONFIG_DAC)" |
| #endif |
| |
| #ifndef CONFIG_EXAMPLES_DAC_DEVPATH |
| # define CONFIG_EXAMPLES_DAC_DEVPATH "/dev/dac0" |
| #endif |
| |
| #define DEFAULT_COUNT 1 |
| #define DEFAULT_DELAY 0 |
| #define DEFAULT_CHANNEL 0 |
| #define DEFAULT_TEST_BIT_RES 8 |
| #define DEFAULT_TEST_STEP 8 |
| #define DEFAULT_INITIALIZED true |
| |
| /**************************************************************************** |
| * Private Types |
| ****************************************************************************/ |
| |
| struct command |
| { |
| FAR const char *name; |
| CODE int (* const cmd)(int argc, FAR const char *argv[]); |
| FAR const char *args; |
| }; |
| |
| struct dac_state_s |
| { |
| FAR char *devpath; |
| int count; |
| int delay; |
| uint8_t channel; |
| int test_bit_res; |
| int test_step; |
| bool initialized; |
| }; |
| |
| /**************************************************************************** |
| * Private Function Prototypes |
| ****************************************************************************/ |
| |
| static int cmd_dac_put(int argc, FAR const char *argv[]); |
| static int cmd_dac_putv(int argc, FAR const char *argv[]); |
| static int cmd_dac_test(int argc, FAR const char *argv[]); |
| |
| /**************************************************************************** |
| * Private Data |
| ****************************************************************************/ |
| |
| static const struct command commands[] = |
| { |
| { "put", cmd_dac_put, "DATA [DELAY]" }, |
| { "putv", cmd_dac_putv, "DATA [DATA...]" }, |
| { "test", cmd_dac_test, "" }, |
| }; |
| |
| static struct dac_state_s g_dacstate; |
| |
| /**************************************************************************** |
| * Private Functions |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: dac_devpath |
| * |
| * Description: |
| * Update the DAC device path in the DAC state structure. This function |
| * manages memory allocation for the device path and frees the previous |
| * path if it exists. |
| * |
| * Input Parameters: |
| * dac - Pointer to the DAC state structure. |
| * devpath - New DAC device path to be set. |
| * |
| * Operation: |
| * - Frees the existing DAC device path if it exists. |
| * - Allocates memory for the new DAC device path. |
| * - Updates the device path in the DAC state structure. |
| * |
| ****************************************************************************/ |
| |
| static void dac_devpath(FAR struct dac_state_s *dac, |
| FAR const char *devpath) |
| { |
| if (dac->devpath) |
| { |
| free(dac->devpath); |
| } |
| |
| dac->devpath = strdup(devpath); |
| } |
| |
| /**************************************************************************** |
| * Name: print_cmds |
| * |
| * Description: |
| * Print a list of commands with their names, arguments, and a given header |
| * and trailer. This function is used to display available |
| * commands and their usage information. |
| * |
| * Input Parameters: |
| * header - Header string to be printed before the command list. |
| * cmds - Pointer to an array of command structures. |
| * ncmds - Number of commands in the array. |
| * trailer - Trailer string to be printed after the command list. |
| * |
| * Operation: |
| * - Prints the header. |
| * - Iterates through the array of command structures and prints |
| * their names, arguments, and a newline character after each command. |
| * - Prints the trailer. |
| * |
| ****************************************************************************/ |
| |
| static void print_cmds(FAR const char *header, |
| FAR const struct command *cmds, |
| size_t ncmds, |
| FAR const char *trailer) |
| { |
| printf("%s", header); |
| while (ncmds--) |
| { |
| printf(" %s %s %c", cmds->name, cmds->args, |
| (ncmds > 0) ? '\n' : ' '); |
| cmds++; |
| } |
| |
| printf("%s", trailer); |
| } |
| |
| /**************************************************************************** |
| * Name: find_cmd |
| * |
| * Description: |
| * Find a command structure in an array of commands by comparing command |
| * names. |
| * |
| * Input Parameters: |
| * name - Name of the command to be found. |
| * cmds - Pointer to an array of command structures. |
| * ncmds - Number of commands in the array. |
| * |
| * Returned Value: |
| * Returns a pointer to the found command structure if successful; NULL |
| * if the command is not found. |
| * |
| * Operation: |
| * - Iterates through the array of command structures. |
| * - Compares the name of each command with the specified name. |
| * - Returns a pointer to the found command structure or NULL if not found. |
| * |
| ****************************************************************************/ |
| |
| static const struct command *find_cmd(FAR const char *name, |
| FAR const struct command *cmds, |
| size_t ncmds) |
| { |
| while (ncmds--) |
| { |
| if (!strcmp(cmds->name, name)) |
| { |
| return cmds; |
| } |
| |
| cmds++; |
| } |
| |
| return NULL; |
| } |
| |
| /**************************************************************************** |
| * Name: execute_cmd |
| * |
| * Description: |
| * Execute a command function based on the command name. |
| * This function finds the corresponding command structure in the |
| * array and invokes the associated function. |
| * |
| * Input Parameters: |
| * argc - Number of command-line arguments. |
| * argv - Array of command-line argument strings. |
| * cmds - Pointer to an array of command structures. |
| * ncmds - Number of commands in the array. |
| * |
| * Returned Value: |
| * Returns the result of the executed command function. |
| * |
| * Operation: |
| * - Finds the command structure for the specified command name. |
| * - Invokes the associated command function with the provided arguments. |
| * - Prints an error message if the command is not found. |
| * |
| ****************************************************************************/ |
| |
| static int execute_cmd(int argc, |
| FAR const char *argv[], |
| FAR const struct command *cmds, |
| size_t ncmds) |
| { |
| FAR const struct command *cmd; |
| |
| cmd = find_cmd(argv[0], cmds, ncmds); |
| if (!cmd) |
| { |
| fprintf(stderr, "ERROR: unknown command: %s\n", argv[0]); |
| print_cmds("", cmds, ncmds, "\n"); |
| return -EINVAL; |
| } |
| |
| return cmd->cmd(argc - 1, argv + 1); |
| } |
| |
| /**************************************************************************** |
| * Name: dac_put |
| * |
| * Description: |
| * Write DAC messages to the specified DAC device. This function writes |
| * multiple DAC messages, allowing the configuration of DAC channel and |
| * data values. It handles potential write retries in case of non-blocking |
| * write operations and provides debug information about the write process. |
| * |
| * Input Parameters: |
| * devpath - Path to the DAC device. |
| * msg - Pointer to an array of DAC messages to be written. |
| * nmsgs - Number of DAC messages in the array. |
| * delay - Delay between writes in milliseconds. |
| * |
| * Returned Value: |
| * Returns the number of successfully written messages on success; a |
| * negated errno value on failure. |
| * |
| * Operation: |
| * - Opens the specified DAC device for writing. |
| * - Iterates through the array of DAC messages and writes |
| * them to the device. |
| * - Handles non-blocking writes, retries on EAGAIN, and provides |
| * debug output. |
| * - Closes the DAC device after completing the write operations. |
| * |
| ****************************************************************************/ |
| |
| static int dac_put(FAR const char *devpath, |
| FAR struct dac_msg_s *msg, |
| size_t nmsgs, |
| int delay) |
| { |
| size_t retries; |
| size_t i; |
| int fd; |
| int ret = OK; |
| |
| fd = open(devpath, O_WRONLY | O_NONBLOCK); |
| if (fd < 0) |
| { |
| fprintf(stderr, "ERROR: open() failed: %d\n", errno); |
| return -ENODEV; |
| } |
| |
| i = retries = 0; |
| while (i < nmsgs && retries < 3) |
| { |
| errno = 0; |
| ret = write(fd, &msg[i], sizeof(*msg)); |
| printf("write: ret=%d, errno=%d\n", ret, errno); |
| if (ret != sizeof(*msg)) |
| { |
| if (errno == EAGAIN) |
| { |
| retries++; |
| continue; |
| } |
| |
| fprintf(stderr, "write failed: ret=%d, errno=%d\n", ret, errno); |
| ret = -errno; |
| break; |
| } |
| else |
| { |
| printf("wrote: chan=%d, data=%" PRId32 "\n", msg[i].am_channel, |
| msg[i].am_data); |
| i++; |
| retries = 0; |
| ret = OK; |
| usleep(1000 * delay); |
| } |
| } |
| |
| close(fd); |
| return (i > 0) ? i : ret; |
| } |
| |
| /**************************************************************************** |
| * Name: cmd_dac_put |
| * |
| * Description: |
| * Execute the 'put' command, writing a specified DAC value to the DAC |
| * device. |
| * |
| * Input Parameters: |
| * argc - Number of command-line arguments. |
| * argv - Array of command-line argument strings. |
| * |
| * Returned Value: |
| * Returns OK on success; a negated errno value on failure. |
| * |
| * Operation: |
| * - Parses the command-line arguments to extract the DAC value and delay. |
| * - Overrides the "sticky" delay option if provided in the arguments. |
| * - Repeats the DAC write operation for the specified number of times. |
| * |
| * Usage: |
| * `put [value] [delay]`: Write the specified DAC value to the device. |
| * - [value]: DAC value to be written (Default: 100). |
| * - [delay]: Delay between writes in milliseconds. |
| * |
| ****************************************************************************/ |
| |
| static int cmd_dac_put(int argc, FAR const char *argv[]) |
| { |
| struct dac_msg_s msgs[1]; |
| int data; |
| int delay; |
| int i; |
| int ret = OK; |
| |
| /* This command allows overriding the "sticky" delay option. */ |
| |
| data = (argc > 0) ? atoi(argv[0]) : 100; |
| delay = (argc > 1) ? atoi(argv[1]) : g_dacstate.delay; |
| |
| printf("devpath=%s data=%d delay=%d\n", |
| g_dacstate.devpath, data, delay); |
| |
| for (i = 0; i < g_dacstate.count; i++) |
| { |
| msgs[0].am_channel = g_dacstate.channel; |
| msgs[0].am_data = data; |
| ret = dac_put(g_dacstate.devpath, msgs, nitems(msgs), delay); |
| printf("ret=%d\n", ret); |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: cmd_dac_putv |
| * |
| * Description: |
| * Execute the 'putv' command, writing DAC values specified in the command |
| * arguments to the DAC device. The command supports writing |
| * multiple values in a single execution. |
| * |
| * Input Parameters: |
| * argc - Number of command-line arguments. |
| * argv - Array of command-line argument strings. |
| * |
| * Returned Value: |
| * Returns OK on success; a negated errno value on failure. |
| * |
| * Operation: |
| * - Parses the command-line arguments to extract DAC values. |
| * - Constructs DAC messages with the specified channel and data values. |
| * - Repeats the DAC write operation for the specified number of times. |
| * |
| ****************************************************************************/ |
| |
| static int cmd_dac_putv(int argc, FAR const char *argv[]) |
| { |
| struct dac_msg_s msgs[CONFIG_NSH_MAXARGUMENTS]; |
| int nmsgs; |
| int i; |
| int ret = OK; |
| |
| for (nmsgs = 0; nmsgs < CONFIG_NSH_MAXARGUMENTS; nmsgs++) |
| { |
| if (nmsgs >= argc) |
| { |
| break; |
| } |
| |
| msgs[nmsgs].am_channel = g_dacstate.channel; |
| msgs[nmsgs].am_data = atoi(argv[nmsgs]); |
| } |
| |
| for (i = 0; i < g_dacstate.count; i++) |
| { |
| ret = dac_put(g_dacstate.devpath, msgs, nmsgs, g_dacstate.delay); |
| printf("ret=%d\n", ret); |
| } |
| |
| return ret; |
| } |
| |
| /**************************************************************************** |
| * Name: cmd_dac_test |
| * |
| * Description: |
| * Perform DAC testing by generating a sequence of values and writing them |
| * to the DAC device specified in the global DAC state structure. |
| * |
| * Input Parameters: |
| * argc - Number of arguments in argv. |
| * argv - Array of command-line argument strings. |
| * |
| * Returned Value: |
| * Total return value, the sum of return values from write calls. Returns |
| * a negative errno on failure. |
| * |
| * Note: Utilizing the parameters can make testing much easier. If you are |
| * testing with one config test, you can change the constant definition for |
| * default value at the top and simply run `nsh> dat test` |
| * If you want setup for multimeter testing, set appropriate delay between |
| * writes (in ms). Example for 8 bit DAC using step in value of 16 |
| * nsh> dac -d 5000 -b 8 -s 16 test |
| * Example for oscilloscope test for 12 bit DAC: |
| * nsh> dac -d 10 -b 12 -s 4 test |
| * |
| ****************************************************************************/ |
| |
| static int cmd_dac_test(int argc, FAR const char *argv[]) |
| { |
| struct dac_msg_s msg; |
| int fd; |
| int i; |
| bool count_up; |
| uint32_t value = 0; |
| uint32_t max_value = (1 << g_dacstate.test_bit_res); |
| int ret = OK; |
| int total_ret = 0; |
| |
| fd = open(g_dacstate.devpath, O_WRONLY | O_NONBLOCK); |
| if (fd < 0) |
| { |
| fprintf(stderr, "ERROR: open() failed: %d\n", errno); |
| return -ENODEV; |
| } |
| |
| for (i = 0; i < g_dacstate.count; i++) |
| { |
| count_up = true; |
| value = 0; |
| while (count_up || value) |
| { |
| msg.am_channel = g_dacstate.channel; |
| msg.am_data = value; |
| |
| if (count_up) |
| { |
| value += g_dacstate.test_step; |
| if (value >= max_value - 1) |
| { |
| value = max_value - 1; |
| count_up = false; |
| } |
| } |
| else |
| { |
| value -= g_dacstate.test_step; |
| |
| /* Check if value is underflow */ |
| |
| if (value > UINT32_MAX - g_dacstate.test_step) |
| { |
| value = 0; |
| } |
| } |
| |
| ret = write(fd, &msg, sizeof(struct dac_msg_s)); |
| total_ret += ret; |
| usleep(1000 * g_dacstate.delay); |
| } |
| } |
| |
| close(fd); |
| |
| return total_ret; |
| } |
| |
| /**************************************************************************** |
| * Name: dac_help |
| * |
| * Description: |
| * Display the help message for the DAC testing application. |
| * |
| * Input Parameters: |
| * None |
| * |
| * Returned Value: |
| * None |
| * |
| ****************************************************************************/ |
| |
| static void dac_help(void) |
| { |
| printf("Usage: dac [OPTIONS] command [CMD OPTIONS]\n"); |
| printf("\nGlobal arguments are \"sticky\". " |
| "For example, once the DAC device is\n"); |
| printf("specified, that device will be re-used until it is changed.\n"); |
| printf("\n\"sticky\" OPTIONS include:\n"); |
| printf(" [-c channel] selects the DAC channel. " |
| "Default: %d Current: %d\n", DEFAULT_CHANNEL, g_dacstate.channel); |
| printf(" [-d delay] pause for DELAY ms between writes. " |
| "Default: %d Current: %d\n", DEFAULT_DELAY, g_dacstate.delay); |
| printf(" [-n count] repeats device write COUNT times. " |
| "Default: %d Current: %d\n", DEFAULT_COUNT, g_dacstate.count); |
| printf(" [-b bit_resolution] Test-specific config - set DAC bit" |
| " resolution Default: %d Current: %d\n", |
| DEFAULT_TEST_BIT_RES, g_dacstate.test_bit_res); |
| printf(" [-s step] Test-specific config - test loop step " |
| "Default: %d Current: %d\n", |
| DEFAULT_TEST_STEP, g_dacstate.test_step); |
| printf(" [-p devpath] selects the DAC device. " |
| "Default: %s Current: %s\n", |
| CONFIG_EXAMPLES_DAC_DEVPATH, |
| g_dacstate.devpath ? g_dacstate.devpath : "NONE"); |
| printf(" [-h] Print this help and exit.\n"); |
| print_cmds("\nCommands:\n", commands, nitems(commands), "\n"); |
| } |
| |
| /**************************************************************************** |
| * Name: arg_string |
| * |
| * Description: |
| * Extracts a string argument from a command-line option. |
| * |
| * Input Parameters: |
| * arg - Pointer to the current command-line argument being processed. |
| * value - Pointer to store the extracted string argument. |
| * |
| * Returned Value: |
| * Integer representing the number of arguments consumed |
| * (2 if the option takes an additional argument, 1 otherwise). |
| * |
| ****************************************************************************/ |
| |
| static int arg_string(FAR const char **arg, FAR const char **value) |
| { |
| FAR const char *ptr = *arg; |
| |
| if (ptr[2] == '\0') |
| { |
| *value = arg[1]; |
| return 2; |
| } |
| else |
| { |
| *value = &ptr[2]; |
| return 1; |
| } |
| } |
| |
| /**************************************************************************** |
| * Name: arg_decimal |
| * |
| * Description: |
| * Extracts a decimal value from a command-line option. |
| * |
| * Input Parameters: |
| * arg - Pointer to the current command-line argument being processed. |
| * value - Pointer to store the extracted decimal value. |
| * |
| * Returned Value: |
| * Integer representing the number of arguments consumed |
| * (2 if the option takes an additional argument, 1 otherwise). |
| * |
| * Note: |
| * Utilizes arg_string internally to extract the string argument |
| * and then converts it to a long integer using strtol. |
| * |
| ****************************************************************************/ |
| |
| static int arg_decimal(FAR const char **arg, FAR long *value) |
| { |
| FAR const char *string; |
| int ret; |
| |
| ret = arg_string(arg, &string); |
| *value = strtol(string, NULL, 10); |
| return ret; |
| } |
| |
| static int parse_args(FAR struct dac_state_s *dac, |
| int argc, |
| const char *argv[]) |
| { |
| FAR const char *ptr; /* Pointer to the current argument in argv */ |
| FAR const char *str; /* Pointer to a string argument extracted from argv */ |
| long value; /* Numerical argument value */ |
| int nargs; /* Number of args consumed by the current option */ |
| int n; /* Total number of arguments processed */ |
| int i; /* Loop counter */ |
| |
| for (i = n = 1; i < argc; ) |
| { |
| ptr = argv[i]; |
| if (ptr[0] != '-') |
| { |
| i++; |
| continue; |
| } |
| |
| switch (ptr[1]) |
| { |
| case 'c': |
| nargs = arg_decimal(&argv[i], &value); |
| if (value < 0 || value > 255) |
| { |
| printf("Channel must be in range [0..255]: %ld\n", value); |
| exit(1); |
| } |
| |
| dac->channel = (uint8_t)value; |
| i += nargs; |
| n += nargs; |
| break; |
| |
| case 'd': |
| nargs = arg_decimal(&argv[i], &value); |
| if (value < 0) |
| { |
| printf("Delay must be non-negative: %ld\n", value); |
| exit(1); |
| } |
| |
| dac->delay = (uint32_t)value; |
| i += nargs; |
| n += nargs; |
| break; |
| |
| case 'n': |
| nargs = arg_decimal(&argv[i], &value); |
| if (value < 0) |
| { |
| printf("Count must be non-negative: %ld\n", value); |
| exit(1); |
| } |
| |
| dac->count = (uint32_t)value; |
| i += nargs; |
| n += nargs; |
| break; |
| |
| case 'b': |
| nargs = arg_decimal(&argv[i], &value); |
| if (value < 0) |
| { |
| printf("Bit resolution must be non-negative: %ld\n", value); |
| exit(1); |
| } |
| |
| dac->test_bit_res = (uint32_t)value; |
| i += nargs; |
| n += nargs; |
| break; |
| |
| case 's': |
| nargs = arg_decimal(&argv[i], &value); |
| if (value < 0) |
| { |
| printf("Step must be non-negative: %ld\n", value); |
| exit(1); |
| } |
| |
| dac->test_step = (uint32_t)value; |
| i += nargs; |
| n += nargs; |
| break; |
| |
| case 'p': |
| nargs = arg_string(&argv[i], &str); |
| dac_devpath(dac, str); |
| i += nargs; |
| n += nargs; |
| break; |
| |
| case 'h': |
| dac_help(); |
| exit(0); |
| break; |
| |
| case '?': |
| default: |
| printf("Unsupported option: %s\n", ptr); |
| dac_help(); |
| exit(1); |
| } |
| } |
| |
| return n; |
| } |
| |
| /**************************************************************************** |
| * Public Functions |
| ****************************************************************************/ |
| |
| /**************************************************************************** |
| * Name: main |
| * |
| * Description: |
| * Entry point for the DAC testing application. |
| * Initializes the DAC hardware and processes command-line |
| * arguments to execute DAC testing commands. |
| * |
| * Input Parameters: |
| * argc - Number of command-line arguments. |
| * argv - Array of command-line argument strings. |
| * |
| * Returned Value: |
| * EXIT_SUCCESS on success, EXIT_FAILURE on failure. |
| * |
| ****************************************************************************/ |
| |
| int main(int argc, FAR const char *argv[]) |
| { |
| int ret; |
| int nargs = 1; |
| |
| if (!g_dacstate.initialized) |
| { |
| /* Initialization of the DAC hardware must be performed by |
| * board-specific logic prior to running this test. |
| */ |
| |
| /* Set the default values */ |
| |
| dac_devpath(&g_dacstate, CONFIG_EXAMPLES_DAC_DEVPATH); |
| g_dacstate.delay = DEFAULT_DELAY; |
| g_dacstate.count = DEFAULT_COUNT; |
| g_dacstate.channel = DEFAULT_CHANNEL; |
| g_dacstate.test_bit_res = DEFAULT_TEST_BIT_RES; |
| g_dacstate.test_step = DEFAULT_TEST_STEP; |
| g_dacstate.initialized = DEFAULT_INITIALIZED; |
| } |
| |
| /* Parse the command line */ |
| |
| nargs = parse_args(&g_dacstate, argc, argv); |
| |
| argc -= nargs; |
| argv += nargs; |
| |
| if (argc < 1) |
| { |
| dac_help(); |
| return EXIT_FAILURE; |
| } |
| else |
| { |
| ret = execute_cmd(argc, argv, commands, nitems(commands)); |
| } |
| |
| return (ret >= 0) ? EXIT_SUCCESS : EXIT_FAILURE; |
| } |