Macintosh-HW
/
RASCSI
mirror of https://github.com/akuker/RASCSI.git
1
0
Fork 0
Code Issues Projects Releases Wiki Activity
RASCSI/cpp/hal/gpiobus_allwinner.cpp

1039 lines
35 KiB
C++
Raw Blame History

//---------------------------------------------------------------------------
//
// SCSI Target Emulator RaSCSI Reloaded
// for Raspberry Pi (And Banana Pi)
//
// Copyright (c) 2012-2015 Ben Croston
// Copyright (C) 2022 akuker
//
// Large portions of this functionality were derived from c_gpio.c, which
// is part of the RPI.GPIO library available here:
// https://github.com/BPI-SINOVOIP/RPi.GPIO/blob/master/source/c_gpio.c
//
// Permission is hereby granted, free of charge, to any person obtaining a copy of
// this software and associated documentation files (the "Software"), to deal in
// the Software without restriction, including without limitation the rights to
// use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies
// of the Software, and to permit persons to whom the Software is furnished to do
// so, subject to the following conditions:
//
// The above copyright notice and this permission notice shall be included in all
// copies or substantial portions of the Software.
//
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
// IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
// FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
// AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
// LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
// OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
// SOFTWARE.
//
//---------------------------------------------------------------------------
#include <iomanip>
#include <memory>
#include <sstream>
#include <string.h>
#include <sys/epoll.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
#include "hal/gpiobus.h"
#include "hal/gpiobus_allwinner.h"
#include "hal/pi_defs/bpi-gpio.h"
#include "hal/systimer.h"
#include "log.h"
extern int wiringPiMode;
#pragma GCC diagnostic push
#pragma GCC diagnostic ignored "-Wunused-variable"
#pragma GCC diagnostic ignored "-Wunused-parameter"
// #pragma GCC diagnostic ignored "-Wformat-truncation"
#define GPIO_BANK(pin) ((pin) >> 5)
#define GPIO_NUM(pin) ((pin)&0x1F)
#define GPIO_CFG_INDEX(pin) (((pin)&0x1F) >> 3)
#define GPIO_CFG_OFFSET(pin) ((((pin)&0x1F) & 0x7) << 2)
#define GPIO_PUL_INDEX(pin) (((pin)&0x1F) >> 4)
#define GPIO_PUL_OFFSET(pin) (((pin)&0x0F) << 1)
#define GPIO_DRV_INDEX(pin) (((pin)&0x1F) >> 4)
#define GPIO_DRV_OFFSET(pin) (((pin)&0x0F) << 1)
#define SUNXI_R_GPIO_BASE 0x01F02000
#define SUNXI_R_GPIO_REG_OFFSET 0xC00
#define SUNXI_GPIO_BASE 0x01C20000
#define SUNXI_GPIO_REG_OFFSET 0x800
#define SUNXI_CFG_OFFSET 0x00
#define SUNXI_DATA_OFFSET 0x10
#define SUNXI_PUD_OFFSET 0x1C
#define SUNXI_BANK_SIZE 0x24
#define MAP_SIZE (4096 * 2)
#define MAP_MASK (MAP_SIZE - 1)
// TODO: Delete these. They're just to make things compile for now
int pinToGpio_BPI_M1P[64] = {0};
int pinToGpio_BPI_M2[64] = {0};
int pinToGpio_BPI_M2M[64] = {0};
int pinToGpio_BPI_M2M_1P1[64] = {0};
int pinToGpio_BPI_M2P[64] = {0};
int pinToGpio_BPI_M2U[64] = {0};
int pinToGpio_BPI_M3[64] = {0};
int pinToGpio_BPI_M64[64] = {0};
int pinTobcm_BPI_M1P[64] = {0};
int pinTobcm_BPI_M2[64] = {0};
int pinTobcm_BPI_M2M[64] = {0};
int pinTobcm_BPI_M2M_1P1[64] = {0};
int pinTobcm_BPI_M2P[64] = {0};
int pinTobcm_BPI_M2U[64] = {0};
int pinTobcm_BPI_M3[64] = {0};
int pinTobcm_BPI_M64[64] = {0};
// #define BCM2708_PERI_BASE_DEFAULT 0x20000000
// #define BCM2709_PERI_BASE_DEFAULT 0x3f000000
// #define GPIO_BASE_OFFSET 0x200000
#define FSEL_OFFSET 0 // 0x0000
#define SET_OFFSET 7 // 0x001c / 4
#define CLR_OFFSET 10 // 0x0028 / 4
#define PINLEVEL_OFFSET 13 // 0x0034 / 4
#define EVENT_DETECT_OFFSET 16 // 0x0040 / 4
#define RISING_ED_OFFSET 19 // 0x004c / 4
#define FALLING_ED_OFFSET 22 // 0x0058 / 4
#define HIGH_DETECT_OFFSET 25 // 0x0064 / 4
#define LOW_DETECT_OFFSET 28 // 0x0070 / 4
#define PULLUPDN_OFFSET 37 // 0x0094 / 4
#define PULLUPDNCLK_OFFSET 38 // 0x0098 / 4
#define PAGE_SIZE (4 * 1024)
#define BLOCK_SIZE (4 * 1024)
// BpiBoardsType bpiboard[];
GPIOBUS_Allwinner::BpiBoardsType GPIOBUS_Allwinner::bpiboard[] = {
{"bpi-0", -1, 0, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-1", -1, 1, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-2", -1, 2, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-3", -1, 3, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-4", -1, 4, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-5", -1, 5, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-6", -1, 6, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-7", -1, 7, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-8", -1, 8, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-9", -1, 9, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-10", -1, 10, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-11", -1, 11, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-12", -1, 12, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-13", -1, 13, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-14", -1, 14, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-15", -1, 15, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-new", -1, 16, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-x86", -1, 17, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-rpi", -1, 18, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-rpi2", -1, 19, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-rpi3", -1, 20, 1, 2, 5, 0, NULL, NULL, NULL},
{"bpi-m1", 10001, 21, 1, 2, 5, 0, pinToGpio_BPI_M1P, physToGpio_BPI_M1P, pinTobcm_BPI_M1P},
{"bpi-m1p", 10001, 22, 1, 2, 5, 0, pinToGpio_BPI_M1P, physToGpio_BPI_M1P, pinTobcm_BPI_M1P},
{"bpi-r1", 10001, 23, 1, 2, 5, 0, pinToGpio_BPI_M1P, physToGpio_BPI_M1P, pinTobcm_BPI_M1P},
{"bpi-m2", 10101, 24, 1, 2, 5, 0, pinToGpio_BPI_M2, physToGpio_BPI_M2, pinTobcm_BPI_M2},
{"bpi-m3", 10201, 25, 1, 3, 5, 0, pinToGpio_BPI_M3, physToGpio_BPI_M3, pinTobcm_BPI_M3},
{"bpi-m2p", 10301, 26, 1, 2, 5, 0, pinToGpio_BPI_M2P, physToGpio_BPI_M2P, pinTobcm_BPI_M2P},
{"bpi-m64", 10401, 27, 1, 3, 5, 0, pinToGpio_BPI_M64, physToGpio_BPI_M64, pinTobcm_BPI_M64},
{"bpi-m2u", 10501, 28, 1, 3, 5, 0, pinToGpio_BPI_M2U, physToGpio_BPI_M2U, pinTobcm_BPI_M2U},
{"bpi-m2m", 10601, 29, 1, 1, 5, 0, pinToGpio_BPI_M2M, physToGpio_BPI_M2M, pinTobcm_BPI_M2M},
{"bpi-m2p_H2+", 10701, 30, 1, 2, 5, 0, pinToGpio_BPI_M2P, physToGpio_BPI_M2P, pinTobcm_BPI_M2P},
{"bpi-m2p_H5", 10801, 31, 1, 2, 5, 0, pinToGpio_BPI_M2P, physToGpio_BPI_M2P, pinTobcm_BPI_M2P},
{"bpi-m2u_V40", 10901, 32, 1, 3, 5, 0, pinToGpio_BPI_M2U, physToGpio_BPI_M2U, pinTobcm_BPI_M2U},
{"bpi-m2z", 11001, 33, 1, 1, 5, 0, pinToGpio_BPI_M2P, physToGpio_BPI_M2P, pinTobcm_BPI_M2P},
// { "bpi-r2", 11101, 34, 1, 3, 5, 0, pinToGpio_BPI_R2, physToGpio_BPI_R2, pinTobcm_BPI_R2 },
{NULL, 0, 0, 1, 2, 5, 0, NULL, NULL, NULL},
};
std::vector<int> gpio_banks;
bool GPIOBUS_Allwinner::Init(mode_e mode, board_type::rascsi_board_type_e rascsi_type)
{
GPIOBUS::Init(mode, rascsi_type);
SysTimer::Init();
sbc_version = SBC_Version::GetSbcVersion();
phys_to_gpio_map = BPI_GPIO::GetBpiGpioMapping(sbc_version);
for (auto const &pair : phys_to_gpio_map->phys_to_gpio_map) {
LOGDEBUG("{ %d, : %d}", (int)pair.first, pair.second)
int phys_pin = (int)pair.first;
if (phys_pin < 0) {
continue;
}
int gpio_num = pair.second;
int gpio_bank = GPIO_BANK(gpio_num);
if (std::find(gpio_banks.begin(), gpio_banks.end(), gpio_bank) != gpio_banks.end()) {
LOGTRACE("Duplicate bank: %d", gpio_bank)
} else {
LOGDEBUG("New bank: %d", gpio_bank);
gpio_banks.push_back(gpio_bank);
}
}
for (auto const &pair : phys_to_gpio_map->phys_to_gpio_map) {
LOGDEBUG("{ %d, : %d}", (int)pair.first, pair.second)
}
if (int result = sunxi_setup(); result != SETUP_OK) {
return false;
}
SaveGpioConfig();
if (!SetupSelEvent()) {
LOGERROR("Failed to setup SELECT poll event");
return false;
}
LOGINFO("SetupSelEvent OK!")
DrvConfig(3);
// usleep(5000000);
InitializeGpio();
return true;
}
void GPIOBUS_Allwinner::Cleanup()
{
GPIO_FUNCTION_TRACE
#if defined(__x86_64__) || defined(__X86__)
return;
#else
SetENB(false);
SetACT(false);
RestoreGpioConfig();
munmap((void *)gpio_map, BLOCK_SIZE);
munmap((void *)r_gpio_map, BLOCK_SIZE);
// Release SEL signal interrupt
#ifdef USE_SEL_EVENT_ENABLE
close(selevreq.fd);
#endif // USE_SEL_EVENT_ENABLE
#endif
}
void GPIOBUS_Allwinner::SaveGpioConfig()
{
saved_gpio_config.resize(14);
for (auto this_bank : gpio_banks) {
int bank = this_bank;
if (this_bank < 11) {
// std::vector<sunxi_gpio_t> saved_gpio_config;
memcpy(&(saved_gpio_config[bank]), &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank],
sizeof(sunxi_gpio_t));
} else {
bank -= 11;
memcpy(&(saved_gpio_config[bank]), &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank],
sizeof(sunxi_gpio_t));
}
}
}
void GPIOBUS_Allwinner::RestoreGpioConfig()
{
for (auto this_bank : gpio_banks) {
int bank = this_bank;
if (this_bank < 11) {
// std::vector<sunxi_gpio_t> saved_gpio_config;
memcpy(&((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank], &(saved_gpio_config[bank]),
sizeof(sunxi_gpio_t));
} else {
bank -= 11;
memcpy(&((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank], &(saved_gpio_config[bank]),
sizeof(sunxi_gpio_t));
}
}
}
bool GPIOBUS_Allwinner::SetupSelEvent()
{
int gpio_pin = phys_to_gpio_map->phys_to_gpio_map.at(board->pin_sel);
// GPIO chip open
LOGTRACE("%s GPIO chip open Pin: %d [GPIO %d]", __PRETTY_FUNCTION__, (int)board->pin_sel, gpio_pin);
std::string gpio_dev = "/dev/gpiochip0";
if (GPIO_BANK(gpio_pin) >= 11) {
gpio_dev = "/dev/gpiochip1";
LOGWARN("gpiochip1 support isn't implemented yet....");
LOGWARN("THIS PROBABLY WONT WORK!");
}
int gpio_fd = open(gpio_dev.c_str(), 0);
if (gpio_fd == -1) {
LOGERROR("Unable to open /dev/gpiochip0. Is RaSCSI already running?")
return false;
}
// Event request setting
LOGTRACE("%s Event request setting (pin sel: %d)", __PRETTY_FUNCTION__, gpio_pin);
strcpy(selevreq.consumer_label, "RaSCSI");
selevreq.lineoffset = gpio_pin;
selevreq.handleflags = GPIOHANDLE_REQUEST_INPUT;
#if SIGNAL_CONTROL_MODE < 2
selevreq.eventflags = GPIOEVENT_REQUEST_FALLING_EDGE;
LOGTRACE("%s eventflags = GPIOEVENT_REQUEST_FALLING_EDGE", __PRETTY_FUNCTION__);
#else
selevreq.eventflags = GPIOEVENT_REQUEST_RISING_EDGE;
LOGTRACE("%s eventflags = GPIOEVENT_REQUEST_RISING_EDGE", __PRETTY_FUNCTION__);
#endif // SIGNAL_CONTROL_MODE
// Get event request
if (ioctl(gpio_fd, GPIO_GET_LINEEVENT_IOCTL, &selevreq) == -1) {
LOGERROR("selevreq.fd = %d %08X", selevreq.fd, (unsigned int)selevreq.fd);
LOGERROR("Unable to register event request. Is RaSCSI already running?")
LOGERROR("[%08X] %s", errno, strerror(errno));
close(gpio_fd);
return false;
}
// Close GPIO chip file handle
LOGTRACE("%s Close GPIO chip file handle", __PRETTY_FUNCTION__);
close(gpio_fd);
// epoll initialization
LOGTRACE("%s epoll initialization", __PRETTY_FUNCTION__);
epfd = epoll_create(1);
if (epfd == -1) {
LOGERROR("Unable to create the epoll event");
return false;
}
epoll_event ev = {};
memset(&ev, 0, sizeof(ev));
ev.events = EPOLLIN | EPOLLPRI;
ev.data.fd = selevreq.fd;
if (epoll_ctl(epfd, EPOLL_CTL_ADD, selevreq.fd, &ev) < 0) {
return false;
}
return true;
// // GPIO chip open
// LOGTRACE("%s GPIO chip open", __PRETTY_FUNCTION__);
// int gpio_fd = open("/dev/gpiochip0", 0);
// if (gpio_fd == -1) {
// LOGERROR("Unable to open /dev/gpiochip0. Is RaSCSI already running?")
// return false;
// }
// // Event request setting
// LOGTRACE("%s Event request setting (pin sel: %d)", __PRETTY_FUNCTION__, phys_to_gpio_map.at(board->pin_sel));
// strcpy(selevreq.consumer_label, "RaSCSI");
// selevreq.lineoffset = phys_to_gpio_map->phys_to_gpio_map.at(board->pin_sel);
// selevreq.handleflags = GPIOHANDLE_REQUEST_INPUT;
// #if SIGNAL_CONTROL_MODE < 2
// selevreq.eventflags = GPIOEVENT_REQUEST_FALLING_EDGE;
// LOGTRACE("%s eventflags = GPIOEVENT_REQUEST_FALLING_EDGE", __PRETTY_FUNCTION__);
// #else
// selevreq.eventflags = GPIOEVENT_REQUEST_RISING_EDGE;
// LOGTRACE("%s eventflags = GPIOEVENT_REQUEST_RISING_EDGE", __PRETTY_FUNCTION__);
// #endif // SIGNAL_CONTROL_MODE
// // Get event request
// if (ioctl(gpio_fd, GPIO_GET_LINEEVENT_IOCTL, &selevreq) == -1) {
// LOGERROR("selevreq.fd = %d %08X", selevreq.fd, (unsigned int)selevreq.fd);
// LOGERROR("Unable to register event request. Is RaSCSI already running?")
// LOGERROR("[%08X] %s", errno, strerror(errno));
// close(gpio_fd);
// return false;
// }
// // Close GPIO chip file handle
// LOGTRACE("%s Close GPIO chip file handle", __PRETTY_FUNCTION__);
// close(gpio_fd);
// // epoll initialization
// LOGTRACE("%s epoll initialization", __PRETTY_FUNCTION__);
// epfd = epoll_create(1);
// if (epfd == -1) {
// LOGERROR("Unable to create the epoll event");
// return false;
// }
// memset(&ev, 0, sizeof(ev));
// ev.events = EPOLLIN | EPOLLPRI;
// ev.data.fd = selevreq.fd;
// epoll_ctl(epfd, EPOLL_CTL_ADD, selevreq.fd, &ev);
}
uint8_t GPIOBUS_Allwinner::GetDAT()
{
static uint8_t prev_data = 0;
// LOGWARN("%s NOT IMPLEMENTED", __PRETTY_FUNCTION__)
LOGINFO("0:%02X 1:%02X 2:%02X 3:%02X 4:%02X 5:%02X 6:%02X 7:%02X P:%02X", GetSignal(board->pin_dt0),
GetSignal(board->pin_dt1), GetSignal(board->pin_dt2), GetSignal(board->pin_dt3), GetSignal(board->pin_dt4),
GetSignal(board->pin_dt5), GetSignal(board->pin_dt6), GetSignal(board->pin_dt7), GetSignal(board->pin_dp));
// TODO: This is crazy inefficient...
uint8_t data = ((GetSignal(board->pin_dt0) ? 0x01 : 0x00) << 0) | ((GetSignal(board->pin_dt1) ? 0x01 : 0x00) << 1) |
((GetSignal(board->pin_dt2) ? 0x01 : 0x00) << 2) | ((GetSignal(board->pin_dt3) ? 0x01 : 0x00) << 3) |
((GetSignal(board->pin_dt4) ? 0x01 : 0x00) << 4) | ((GetSignal(board->pin_dt5) ? 0x01 : 0x00) << 5) |
((GetSignal(board->pin_dt6) ? 0x01 : 0x00) << 6) | ((GetSignal(board->pin_dt7) ? 0x01 : 0x00) << 7);
if (prev_data != data) {
LOGINFO("Data %02X", data);
prev_data = data;
}
return (uint8_t)data;
// return 0;
}
void GPIOBUS_Allwinner::SetDAT(uint8_t dat)
{
// TODO: This is crazy inefficient...
PinSetSignal(board->pin_dt0, (dat & (1 << 0)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
PinSetSignal(board->pin_dt1, (dat & (1 << 1)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
PinSetSignal(board->pin_dt2, (dat & (1 << 2)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
PinSetSignal(board->pin_dt3, (dat & (1 << 3)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
PinSetSignal(board->pin_dt4, (dat & (1 << 4)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
PinSetSignal(board->pin_dt5, (dat & (1 << 5)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
PinSetSignal(board->pin_dt6, (dat & (1 << 6)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
PinSetSignal(board->pin_dt7, (dat & (1 << 7)) != 0 ? board_type::gpio_high_low_e::GPIO_STATE_HIGH
: board_type::gpio_high_low_e::GPIO_STATE_LOW);
}
void GPIOBUS_Allwinner::MakeTable(void)
{
LOGWARN("%s NOT IMPLEMENTED", __PRETTY_FUNCTION__)
}
void GPIOBUS_Allwinner::SetControl(board_type::pi_physical_pin_e pin, board_type::gpio_high_low_e ast)
{
GPIO_FUNCTION_TRACE
if ((int)pin < 0) {
return;
}
GPIOBUS_Allwinner::SetSignal(pin, ast);
// LOGWARN("%s NOT IMPLEMENTED", __PRETTY_FUNCTION__)
}
void GPIOBUS_Allwinner::SetMode(board_type::pi_physical_pin_e pin, board_type::gpio_direction_e mode)
{
GPIO_FUNCTION_TRACE
int gpio_num = phys_to_gpio_map->phys_to_gpio_map.at(pin);
int sunxi_gpio_direction = (mode == board_type::gpio_direction_e::GPIO_INPUT) ? INPUT : OUTPUT;
sunxi_setup_gpio(gpio_num, sunxi_gpio_direction, -1);
// LOGWARN("%s NOT IMPLEMENTED", __PRETTY_FUNCTION__)
// if(mode == board_type::gpio_high_low_e::GPIO_INPUT){
// pinMode(pin, INPUT);
// }else{
// pinMode(pin, OUTPUT);
// }
// LOGWARN("%s NOT IMPLEMENTED", __PRETTY_FUNCTION__)
}
bool GPIOBUS_Allwinner::GetSignal(board_type::pi_physical_pin_e pin) const
{
GPIO_FUNCTION_TRACE
int gpio_num = phys_to_gpio_map->phys_to_gpio_map.at(pin);
// int sunxi_gpio_state = sunxi_input_gpio(gpio_num);
uint32_t regval = 0;
int bank = GPIO_BANK(gpio_num); // gpio >> 5
int num = GPIO_NUM(gpio_num); // gpio & 0x1F
LOGDEBUG("%s gpio(%d) bank(%d) num(%d)", __PRETTY_FUNCTION__, (int)gpio, (int)bank, (int)num);
regval = (signals[bank] >> num) & 0x1;
return regval != 0;
// sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
// /* DK, for PL and PM */
// if (bank >= 11) {
// bank -= 11;
// pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
// }
// regval = *(&pio->DAT);
// regval = regval >> num;
// regval &= 1;
// int sunxi_gpio_state = regval;
// LOGDEBUG("%s GPIO %d is set to %d", __PRETTY_FUNCTION__, gpio_num, sunxi_gpio_state);
// if (sunxi_gpio_state == LOW) {
// return true;
// } else {
// return false;
// }
// return (digitalRead(pin) != 0);
}
void GPIOBUS_Allwinner::SetSignal(board_type::pi_physical_pin_e pin, board_type::gpio_high_low_e ast)
{
GPIO_FUNCTION_TRACE
LOGTRACE("pin(%d) ast(%d)", (int)pin, (int)ast)
int gpio_num = phys_to_gpio_map->phys_to_gpio_map.at(pin);
int sunxi_gpio_state = (ast == board_type::gpio_high_low_e::GPIO_STATE_HIGH) ? HIGH : LOW;
LOGTRACE("gpio(%d) sunxi_state(%d)", gpio_num, sunxi_gpio_state)
// sunxi_output_gpio(gpio_num, sunxi_gpio_state);
int bank = GPIO_BANK(gpio_num); // gpio >> 5
int num = GPIO_NUM(gpio_num); // gpio & 0x1F
// LOGDEBUG("%s gpio(%d) bank(%d) num(%d) value(%d)", __PRETTY_FUNCTION__, gpio, bank, num, value)
// LOGTRACE("pio_map: %p", pio_map)
// LOGTRACE("pio_map->gpio_bank: %p", &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[0])
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
// LOGTRACE("pio: %p", pio)
/* DK, for PL and PM */
if (bank >= 11) {
LOGTRACE("bank > 11");
bank -= 11;
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
}
if (sunxi_gpio_state == 0)
*(&pio->DAT) &= ~(1 << num);
else
*(&pio->DAT) |= (1 << num);
}
//---------------------------------------------------------------------------
//
// Wait for signal change
//
// TODO: maybe this should be moved to SCSI_Bus?
//---------------------------------------------------------------------------
bool GPIOBUS_Allwinner::WaitSignal(board_type::pi_physical_pin_e hw_pin, board_type::gpio_high_low_e ast)
{
LOGERROR("%s not implemented!!", __PRETTY_FUNCTION__)
// Get current time
uint32_t now = SysTimer::GetTimerLow();
// Calculate timeout (3000ms)
uint32_t timeout = 3000 * 1000;
// end immediately if the signal has changed
do {
// Immediately upon receiving a reset
Acquire();
if (GetRST()) {
return false;
}
// Check for the signal edge
if (((GetSignal(hw_pin)) ^ !board->gpio_state_to_bool(ast)) == true) {
return true;
}
} while ((SysTimer::GetTimerLow() - now) < timeout);
// We timed out waiting for the signal
return false;
}
void GPIOBUS_Allwinner::DisableIRQ()
{
LOGERROR("%s not implemented!!", __PRETTY_FUNCTION__)
}
void GPIOBUS_Allwinner::EnableIRQ()
{
LOGERROR("%s not implemented!!", __PRETTY_FUNCTION__)
}
void GPIOBUS_Allwinner::PinConfig(board_type::pi_physical_pin_e pin, board_type::gpio_direction_e mode)
{
GPIO_FUNCTION_TRACE
int gpio_num = 0;
try {
gpio_num = phys_to_gpio_map->phys_to_gpio_map.at(pin);
} catch (const std::out_of_range &e) {
LOGERROR("%s %d is not a valid pin", __PRETTY_FUNCTION__, (int)pin);
}
int sunxi_direction = (mode == board_type::gpio_direction_e::GPIO_INPUT) ? INPUT : OUTPUT;
sunxi_setup_gpio(gpio_num, sunxi_direction, -1);
// if(mode == board_type::gpio_high_low_e::GPIO_INPUT){
// pinMode(pin, INPUT);
// }else{
// pinMode(pin, OUTPUT);
// }
}
void GPIOBUS_Allwinner::PullConfig(board_type::pi_physical_pin_e pin, board_type::gpio_pull_up_down_e mode)
{
GPIO_FUNCTION_TRACE
#ifndef __arm__
(void)
pin;
(void)mode;
return;
#else
// Note: this will throw an exception if an invalid pin is specified
int gpio_num = phys_to_gpio_map->phys_to_gpio_map.at(pin);
int pull_up_down_state = 0;
switch (mode) {
case board_type::gpio_pull_up_down_e::GPIO_PULLNONE:
pull_up_down_state = PUD_OFF;
break;
case board_type::gpio_pull_up_down_e::GPIO_PULLUP:
pull_up_down_state = PUD_UP;
break;
case board_type::gpio_pull_up_down_e::GPIO_PULLDOWN:
pull_up_down_state = PUD_DOWN;
break;
default:
LOGERROR("%s INVALID PIN MODE", __PRETTY_FUNCTION__);
return;
}
uint32_t regval = 0;
int bank = GPIO_BANK(gpio_num); // gpio >> 5
int index = GPIO_PUL_INDEX(gpio_num); // (gpio & 0x1f) >> 4
int offset = GPIO_PUL_OFFSET(gpio_num); // (gpio) & 0x0F) << 1
LOGDEBUG("%s gpio(%d) bank(%d) index(%d) offset(%d)", __PRETTY_FUNCTION__, gpio_num, bank, index, offset)
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
/* DK, for PL and PM */
if (bank >= 11) {
bank -= 11;
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
}
regval = *(&pio->PULL[0] + index);
regval &= ~(3 << offset);
regval |= pull_up_down_state << offset;
*(&pio->PULL[0] + index) = regval;
#endif
}
void GPIOBUS_Allwinner::PinSetSignal(board_type::pi_physical_pin_e pin, board_type::gpio_high_low_e ast)
{
GPIO_FUNCTION_TRACE
int gpio_num = -1;
try {
gpio_num = phys_to_gpio_map->phys_to_gpio_map.at(pin);
} catch (const std::out_of_range &e) {
LOGERROR("%s %d is not a valid pin", __PRETTY_FUNCTION__, (int)pin);
exit(1);
}
int sunxi_gpio_state = (ast == board_type::gpio_high_low_e::GPIO_STATE_HIGH) ? HIGH : LOW;
sunxi_output_gpio(gpio_num, sunxi_gpio_state);
// digitalWrite(pin, ast);
// LOGERROR("%s not implemented!!", __PRETTY_FUNCTION__)
}
void GPIOBUS_Allwinner::DrvConfig(uint32_t drive)
{
GPIO_FUNCTION_TRACE
// #ifndef __arm__
// (void)drive;
// return;
// #else
for (auto hw_pin : phys_to_gpio_map->phys_to_gpio_map) {
if (hw_pin.first == board_type::pi_physical_pin_e::PI_PHYS_PIN_NONE) {
continue;
}
int gpio = hw_pin.second;
LOGTRACE("Configuring HW Pin %d [GPIO %d] to drive strength %d", (int)hw_pin.first, gpio, drive);
uint32_t regval = 0;
int bank = GPIO_BANK(gpio); // gpio >> 5
int index = GPIO_DRV_INDEX(gpio); // (gpio & 0x1F) >> 3
int offset = GPIO_DRV_OFFSET(gpio); // ((gpio & 0x1F) & 0x7) << 2
LOGDEBUG("%s gpio(%d) bank(%d) index(%d) offset(%d)", __PRETTY_FUNCTION__, gpio, bank, index, offset)
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
/* DK, for PL and PM */
if (bank >= 11) {
bank -= 11;
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
}
// Get current register value
regval = *(&pio->DRV[0] + index);
// Clear the DRV value for that gpio
regval &= ~(0x7 << offset); // 0xf?
// Set the new DRV strength
regval |= (drive & 0b11) << offset;
// Save back to the register
*(&pio->DRV[0] + index) = regval;
}
// #endif // if __arm__
}
uint32_t GPIOBUS_Allwinner::Acquire()
{
// (void)sunxi_capture_all_gpio();
// uint32_t GPIOBUS_Allwinner::sunxi_capture_all_gpio()
// {
GPIO_FUNCTION_TRACE
uint32_t value = 0;
for (auto bank : gpio_banks) {
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
/* DK, for PL and PM */
if (bank >= 11) {
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[(bank - 11)];
}
uint32_t regval = *(&pio->DAT);
signals[bank] = regval;
// LOGDEBUG("Bank %d value %08X", bank, regval);
}
// return value;
return 0;
}
#pragma GCC diagnostic pop
uint32_t GPIOBUS_Allwinner::sunxi_readl(volatile uint32_t *addr)
{
GPIO_FUNCTION_TRACE
#ifndef __arm__
(void)
addr;
return 0;
#else
printf("sunxi_readl\n");
uint32_t val = 0;
uint32_t mmap_base = (uint32_t)addr & (~MAP_MASK);
uint32_t mmap_seek = ((uint32_t)addr - mmap_base) >> 2;
val = *(gpio_map + mmap_seek);
return val;
#endif
}
void GPIOBUS_Allwinner::sunxi_writel(volatile uint32_t *addr, uint32_t val)
{
GPIO_FUNCTION_TRACE
#ifndef __arm__
(void)
addr;
(void)val;
return;
#else
printf("sunxi_writel\n");
uint32_t mmap_base = (uint32_t)addr & (~MAP_MASK);
uint32_t mmap_seek = ((uint32_t)addr - mmap_base) >> 2;
*(gpio_map + mmap_seek) = val;
#endif
}
int GPIOBUS_Allwinner::sunxi_setup(void)
{
GPIO_FUNCTION_TRACE
#ifndef __arm__
return SETUP_MMAP_FAIL;
#else
int mem_fd;
uint8_t *gpio_mem;
// uint8_t *r_gpio_mem;
// uint32_t peri_base;
// uint32_t gpio_base;
// unsigned char buf[4];
// FILE *fp;
// char buffer[1024];
// char hardware[1024];
// int found = 0;
// mmap the GPIO memory registers
if ((mem_fd = open("/dev/mem", O_RDWR | O_SYNC)) < 0) {
LOGERROR("Error: Unable to open /dev/mem. Are you running as root?")
LOGDEBUG("errno: [%08X] %s", errno, strerror(errno));
return SETUP_DEVMEM_FAIL;
}
if ((gpio_mem = (uint8_t *)malloc(BLOCK_SIZE + (PAGE_SIZE - 1))) == NULL) {
LOGERROR("Error: Unable to allocate gpio memory. Are you running as root?")
LOGDEBUG("errno: [%08X] %s", errno, strerror(errno));
return SETUP_DEVMEM_FAIL;
}
if ((uint32_t)gpio_mem % PAGE_SIZE)
gpio_mem += PAGE_SIZE - ((uint32_t)gpio_mem % PAGE_SIZE);
gpio_map = (uint32_t *)mmap((caddr_t)gpio_mem, BLOCK_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED | MAP_FIXED, mem_fd,
SUNXI_GPIO_BASE);
if ((void *)gpio_map == MAP_FAILED) {
LOGERROR("Error: Unable to map gpio memory. Are you running as root?")
LOGDEBUG("errno: [%08X] %s", errno, strerror(errno));
return SETUP_MMAP_FAIL;
}
pio_map = gpio_map + (SUNXI_GPIO_REG_OFFSET >> 2);
LOGTRACE("gpio_mem[%p] gpio_map[%p] pio_map[%p]", gpio_mem, gpio_map, pio_map)
// R_PIO GPIO LMN
r_gpio_map =
(uint32_t *)mmap((caddr_t)0, BLOCK_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, mem_fd, SUNXI_R_GPIO_BASE);
if ((void *)r_gpio_map == MAP_FAILED) {
LOGERROR("Error: Unable to map r_gpio memory. Are you running as root?")
LOGDEBUG("errno: [%08X] %s", errno, strerror(errno));
return SETUP_MMAP_FAIL;
}
r_pio_map = r_gpio_map + (SUNXI_R_GPIO_REG_OFFSET >> 2);
LOGTRACE("r_gpio_map[%p] r_pio_map[%p]", r_gpio_map, r_pio_map)
close(mem_fd);
return SETUP_OK;
#endif
}
void GPIOBUS_Allwinner::sunxi_setup_gpio(int gpio, int direction, int pud)
{
GPIO_FUNCTION_TRACE
#ifndef __arm__
(void)
gpio;
(void)direction;
(void)pud;
return;
#else
uint32_t regval = 0;
int bank = GPIO_BANK(gpio); // gpio >> 5
int index = GPIO_CFG_INDEX(gpio); // (gpio & 0x1F) >> 3
int offset = GPIO_CFG_OFFSET(gpio); // ((gpio & 0x1F) & 0x7) << 2
LOGDEBUG("%s gpio(%d) bank(%d) index(%d) offset(%d)", __PRETTY_FUNCTION__, gpio, bank, index, offset)
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
/* DK, for PL and PM */
if (bank >= 11) {
bank -= 11;
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
}
if (pud != -1) {
set_pullupdn(gpio, pud);
}
regval = *(&pio->CFG[0] + index);
regval &= ~(0x7 << offset); // 0xf?
if (INPUT == direction) {
*(&pio->CFG[0] + index) = regval;
} else if (OUTPUT == direction) {
regval |= (1 << offset);
*(&pio->CFG[0] + index) = regval;
} else {
LOGERROR("line:%dgpio number error\n", __LINE__);
}
#endif
}
// Contribution by Eric Ptak <trouch@trouch.com>
int GPIOBUS_Allwinner::sunxi_gpio_function(int gpio)
{
GPIO_FUNCTION_TRACE
uint32_t regval = 0;
int bank = GPIO_BANK(gpio); // gpio >> 5
int index = GPIO_CFG_INDEX(gpio); // (gpio & 0x1F) >> 3
int offset = GPIO_CFG_OFFSET(gpio); // ((gpio & 0x1F) & 0x7) << 2
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
/* DK, for PL and PM */
if (bank >= 11) {
bank -= 11;
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
}
regval = *(&pio->CFG[0] + index);
regval >>= offset;
regval &= 7;
return regval; // 0=input, 1=output, 4=alt0
}
void GPIOBUS_Allwinner::sunxi_output_gpio(int gpio, int value)
{
GPIO_FUNCTION_TRACE
int bank = GPIO_BANK(gpio); // gpio >> 5
int num = GPIO_NUM(gpio); // gpio & 0x1F
// LOGDEBUG("%s gpio(%d) bank(%d) num(%d) value(%d)", __PRETTY_FUNCTION__, gpio, bank, num, value)
// LOGTRACE("pio_map: %p", pio_map)
// LOGTRACE("pio_map->gpio_bank: %p", &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[0])
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
// LOGTRACE("pio: %p", pio)
/* DK, for PL and PM */
if (bank >= 11) {
LOGTRACE("bank > 11");
bank -= 11;
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
}
if (value == 0)
*(&pio->DAT) &= ~(1 << num);
else
*(&pio->DAT) |= (1 << num);
}
int GPIOBUS_Allwinner::sunxi_input_gpio(int gpio) const
{
GPIO_FUNCTION_TRACE
uint32_t regval = 0;
int bank = GPIO_BANK(gpio); // gpio >> 5
int num = GPIO_NUM(gpio); // gpio & 0x1F
// LOGDEBUG("%s gpio(%d) bank(%d) num(%d)", __PRETTY_FUNCTION__, gpio, bank, num);
sunxi_gpio_t *pio = &((sunxi_gpio_reg_t *)pio_map)->gpio_bank[bank];
/* DK, for PL and PM */
if (bank >= 11) {
bank -= 11;
pio = &((sunxi_gpio_reg_t *)r_pio_map)->gpio_bank[bank];
}
regval = *(&pio->DAT);
regval = regval >> num;
regval &= 1;
return regval;
}
int GPIOBUS_Allwinner::bpi_piGpioLayout(void)
{
GPIO_FUNCTION_TRACE
FILE *bpiFd;
char buffer[1024];
char hardware[1024];
struct BPIBoards *board = nullptr;
static int gpioLayout = -1;
if (gpioLayout != -1) // No point checking twice
return gpioLayout;
bpi_found = 0; // -1: not init, 0: init but not found, 1: found
if ((bpiFd = fopen("/var/lib/bananapi/board.sh", "r")) == NULL) {
return -1;
}
while (!feof(bpiFd)) {
// TODO: check the output of fgets()
char *ret = fgets(buffer, sizeof(buffer), bpiFd);
(void)ret;
sscanf(buffer, "BOARD=%s", hardware);
LOGDEBUG("BPI: buffer[%s] hardware[%s]\n", buffer, hardware);
// Search for board:
for (board = bpiboard; board->name != NULL; ++board) {
LOGDEBUG("BPI: name[%s] hardware[%s]\n", board->name, hardware);
if (strcmp(board->name, hardware) == 0) {
// gpioLayout = board->gpioLayout;
gpioLayout = board->model; // BPI: use model to replace gpioLayout
LOGDEBUG("BPI: name[%s] gpioLayout(%d)\n", board->name, gpioLayout);
if (gpioLayout >= 21) {
bpi_found = 1;
break;
}
}
}
if (bpi_found == 1) {
break;
}
}
fclose(bpiFd);
LOGDEBUG("BPI: name[%s] gpioLayout(%d)\n", board->name, gpioLayout);
return gpioLayout;
}
// int GPIOBUS_Allwinner::bpi_get_rpi_info(rpi_info *info)
// {
// struct BPIBoards *board=bpiboard;
// static int gpioLayout = -1 ;
// char ram[64];
// char manufacturer[64];
// char processor[64];
// char type[64];
// gpioLayout = bpi_piGpioLayout () ;
// printf("BPI: gpioLayout(%d)\n", gpioLayout);
// if(bpi_found == 1) {
// board = &bpiboard[gpioLayout];
// printf("BPI: name[%s] gpioLayout(%d)\n",board->name, gpioLayout);
// sprintf(ram, "%dMB", piMemorySize [board->mem]);
// sprintf(type, "%s", piModelNames [board->model]);
// //add by jackzeng
// //jude mtk platform
// if(strcmp(board->name, "bpi-r2") == 0){
// bpi_found_mtk = 1;
// printf("found mtk board\n");
// }
// sprintf(manufacturer, "%s", piMakerNames [board->maker]);
// info->p1_revision = 3;
// info->type = type;
// info->ram = ram;
// info->manufacturer = manufacturer;
// if(bpi_found_mtk == 1){
// info->processor = "MTK";
// }else{
// info->processor = "Allwinner";
// }
// strcpy(info->revision, "4001");
// // pin_to_gpio = board->physToGpio ;
// pinToGpio_BP = board->pinToGpio ;
// physToGpio_BP = board->physToGpio ;
// pinTobcm_BP = board->pinTobcm ;
// //printf("BPI: name[%s] bType(%d) model(%d)\n",board->name, bType, board->model);
// return 0;
// }
// return -1;
// }
void GPIOBUS_Allwinner::set_pullupdn(int gpio, int pud)
{
GPIO_FUNCTION_TRACE
int clk_offset = PULLUPDNCLK_OFFSET + (gpio / 32);
int shift = (gpio % 32);
#ifdef BPI
if (bpi_found == 1) {
gpio = *(pinTobcm_BP + gpio);
return sunxi_set_pullupdn(gpio, pud);
}
#endif
if (pud == PUD_DOWN)
*(gpio_map + PULLUPDN_OFFSET) = (*(gpio_map + PULLUPDN_OFFSET) & ~3) | PUD_DOWN;
else if (pud == PUD_UP)
*(gpio_map + PULLUPDN_OFFSET) = (*(gpio_map + PULLUPDN_OFFSET) & ~3) | PUD_UP;
else // pud == PUD_OFF
*(gpio_map + PULLUPDN_OFFSET) &= ~3;
short_wait();
*(gpio_map + clk_offset) = 1 << shift;
short_wait();
*(gpio_map + PULLUPDN_OFFSET) &= ~3;
*(gpio_map + clk_offset) = 0;
}
void GPIOBUS_Allwinner::short_wait(void)
{
GPIO_FUNCTION_TRACE
int i;
for (i = 0; i < 150; i++) { // wait 150 cycles
asm volatile("nop");
}
}
Reference in New Issue View Git Blame Copy Permalink