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 int
  63 list_platform_pins(uint8_t platform_offset)
  64 {
  65     int pin_count = mraa_get_platform_pin_count(platform_offset);
  66     int i;
  67     for (i = 0; i < pin_count; ++i) {
  68         if (strcmp(mraa_get_pin_name(i), "INVALID") != 0) {
  69             int pin_id = platform_offset > 0 ? mraa_get_sub_platform_id(i) : i;
  70             fprintf(stdout, "%02d ", pin_id);
  71             fprintf(stdout, "%*s: ", (MRAA_PIN_NAME_SIZE - 1), mraa_get_pin_name(i));
  72             if (mraa_pin_mode_test(i, MRAA_PIN_GPIO))
  73                 fprintf(stdout, "GPIO ");
  74             if (mraa_pin_mode_test(i, MRAA_PIN_I2C))
  75                 fprintf(stdout, "I2C  ");
  76             if (mraa_pin_mode_test(i, MRAA_PIN_SPI))
  77                 fprintf(stdout, "SPI  ");
  78             if (mraa_pin_mode_test(i, MRAA_PIN_PWM))
  79                 fprintf(stdout, "PWM  ");
  80             if (mraa_pin_mode_test(i, MRAA_PIN_AIO))
  81                 fprintf(stdout, "AIO  ");
  82             if (mraa_pin_mode_test(i, MRAA_PIN_UART))
  83                 fprintf(stdout, "UART ");
  84             fprintf(stdout, "\n");
  85         }
  86     }
  87     return pin_count;
  88 }
  89
  90 int
  91 list_pins()
  92 {
  93     int pin_count = 0;
  94     pin_count += list_platform_pins(MRAA_MAIN_PLATFORM_OFFSET);
  95     pin_count += list_platform_pins(MRAA_SUB_PLATFORM_OFFSET);
  96     if (pin_count == 0) {
  97         fprintf(stdout, "No Pins\n");
  98     }
  99 }
 100
 101
 102 mraa_result_t
 103 gpio_set(int pin, int level, mraa_boolean_t raw)
 104 {
 105     mraa_gpio_context gpio = mraa_gpio_init(pin);
 106     if (gpio != NULL) {
 107         mraa_gpio_dir(gpio, MRAA_GPIO_OUT);
 108         if (raw != 0) {
 109             if (mraa_gpio_use_mmaped(gpio, 1) != MRAA_SUCCESS) {
 110                 fprintf(stdout,
 111                         "mmapped access to gpio %d not supported, falling back to normal mode\n", pin);
 112             }
 113         }
 114         mraa_gpio_write(gpio, level);
 115         return MRAA_SUCCESS;
 116     }
 117     return MRAA_ERROR_INVALID_RESOURCE;
 118 }
 119
 120 mraa_result_t
 121 gpio_get(int pin, int* level, mraa_boolean_t raw)
 122 {
 123     mraa_gpio_context gpio = mraa_gpio_init(pin);
 124     if (gpio != NULL) {
 125         mraa_gpio_dir(gpio, MRAA_GPIO_IN);
 126         if (raw != 0) {
 127             if (mraa_gpio_use_mmaped(gpio, 1) != MRAA_SUCCESS) {
 128                 fprintf(stdout,
 129                         "mmapped access to gpio %d not supported, falling back to normal mode\n", pin);
 130             }
 131         }
 132         *level = mraa_gpio_read(gpio);
 133         return MRAA_SUCCESS;
 134     }
 135     return MRAA_ERROR_INVALID_RESOURCE;
 136 }
 137
 138
 139 void
 140 gpio_isr_handler(void* args)
 141 {
 142     struct gpio_source* gpio_info = (struct gpio_source*) args;
 143     int level = mraa_gpio_read(gpio_info->context);
 144     fprintf(stdout, "Pin %d = %d\n", gpio_info->pin, level);
 145 }
 146
 147 mraa_result_t
 148 gpio_isr_start(struct gpio_source* gpio_info)
 149 {
 150     gpio_info->context = mraa_gpio_init(gpio_info->pin);
 151     if (gpio_info->context != NULL) {
 152         mraa_result_t status = mraa_gpio_dir(gpio_info->context, MRAA_GPIO_IN);
 153         if (status == MRAA_SUCCESS) {
 154             status = mraa_gpio_isr(gpio_info->context, MRAA_GPIO_EDGE_BOTH, &gpio_isr_handler, gpio_info);
 155         }
 156         return status;
 157     } else {
 158         return MRAA_ERROR_INVALID_RESOURCE;
 159     }
 160 }
 161
 162
 163 mraa_result_t
 164 gpio_isr_stop(struct gpio_source* gpio_info)
 165 {
 166     mraa_gpio_isr_exit(gpio_info->context);
 167     mraa_gpio_close(gpio_info->context);
 168     return MRAA_SUCCESS;
 169 }
 170
 171
 172 int
 173 main(int argc, char** argv)
 174 {
 175     if (argc == 1) {
 176         print_command_error();
 177     }
 178
 179     if (argc > 1) {
 180         if (strcmp(argv[1], "list") == 0) {
 181             list_pins();
 182         } else if (strcmp(argv[1], "help") == 0) {
 183             print_help();
 184         } else if (strcmp(argv[1], "version") == 0) {
 185             print_version();
 186         } else if ((strcmp(argv[1], "set") == 0) || (strcmp(argv[1], "setraw") == 0)) {
 187             if (argc == 4) {
 188                 int pin = atoi(argv[2]);
 189                 mraa_boolean_t rawmode = strcmp(argv[1], "setraw") == 0;
 190                 if (gpio_set(pin, atoi(argv[3]), rawmode) != MRAA_SUCCESS)
 191                     fprintf(stdout, "Could not initialize gpio %d\n", pin);
 192             } else {
 193                 print_command_error();
 194             }
 195         } else if ((strcmp(argv[1], "get") == 0) || (strcmp(argv[1], "getraw") == 0)) {
 196             if (argc == 3) {
 197                 int pin = atoi(argv[2]);
 198                 int level;
 199                 mraa_boolean_t rawmode = strcmp(argv[1], "getraw") == 0;
 200                 if (gpio_get(pin, &level, rawmode) == MRAA_SUCCESS) {
 201                     fprintf(stdout, "Pin %d = %d\n", pin, level);
 202                 } else {
 203                     fprintf(stdout, "Could not initialize gpio %d\n", pin);
 204                 }
 205             } else {
 206                 print_command_error();
 207             }
 208         } else if (strcmp(argv[1], "monitor") == 0) {
 209             if (argc == 3) {
 210                 int pin = atoi(argv[2]);
 211                 struct gpio_source gpio_info;
 212                 gpio_info.pin = pin;
 213                 if (gpio_isr_start(&gpio_info) == MRAA_SUCCESS) {
 214                     fprintf(stdout, "Monitoring level changes to pin %d. Press RETURN to exit.\n", pin);
 215                     gpio_isr_handler(&gpio_info);
 216                     char aux = 0;
 217                     do {
 218                         fflush(stdin);
 219                         fscanf(stdin, "%c", &aux);
 220                     } while (aux != '\n');
 221                     gpio_isr_stop(&gpio_info);
 222                 } else {
 223                     fprintf(stdout, "Failed to register ISR for pin %d\n", pin);
 224                 }
 225             } else {
 226                 print_command_error();
 227             }
 228         } else {
 229             print_command_error();
 230         }
 231     }
 232     return 0;
 233 }