Raspberry Pi Forums

Code: Select all

#define GPIO_BASE 0x22000000
#define BLOCK_SIZE (4 * 1024)
bool PiGPIO::setupio()
{
    if((mem_fd = open("/dev/mem", O_RDWR | O_SYNC)) < 0) return false; // this succeeds when run as root

    gpio_map = (char *) mmap(
                             NULL,
                             BLOCK_SIZE,
                             PROT_READ | PROT_WRITE,
                             mem_fd,
                             GPIO_BASE); // always fails with errno 11 (EAGAIN -- Resource temporarily unavailable)
 // etc
}

Code: Select all

#include <stdio.h>
#include <unistd.h>
#include <stdint.h>
#include <fcntl.h>
#include <sys/mman.h>
#include <sys/stat.h>
#include <sys/types.h>

#define GPIO_BASE 0x20200000
#define GPIO_LEN  0xB4

#define GPLEV0    13
#define GPLEV1    14

static volatile uint32_t  * gpioReg = MAP_FAILED;

int gpioSetMode(unsigned gpio, unsigned mode)
{
   int reg, shift;

   reg   =  gpio/10;
   shift = (gpio%10) * 3;

   gpioReg[reg] = (gpioReg[reg] & ~(7<<shift)) | (mode<<shift);

   return 0;
}

int gpioGetMode(unsigned gpio)
{
   int reg, shift;

   reg   =  gpio/10;
   shift = (gpio%10) * 3;

   return (*(gpioReg + reg) >> shift) & 7;
}

uint32_t gpioRead_Bits_0_31(void) { return (*(gpioReg + GPLEV0)); }
uint32_t gpioRead_Bits_32_53(void) { return (*(gpioReg + GPLEV1)); }

main()
{
   int fd;

   fd = open("/dev/mem", O_RDWR | O_SYNC) ;

   gpioReg = mmap(0,
                  GPIO_LEN,
                  PROT_READ|PROT_WRITE|PROT_EXEC,
                  MAP_SHARED|MAP_LOCKED,
                  fd,
                  GPIO_BASE);

   close(fd);

   if (gpioReg != MAP_FAILED)
   {
      gpioSetMode(0,  0); /* mode value for input */
      gpioSetMode(1,  0); /* mode value for input */
      gpioSetMode(28, 4); /* mode value for alt0 */
      gpioSetMode(29, 4); /* mode value for alt0 */
   }
   else fprintf(stderr, "map failed\n");
}