|
|
/*
|
|
|
* This programmer uses AT91' GPIO lines
|
|
|
*
|
|
|
* 2006 by Carlos Camargo
|
|
|
* 2007.May.10 Andres Calderon
|
|
|
* 2009.Aug.26 Jose Francisco Quenta
|
|
|
*/
|
|
|
|
|
|
#include <stdint.h>
|
|
|
#include <stdlib.h>
|
|
|
#include <stdio.h>
|
|
|
#include <unistd.h>
|
|
|
|
|
|
|
|
|
#include <sys/types.h>
|
|
|
#include <sys/stat.h>
|
|
|
#include <sys/mman.h>
|
|
|
#include <fcntl.h>
|
|
|
|
|
|
#include "./Librerias/AT91gpio_Funciones.h"
|
|
|
|
|
|
void pio_out(AT91S_PIO * pio, int mask, unsigned long val, int opcion)
|
|
|
{
|
|
|
if (opcion == 1)
|
|
|
pio->PIO_SODR = mask & val;
|
|
|
else
|
|
|
pio->PIO_CODR = mask & val;
|
|
|
}
|
|
|
|
|
|
|
|
|
int pio_in(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
return (pio->PIO_PDSR & mask);
|
|
|
}
|
|
|
|
|
|
|
|
|
AT91S_PIO *pio_map(unsigned int piobase)
|
|
|
{
|
|
|
int fd;
|
|
|
void *base;
|
|
|
|
|
|
AT91S_PIO *pio;
|
|
|
|
|
|
off_t addr = piobase;
|
|
|
|
|
|
if ((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1) {
|
|
|
fprintf(stderr, "Cannot open /dev/mem.\n");
|
|
|
exit(EXIT_FAILURE);
|
|
|
}
|
|
|
|
|
|
fprintf(stderr, "/dev/mem opened.\n");
|
|
|
|
|
|
base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, addr & ~MAP_MASK);
|
|
|
|
|
|
if (base == (void *) -1) {
|
|
|
fprintf(stderr, "Cannot open /dev/mem.\n");
|
|
|
exit(EXIT_FAILURE);
|
|
|
}
|
|
|
|
|
|
fprintf(stderr, "Memory mapped at address %p.\n", base);
|
|
|
|
|
|
pio = base + (addr & MAP_MASK);
|
|
|
|
|
|
return pio;
|
|
|
}
|
|
|
|
|
|
|
|
|
void pio_enable(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
pio->PIO_PER = mask; /* Enable PIO */
|
|
|
}
|
|
|
|
|
|
void pio_output_enable(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
pio->PIO_OER = mask; /* Set TDI, TMS and TCK as outputs */
|
|
|
}
|
|
|
|
|
|
void pio_input_enable(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
pio->PIO_ODR = mask; /* Set TDO as input */
|
|
|
pio->PIO_IFER = mask; /* Enable Input Filter */
|
|
|
}
|
|
|
|
|
|
void pio_disable_irq(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
pio->PIO_IDR = mask; /* Disable pin interrupts */
|
|
|
}
|
|
|
|
|
|
void pio_disable_multiple_driver(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
pio->PIO_MDDR = mask; /* Disable Multiple Diver */
|
|
|
}
|
|
|
|
|
|
void pio_disable_pull_ups(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
pio->PIO_PUDR = mask; /* Disable Pull-Ups */
|
|
|
}
|
|
|
|
|
|
void pio_synchronous_data_output(AT91S_PIO * pio, int mask)
|
|
|
{
|
|
|
pio->PIO_OWDR = mask; /* Synchronous Data Output Write in PIO_ */
|
|
|
}
|
|
|
|
