e18fcbba5a
Now that device_api attribute is unmodified at runtime, as well as all the other attributes, it is possible to switch all device driver instance to be constant. A coccinelle rule is used for this: @r_const_dev_1 disable optional_qualifier @ @@ -struct device * +const struct device * @r_const_dev_2 disable optional_qualifier @ @@ -struct device * const +const struct device * Fixes #27399 Signed-off-by: Tomasz Bursztyka <tomasz.bursztyka@linux.intel.com>
125 lines
2.7 KiB
C
125 lines
2.7 KiB
C
/*
|
|
* Copyright (c) 2017 Linaro Limited
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr.h>
|
|
#include <device.h>
|
|
#include <drivers/gpio.h>
|
|
#include <sys/printk.h>
|
|
#include <sys/__assert.h>
|
|
#include <string.h>
|
|
|
|
/* size of stack area used by each thread */
|
|
#define STACKSIZE 1024
|
|
|
|
/* scheduling priority used by each thread */
|
|
#define PRIORITY 7
|
|
|
|
#define LED0_NODE DT_ALIAS(led0)
|
|
#define LED1_NODE DT_ALIAS(led1)
|
|
|
|
struct printk_data_t {
|
|
void *fifo_reserved; /* 1st word reserved for use by fifo */
|
|
uint32_t led;
|
|
uint32_t cnt;
|
|
};
|
|
|
|
K_FIFO_DEFINE(printk_fifo);
|
|
|
|
struct led {
|
|
const char *gpio_dev_name;
|
|
const char *gpio_pin_name;
|
|
unsigned int gpio_pin;
|
|
unsigned int gpio_flags;
|
|
};
|
|
|
|
void blink(const struct led *led, uint32_t sleep_ms, uint32_t id)
|
|
{
|
|
const struct device *gpio_dev;
|
|
int cnt = 0;
|
|
int ret;
|
|
|
|
gpio_dev = device_get_binding(led->gpio_dev_name);
|
|
if (gpio_dev == NULL) {
|
|
printk("Error: didn't find %s device\n",
|
|
led->gpio_dev_name);
|
|
return;
|
|
}
|
|
|
|
ret = gpio_pin_configure(gpio_dev, led->gpio_pin, led->gpio_flags);
|
|
if (ret != 0) {
|
|
printk("Error %d: failed to configure pin %d '%s'\n",
|
|
ret, led->gpio_pin, led->gpio_pin_name);
|
|
return;
|
|
}
|
|
|
|
while (1) {
|
|
gpio_pin_set(gpio_dev, led->gpio_pin, cnt % 2);
|
|
|
|
struct printk_data_t tx_data = { .led = id, .cnt = cnt };
|
|
|
|
size_t size = sizeof(struct printk_data_t);
|
|
char *mem_ptr = k_malloc(size);
|
|
__ASSERT_NO_MSG(mem_ptr != 0);
|
|
|
|
memcpy(mem_ptr, &tx_data, size);
|
|
|
|
k_fifo_put(&printk_fifo, mem_ptr);
|
|
|
|
k_msleep(sleep_ms);
|
|
cnt++;
|
|
}
|
|
}
|
|
|
|
void blink0(void)
|
|
{
|
|
const struct led led0 = {
|
|
#if DT_NODE_HAS_STATUS(LED0_NODE, okay)
|
|
.gpio_dev_name = DT_GPIO_LABEL(LED0_NODE, gpios),
|
|
.gpio_pin_name = DT_LABEL(LED0_NODE),
|
|
.gpio_pin = DT_GPIO_PIN(LED0_NODE, gpios),
|
|
.gpio_flags = GPIO_OUTPUT | DT_GPIO_FLAGS(LED0_NODE, gpios),
|
|
#else
|
|
#error "Unsupported board: led0 devicetree alias is not defined"
|
|
#endif
|
|
};
|
|
|
|
blink(&led0, 100, 0);
|
|
}
|
|
|
|
void blink1(void)
|
|
{
|
|
const struct led led1 = {
|
|
#if DT_NODE_HAS_STATUS(LED1_NODE, okay)
|
|
.gpio_dev_name = DT_GPIO_LABEL(LED1_NODE, gpios),
|
|
.gpio_pin_name = DT_LABEL(LED1_NODE),
|
|
.gpio_pin = DT_GPIO_PIN(LED1_NODE, gpios),
|
|
.gpio_flags = GPIO_OUTPUT | DT_GPIO_FLAGS(LED1_NODE, gpios),
|
|
#else
|
|
#error "Unsupported board: led1 devicetree alias is not defined"
|
|
#endif
|
|
};
|
|
|
|
blink(&led1, 1000, 1);
|
|
}
|
|
|
|
void uart_out(void)
|
|
{
|
|
while (1) {
|
|
struct printk_data_t *rx_data = k_fifo_get(&printk_fifo,
|
|
K_FOREVER);
|
|
printk("Toggled led%d; counter=%d\n",
|
|
rx_data->led, rx_data->cnt);
|
|
k_free(rx_data);
|
|
}
|
|
}
|
|
|
|
K_THREAD_DEFINE(blink0_id, STACKSIZE, blink0, NULL, NULL, NULL,
|
|
PRIORITY, 0, 0);
|
|
K_THREAD_DEFINE(blink1_id, STACKSIZE, blink1, NULL, NULL, NULL,
|
|
PRIORITY, 0, 0);
|
|
K_THREAD_DEFINE(uart_out_id, STACKSIZE, uart_out, NULL, NULL, NULL,
|
|
PRIORITY, 0, 0);
|