3106d0df2b
factor out common board structure initialisations to function Signed-off-by: Michael Geszkiewicz <micges@wp.pl>
131 lines
3.3 KiB
C
131 lines
3.3 KiB
C
//
|
|
// Copyright (C) 2013-2014 Michael Geszkiewicz
|
|
//
|
|
// This program is free software; you can redistribute it and/or modify
|
|
// it under the terms of the GNU General Public License as published by
|
|
// the Free Software Foundation; either version 2 of the License, or
|
|
// (at your option) any later version.
|
|
//
|
|
// This program is distributed in the hope that it will be useful,
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
// GNU General Public License for more details.
|
|
//
|
|
// You should have received a copy of the GNU General Public License
|
|
// along with this program; if not, write to the Free Software
|
|
// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
//
|
|
|
|
#ifdef __linux__
|
|
#include <time.h>
|
|
#elif _WIN32
|
|
#include <windows.h>
|
|
#endif
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include "types.h"
|
|
#include "common.h"
|
|
#include "eeprom.h"
|
|
|
|
#ifdef _WIN32
|
|
void init_io_library() {
|
|
InitializeWinIo();
|
|
}
|
|
|
|
void release_io_library() {
|
|
ShutdownWinIo();
|
|
}
|
|
|
|
u8 inb(u32 addr) {
|
|
u32 val;
|
|
GetPortVal((WORD) addr, &val, 1);
|
|
return val & 0xFF;
|
|
}
|
|
|
|
void outb(u8 data, u32 addr) {
|
|
SetPortVal((WORD) addr, (DWORD) data, 1);
|
|
}
|
|
|
|
u16 inw(u32 addr) {
|
|
u32 val;
|
|
GetPortVal((WORD) addr, &val, 2);
|
|
return val & 0xFFFF;
|
|
}
|
|
|
|
void outw(u16 data, u32 addr) {
|
|
SetPortVal((WORD) addr, (DWORD) data, 2);
|
|
}
|
|
|
|
u32 inl(u32 addr) {
|
|
u32 val;
|
|
GetPortVal((WORD) addr, &val, 4);
|
|
return val;
|
|
}
|
|
|
|
void outl(u32 data, u32 addr) {
|
|
SetPortVal((WORD) addr, (DWORD) data, 4);
|
|
}
|
|
|
|
void *map_memory(u32 base, u32 size, tagPhysStruct_t *phys) {
|
|
void *ptr;
|
|
|
|
memset(phys, 0, sizeof(tagPhysStruct_t));
|
|
phys->pvPhysAddress = (DWORD64)(DWORD32) base;
|
|
phys->dwPhysMemSizeInBytes = size;
|
|
|
|
ptr = MapPhysToLin(phys);
|
|
return ptr;
|
|
}
|
|
|
|
void *unmap_memory(tagPhysStruct_t *phys) {
|
|
UnmapPhysicalMemory(phys);
|
|
}
|
|
#endif
|
|
|
|
void sleep_ns(u64 nanoseconds) {
|
|
#ifdef __linux__
|
|
struct timespec tv, tvret;
|
|
|
|
tv.tv_sec = 0;
|
|
tv.tv_nsec = nanoseconds;
|
|
nanosleep(&tv, &tvret);
|
|
#elif _WIN32
|
|
Sleep(nanoseconds/1000/1000);
|
|
#endif
|
|
}
|
|
|
|
void show_formatted_size(u32 size) {
|
|
if (size < 1024) {
|
|
printf(" [size=%u]", size);
|
|
} else if (size < 1024*1024) {
|
|
printf(" [size=%uK]", size/1024);
|
|
} else if (size < 0x80000000) {
|
|
printf(" [size=%uM]", size/(1024*1024));
|
|
} else {
|
|
printf(" [size=%08X]", size);
|
|
}
|
|
}
|
|
|
|
void board_init_struct(board_t *board) {
|
|
memset(board, 0, sizeof(board_t));
|
|
board->llio.board = board;
|
|
board->llio.hm2.llio = &(board->llio);
|
|
}
|
|
|
|
void show_board_info(board_t *board) {
|
|
int i;
|
|
|
|
printf("Board info:\n");
|
|
if (board->flash_id > 0) {
|
|
printf(" Flash size: %s (id: 0x%02X)\n", eeprom_get_flash_type(board->flash_id), board->flash_id);
|
|
}
|
|
printf(" Connectors count: %d\n", board->llio.num_ioport_connectors);
|
|
printf(" Pins per connector: %d\n", board->llio.pins_per_connector);
|
|
printf(" Connectors names:");
|
|
for (i = 0; i < board->llio.num_ioport_connectors; i++) {
|
|
printf(" %s", board->llio.ioport_connector_name[i]);
|
|
}
|
|
printf("\n");
|
|
printf(" FPGA type: %s\n", board->llio.fpga_part_number);
|
|
printf(" Number of leds: %d\n", board->llio.num_leds);
|
|
}
|