Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-06-02 03:49:12 +08:00
Code Issues Actions 6 Packages Projects Releases Wiki Activity

Added GPIO_EXT1/GPIO_EXT2 selection.

Browse Source
This commit is contained in:
Anton Babushkin
2013-05-22 11:30:50 +04:00
parent 2f280bb4ca
commit 09ce3e2d0a
1 changed files with 23 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/gpio_led/gpio_led.c
+23 -7
View File
@@ -57,13 +57,14 @@ struct gpio_led_s
{ {
struct work_s work; struct work_s work;
int gpio_fd; int gpio_fd;
int pin;
struct vehicle_status_s status; struct vehicle_status_s status;
int vehicle_status_sub; int vehicle_status_sub;
bool led_state; bool led_state;
int counter; int counter;
}; };
static struct gpio_led_s gpio_led; static struct gpio_led_s gpio_led_data;
__EXPORT int gpio_led_main(int argc, char *argv[]); __EXPORT int gpio_led_main(int argc, char *argv[]);
@@ -73,8 +74,23 @@ void gpio_led_cycle(FAR void *arg);
int gpio_led_main(int argc, char *argv[]) int gpio_led_main(int argc, char *argv[])
{ {
memset(&gpio_led, 0, sizeof(gpio_led)); int pin = GPIO_EXT_1;
int ret = work_queue(LPWORK, &gpio_led.work, gpio_led_start, &gpio_led, 0); if (argc > 1) {
if (!strcmp(argv[1], "-p")) {
if (!strcmp(argv[2], "1")) {
pin = GPIO_EXT_1;
} else if (!strcmp(argv[2], "2")) {
pin = GPIO_EXT_2;
} else {
printf("[gpio_led] Unsupported pin: %s\n", argv[2]);
exit(1);
}
}
}
memset(&gpio_led_data, 0, sizeof(gpio_led_data));
gpio_led_data.pin = pin;
int ret = work_queue(LPWORK, &gpio_led_data.work, gpio_led_start, &gpio_led_data, 0);
if (ret != 0) { if (ret != 0) {
printf("[gpio_led] Failed to queue work: %d\n", ret); printf("[gpio_led] Failed to queue work: %d\n", ret);
exit(1); exit(1);
@@ -94,7 +110,7 @@ void gpio_led_start(FAR void *arg)
} }
/* configure GPIO pin */ /* configure GPIO pin */
ioctl(priv->gpio_fd, GPIO_SET_OUTPUT, GPIO_EXT_1); ioctl(priv->gpio_fd, GPIO_SET_OUTPUT, priv->pin);
/* subscribe to vehicle status topic */ /* subscribe to vehicle status topic */
memset(&priv->status, 0, sizeof(priv->status)); memset(&priv->status, 0, sizeof(priv->status));
@@ -107,7 +123,7 @@ void gpio_led_start(FAR void *arg)
return; return;
} }
printf("[gpio_led] Started\n"); printf("[gpio_led] Started, using pin GPIO_EXT%i\n", priv->pin);
} }
void gpio_led_cycle(FAR void *arg) void gpio_led_cycle(FAR void *arg)
@@ -144,9 +160,9 @@ void gpio_led_cycle(FAR void *arg)
if (led_state_new != priv->led_state) { if (led_state_new != priv->led_state) {
priv->led_state = led_state_new; priv->led_state = led_state_new;
if (led_state_new) { if (led_state_new) {
ioctl(priv->gpio_fd, GPIO_SET, GPIO_EXT_1); ioctl(priv->gpio_fd, GPIO_SET, priv->pin);
} else { } else {
ioctl(priv->gpio_fd, GPIO_CLEAR, GPIO_EXT_1); ioctl(priv->gpio_fd, GPIO_CLEAR, priv->pin);
} }
} }