examples/mraa-gpio.c

   1 /*
   2  * Author: Brendan Le Foll <brendan.le.foll@intel.com>
   3  * Copyright (c) 2014 Intel Corporation.
   4  *
   5  * Permission is hereby granted, free of charge, to any person obtaining
   6  * a copy of this software and associated documentation files (the
   7  * "Software"), to deal in the Software without restriction, including
   8  * without limitation the rights to use, copy, modify, merge, publish,
   9  * distribute, sublicense, and/or sell copies of the Software, and to
  10  * permit persons to whom the Software is furnished to do so, subject to
  11  * the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be
  14  * included in all copies or substantial portions of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  17  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  18  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  19  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
  20  * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
  21  * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
  22  * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  23  */
  24
  25 #include <stdio.h>
  26 #include <stdlib.h>
  27 #include <string.h>
  28 #include <unistd.h>
  29
  30 #include "mraa/gpio.h"
  31
  32 struct gpio_source {
  33     int pin;
  34     mraa_gpio_context context;
  35 };
  36
  37 void
  38 print_version()
  39 {
  40     fprintf(stdout, "Version %s on %s\n", mraa_get_version(), mraa_get_platform_name());
  41 }
  42
  43 void
  44 print_help()
  45 {
  46     fprintf(stdout, "list              List pins\n");
  47     fprintf(stdout, "set pin level     Set pin to level (0/1)\n");
  48     fprintf(stdout, "setraw pin level  Set pin to level (0/1) via mmap (if available)\n");
  49     fprintf(stdout, "get pin           Get pin level\n");
  50     fprintf(stdout, "getraw pin        Get pin level via mmap (if available)\n");
  51     fprintf(stdout, "monitor pin       Monitor pin level changes\n");
  52     fprintf(stdout, "version           Get mraa version and board name\n");
  53 }
  54
  55 void
  56 print_command_error()
  57 {
  58     fprintf(stdout, "Invalid command, options are:\n");
  59     print_help();
  60 }
  61
  62 void
  63 list_pins()
  64 {
  65     int pin_count = mraa_get_pin_count();
  66     if (pin_count == 0) {
  67         fprintf(stdout, "No Pins\n");
  68         return;
  69     }
  70     int i;
  71     for (i = 0; i < pin_count; ++i) {
  72         if (strcmp(mraa_get_pin_name(i), "INVALID") != 0) {
  73             fprintf(stdout, "%02d ", i);
  74             fprintf(stdout, "%*s: ", (MRAA_PIN_NAME_SIZE - 1), mraa_get_pin_name(i));
  75             if (mraa_pin_mode_test(i, MRAA_PIN_GPIO))
  76                 fprintf(stdout, "GPIO ");
  77             if (mraa_pin_mode_test(i, MRAA_PIN_I2C))
  78                 fprintf(stdout, "I2C  ");
  79             if (mraa_pin_mode_test(i, MRAA_PIN_SPI))
  80                 fprintf(stdout, "SPI  ");
  81             if (mraa_pin_mode_test(i, MRAA_PIN_PWM))
  82                 fprintf(stdout, "PWM  ");
  83             if (mraa_pin_mode_test(i, MRAA_PIN_AIO))
  84                 fprintf(stdout, "AIO  ");
  85             if (mraa_pin_mode_test(i, MRAA_PIN_UART))
  86                 fprintf(stdout, "UART ");
  87             fprintf(stdout, "\n");
  88         }
  89     }
  90 }
  91
  92 mraa_result_t
  93 gpio_set(int pin, int level, mraa_boolean_t raw)
  94 {
  95     mraa_gpio_context gpio = mraa_gpio_init(pin);
  96     if (gpio != NULL) {
  97         mraa_gpio_dir(gpio, MRAA_GPIO_OUT);
  98         if (raw != 0) {
  99             if (mraa_gpio_use_mmaped(gpio, 1) != MRAA_SUCCESS) {
 100                 fprintf(stdout,
 101                         "mmapped access to gpio not supported, falling back to normal mode\n", pin);
 102             }
 103         }
 104         mraa_gpio_write(gpio, level);
 105         return MRAA_SUCCESS;
 106     }
 107     return MRAA_ERROR_INVALID_RESOURCE;
 108 }
 109
 110 mraa_result_t
 111 gpio_get(int pin, int* level, mraa_boolean_t raw)
 112 {
 113     mraa_gpio_context gpio = mraa_gpio_init(pin);
 114     if (gpio != NULL) {
 115         mraa_gpio_dir(gpio, MRAA_GPIO_IN);
 116         if (raw != 0) {
 117             if (mraa_gpio_use_mmaped(gpio, 1) != MRAA_SUCCESS) {
 118                 fprintf(stdout,
 119                         "mmapped access to gpio not supported, falling back to normal mode\n", pin);
 120             }
 121         }
 122         *level = mraa_gpio_read(gpio);
 123         return MRAA_SUCCESS;
 124     }
 125     return MRAA_ERROR_INVALID_RESOURCE;
 126 }
 127
 128
 129 void
 130 gpio_isr_handler(void* args)
 131 {
 132     struct gpio_source* gpio_info = (struct gpio_source*) args;
 133     int level = mraa_gpio_read(gpio_info->context);
 134     fprintf(stdout, "Pin %d = %d\n", gpio_info->pin, level);
 135 }
 136
 137 mraa_result_t
 138 gpio_isr_start(struct gpio_source* gpio_info)
 139 {
 140     gpio_info->context = mraa_gpio_init(gpio_info->pin);
 141     if (gpio_info->context != NULL) {
 142         mraa_result_t status = mraa_gpio_dir(gpio_info->context, MRAA_GPIO_IN);
 143         if (status == MRAA_SUCCESS) {
 144             status = mraa_gpio_isr(gpio_info->context, MRAA_GPIO_EDGE_BOTH, &gpio_isr_handler, gpio_info);
 145         }
 146         return status;
 147     } else {
 148         return MRAA_ERROR_INVALID_RESOURCE;
 149     }
 150 }
 151
 152
 153 mraa_result_t
 154 gpio_isr_stop(struct gpio_source* gpio_info)
 155 {
 156     mraa_gpio_isr_exit(gpio_info->context);
 157     mraa_gpio_close(gpio_info->context);
 158     return MRAA_SUCCESS;
 159 }
 160
 161
 162 int
 163 main(int argc, char** argv)
 164 {
 165     if (argc == 1) {
 166         print_command_error();
 167     }
 168
 169     if (argc > 1) {
 170         if (strcmp(argv[1], "list") == 0) {
 171             list_pins();
 172         } else if (strcmp(argv[1], "help") == 0) {
 173             print_help();
 174         } else if (strcmp(argv[1], "version") == 0) {
 175             print_version();
 176         } else if ((strcmp(argv[1], "set") == 0) || (strcmp(argv[1], "setraw") == 0)) {
 177             if (argc == 4) {
 178                 int pin = atoi(argv[2]);
 179                 mraa_boolean_t rawmode = strcmp(argv[1], "setraw") == 0;
 180                 if (gpio_set(pin, atoi(argv[3]), rawmode) != MRAA_SUCCESS)
 181                     fprintf(stdout, "Could not initialize gpio %d\n", pin);
 182             } else {
 183                 print_command_error();
 184             }
 185         } else if ((strcmp(argv[1], "get") == 0) || (strcmp(argv[1], "getraw") == 0)) {
 186             if (argc == 3) {
 187                 int pin = atoi(argv[2]);
 188                 int level;
 189                 mraa_boolean_t rawmode = strcmp(argv[1], "getraw") == 0;
 190                 if (gpio_get(pin, &level, rawmode) == MRAA_SUCCESS) {
 191                     fprintf(stdout, "Pin %d = %d\n", pin, level);
 192                 } else {
 193                     fprintf(stdout, "Could not initialize gpio %d\n", pin);
 194                 }
 195             } else {
 196                 print_command_error();
 197             }
 198         } else if (strcmp(argv[1], "monitor") == 0) {
 199             if (argc == 3) {
 200                 int pin = atoi(argv[2]);
 201                 struct gpio_source gpio_info;
 202                 gpio_info.pin = pin;
 203                 if (gpio_isr_start(&gpio_info) == MRAA_SUCCESS) {
 204                     fprintf(stdout, "Monitoring level changes to pin %d. Press RETURN to exit.\n", pin);
 205                     gpio_isr_handler(&gpio_info);
 206                     while (getchar() != '\n')
 207                         ;
 208                     gpio_isr_stop(&gpio_info);
 209                 } else {
 210                     fprintf(stdout, "Failed to register ISR for pin %d\n", pin);
 211                 }
 212             } else {
 213                 print_command_error();
 214             }
 215         } else {
 216             print_command_error();
 217         }
 218     }
 219     return 0;
 220 }