|
|
@@ -0,0 +1,634 @@ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* */ |
|
|
|
/* WiringPi KHADAS VIM3 Board control file */ |
|
|
|
/* */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
#include <stdio.h> |
|
|
|
#include <stdlib.h> |
|
|
|
#include <stdint.h> |
|
|
|
#include <unistd.h> |
|
|
|
#include <errno.h> |
|
|
|
#include <fcntl.h> |
|
|
|
#include <sys/ioctl.h> |
|
|
|
#include <asm/ioctl.h> |
|
|
|
#include <sys/mman.h> |
|
|
|
#include <sys/utsname.h> |
|
|
|
#include <string.h> |
|
|
|
|
|
|
|
#include "softPwm.h" |
|
|
|
#include "softTone.h" |
|
|
|
#include "wiringPi.h" |
|
|
|
#include "khadas_vim3.h" |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* WiringPi gpio map define */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
|
|
|
|
static const int pinToGpio_rev[64] = { |
|
|
|
//wiringPi number to native gpio number |
|
|
|
-1,353, // 0 | 1 : | GPIOAO_3 |
|
|
|
-1, -1, // 2 | 3 : | |
|
|
|
-1,301, // 4 | 5 : | GPIOA_1 |
|
|
|
303, -1, // 6 | 7 : GPIOA_3 | |
|
|
|
-1, -1, // 8 | 9 : | |
|
|
|
302,304, // 10 | 11 : GPIOA_2 | GPIOA_4 |
|
|
|
-1, -1, // 12 | 13 : | |
|
|
|
-1, -1, // 14 | 15 : | |
|
|
|
352, -1, // 16 | 17 : GPIOAO_2 | |
|
|
|
-1, -1, // 18 | 19 : | |
|
|
|
-1,326, // 20 | 21 : | GPIOH_6 |
|
|
|
327, -1, // 22 | 23 : GPIOH_7 | |
|
|
|
351,350, // 24 | 25 : GPIOAO_1 | GPIOAO_0 |
|
|
|
-1, -1, // 26 | 27 : | |
|
|
|
-1, -1, // 28 | 29 : | |
|
|
|
-1, -1, // 30 | 31 : | |
|
|
|
// Padding: |
|
|
|
-1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, //32to47 |
|
|
|
-1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, //48to63 |
|
|
|
|
|
|
|
}; |
|
|
|
|
|
|
|
static const int phyToGpio_rev[64] = { |
|
|
|
//physical header pin number to native gpio number |
|
|
|
-1, // 0 |
|
|
|
-1, -1, // 1 | 21 : 5V | GND |
|
|
|
-1, -1, // 2 | 22 : 5V | GPIOA_15 |
|
|
|
-1, -1, // 3 | 23 : USB_DM | GPIOA_14 |
|
|
|
-1, -1, // 4 | 24 : USB_DP | GND |
|
|
|
-1,352, // 5 | 25 : GND | GPIOAO_2 |
|
|
|
-1,353, // 6 | 26 : MCU3.3 | GPIOAO_3 |
|
|
|
-1, -1, // 7 | 27 : MCUNrST | 3.3V |
|
|
|
-1, -1, // 8 | 28 : MCUSWIM | GND |
|
|
|
-1,301, // 9 | 29 : GND | GPIOA_1 |
|
|
|
-1, -1, // 10 | 30 : ADC0 | GPIOA_0 |
|
|
|
-1,303, // 11 | 31 : 1.8V | GPIOA_3 |
|
|
|
-1,302, // 12 | 32 : ADC1 | GPIOA_2 |
|
|
|
-1,304, // 13 | 33 : SPDIF | GPIOA_4 |
|
|
|
-1, -1, // 14 | 34 : GND | GND |
|
|
|
326, -1, // 15 | 35 : (GPIOH_6)UART_RX_AO_B | PWM-F |
|
|
|
327, -1, // 16 | 36 : (GPIOH_7)UART_TX_AO_B | RTC_CLK |
|
|
|
-1, -1, // 17 | 37 : GND | GPIOH_4 |
|
|
|
351, -1, // 18 | 38 : (GPIOAO_1)Linux_RX | MCUFA_1 |
|
|
|
350, -1, // 19 | 39 : (GPIOAO_0)Linux_TX | GPIOZ_15 |
|
|
|
-1, -1, // 20 | 40 : 3.3V | GND |
|
|
|
//Not used |
|
|
|
-1, -1, -1, -1, -1, -1, -1, -1, -1, -1, |
|
|
|
-1, -1, -1, -1, -1, -1, -1, -1, -1, -1, |
|
|
|
-1, -1, -1, //41-63 |
|
|
|
}; |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* */ |
|
|
|
/* Global variable define */ |
|
|
|
/* */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* wiringPi Pinmap control array */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
const int *pinToGpio, *phyToGpio; |
|
|
|
|
|
|
|
/* ADC file descriptor */ |
|
|
|
static char *adcFds[2]; |
|
|
|
|
|
|
|
/* GPIO mmap control */ |
|
|
|
static volatile uint32_t *gpio,*gpio1; |
|
|
|
|
|
|
|
/* wiringPi Global library */ |
|
|
|
static struct libkhadas *lib = NULL; |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* Function prototype define */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
|
|
|
|
static int gpioToGPSETReg (int pin); |
|
|
|
static int gpioToGPLEVReg (int pin); |
|
|
|
static int gpioToPUENReg (int pin); |
|
|
|
static int gpioToPUPDReg (int pin); |
|
|
|
static int gpioToShiftReg (int pin); |
|
|
|
static int gpioToGPFSELReg (int pin); |
|
|
|
static int gpioToDSReg (int pin); |
|
|
|
static int gpioToMuxReg (int pin); |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* wiringPi core function */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
static int _getModeToGpio (int mode, int pin); |
|
|
|
static void _setPadDrive (int pin, int value); |
|
|
|
static void _getPadDrive (int pin); |
|
|
|
static void _pinMode (int pin, int mode); |
|
|
|
static int _getAlt (int pin); |
|
|
|
static int _getPUPD (int pin); |
|
|
|
static void _pullUpDnControl (int pin, int pud); |
|
|
|
static int _digitalRead (int pin); |
|
|
|
static void _digitalWrite (int pin, int value); |
|
|
|
static int _analogRead (int pin); |
|
|
|
static void _digitalWriteByte (const int value); |
|
|
|
static unsigned int _digitalReadByte (void); |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* board init function */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
static int init_gpio_mmap (void); |
|
|
|
static void init_adc_fds (void); |
|
|
|
void init_khadas_vim3(struct libkhadas *libwiring); |
|
|
|
|
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO Set regsiter */ |
|
|
|
/*--------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToGPSETReg (int pin) |
|
|
|
{ |
|
|
|
if(pin >= VIM3_GPIOA_PIN_START && pin <= VIM3_GPIOA_PIN_END) |
|
|
|
return VIM3_GPIOA_OUTP_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOH_PIN_START && pin <= VIM3_GPIOH_PIN_END) |
|
|
|
return VIM3_GPIOH_OUTP_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END) |
|
|
|
return VIM3_GPIOAO_OUTP_REG_OFFSET; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO Input regsiter */ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToGPLEVReg (int pin) |
|
|
|
{ |
|
|
|
if(pin >= VIM3_GPIOA_PIN_START && pin <= VIM3_GPIOA_PIN_END) |
|
|
|
return VIM3_GPIOA_INP_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOH_PIN_START && pin <= VIM3_GPIOH_PIN_END) |
|
|
|
return VIM3_GPIOH_INP_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END) |
|
|
|
return VIM3_GPIOAO_INP_REG_OFFSET; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO Pull up/down enable regsiter */ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToPUENReg(int pin) |
|
|
|
{ |
|
|
|
if(pin >= VIM3_GPIOA_PIN_START && pin <= VIM3_GPIOA_PIN_END) |
|
|
|
return VIM3_GPIOA_PUEN_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOH_PIN_START && pin <= VIM3_GPIOH_PIN_END) |
|
|
|
return VIM3_GPIOH_PUEN_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END) |
|
|
|
return VIM3_GPIOAO_PUEN_REG_OFFSET; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO Pull up/down regsiter */ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToPUPDReg(int pin) |
|
|
|
{ |
|
|
|
if(pin >= VIM3_GPIOA_PIN_START && pin <= VIM3_GPIOA_PIN_END) |
|
|
|
return VIM3_GPIOA_PUPD_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOH_PIN_START && pin <= VIM3_GPIOH_PIN_END) |
|
|
|
return VIM3_GPIOH_PUPD_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END) |
|
|
|
return VIM3_GPIOAO_PUPD_REG_OFFSET; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO bit */ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToShiftReg (int pin) |
|
|
|
{ |
|
|
|
if(pin >= VIM3_GPIOA_PIN_START && pin <= VIM3_GPIOA_PIN_END) |
|
|
|
return pin - VIM3_GPIOA_PIN_START; |
|
|
|
if(pin >= VIM3_GPIOH_PIN_START && pin <= VIM3_GPIOH_PIN_END) |
|
|
|
return pin - VIM3_GPIOH_PIN_START; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END) |
|
|
|
return pin - VIM3_GPIOAO_PIN_START; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO Function register */ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToGPFSELReg(int pin) |
|
|
|
{ |
|
|
|
if(pin >= VIM3_GPIOA_PIN_START && pin <= VIM3_GPIOA_PIN_END) |
|
|
|
return VIM3_GPIOA_FSEL_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOH_PIN_START && pin <= VIM3_GPIOH_PIN_END) |
|
|
|
return VIM3_GPIOH_FSEL_REG_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END) |
|
|
|
return VIM3_GPIOAO_FSEL_REG_OFFSET; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO Drive Strength register */ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToDSReg (int pin) |
|
|
|
{ |
|
|
|
if(pin >= VIM3_GPIOA_PIN_START && pin <= VIM3_GPIOA_PIN_END) |
|
|
|
return VIM3_GPIOA_DS_REG_5A_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOH_PIN_START && pin <= VIM3_GPIOH_PIN_END) |
|
|
|
return VIM3_GPIOH_DS_REG_3A_OFFSET; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END) |
|
|
|
return VIM3_GPIOAO_DS_REG_A_OFFSET; |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/* offset to the GPIO Pin Mux register */ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int gpioToMuxReg(int pin) |
|
|
|
{ |
|
|
|
switch(pin){ |
|
|
|
case VIM3_GPIOA_PIN_START ...VIM3_GPIOA_PIN_START + 7: |
|
|
|
return VIM3_GPIOA_MUX_D_REG_OFFSET; |
|
|
|
case VIM3_GPIOA_PIN_START + 8 ...VIM3_GPIOA_PIN_END: |
|
|
|
return VIM3_GPIOA_MUX_E_REG_OFFSET; |
|
|
|
case VIM3_GPIOH_PIN_START ...VIM3_GPIOH_PIN_END: |
|
|
|
return VIM3_GPIOH_MUX_B_REG_OFFSET; |
|
|
|
case VIM3_GPIOAO_PIN_START ...VIM3_GPIOAO_PIN_START + 7: |
|
|
|
return VIM3_GPIOAO_MUX_0_REG_OFFSET; |
|
|
|
case VIM3_GPIOAO_PIN_START + 8 ...VIM3_GPIOAO_PIN_END: |
|
|
|
return VIM3_GPIOAO_MUX_1_REG_OFFSET; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int _getModeToGpio(int mode, int pin) |
|
|
|
{ |
|
|
|
int retPin = -1; |
|
|
|
switch(mode){ |
|
|
|
/* Native gpio number */ |
|
|
|
case MODE_GPIO: |
|
|
|
retPin = pin; |
|
|
|
break; |
|
|
|
/* Native gpio number for sysfs */ |
|
|
|
case MODE_GPIO_SYS: |
|
|
|
retPin = lib->sysFds[pin] != -1 ? pin : -1; |
|
|
|
break; |
|
|
|
/* wiringPi number */ |
|
|
|
case MODE_PINS: |
|
|
|
retPin = pin < 64 ? pinToGpio[pin] : -1; |
|
|
|
break; |
|
|
|
/* header pin number */ |
|
|
|
case MODE_PHYS: |
|
|
|
retPin = pin < 64 ? phyToGpio[pin] : -1; |
|
|
|
break; |
|
|
|
default: |
|
|
|
msg(MSG_WARN, "%s : Unknown Mode %d\n", __func__, mode); |
|
|
|
return -1; |
|
|
|
} |
|
|
|
return retPin; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static void _setPadDrive(int pin, int value) |
|
|
|
{ |
|
|
|
int ds, shift; |
|
|
|
|
|
|
|
if(lib->mode == MODE_GPIO_SYS) |
|
|
|
return; |
|
|
|
|
|
|
|
if((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return; |
|
|
|
|
|
|
|
if(value < 0 || value > 3){ |
|
|
|
msg(MSG_WARN, "%s : Invalid value %d (Must be 0 ~ 3)\n", __func__, value); |
|
|
|
return; |
|
|
|
} |
|
|
|
|
|
|
|
ds = gpioToDSReg(pin); |
|
|
|
shift = gpioToShiftReg(pin); |
|
|
|
shift *= 2; |
|
|
|
|
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
*(gpio1 + ds) &= ~(0b11 << shift); |
|
|
|
*(gpio1 + ds) |= (value << shift); |
|
|
|
}else{ |
|
|
|
*(gpio + ds) &= ~(0b11 << shift); |
|
|
|
*(gpio + ds) |= (value << shift); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*-----------------------------------------------------------------------------------------*/ |
|
|
|
static void _getPadDrive(int pin) |
|
|
|
{ |
|
|
|
int ds, shift; |
|
|
|
|
|
|
|
if(lib->mode == MODE_GPIO_SYS) |
|
|
|
return; |
|
|
|
|
|
|
|
if((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return; |
|
|
|
|
|
|
|
ds = gpioToDSReg(pin); |
|
|
|
shift = gpioToShiftReg(pin); |
|
|
|
shift *= 2; |
|
|
|
|
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
return (*(gpio1 + ds) >> shift) & 0b11; |
|
|
|
}else{ |
|
|
|
return (*(gpio + ds) >> shift) & 0b11; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static void _pinMode(int pin, int mode) |
|
|
|
{ |
|
|
|
int fsel, shift, origPin = pin; |
|
|
|
|
|
|
|
if (lib->mode == MODE_GPIO_SYS) |
|
|
|
return; |
|
|
|
if ((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return; |
|
|
|
|
|
|
|
softPwmStop (origPin); |
|
|
|
softToneStop (origPin); |
|
|
|
|
|
|
|
fsel = gpioToGPFSELReg(pin); |
|
|
|
shift = gpioToShiftReg (pin); |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
switch (mode) { |
|
|
|
case INPUT: |
|
|
|
*(gpio1 + fsel) = (*(gpio1 + fsel) | (1 << shift)); |
|
|
|
break; |
|
|
|
case OUTPUT: |
|
|
|
*(gpio1 + fsel) = (*(gpio1 + fsel) & ~(1 << shift)); |
|
|
|
break; |
|
|
|
case SOFT_PWM_OUTPUT: |
|
|
|
softPwmCreate (pin, 0, 100); |
|
|
|
break; |
|
|
|
case SOFT_TONE_OUTPUT: |
|
|
|
softToneCreate (pin); |
|
|
|
break; |
|
|
|
default: |
|
|
|
msg(MSG_WARN, "%s : Unknown Mode %d\n", __func__, mode); |
|
|
|
break; |
|
|
|
} |
|
|
|
}else{ |
|
|
|
switch (mode) { |
|
|
|
case INPUT: |
|
|
|
*(gpio + fsel) = (*(gpio + fsel) | (1 << shift)); |
|
|
|
break; |
|
|
|
case OUTPUT: |
|
|
|
*(gpio + fsel) = (*(gpio + fsel) & ~(1 << shift)); |
|
|
|
break; |
|
|
|
case SOFT_PWM_OUTPUT: |
|
|
|
softPwmCreate (pin, 0, 100); |
|
|
|
break; |
|
|
|
case SOFT_TONE_OUTPUT: |
|
|
|
softToneCreate (pin); |
|
|
|
break; |
|
|
|
default: |
|
|
|
msg(MSG_WARN, "%s : Unknown Mode %d\n", __func__, mode); |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int _getAlt(int pin) |
|
|
|
{ |
|
|
|
int fsel, mux, shift, target, mode; |
|
|
|
|
|
|
|
if(lib->mode == MODE_GPIO_SYS) |
|
|
|
return 0; |
|
|
|
if ((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return 2; |
|
|
|
|
|
|
|
fsel = gpioToGPFSELReg(pin); |
|
|
|
mux = gpioToMuxReg(pin); |
|
|
|
target = shift = gpioToShiftReg(pin); |
|
|
|
|
|
|
|
while(target >= 8) { |
|
|
|
target -= 8; |
|
|
|
} |
|
|
|
|
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
mode = (*(gpio1 + mux) >> (target * 4)) & 0xF; |
|
|
|
return mode ? mode + 1 : (*(gpio1 + fsel) & (1 << shift)) ? 0 : 1; |
|
|
|
}else{ |
|
|
|
mode = (*(gpio + mux) >> (target * 4)) & 0xF; |
|
|
|
return mode ? mode + 1 : (*(gpio + fsel) & (1 << shift)) ? 0 : 1; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int _getPUPD(int pin) |
|
|
|
{ |
|
|
|
int puen, pupd, shift; |
|
|
|
|
|
|
|
if (lib->mode == MODE_GPIO_SYS) |
|
|
|
return -1; |
|
|
|
if ((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return -1; |
|
|
|
|
|
|
|
puen = gpioToPUENReg(pin); |
|
|
|
pupd = gpioToPUPDReg(pin); |
|
|
|
shift = gpioToShiftReg(pin); |
|
|
|
|
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
if(*(gpio1 + puen) & (1 << shift)){ |
|
|
|
return *(gpio1 + pupd) & (1 << shift) ? 1 : 2; |
|
|
|
}else{ |
|
|
|
return 0; |
|
|
|
} |
|
|
|
}else{ |
|
|
|
if(*(gpio + puen) & (1 << shift)){ |
|
|
|
return *(gpio + pupd) & (1 << shift) ? 1 : 2; |
|
|
|
}else{ |
|
|
|
return 0; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static void _pullUpDnControl(int pin, int pud) |
|
|
|
{ |
|
|
|
int shift = 0; |
|
|
|
if (lib->mode == MODE_GPIO_SYS) |
|
|
|
return; |
|
|
|
|
|
|
|
if ((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return; |
|
|
|
|
|
|
|
shift = gpioToShiftReg(pin); |
|
|
|
|
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
if(pud){ |
|
|
|
//Enable Pull/Pull-down resister |
|
|
|
*(gpio1 + gpioToPUENReg(pin)) = |
|
|
|
(*(gpio1 + gpioToPUENReg(pin)) | (1 << shift)); |
|
|
|
|
|
|
|
if (pud == PUD_UP) |
|
|
|
*(gpio1 + gpioToPUPDReg(pin)) = |
|
|
|
(*(gpio1 + gpioToPUPDReg(pin)) | (1 << shift)); |
|
|
|
|
|
|
|
else |
|
|
|
*(gpio1 + gpioToPUPDReg(pin)) = |
|
|
|
(*(gpio1 + gpioToPUPDReg(pin)) & ~(1 << shift)); |
|
|
|
}else //Disable Pull/Pull-down resister |
|
|
|
*(gpio1 + gpioToPUENReg(pin)) = |
|
|
|
(*(gpio1 + gpioToPUENReg(pin)) & ~(1 << shift)); |
|
|
|
}else{ |
|
|
|
if(pud){ |
|
|
|
//Enable Pull/Pull-down resister |
|
|
|
*(gpio + gpioToPUENReg(pin)) = |
|
|
|
(*(gpio + gpioToPUENReg(pin)) | (1 << shift)); |
|
|
|
|
|
|
|
if (pud == PUD_UP) |
|
|
|
*(gpio + gpioToPUPDReg(pin)) = |
|
|
|
(*(gpio + gpioToPUPDReg(pin)) | (1 << shift)); |
|
|
|
|
|
|
|
else |
|
|
|
*(gpio + gpioToPUPDReg(pin)) = |
|
|
|
(*(gpio + gpioToPUPDReg(pin)) & ~(1 << shift)); |
|
|
|
}else //Disable Pull/Pull-down resister |
|
|
|
*(gpio + gpioToPUENReg(pin)) = |
|
|
|
(*(gpio + gpioToPUENReg(pin)) & ~(1 << shift)); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int _digitalRead(int pin) |
|
|
|
{ |
|
|
|
char c; |
|
|
|
|
|
|
|
if (lib->mode == MODE_GPIO_SYS) { |
|
|
|
if (lib->sysFds[pin] == -1) |
|
|
|
return LOW; |
|
|
|
|
|
|
|
lseek(lib->sysFds[pin], 0L, SEEK_SET); |
|
|
|
read(lib->sysFds[pin], &c, 1); |
|
|
|
|
|
|
|
return (c=='0') ? LOW : HIGH; |
|
|
|
} |
|
|
|
|
|
|
|
if ((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return 0; |
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
if ((*(gpio1 + gpioToGPLEVReg(pin)) & (1 << gpioToShiftReg(pin))) != 0) |
|
|
|
return HIGH; |
|
|
|
else |
|
|
|
return LOW; |
|
|
|
}else{ |
|
|
|
if ((*(gpio + gpioToGPLEVReg(pin)) & (1 << gpioToShiftReg(pin))) != 0) |
|
|
|
return HIGH; |
|
|
|
else |
|
|
|
return LOW; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static void _digitalWrite(int pin, int value) |
|
|
|
{ |
|
|
|
if (lib->mode == MODE_GPIO_SYS) { |
|
|
|
if (lib->sysFds[pin] != -1) { |
|
|
|
if(value == LOW) |
|
|
|
write (lib->sysFds[pin], "0\n", 2); |
|
|
|
else |
|
|
|
write (lib->sysFds[pin], "1\n", 2); |
|
|
|
} |
|
|
|
return; |
|
|
|
} |
|
|
|
|
|
|
|
if ((pin = _getModeToGpio(lib->mode, pin)) < 0) |
|
|
|
return; |
|
|
|
|
|
|
|
if(pin >= VIM3_GPIOAO_PIN_START && pin <= VIM3_GPIOAO_PIN_END){ |
|
|
|
if (value == LOW) |
|
|
|
*(gpio1 + gpioToGPSETReg(pin)) &= ~(1 << gpioToShiftReg(pin)); |
|
|
|
else |
|
|
|
*(gpio1 + gpioToGPSETReg(pin)) |= (1 << gpioToShiftReg(pin)); |
|
|
|
}else{ |
|
|
|
if (value == LOW) |
|
|
|
*(gpio + gpioToGPSETReg(pin)) &= ~(1 << gpioToShiftReg(pin)); |
|
|
|
else |
|
|
|
*(gpio + gpioToGPSETReg(pin)) |= (1 << gpioToShiftReg(pin)); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int _analogRead (int pin) |
|
|
|
{ |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*-------------------------------------------------------------------------------------------*/ |
|
|
|
static void _digitalWriteByte(const int value) |
|
|
|
{ |
|
|
|
return; |
|
|
|
} |
|
|
|
static unsigned int _digitalReadByte (void) |
|
|
|
{ |
|
|
|
return -1; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static int init_gpio_mmap(void) |
|
|
|
{ |
|
|
|
int fd; |
|
|
|
|
|
|
|
/* GPIO mmap setup */ |
|
|
|
if(access("/dev/gpiomem",0) == 0){ |
|
|
|
if ((fd = open ("/dev/gpiomem", O_RDWR | O_SYNC | O_CLOEXEC) ) < 0) |
|
|
|
return msg (MSG_ERR, |
|
|
|
"wiringPiSetup: Unable to open /dev/gpiomem: %s\n", |
|
|
|
strerror (errno)); |
|
|
|
}else{ |
|
|
|
if (geteuid () != 0) |
|
|
|
return msg (MSG_ERR, |
|
|
|
"wiringPiSetup: Must be root. (Did you forget sudo?)\n"); |
|
|
|
|
|
|
|
if ((fd = open ("/dev/mem", O_RDWR | O_SYNC | O_CLOEXEC) ) < 0) |
|
|
|
return msg (MSG_ERR, |
|
|
|
"wiringPiSetup: Unable to open /dev/mem: %s\n", |
|
|
|
strerror (errno)); |
|
|
|
} |
|
|
|
gpio1 = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, |
|
|
|
MAP_SHARED, fd, VIM3_GPIOAO_BASE); |
|
|
|
gpio = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, |
|
|
|
MAP_SHARED, fd, VIM3_GPIO_BASE); |
|
|
|
if (((int32_t)gpio == -1) || ((int32_t)gpio1 == -1)) |
|
|
|
return msg (MSG_ERR, |
|
|
|
"wiringPiSetup: mmap (GPIO) failed: %s\n", |
|
|
|
strerror (errno)); |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
static void init_adc_fds(void) |
|
|
|
{ |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
void init_khadas_vim3(struct libkhadas *libwiring) |
|
|
|
{ |
|
|
|
init_gpio_mmap(); |
|
|
|
|
|
|
|
pinToGpio = pinToGpio_rev; |
|
|
|
phyToGpio = phyToGpio_rev; |
|
|
|
|
|
|
|
/* wiringPi core function initialize */ |
|
|
|
libwiring->getModeToGpio = _getModeToGpio; |
|
|
|
libwiring->setPadDrive = _setPadDrive; |
|
|
|
libwiring->getPadDrive = _getPadDrive; |
|
|
|
libwiring->pinMode = _pinMode; |
|
|
|
libwiring->getAlt = _getAlt; |
|
|
|
libwiring->getPUPD = _getPUPD; |
|
|
|
libwiring->pullUpDnControl = _pullUpDnControl; |
|
|
|
libwiring->digitalRead = _digitalRead; |
|
|
|
libwiring->digitalWrite = _digitalWrite; |
|
|
|
libwiring->analogRead = _analogRead; |
|
|
|
libwiring->digitalWriteByte = _digitalWriteByte; |
|
|
|
libwiring->digitalReadByte = _digitalReadByte; |
|
|
|
|
|
|
|
/* specify pin base number */ |
|
|
|
libwiring->pinBase = VIM3_GPIO_PIN_BASE; |
|
|
|
|
|
|
|
/* global variable setup */ |
|
|
|
lib = libwiring; |
|
|
|
} |
|
|
|
|
|
|
|
/*------------------------------------------------------------------------------------------*/ |
|
|
|
/*------------------------------------------------------------------------------------------*/ |