mirror of
https://gitea.osmocom.org/sim-card/simtrace2.git
synced 2026-03-18 22:38:32 +03:00
Compare commits
4 Commits
0.2
...
christina/
| Author | SHA1 | Date | |
|---|---|---|---|
|
2a5debfec4 | ||
|
|
557e287feb | ||
|
|
899348ebbe | ||
|
|
442dc27bc9 |
14
.gitignore
vendored
14
.gitignore
vendored
@@ -7,15 +7,7 @@ cscope.out
|
|||||||
*/__pycache__
|
*/__pycache__
|
||||||
*.E
|
*.E
|
||||||
*.pyc
|
*.pyc
|
||||||
|
sam3s_example/mains/zwizwa_ccid.c
|
||||||
|
Baselibc
|
||||||
|
venv
|
||||||
tags
|
tags
|
||||||
*.hobj
|
|
||||||
*.o
|
|
||||||
*.a
|
|
||||||
*.lst
|
|
||||||
*.map
|
|
||||||
*.elf
|
|
||||||
*.size
|
|
||||||
*.bin
|
|
||||||
*.p
|
|
||||||
host/simtrace2-remsim
|
|
||||||
host/simtrace2-remsim-usb2udp
|
|
||||||
|
|||||||
@@ -34,34 +34,49 @@
|
|||||||
|
|
||||||
# Chip & board used for compilation
|
# Chip & board used for compilation
|
||||||
# (can be overriden by adding CHIP=chip and BOARD=board to the command-line)
|
# (can be overriden by adding CHIP=chip and BOARD=board to the command-line)
|
||||||
CHIP ?= sam3s4
|
CHIP = sam3s2
|
||||||
BOARD ?= qmod
|
BOARD = simtrace
|
||||||
|
|
||||||
# Defines which are the available memory targets for the SAM3S-EK board.
|
# Defines which are the available memory targets for the SAM3S-EK board.
|
||||||
MEMORIES ?= flash dfu
|
MEMORIES = flash
|
||||||
|
|
||||||
|
# Trace level used for compilation
|
||||||
|
# (can be overriden by adding TRACE_LEVEL=#number to the command-line)
|
||||||
|
# TRACE_LEVEL_DEBUG 5
|
||||||
|
# TRACE_LEVEL_INFO 4
|
||||||
|
# TRACE_LEVEL_WARNING 3
|
||||||
|
# TRACE_LEVEL_ERROR 2
|
||||||
|
# TRACE_LEVEL_FATAL 1
|
||||||
|
# TRACE_LEVEL_NO_TRACE 0
|
||||||
|
TRACE_LEVEL = 1
|
||||||
|
#FIXME: Remove this variable
|
||||||
|
NOAUTOCALLBACK=no
|
||||||
|
|
||||||
|
DEBUG_PHONE_SNIFF=0
|
||||||
|
|
||||||
|
#CFLAGS+=-DUSB_NO_DEBUG=1
|
||||||
|
|
||||||
|
# Optimization level, put in comment for debugging
|
||||||
|
OPTIMIZATION = -O0
|
||||||
|
|
||||||
# Output file basename
|
# Output file basename
|
||||||
APP ?= dfu
|
OUTPUT = project
|
||||||
|
|
||||||
# Output directories
|
# Output directories
|
||||||
OUTPUT = $(BOARD)-$(APP)
|
|
||||||
BIN = bin
|
BIN = bin
|
||||||
OBJ = obj/$(BOARD)
|
OBJ = obj
|
||||||
|
|
||||||
#-------------------------------------------------------------------------------
|
#-------------------------------------------------------------------------------
|
||||||
# Tools
|
# Tools
|
||||||
#-------------------------------------------------------------------------------
|
#-------------------------------------------------------------------------------
|
||||||
|
|
||||||
AT91LIB = ./atmel_softpack_libraries
|
AT91LIB_USB_COMMON_CORE_PATH = atmel_softpack_libraries/usb/common/core
|
||||||
|
AT91LIB_USB_CORE_PATH = atmel_softpack_libraries/usb/device/core
|
||||||
AT91LIB_USB_COMMON_CORE_PATH = $(AT91LIB)/usb/common/core
|
|
||||||
AT91LIB_USB_CORE_PATH = $(AT91LIB)/usb/device/core
|
|
||||||
AT91LIB_USB_DFU_PATH = $(AT91LIB)/usb/device/dfu
|
|
||||||
|
|
||||||
# Tool suffix when cross-compiling
|
# Tool suffix when cross-compiling
|
||||||
CROSS_COMPILE = arm-none-eabi-
|
CROSS_COMPILE = arm-none-eabi-
|
||||||
|
|
||||||
LIBS = -Wl,--start-group -lgcc -Wl,--end-group -nostdlib
|
LIBS = -Wl,--start-group -lgcc -lc -Wl,--end-group
|
||||||
|
|
||||||
# Compilation tools
|
# Compilation tools
|
||||||
CC = $(CROSS_COMPILE)gcc
|
CC = $(CROSS_COMPILE)gcc
|
||||||
@@ -72,73 +87,12 @@ OBJCOPY = $(CROSS_COMPILE)objcopy
|
|||||||
GDB = $(CROSS_COMPILE)gdb
|
GDB = $(CROSS_COMPILE)gdb
|
||||||
NM = $(CROSS_COMPILE)nm
|
NM = $(CROSS_COMPILE)nm
|
||||||
|
|
||||||
TOP=..
|
|
||||||
GIT_VERSION=$(shell $(TOP)/git-version-gen $(TOP)/.tarvers)
|
|
||||||
|
|
||||||
#-------------------------------------------------------------------------------
|
|
||||||
# Files
|
|
||||||
#-------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
# Directories where source files can be found
|
|
||||||
|
|
||||||
USB_PATHS = $(AT91LIB_USB_CORE_PATH) $(AT91LIB_USB_DFU_PATH) $(AT91LIB_USB_COMMON_CORE_PATH)
|
|
||||||
|
|
||||||
VPATH += $(USB_PATHS)
|
|
||||||
VPATH += $(AT91LIB)/libchip_sam3s/source/ $(AT91LIB)/libchip_sam3s/cmsis
|
|
||||||
VPATH += libboard/common/source libboard/$(BOARD)/source
|
|
||||||
VPATH += libcommon/source
|
|
||||||
VPATH += libosmocore/source
|
|
||||||
VPATH += apps/$(APP)
|
|
||||||
|
|
||||||
# Objects built from C source files
|
|
||||||
C_OSMOCORE = $(notdir $(wildcard libosmocore/source/*.c))
|
|
||||||
C_LIBCHIP = $(notdir $(wildcard $(AT91LIB)/libchip_sam3s/source/*.c) $(wildcard $(AT91LIB)/libchip_sam3s/cmsis/*.c))
|
|
||||||
|
|
||||||
C_LIBUSB = USBDescriptors.c USBRequests.c USBD.c USBDCallbacks.c USBDDriver.c USBDDriverCallbacks.c
|
|
||||||
C_LIBUSB_RT = dfu.c dfu_desc.c dfu_runtime.c
|
|
||||||
C_LIBUSB_DFU = dfu.c dfu_desc.c dfu_driver.c
|
|
||||||
C_LIBCOMMON = string.c stdio.c fputs.c req_ctx.c ringbuffer.c
|
|
||||||
|
|
||||||
C_BOARD = $(notdir $(wildcard libboard/common/source/*.c))
|
|
||||||
C_BOARD += $(notdir $(wildcard libboard/$(BOARD)/source/*.c))
|
|
||||||
|
|
||||||
C_APPLEVEL = $(notdir $(wildcard apps/$(APP)/*.c))
|
|
||||||
|
|
||||||
C_FILES = $(C_OSMOCORE) $(C_LIBCHIP) $(C_LIBUSB) $(C_LIBCOMMON) $(C_BOARD) $(C_APPLEVEL)
|
|
||||||
|
|
||||||
-include apps/$(APP)/Makefile
|
|
||||||
|
|
||||||
C_OBJECTS = $(C_FILES:%.c=%.o)
|
|
||||||
|
|
||||||
# Trace level used for compilation
|
|
||||||
# (can be overriden by adding TRACE_LEVEL=#number to the command-line)
|
|
||||||
# TRACE_LEVEL_DEBUG 5
|
|
||||||
# TRACE_LEVEL_INFO 4
|
|
||||||
# TRACE_LEVEL_WARNING 3
|
|
||||||
# TRACE_LEVEL_ERROR 2
|
|
||||||
# TRACE_LEVEL_FATAL 1
|
|
||||||
# TRACE_LEVEL_NO_TRACE 0
|
|
||||||
TRACE_LEVEL ?= 4
|
|
||||||
|
|
||||||
DEBUG_PHONE_SNIFF?=0
|
|
||||||
|
|
||||||
#CFLAGS+=-DUSB_NO_DEBUG=1
|
|
||||||
|
|
||||||
# Optimization level, put in comment for debugging
|
|
||||||
OPTIMIZATION ?= -Os
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
# Flags
|
# Flags
|
||||||
INCLUDES_USB = -I$(AT91LIB)/usb/include -I$(AT91LIB)
|
INCLUDES_USB = -Iatmel_softpack_libraries/usb/include
|
||||||
|
|
||||||
INCLUDES = $(INCLUDES_USB)
|
INCLUDES = -Iinclude_board -Iinclude_sam3s -Iinclude -Isrc_simtrace
|
||||||
INCLUDES += -I$(AT91LIB)/libchip_sam3s -I$(AT91LIB)/libchip_sam3s/include
|
INCLUDES += -Icmsis
|
||||||
INCLUDES += -I$(AT91LIB)/libchip_sam3s/cmsis
|
INCLUDES += $(INCLUDES_USB)
|
||||||
INCLUDES += -Ilibboard/common/include -Ilibboard/$(BOARD)/include
|
|
||||||
INCLUDES += -Ilibcommon/include
|
|
||||||
INCLUDES += -Ilibosmocore/include
|
|
||||||
INCLUDES += -Isrc_simtrace -Iinclude
|
|
||||||
|
|
||||||
CFLAGS += -Wall -Wchar-subscripts -Wcomment -Wimplicit-int #-Wformat=2
|
CFLAGS += -Wall -Wchar-subscripts -Wcomment -Wimplicit-int #-Wformat=2
|
||||||
CFLAGS += -Werror-implicit-function-declaration -Wmain -Wparentheses
|
CFLAGS += -Werror-implicit-function-declaration -Wmain -Wparentheses
|
||||||
@@ -151,26 +105,42 @@ CFLAGS += -Wmissing-format-attribute -Wno-deprecated-declarations
|
|||||||
CFLAGS += #-Wpacked
|
CFLAGS += #-Wpacked
|
||||||
CFLAGS += -Wredundant-decls -Wnested-externs -Winline #-Wlong-long
|
CFLAGS += -Wredundant-decls -Wnested-externs -Winline #-Wlong-long
|
||||||
CFLAGS += -Wunreachable-code
|
CFLAGS += -Wunreachable-code
|
||||||
#CFLAGS += -Wcast-align
|
CFLAGS += -Wcast-align
|
||||||
#CFLAGS += -std=c11
|
CFLAGS += -std=c11
|
||||||
CFLAGS += -Wmissing-noreturn
|
CFLAGS += -Wmissing-noreturn
|
||||||
#CFLAGS += -Wconversion
|
#CFLAGS += -Wconversion
|
||||||
CFLAGS += -Wno-unused-but-set-variable -Wno-unused-variable
|
CFLAGS += -Wno-unused-but-set-variable -Wno-unused-variable
|
||||||
CFLAGS += -Wno-suggest-attribute=noreturn
|
CFLAGS += -Wno-suggest-attribute=noreturn
|
||||||
|
|
||||||
|
# To reduce application size use only integer printf function.
|
||||||
|
CFLAGS += -Dprintf=iprintf
|
||||||
|
|
||||||
# -mlong-calls -Wall
|
# -mlong-calls -Wall
|
||||||
#CFLAGS += -save-temps -fverbose-asm
|
#CFLAGS += -save-temps -fverbose-asm
|
||||||
#CFLAGS += -Wa,-a,-ad
|
#CFLAGS += -Wa,-a,-ad
|
||||||
CFLAGS += -D__ARM
|
|
||||||
CFLAGS += --param max-inline-insns-single=500 -mcpu=cortex-m3 -mthumb # -mfix-cortex-m3-ldrd
|
CFLAGS += --param max-inline-insns-single=500 -mcpu=cortex-m3 -mthumb # -mfix-cortex-m3-ldrd
|
||||||
CFLAGS += -ffunction-sections -g $(OPTIMIZATION) $(INCLUDES) -D$(CHIP) -DTRACE_LEVEL=$(TRACE_LEVEL) -DDEBUG_PHONE_SNIFF=$(DEBUG_PHONE_SNIFF)
|
CFLAGS += -ffunction-sections -g $(OPTIMIZATION) $(INCLUDES) -D$(CHIP) -DTRACE_LEVEL=$(TRACE_LEVEL) -DDEBUG_PHONE_SNIFF=$(DEBUG_PHONE_SNIFF)
|
||||||
CFLAGS += -DGIT_VERSION=\"$(GIT_VERSION)\"
|
|
||||||
CFLAGS += -DBOARD=\"$(BOARD)\" -DBOARD_$(BOARD)
|
|
||||||
CFLAGS += -DAPPLICATION=\"$(APP)\" -DAPPLICATION_$(APP)
|
|
||||||
ASFLAGS = -mcpu=cortex-m3 -mthumb -Wall -g $(OPTIMIZATION) $(INCLUDES) -D$(CHIP) -D__ASSEMBLY__
|
ASFLAGS = -mcpu=cortex-m3 -mthumb -Wall -g $(OPTIMIZATION) $(INCLUDES) -D$(CHIP) -D__ASSEMBLY__
|
||||||
LDFLAGS = -mcpu=cortex-m3 -mthumb -Wl,--cref -Wl,--check-sections -Wl,--gc-sections -Wl,--entry=ResetException -Wl,--unresolved-symbols=report-all -Wl,--warn-common -Wl,--warn-section-align -Wl,--warn-unresolved-symbols $(LIB)
|
LDFLAGS = -mcpu=cortex-m3 -mthumb -Wl,--cref -Wl,--check-sections -Wl,--gc-sections -Wl,--entry=ResetException -Wl,--unresolved-symbols=report-all -Wl,--warn-common -Wl,--warn-section-align -Wl,--warn-unresolved-symbols $(LIB)
|
||||||
#LD_OPTIONAL=-Wl,--print-gc-sections -Wl,--stats
|
#LD_OPTIONAL=-Wl,--print-gc-sections -Wl,--stats
|
||||||
|
|
||||||
|
#-------------------------------------------------------------------------------
|
||||||
|
# Files
|
||||||
|
#-------------------------------------------------------------------------------
|
||||||
|
|
||||||
|
# Directories where source files can be found
|
||||||
|
|
||||||
|
USB_PATHS = $(AT91LIB_USB_CORE_PATH) $(AT91LIB_USB_COMMON_CORE_PATH)
|
||||||
|
VPATH += src_board src_sam3s cmsis $(USB_PATHS) src_simtrace
|
||||||
|
|
||||||
|
# Objects built from C source files
|
||||||
|
C_CMSIS = core_cm3.o
|
||||||
|
C_LOWLEVEL = board_cstartup_gnu.o board_lowlevel.o syscalls.o exceptions.o
|
||||||
|
C_LIBLEVEL = spi.o pio.o pmc.o usart.o pio_it.o pio_capture.o uart_console.o iso7816_4.o wdt.o led.o tc.o
|
||||||
|
C_CCID = cciddriver.o USBD.o USBDDriver.o USBD_HAL.o USBRequests.o USBDCallbacks.o USBDescriptors.o USBDDriverCallbacks.o
|
||||||
|
C_SIMTRACE = simtrace_iso7816.o usb.o ccid.o sniffer.o phone.o mitm.o ringbuffer.o host_communication.o #iso7816_uart.o
|
||||||
|
C_APPLEVEL = main.o
|
||||||
|
C_OBJECTS = $(C_CMSIS) $(C_LOWLEVEL) $(C_LIBLEVEL) $(C_APPLEVEL) $(C_CCID) $(C_SIMTRACE)
|
||||||
|
|
||||||
# Append OBJ and BIN directories to output filename
|
# Append OBJ and BIN directories to output filename
|
||||||
OUTPUT := $(BIN)/$(OUTPUT)
|
OUTPUT := $(BIN)/$(OUTPUT)
|
||||||
@@ -189,18 +159,18 @@ C_OBJECTS_$(1) = $(addprefix $(OBJ)/$(1)_, $(C_OBJECTS))
|
|||||||
ASM_OBJECTS_$(1) = $(addprefix $(OBJ)/$(1)_, $(ASM_OBJECTS))
|
ASM_OBJECTS_$(1) = $(addprefix $(OBJ)/$(1)_, $(ASM_OBJECTS))
|
||||||
|
|
||||||
$(1): $$(ASM_OBJECTS_$(1)) $$(C_OBJECTS_$(1))
|
$(1): $$(ASM_OBJECTS_$(1)) $$(C_OBJECTS_$(1))
|
||||||
@$(CC) $(LDFLAGS) $(LD_OPTIONAL) -T"libboard/common/resources/$(CHIP)/$$@.ld" -Wl,-Map,$(OUTPUT)-$$@.map -o $(OUTPUT)-$$@.elf $$^ $(LIBS)
|
@$(CC) $(LDFLAGS) $(LD_OPTIONAL) -T"$$@.ld" -Wl,-Map,$(OUTPUT)-$$@.map -o $(OUTPUT)-$$@.elf $$^ $(LIBS)
|
||||||
@$(NM) $(OUTPUT)-$$@.elf >$(OUTPUT)-$$@.elf.txt
|
@$(NM) $(OUTPUT)-$$@.elf >$(OUTPUT)-$$@.elf.txt
|
||||||
@$(OBJCOPY) -O binary $(OUTPUT)-$$@.elf $(OUTPUT)-$$@.bin
|
@$(OBJCOPY) -O binary $(OUTPUT)-$$@.elf $(OUTPUT)-$$@.bin
|
||||||
@$(SIZE) $$^ $(OUTPUT)-$$@.elf
|
@$(SIZE) $$^ $(OUTPUT)-$$@.elf
|
||||||
|
|
||||||
$$(C_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.c Makefile $(OBJ) $(BIN)
|
$$(C_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.c Makefile $(OBJ) $(BIN)
|
||||||
@echo [COMPILING $$<]
|
@echo [COMPILING $$<]
|
||||||
@$(CC) $(CFLAGS) -DENVIRONMENT_$(1) -DENVIRONMENT=\"$(1)\" -Wa,-ahlms=$(BIN)/$$*.lst -c -o $$@ $$<
|
@$(CC) $(CFLAGS) -D$(1) -Wa,-ahlms=$(BIN)/$$*.lst -c -o $$@ $$<
|
||||||
|
|
||||||
$$(ASM_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.S Makefile $(OBJ) $(BIN)
|
$$(ASM_OBJECTS_$(1)): $(OBJ)/$(1)_%.o: %.S Makefile $(OBJ) $(BIN)
|
||||||
@echo [ASSEMBLING $$@]
|
@echo [ASSEMBLING $$@]
|
||||||
@$(CC) $(ASFLAGS) -DENVIRONMENT_$(1) -DENVIRONMENT=\"$(1)\" -c -o $$@ $$<
|
@$(CC) $(ASFLAGS) -D$(1) -c -o $$@ $$<
|
||||||
|
|
||||||
debug_$(1): $(1)
|
debug_$(1): $(1)
|
||||||
$(GDB) -x "$(BOARD_LIB)/resources/gcc/$(BOARD)_$(1).gdb" -ex "reset" -readnow -se $(OUTPUT)-$(1).elf
|
$(GDB) -x "$(BOARD_LIB)/resources/gcc/$(BOARD)_$(1).gdb" -ex "reset" -readnow -se $(OUTPUT)-$(1).elf
|
||||||
@@ -218,3 +188,6 @@ log:
|
|||||||
|
|
||||||
clean:
|
clean:
|
||||||
-rm -fR $(OBJ)/*.o $(BIN)/*.bin $(BIN)/*.elf $(BIN)/*.elf.txt $(BIN)/*.map $(BIN)/*.lst
|
-rm -fR $(OBJ)/*.o $(BIN)/*.bin $(BIN)/*.elf $(BIN)/*.elf.txt $(BIN)/*.map $(BIN)/*.lst
|
||||||
|
|
||||||
|
rmbak:
|
||||||
|
-rm *~ $(BIN)/*~
|
||||||
|
|||||||
@@ -1,33 +0,0 @@
|
|||||||
|
|
||||||
== BOARDS
|
|
||||||
|
|
||||||
A board defines a given circuit board, i.e. SIMtrace, OWHW, QMOD
|
|
||||||
|
|
||||||
It defines the given hardware model for which the program is to be
|
|
||||||
compiled.
|
|
||||||
|
|
||||||
Current boards supported are:
|
|
||||||
* simtrace: The good old Osmocom SIMtrace PCB with SAM3 instead of
|
|
||||||
SAM7, open hardware.
|
|
||||||
* qmod: A sysmocom-proprietary quad mPCIe carrier board, publicly available
|
|
||||||
* owhw: An undisclosed sysmocom-internal board, not publicly available
|
|
||||||
|
|
||||||
== APPLICATIONS
|
|
||||||
|
|
||||||
An application is a specific piece of software with given
|
|
||||||
functionality.
|
|
||||||
|
|
||||||
== ENVIRONMENTS
|
|
||||||
|
|
||||||
An environment is a runtime environment, typically defined by a linker
|
|
||||||
script. The current runtime environments include
|
|
||||||
* flash: Run natively from start of flash memory
|
|
||||||
* dfu: Run after a DFU bootloader from an offset after the first 16k
|
|
||||||
of flash (the first 16k are reserved for the bootloader)
|
|
||||||
* ram: Run from within the RAM of the chip, downloaded via JTAG/SWD
|
|
||||||
|
|
||||||
|
|
||||||
== Building
|
|
||||||
|
|
||||||
A given software build is made for a specific combination of an APP
|
|
||||||
running in a certain ENVIRONMENT on a given BOARD.
|
|
||||||
@@ -1,3 +0,0 @@
|
|||||||
C_FILES += $(C_LIBUSB_RT)
|
|
||||||
|
|
||||||
C_FILES += card_emu.c ccid.c host_communication.c iso7816_4.c iso7816_fidi.c mitm.c mode_cardemu.c simtrace_iso7816.c sniffer.c tc_etu.c usb.c
|
|
||||||
@@ -1,207 +0,0 @@
|
|||||||
// FIXME: Copyright license here
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Headers
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "simtrace.h"
|
|
||||||
#include "utils.h"
|
|
||||||
#include "req_ctx.h"
|
|
||||||
#include "osmocom/core/timer.h"
|
|
||||||
|
|
||||||
unsigned int g_unique_id[4];
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Internal variables
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
typedef struct {
|
|
||||||
/* static initialization, called whether or not the usb config is active */
|
|
||||||
void (*configure) (void);
|
|
||||||
/* initialization function after the config was selected */
|
|
||||||
void (*init) (void);
|
|
||||||
/* de-initialization before selecting new config */
|
|
||||||
void (*exit) (void);
|
|
||||||
/* main loop content for given configuration */
|
|
||||||
void (*run) (void);
|
|
||||||
/* Interrupt handler for USART1 */
|
|
||||||
void (*usart0_irq) (void);
|
|
||||||
/* Interrupt handler for USART1 */
|
|
||||||
void (*usart1_irq) (void);
|
|
||||||
} conf_func;
|
|
||||||
|
|
||||||
static const conf_func config_func_ptrs[] = {
|
|
||||||
/* array slot 0 is empty, usb configs start at 1 */
|
|
||||||
#ifdef HAVE_SNIFFER
|
|
||||||
[CFG_NUM_SNIFF] = {
|
|
||||||
.configure = Sniffer_configure,
|
|
||||||
.init = Sniffer_init,
|
|
||||||
.exit = Sniffer_exit,
|
|
||||||
.run = Sniffer_run,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_CCID
|
|
||||||
[CFG_NUM_CCID] = {
|
|
||||||
.configure = CCID_configure,
|
|
||||||
.init = CCID_init,
|
|
||||||
.exit = CCID_exit,
|
|
||||||
.run = CCID_run,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_CARDEM
|
|
||||||
[CFG_NUM_PHONE] = {
|
|
||||||
.configure = mode_cardemu_configure,
|
|
||||||
.init = mode_cardemu_init,
|
|
||||||
.exit = mode_cardemu_exit,
|
|
||||||
.run = mode_cardemu_run,
|
|
||||||
.usart0_irq = mode_cardemu_usart0_irq,
|
|
||||||
.usart1_irq = mode_cardemu_usart1_irq,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_MITM
|
|
||||||
[CFG_NUM_MITM] = {
|
|
||||||
.configure = MITM_configure,
|
|
||||||
.init = MITM_init,
|
|
||||||
.exit = MITM_exit,
|
|
||||||
.run = MITM_run,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Internal variables
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
#if defined(HAVE_SNIFFER)
|
|
||||||
static volatile enum confNum simtrace_config = CFG_NUM_SNIFF;
|
|
||||||
#elif defined(HAVE_CARDEM)
|
|
||||||
static volatile enum confNum simtrace_config = CFG_NUM_PHONE;
|
|
||||||
#elif defined(HAVE_CCID)
|
|
||||||
static volatile enum confNum simtrace_config = CFG_NUM_CCID;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Callbacks
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
void USBDDriverCallbacks_ConfigurationChanged(uint8_t cfgnum)
|
|
||||||
{
|
|
||||||
TRACE_INFO_WP("cfgChanged%d ", cfgnum);
|
|
||||||
simtrace_config = cfgnum;
|
|
||||||
}
|
|
||||||
|
|
||||||
void USART1_IrqHandler(void)
|
|
||||||
{
|
|
||||||
config_func_ptrs[simtrace_config].usart1_irq();
|
|
||||||
}
|
|
||||||
|
|
||||||
void USART0_IrqHandler(void)
|
|
||||||
{
|
|
||||||
config_func_ptrs[simtrace_config].usart0_irq();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* returns '1' in case we should break any endless loop */
|
|
||||||
static void check_exec_dbg_cmd(void)
|
|
||||||
{
|
|
||||||
int ch;
|
|
||||||
|
|
||||||
if (!UART_IsRxReady())
|
|
||||||
return;
|
|
||||||
|
|
||||||
ch = UART_GetChar();
|
|
||||||
|
|
||||||
board_exec_dbg_cmd(ch);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Main
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
#define MAX_USB_ITER BOARD_MCK/72 // This should be around a second
|
|
||||||
extern int main(void)
|
|
||||||
{
|
|
||||||
uint8_t isUsbConnected = 0;
|
|
||||||
enum confNum last_simtrace_config = simtrace_config;
|
|
||||||
unsigned int i = 0;
|
|
||||||
|
|
||||||
LED_Configure(LED_NUM_RED);
|
|
||||||
LED_Configure(LED_NUM_GREEN);
|
|
||||||
LED_Set(LED_NUM_RED);
|
|
||||||
|
|
||||||
/* Disable watchdog */
|
|
||||||
WDT_Disable(WDT);
|
|
||||||
|
|
||||||
req_ctx_init();
|
|
||||||
|
|
||||||
PIO_InitializeInterrupts(0);
|
|
||||||
|
|
||||||
EEFC_ReadUniqueID(g_unique_id);
|
|
||||||
|
|
||||||
printf("\r\n\r\n"
|
|
||||||
"=============================================================================\r\n"
|
|
||||||
"SIMtrace2 firmware " GIT_VERSION " (C) 2010-2016 by Harald Welte\r\n"
|
|
||||||
"=============================================================================\r\n");
|
|
||||||
|
|
||||||
TRACE_INFO("Serial Nr. %08x-%08x-%08x-%08x\r\n",
|
|
||||||
g_unique_id[0], g_unique_id[1],
|
|
||||||
g_unique_id[2], g_unique_id[3]);
|
|
||||||
|
|
||||||
board_main_top();
|
|
||||||
|
|
||||||
TRACE_INFO("USB init...\r\n");
|
|
||||||
SIMtrace_USB_Initialize();
|
|
||||||
|
|
||||||
while (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
|
||||||
check_exec_dbg_cmd();
|
|
||||||
#if 0
|
|
||||||
if (i >= MAX_USB_ITER * 3) {
|
|
||||||
TRACE_ERROR("Resetting board (USB could "
|
|
||||||
"not be configured)\r\n");
|
|
||||||
NVIC_SystemReset();
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
i++;
|
|
||||||
}
|
|
||||||
|
|
||||||
TRACE_INFO("calling configure of all configurations...\r\n");
|
|
||||||
for (i = 1; i < sizeof(config_func_ptrs) / sizeof(config_func_ptrs[0]);
|
|
||||||
++i) {
|
|
||||||
if (config_func_ptrs[i].configure)
|
|
||||||
config_func_ptrs[i].configure();
|
|
||||||
}
|
|
||||||
|
|
||||||
TRACE_INFO("calling init of config %u...\r\n", simtrace_config);
|
|
||||||
config_func_ptrs[simtrace_config].init();
|
|
||||||
last_simtrace_config = simtrace_config;
|
|
||||||
|
|
||||||
TRACE_INFO("entering main loop...\r\n");
|
|
||||||
while (1) {
|
|
||||||
#if TRACE_LEVEL >= TRACE_LEVEL_DEBUG
|
|
||||||
const char rotor[] = { '-', '\\', '|', '/' };
|
|
||||||
putchar('\b');
|
|
||||||
putchar(rotor[i++ % ARRAY_SIZE(rotor)]);
|
|
||||||
#endif
|
|
||||||
check_exec_dbg_cmd();
|
|
||||||
osmo_timers_prepare();
|
|
||||||
osmo_timers_update();
|
|
||||||
|
|
||||||
if (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
|
||||||
|
|
||||||
if (isUsbConnected) {
|
|
||||||
isUsbConnected = 0;
|
|
||||||
}
|
|
||||||
} else if (isUsbConnected == 0) {
|
|
||||||
TRACE_INFO("USB is now configured\r\n");
|
|
||||||
LED_Set(LED_NUM_GREEN);
|
|
||||||
LED_Clear(LED_NUM_RED);
|
|
||||||
|
|
||||||
isUsbConnected = 1;
|
|
||||||
}
|
|
||||||
if (last_simtrace_config != simtrace_config) {
|
|
||||||
TRACE_INFO("USB config chg %u -> %u\r\n",
|
|
||||||
last_simtrace_config, simtrace_config);
|
|
||||||
config_func_ptrs[last_simtrace_config].exit();
|
|
||||||
config_func_ptrs[simtrace_config].init();
|
|
||||||
last_simtrace_config = simtrace_config;
|
|
||||||
} else {
|
|
||||||
config_func_ptrs[simtrace_config].run();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
@@ -1,12 +0,0 @@
|
|||||||
|
|
||||||
C_FILES += $(C_LIBUSB_DFU)
|
|
||||||
|
|
||||||
# Trace level used for compilation
|
|
||||||
# (can be overriden by adding TRACE_LEVEL=#number to the command-line)
|
|
||||||
# TRACE_LEVEL_DEBUG 5
|
|
||||||
# TRACE_LEVEL_INFO 4
|
|
||||||
# TRACE_LEVEL_WARNING 3
|
|
||||||
# TRACE_LEVEL_ERROR 2
|
|
||||||
# TRACE_LEVEL_FATAL 1
|
|
||||||
# TRACE_LEVEL_NO_TRACE 0
|
|
||||||
TRACE_LEVEL ?= 3
|
|
||||||
@@ -1,195 +0,0 @@
|
|||||||
#include "board.h"
|
|
||||||
#include "utils.h"
|
|
||||||
#include "usb/device/dfu/dfu.h"
|
|
||||||
#include "usb/common/dfu/usb_dfu.h"
|
|
||||||
#include "manifest.h"
|
|
||||||
|
|
||||||
#define ALTIF_RAM 0
|
|
||||||
#define ALTIF_FLASH 1
|
|
||||||
|
|
||||||
unsigned int g_unique_id[4];
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Callbacks
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
#define RAM_ADDR(offset) (IRAM_ADDR + BOARD_DFU_RAM_SIZE + offset)
|
|
||||||
#define FLASH_ADDR(offset) (IFLASH_ADDR + BOARD_DFU_BOOT_SIZE + offset)
|
|
||||||
|
|
||||||
#define IFLASH_END ((uint8_t *)IFLASH_ADDR + IFLASH_SIZE)
|
|
||||||
#define IRAM_END ((uint8_t *)IRAM_ADDR + IRAM_SIZE)
|
|
||||||
|
|
||||||
/* incoming call-back: Host has transfered 'len' bytes (stored at
|
|
||||||
* 'data'), which we shall write to 'offset' into the partition
|
|
||||||
* associated with 'altif'. Guaranted to be les than
|
|
||||||
* BOARD_DFU_PAGE_SIZE */
|
|
||||||
int USBDFU_handle_dnload(uint8_t altif, unsigned int offset,
|
|
||||||
uint8_t *data, unsigned int len)
|
|
||||||
{
|
|
||||||
uint32_t addr;
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
printf("dnload(altif=%u, offset=%u, len=%u)\n\r", altif, offset, len);
|
|
||||||
|
|
||||||
switch (altif) {
|
|
||||||
case ALTIF_RAM:
|
|
||||||
addr = RAM_ADDR(offset);
|
|
||||||
if (addr > IRAM_ADDR + IRAM_SIZE) {
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
g_dfu->status = DFU_STATUS_errADDRESS;
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
memcpy((void *)addr, data, len);
|
|
||||||
return DFU_RET_ZLP;
|
|
||||||
case ALTIF_FLASH:
|
|
||||||
addr = FLASH_ADDR(offset);
|
|
||||||
if (addr > IFLASH_ADDR + IFLASH_SIZE) {
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
g_dfu->status = DFU_STATUS_errADDRESS;
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
rc = FLASHD_Write(addr, data, len);
|
|
||||||
if (rc != 0) {
|
|
||||||
/* FIXME: set error codes */
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
return DFU_RET_ZLP;
|
|
||||||
default:
|
|
||||||
/* FIXME: set error codes */
|
|
||||||
TRACE_ERROR("DFU download for unknown AltIf %d\n\r", altif);
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* incoming call-back: Host has requested to read back 'req_len' bytes
|
|
||||||
* starting from 'offset' of the firmware * associated with partition
|
|
||||||
* 'altif' */
|
|
||||||
int USBDFU_handle_upload(uint8_t altif, unsigned int offset,
|
|
||||||
uint8_t *data, unsigned int req_len)
|
|
||||||
{
|
|
||||||
uint32_t addr;
|
|
||||||
|
|
||||||
printf("upload(altif=%u, offset=%u, len=%u)", altif, offset, req_len);
|
|
||||||
|
|
||||||
switch (altif) {
|
|
||||||
case ALTIF_RAM:
|
|
||||||
addr = RAM_ADDR(offset);
|
|
||||||
if (addr > IRAM_ADDR + IRAM_SIZE) {
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
g_dfu->status = DFU_STATUS_errADDRESS;
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
if ((uint8_t *)addr + req_len > IRAM_END)
|
|
||||||
req_len = IRAM_END - (uint8_t *)addr;
|
|
||||||
memcpy(data, (void *)addr, req_len);
|
|
||||||
break;
|
|
||||||
case ALTIF_FLASH:
|
|
||||||
addr = FLASH_ADDR(offset);
|
|
||||||
if (addr > IFLASH_ADDR + IFLASH_SIZE) {
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
g_dfu->status = DFU_STATUS_errADDRESS;
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
if ((uint8_t *)addr + req_len > IFLASH_END)
|
|
||||||
req_len = IFLASH_END - (uint8_t *)addr;
|
|
||||||
memcpy(data, (void *)addr, req_len);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
TRACE_ERROR("DFU upload for unknown AltIf %d\n\r", altif);
|
|
||||||
/* FIXME: set error codes */
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
printf("=%u\r\n", req_len);
|
|
||||||
return req_len;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/* returns '1' in case we should break any endless loop */
|
|
||||||
static void check_exec_dbg_cmd(void)
|
|
||||||
{
|
|
||||||
int ch;
|
|
||||||
|
|
||||||
if (!UART_IsRxReady())
|
|
||||||
return;
|
|
||||||
|
|
||||||
ch = UART_GetChar();
|
|
||||||
|
|
||||||
//board_exec_dbg_cmd(ch);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Main
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
#define MAX_USB_ITER BOARD_MCK/72 // This should be around a second
|
|
||||||
extern int main(void)
|
|
||||||
{
|
|
||||||
uint8_t isUsbConnected = 0;
|
|
||||||
unsigned int i = 0;
|
|
||||||
|
|
||||||
LED_Configure(LED_NUM_RED);
|
|
||||||
LED_Configure(LED_NUM_GREEN);
|
|
||||||
LED_Set(LED_NUM_RED);
|
|
||||||
|
|
||||||
/* Disable watchdog */
|
|
||||||
WDT_Disable(WDT);
|
|
||||||
|
|
||||||
//req_ctx_init();
|
|
||||||
|
|
||||||
PIO_InitializeInterrupts(0);
|
|
||||||
|
|
||||||
EEFC_ReadUniqueID(g_unique_id);
|
|
||||||
|
|
||||||
printf("\r\n\r\n"
|
|
||||||
"=============================================================================\r\n"
|
|
||||||
"DFU bootloader %s for board %s (C) 2010-2017 by Harald Welte\r\n"
|
|
||||||
"=============================================================================\r\n",
|
|
||||||
manifest_revision, manifest_board);
|
|
||||||
|
|
||||||
TRACE_INFO("Chip ID: 0x%08x (Ext 0x%08x)\r\n", CHIPID->CHIPID_CIDR, CHIPID->CHIPID_EXID);
|
|
||||||
TRACE_INFO("Serial Nr. %08x-%08x-%08x-%08x\r\n",
|
|
||||||
g_unique_id[0], g_unique_id[1],
|
|
||||||
g_unique_id[2], g_unique_id[3]);
|
|
||||||
|
|
||||||
//board_main_top();
|
|
||||||
|
|
||||||
TRACE_INFO("USB init...\r\n");
|
|
||||||
USBDFU_Initialize(&dfu_descriptors);
|
|
||||||
|
|
||||||
while (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
|
||||||
check_exec_dbg_cmd();
|
|
||||||
#if 1
|
|
||||||
if (i >= MAX_USB_ITER * 3) {
|
|
||||||
TRACE_ERROR("Resetting board (USB could "
|
|
||||||
"not be configured)\r\n");
|
|
||||||
NVIC_SystemReset();
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
i++;
|
|
||||||
}
|
|
||||||
|
|
||||||
FLASHD_Initialize(BOARD_MCK, 1);
|
|
||||||
TRACE_INFO("entering main loop...\r\n");
|
|
||||||
while (1) {
|
|
||||||
#if TRACE_LEVEL >= TRACE_LEVEL_DEBUG
|
|
||||||
const char rotor[] = { '-', '\\', '|', '/' };
|
|
||||||
putchar('\b');
|
|
||||||
putchar(rotor[i++ % ARRAY_SIZE(rotor)]);
|
|
||||||
#endif
|
|
||||||
check_exec_dbg_cmd();
|
|
||||||
//osmo_timers_prepare();
|
|
||||||
//osmo_timers_update();
|
|
||||||
|
|
||||||
if (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
|
||||||
|
|
||||||
if (isUsbConnected) {
|
|
||||||
isUsbConnected = 0;
|
|
||||||
}
|
|
||||||
} else if (isUsbConnected == 0) {
|
|
||||||
TRACE_INFO("USB is now configured\r\n");
|
|
||||||
LED_Set(LED_NUM_GREEN);
|
|
||||||
LED_Clear(LED_NUM_RED);
|
|
||||||
|
|
||||||
isUsbConnected = 1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
@@ -1,3 +0,0 @@
|
|||||||
C_FILES += $(C_LIBUSB_RT)
|
|
||||||
|
|
||||||
C_FILES += card_emu.c ccid.c host_communication.c iso7816_4.c iso7816_fidi.c mitm.c mode_cardemu.c simtrace_iso7816.c sniffer.c tc_etu.c usb.c
|
|
||||||
@@ -1,207 +0,0 @@
|
|||||||
// FIXME: Copyright license here
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Headers
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "simtrace.h"
|
|
||||||
#include "utils.h"
|
|
||||||
#include "req_ctx.h"
|
|
||||||
#include "osmocom/core/timer.h"
|
|
||||||
|
|
||||||
unsigned int g_unique_id[4];
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Internal variables
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
typedef struct {
|
|
||||||
/* static initialization, called whether or not the usb config is active */
|
|
||||||
void (*configure) (void);
|
|
||||||
/* initialization function after the config was selected */
|
|
||||||
void (*init) (void);
|
|
||||||
/* de-initialization before selecting new config */
|
|
||||||
void (*exit) (void);
|
|
||||||
/* main loop content for given configuration */
|
|
||||||
void (*run) (void);
|
|
||||||
/* Interrupt handler for USART1 */
|
|
||||||
void (*usart0_irq) (void);
|
|
||||||
/* Interrupt handler for USART1 */
|
|
||||||
void (*usart1_irq) (void);
|
|
||||||
} conf_func;
|
|
||||||
|
|
||||||
static const conf_func config_func_ptrs[] = {
|
|
||||||
/* array slot 0 is empty, usb configs start at 1 */
|
|
||||||
#ifdef HAVE_SNIFFER
|
|
||||||
[CFG_NUM_SNIFF] = {
|
|
||||||
.configure = Sniffer_configure,
|
|
||||||
.init = Sniffer_init,
|
|
||||||
.exit = Sniffer_exit,
|
|
||||||
.run = Sniffer_run,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_CCID
|
|
||||||
[CFG_NUM_CCID] = {
|
|
||||||
.configure = CCID_configure,
|
|
||||||
.init = CCID_init,
|
|
||||||
.exit = CCID_exit,
|
|
||||||
.run = CCID_run,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_CARDEM
|
|
||||||
[CFG_NUM_PHONE] = {
|
|
||||||
.configure = mode_cardemu_configure,
|
|
||||||
.init = mode_cardemu_init,
|
|
||||||
.exit = mode_cardemu_exit,
|
|
||||||
.run = mode_cardemu_run,
|
|
||||||
.usart0_irq = mode_cardemu_usart0_irq,
|
|
||||||
.usart1_irq = mode_cardemu_usart1_irq,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_MITM
|
|
||||||
[CFG_NUM_MITM] = {
|
|
||||||
.configure = MITM_configure,
|
|
||||||
.init = MITM_init,
|
|
||||||
.exit = MITM_exit,
|
|
||||||
.run = MITM_run,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Internal variables
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
#if defined(HAVE_SNIFFER)
|
|
||||||
static volatile enum confNum simtrace_config = CFG_NUM_SNIFF;
|
|
||||||
#elif defined(HAVE_CARDEM)
|
|
||||||
static volatile enum confNum simtrace_config = CFG_NUM_PHONE;
|
|
||||||
#elif defined(HAVE_CCID)
|
|
||||||
static volatile enum confNum simtrace_config = CFG_NUM_CCID;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Callbacks
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
void USBDDriverCallbacks_ConfigurationChanged(uint8_t cfgnum)
|
|
||||||
{
|
|
||||||
TRACE_INFO_WP("cfgChanged%d ", cfgnum);
|
|
||||||
simtrace_config = cfgnum;
|
|
||||||
}
|
|
||||||
|
|
||||||
void USART1_IrqHandler(void)
|
|
||||||
{
|
|
||||||
config_func_ptrs[simtrace_config].usart1_irq();
|
|
||||||
}
|
|
||||||
|
|
||||||
void USART0_IrqHandler(void)
|
|
||||||
{
|
|
||||||
config_func_ptrs[simtrace_config].usart0_irq();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* returns '1' in case we should break any endless loop */
|
|
||||||
static void check_exec_dbg_cmd(void)
|
|
||||||
{
|
|
||||||
int ch;
|
|
||||||
|
|
||||||
if (!UART_IsRxReady())
|
|
||||||
return;
|
|
||||||
|
|
||||||
ch = UART_GetChar();
|
|
||||||
|
|
||||||
board_exec_dbg_cmd(ch);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Main
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
#define MAX_USB_ITER BOARD_MCK/72 // This should be around a second
|
|
||||||
extern int main(void)
|
|
||||||
{
|
|
||||||
uint8_t isUsbConnected = 0;
|
|
||||||
enum confNum last_simtrace_config = simtrace_config;
|
|
||||||
unsigned int i = 0;
|
|
||||||
|
|
||||||
LED_Configure(LED_NUM_RED);
|
|
||||||
LED_Configure(LED_NUM_GREEN);
|
|
||||||
LED_Set(LED_NUM_RED);
|
|
||||||
|
|
||||||
/* Disable watchdog */
|
|
||||||
WDT_Disable(WDT);
|
|
||||||
|
|
||||||
req_ctx_init();
|
|
||||||
|
|
||||||
PIO_InitializeInterrupts(0);
|
|
||||||
|
|
||||||
EEFC_ReadUniqueID(g_unique_id);
|
|
||||||
|
|
||||||
printf("\r\n\r\n"
|
|
||||||
"=============================================================================\r\n"
|
|
||||||
"SIMtrace2 firmware " GIT_REVISION " (C) 2010-2017 by Harald Welte\r\n"
|
|
||||||
"=============================================================================\r\n");
|
|
||||||
|
|
||||||
TRACE_INFO("Serial Nr. %08x-%08x-%08x-%08x\r\n",
|
|
||||||
g_unique_id[0], g_unique_id[1],
|
|
||||||
g_unique_id[2], g_unique_id[3]);
|
|
||||||
|
|
||||||
board_main_top();
|
|
||||||
|
|
||||||
TRACE_INFO("USB init...\r\n");
|
|
||||||
SIMtrace_USB_Initialize();
|
|
||||||
|
|
||||||
while (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
|
||||||
check_exec_dbg_cmd();
|
|
||||||
#if 0
|
|
||||||
if (i >= MAX_USB_ITER * 3) {
|
|
||||||
TRACE_ERROR("Resetting board (USB could "
|
|
||||||
"not be configured)\r\n");
|
|
||||||
NVIC_SystemReset();
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
i++;
|
|
||||||
}
|
|
||||||
|
|
||||||
TRACE_INFO("calling configure of all configurations...\r\n");
|
|
||||||
for (i = 1; i < sizeof(config_func_ptrs) / sizeof(config_func_ptrs[0]);
|
|
||||||
++i) {
|
|
||||||
if (config_func_ptrs[i].configure)
|
|
||||||
config_func_ptrs[i].configure();
|
|
||||||
}
|
|
||||||
|
|
||||||
TRACE_INFO("calling init of config %u...\r\n", simtrace_config);
|
|
||||||
config_func_ptrs[simtrace_config].init();
|
|
||||||
last_simtrace_config = simtrace_config;
|
|
||||||
|
|
||||||
TRACE_INFO("entering main loop...\r\n");
|
|
||||||
while (1) {
|
|
||||||
#if TRACE_LEVEL >= TRACE_LEVEL_DEBUG
|
|
||||||
const char rotor[] = { '-', '\\', '|', '/' };
|
|
||||||
putchar('\b');
|
|
||||||
putchar(rotor[i++ % ARRAY_SIZE(rotor)]);
|
|
||||||
#endif
|
|
||||||
check_exec_dbg_cmd();
|
|
||||||
osmo_timers_prepare();
|
|
||||||
osmo_timers_update();
|
|
||||||
|
|
||||||
if (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
|
||||||
|
|
||||||
if (isUsbConnected) {
|
|
||||||
isUsbConnected = 0;
|
|
||||||
}
|
|
||||||
} else if (isUsbConnected == 0) {
|
|
||||||
TRACE_INFO("USB is now configured\r\n");
|
|
||||||
LED_Set(LED_NUM_GREEN);
|
|
||||||
LED_Clear(LED_NUM_RED);
|
|
||||||
|
|
||||||
isUsbConnected = 1;
|
|
||||||
}
|
|
||||||
if (last_simtrace_config != simtrace_config) {
|
|
||||||
TRACE_INFO("USB config chg %u -> %u\r\n",
|
|
||||||
last_simtrace_config, simtrace_config);
|
|
||||||
config_func_ptrs[last_simtrace_config].exit();
|
|
||||||
config_func_ptrs[simtrace_config].init();
|
|
||||||
last_simtrace_config = simtrace_config;
|
|
||||||
} else {
|
|
||||||
config_func_ptrs[simtrace_config].run();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
@@ -1,113 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \file
|
|
||||||
*
|
|
||||||
* \section Purpose
|
|
||||||
*
|
|
||||||
* Interface for configuration the Enhanced Embedded Flash Controller (EEFC) peripheral.
|
|
||||||
*
|
|
||||||
* \section Usage
|
|
||||||
*
|
|
||||||
* -# Enable/disable %flash ready interrupt sources using EFC_EnableFrdyIt()
|
|
||||||
* and EFC_DisableFrdyIt().
|
|
||||||
* -# Translates the given address into which EEFC, page and offset values
|
|
||||||
* for difference density %flash memory using EFC_TranslateAddress().
|
|
||||||
* -# Computes the address of a %flash access given the EFC, page and offset
|
|
||||||
* for difference density %flash memory using EFC_ComputeAddress().
|
|
||||||
* -# Start the executing command with EFC_StartCommand()
|
|
||||||
* -# Retrieve the current status of the EFC using EFC_GetStatus().
|
|
||||||
* -# Retrieve the result of the last executed command with EFC_GetResult().
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef _EEFC_
|
|
||||||
#define _EEFC_
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Headers
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
#include "chip.h"
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Definitions
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
/* EFC command */
|
|
||||||
#define EFC_FCMD_GETD 0x00
|
|
||||||
#define EFC_FCMD_WP 0x01
|
|
||||||
#define EFC_FCMD_WPL 0x02
|
|
||||||
#define EFC_FCMD_EWP 0x03
|
|
||||||
#define EFC_FCMD_EWPL 0x04
|
|
||||||
#define EFC_FCMD_EA 0x05
|
|
||||||
#define EFC_FCMD_SLB 0x08
|
|
||||||
#define EFC_FCMD_CLB 0x09
|
|
||||||
#define EFC_FCMD_GLB 0x0A
|
|
||||||
#define EFC_FCMD_SFB 0x0B
|
|
||||||
#define EFC_FCMD_CFB 0x0C
|
|
||||||
#define EFC_FCMD_GFB 0x0D
|
|
||||||
#define EFC_FCMD_STUI 0x0E /* Start unique ID */
|
|
||||||
#define EFC_FCMD_SPUI 0x0F /* Stop unique ID */
|
|
||||||
|
|
||||||
/* The IAP function entry addreass */
|
|
||||||
#define CHIP_FLASH_IAP_ADDRESS (0x00800008)
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
extern "C" {
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Exported functions
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
extern void EFC_EnableFrdyIt( Efc* efc ) ;
|
|
||||||
|
|
||||||
extern void EFC_DisableFrdyIt( Efc* efc ) ;
|
|
||||||
|
|
||||||
extern void EFC_SetWaitState( Efc* efc, uint8_t cycles ) ;
|
|
||||||
|
|
||||||
extern void EFC_TranslateAddress( Efc** pEfc, uint32_t dwAddress, uint16_t *pwPage, uint16_t *pwOffset ) ;
|
|
||||||
|
|
||||||
extern void EFC_ComputeAddress( Efc* efc, uint16_t wPage, uint16_t wOffset, uint32_t *pdwAddress ) ;
|
|
||||||
|
|
||||||
extern void EFC_StartCommand( Efc* efc, uint32_t dwCommand, uint32_t dwArgument ) ;
|
|
||||||
|
|
||||||
extern uint32_t EFC_PerformCommand( Efc* efc, uint32_t dwCommand, uint32_t dwArgument, uint32_t dwUseIAP ) ;
|
|
||||||
|
|
||||||
extern uint32_t EFC_GetStatus( Efc* efc ) ;
|
|
||||||
|
|
||||||
extern uint32_t EFC_GetResult( Efc* efc ) ;
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif /* #ifndef _EEFC_ */
|
|
||||||
|
|
||||||
@@ -1,79 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \file
|
|
||||||
*
|
|
||||||
* The flash driver provides the unified interface for flash program operations.
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef _FLASHD_
|
|
||||||
#define _FLASHD_
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
extern "C" {
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Exported functions
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
extern void FLASHD_Initialize( uint32_t dwMCk, uint32_t dwUseIAP ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_Erase( uint32_t dwAddress ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_Write( uint32_t dwAddress, const void *pvBuffer, uint32_t dwSize ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_Lock( uint32_t dwStart, uint32_t dwEnd, uint32_t *pdwActualStart, uint32_t *pdwActualEnd ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_Unlock( uint32_t dwStart, uint32_t dwEnd, uint32_t *pdwActualStart, uint32_t *pdwActualEnd ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_IsLocked( uint32_t dwStart, uint32_t dwEnd ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_SetGPNVM( uint8_t gpnvm ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_ClearGPNVM( uint8_t gpnvm ) ;
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_IsGPNVMSet( uint8_t gpnvm ) ;
|
|
||||||
|
|
||||||
#define FLASHD_IsSecurityBitSet() FLASHD_IsGPNVMSet( 0 )
|
|
||||||
|
|
||||||
#define FLASHD_SetSecurityBit() FLASHD_SetGPNVM( 0 )
|
|
||||||
|
|
||||||
extern uint32_t FLASHD_ReadUniqueID( uint32_t* pdwUniqueID ) ;
|
|
||||||
|
|
||||||
#ifdef __cplusplus
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#endif /* #ifndef _FLASHD_ */
|
|
||||||
|
|
||||||
@@ -1,3 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
void EEFC_ReadUniqueID(unsigned int *pdwUniqueID);
|
|
||||||
@@ -1,290 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/** \addtogroup efc_module Working with EEFC
|
|
||||||
* The EEFC driver provides the interface to configure and use the EEFC
|
|
||||||
* peripheral.
|
|
||||||
*
|
|
||||||
* The user needs to set the number of wait states depending on the frequency used.\n
|
|
||||||
* Configure number of cycles for flash read/write operations in the FWS field of EEFC_FMR.
|
|
||||||
*
|
|
||||||
* It offers a function to send flash command to EEFC and waits for the
|
|
||||||
* flash to be ready.
|
|
||||||
*
|
|
||||||
* To send flash command, the user could do in either of following way:
|
|
||||||
* <ul>
|
|
||||||
* <li>Write a correct key, command and argument in EEFC_FCR. </li>
|
|
||||||
* <li>Or, Use IAP (In Application Programming) function which is executed from
|
|
||||||
* ROM directly, this allows flash programming to be done by code running in flash.</li>
|
|
||||||
* <li>Once the command is achieved, it can be detected even by polling EEFC_FSR or interrupt.
|
|
||||||
* </ul>
|
|
||||||
*
|
|
||||||
* The command argument could be a page number,GPNVM number or nothing, it depends on
|
|
||||||
* the command itself. Some useful functions in this driver could help user tranlate physical
|
|
||||||
* flash address into a page number and vice verse.
|
|
||||||
*
|
|
||||||
* For more accurate information, please look at the EEFC section of the
|
|
||||||
* Datasheet.
|
|
||||||
*
|
|
||||||
* Related files :\n
|
|
||||||
* \ref efc.c\n
|
|
||||||
* \ref efc.h.\n
|
|
||||||
*/
|
|
||||||
/*@{*/
|
|
||||||
/*@}*/
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \file
|
|
||||||
*
|
|
||||||
* Implementation of Enhanced Embedded Flash Controller (EEFC).
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Headers
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
#include "chip.h"
|
|
||||||
#include "efc.h"
|
|
||||||
|
|
||||||
#include <assert.h>
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Exported functions
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Enables the flash ready interrupt source on the EEFC peripheral.
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
*/
|
|
||||||
extern void EFC_EnableFrdyIt( Efc* efc )
|
|
||||||
{
|
|
||||||
efc->EEFC_FMR |= EEFC_FMR_FRDY ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Disables the flash ready interrupt source on the EEFC peripheral.
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
*/
|
|
||||||
|
|
||||||
extern void EFC_DisableFrdyIt( Efc* efc )
|
|
||||||
{
|
|
||||||
efc->EEFC_FMR &= ~((uint32_t)EEFC_FMR_FRDY) ;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Set read/write wait state on the EEFC perpherial.
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
* \param cycles the number of wait states in cycle.
|
|
||||||
*/
|
|
||||||
|
|
||||||
extern void EFC_SetWaitState( Efc* efc, uint8_t ucCycles )
|
|
||||||
{
|
|
||||||
uint32_t dwValue ;
|
|
||||||
|
|
||||||
dwValue = efc->EEFC_FMR ;
|
|
||||||
dwValue &= ~((uint32_t)EEFC_FMR_FWS_Msk) ;
|
|
||||||
dwValue |= EEFC_FMR_FWS(ucCycles);
|
|
||||||
efc->EEFC_FMR = dwValue ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Returns the current status of the EEFC.
|
|
||||||
*
|
|
||||||
* \note Keep in mind that this function clears the value of some status bits (LOCKE, PROGE).
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
*/
|
|
||||||
extern uint32_t EFC_GetStatus( Efc* efc )
|
|
||||||
{
|
|
||||||
return efc->EEFC_FSR ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Returns the result of the last executed command.
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
*/
|
|
||||||
extern uint32_t EFC_GetResult( Efc* efc )
|
|
||||||
{
|
|
||||||
return efc->EEFC_FRR ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Translates the given address page and offset values.
|
|
||||||
* \note The resulting values are stored in the provided variables if they are not null.
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
* \param address Address to translate.
|
|
||||||
* \param pPage First page accessed.
|
|
||||||
* \param pOffset Byte offset in first page.
|
|
||||||
*/
|
|
||||||
extern void EFC_TranslateAddress( Efc** ppEfc, uint32_t dwAddress, uint16_t* pwPage, uint16_t* pwOffset )
|
|
||||||
{
|
|
||||||
Efc *pEfc ;
|
|
||||||
uint16_t wPage ;
|
|
||||||
uint16_t wOffset ;
|
|
||||||
|
|
||||||
assert( dwAddress >= IFLASH_ADDR ) ;
|
|
||||||
assert( dwAddress <= (IFLASH_ADDR + IFLASH_SIZE) ) ;
|
|
||||||
|
|
||||||
pEfc = EFC ;
|
|
||||||
wPage = (dwAddress - IFLASH_ADDR) / IFLASH_PAGE_SIZE;
|
|
||||||
wOffset = (dwAddress - IFLASH_ADDR) % IFLASH_PAGE_SIZE;
|
|
||||||
|
|
||||||
TRACE_DEBUG( "Translated 0x%08X to page=%d and offset=%d\n\r", dwAddress, wPage, wOffset ) ;
|
|
||||||
/* Store values */
|
|
||||||
if ( pEfc )
|
|
||||||
{
|
|
||||||
*ppEfc = pEfc ;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( pwPage )
|
|
||||||
{
|
|
||||||
*pwPage = wPage ;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( pwOffset )
|
|
||||||
{
|
|
||||||
*pwOffset = wOffset ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Computes the address of a flash access given the page and offset.
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
* \param page Page number.
|
|
||||||
* \param offset Byte offset inside page.
|
|
||||||
* \param pAddress Computed address (optional).
|
|
||||||
*/
|
|
||||||
extern void EFC_ComputeAddress( Efc *efc, uint16_t wPage, uint16_t wOffset, uint32_t *pdwAddress )
|
|
||||||
{
|
|
||||||
uint32_t dwAddress ;
|
|
||||||
|
|
||||||
assert( efc ) ;
|
|
||||||
assert( wPage <= IFLASH_NB_OF_PAGES ) ;
|
|
||||||
assert( wOffset < IFLASH_PAGE_SIZE ) ;
|
|
||||||
|
|
||||||
/* Compute address */
|
|
||||||
dwAddress = IFLASH_ADDR + wPage * IFLASH_PAGE_SIZE + wOffset ;
|
|
||||||
|
|
||||||
/* Store result */
|
|
||||||
if ( pdwAddress != NULL )
|
|
||||||
{
|
|
||||||
*pdwAddress = dwAddress ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Starts the executing the given command on the EEFC and returns as soon as the command is started.
|
|
||||||
*
|
|
||||||
* \note It does NOT set the FMCN field automatically.
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
* \param command Command to execute.
|
|
||||||
* \param argument Command argument (should be 0 if not used).
|
|
||||||
*/
|
|
||||||
extern void EFC_StartCommand( Efc* efc, uint32_t dwCommand, uint32_t dwArgument )
|
|
||||||
{
|
|
||||||
/* Check command & argument */
|
|
||||||
switch ( dwCommand )
|
|
||||||
{
|
|
||||||
case EFC_FCMD_WP:
|
|
||||||
case EFC_FCMD_WPL:
|
|
||||||
case EFC_FCMD_EWP:
|
|
||||||
case EFC_FCMD_EWPL:
|
|
||||||
case EFC_FCMD_SLB:
|
|
||||||
case EFC_FCMD_CLB:
|
|
||||||
assert( dwArgument < IFLASH_NB_OF_PAGES ) ;
|
|
||||||
break ;
|
|
||||||
|
|
||||||
case EFC_FCMD_SFB:
|
|
||||||
case EFC_FCMD_CFB:
|
|
||||||
assert( dwArgument < 2 ) ;
|
|
||||||
break;
|
|
||||||
|
|
||||||
case EFC_FCMD_GETD:
|
|
||||||
case EFC_FCMD_EA:
|
|
||||||
case EFC_FCMD_GLB:
|
|
||||||
case EFC_FCMD_GFB:
|
|
||||||
case EFC_FCMD_STUI:
|
|
||||||
assert( dwArgument == 0 ) ;
|
|
||||||
break;
|
|
||||||
|
|
||||||
default: assert( 0 ) ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Start command Embedded flash */
|
|
||||||
assert( (efc->EEFC_FSR & EEFC_FMR_FRDY) == EEFC_FMR_FRDY ) ;
|
|
||||||
efc->EEFC_FCR = EEFC_FCR_FKEY(0x5A) | EEFC_FCR_FARG(dwArgument) | EEFC_FCR_FCMD(dwCommand) ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Performs the given command and wait until its completion (or an error).
|
|
||||||
*
|
|
||||||
* \param efc Pointer to a Efc instance
|
|
||||||
* \param command Command to perform.
|
|
||||||
* \param argument Optional command argument.
|
|
||||||
*
|
|
||||||
* \return 0 if successful, otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
|
|
||||||
extern uint32_t EFC_PerformCommand( Efc* efc, uint32_t dwCommand, uint32_t dwArgument, uint32_t dwUseIAP )
|
|
||||||
{
|
|
||||||
if ( dwUseIAP != 0 )
|
|
||||||
{
|
|
||||||
/* Pointer on IAP function in ROM */
|
|
||||||
static uint32_t (*IAP_PerformCommand)( uint32_t, uint32_t ) ;
|
|
||||||
|
|
||||||
IAP_PerformCommand = (uint32_t (*)( uint32_t, uint32_t )) *((uint32_t*)CHIP_FLASH_IAP_ADDRESS ) ;
|
|
||||||
IAP_PerformCommand( 0, EEFC_FCR_FKEY(0x5A) | EEFC_FCR_FARG(dwArgument) | EEFC_FCR_FCMD(dwCommand) ) ;
|
|
||||||
|
|
||||||
return (efc->EEFC_FSR & (EEFC_FSR_FLOCKE | EEFC_FSR_FCMDE)) ;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
uint32_t dwStatus ;
|
|
||||||
|
|
||||||
efc->EEFC_FCR = EEFC_FCR_FKEY(0x5A) | EEFC_FCR_FARG(dwArgument) | EEFC_FCR_FCMD(dwCommand) ;
|
|
||||||
do
|
|
||||||
{
|
|
||||||
dwStatus = efc->EEFC_FSR ;
|
|
||||||
}
|
|
||||||
while ( (dwStatus & EEFC_FSR_FRDY) != EEFC_FSR_FRDY ) ;
|
|
||||||
|
|
||||||
return ( dwStatus & (EEFC_FSR_FLOCKE | EEFC_FSR_FCMDE) ) ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
@@ -1,517 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/** \addtogroup flashd_module Flash Memory Interface
|
|
||||||
* The flash driver manages the programming, erasing, locking and unlocking sequences
|
|
||||||
* with dedicated commands.
|
|
||||||
*
|
|
||||||
* To implement flash programing operation, the user has to follow these few steps :
|
|
||||||
* <ul>
|
|
||||||
* <li>Configue flash wait states to initializes the flash. </li>
|
|
||||||
* <li>Checks whether a region to be programmed is locked. </li>
|
|
||||||
* <li>Unlocks the user region to be programmed if the region have locked before.</li>
|
|
||||||
* <li>Erases the user page before program (optional).</li>
|
|
||||||
* <li>Writes the user page from the page buffer.</li>
|
|
||||||
* <li>Locks the region of programmed area if any.</li>
|
|
||||||
* </ul>
|
|
||||||
*
|
|
||||||
* Writing 8-bit and 16-bit data is not allowed and may lead to unpredictable data corruption.
|
|
||||||
* A check of this validity and padding for 32-bit alignment should be done in write algorithm.
|
|
||||||
|
|
||||||
* Lock/unlock range associated with the user address range is automatically translated.
|
|
||||||
*
|
|
||||||
* This security bit can be enabled through the command "Set General Purpose NVM Bit 0".
|
|
||||||
*
|
|
||||||
* A 128-bit factory programmed unique ID could be read to serve several purposes.
|
|
||||||
*
|
|
||||||
* The driver accesses the flash memory by calling the lowlevel module provided in \ref efc_module.
|
|
||||||
* For more accurate information, please look at the EEFC section of the Datasheet.
|
|
||||||
*
|
|
||||||
* Related files :\n
|
|
||||||
* \ref flashd.c\n
|
|
||||||
* \ref flashd.h.\n
|
|
||||||
* \ref efc.c\n
|
|
||||||
* \ref efc.h.\n
|
|
||||||
*/
|
|
||||||
/*@{*/
|
|
||||||
/*@}*/
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \file
|
|
||||||
*
|
|
||||||
* The flash driver provides the unified interface for flash program operations.
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Headers
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
#include "chip.h"
|
|
||||||
#include "flashd.h"
|
|
||||||
#include "efc.h"
|
|
||||||
|
|
||||||
#include <string.h>
|
|
||||||
#include <assert.h>
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Local variables
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
//static NO_INIT uint8_t _aucPageBuffer[IFLASH_PAGE_SIZE] ;
|
|
||||||
static NO_INIT uint32_t _adwPageBuffer[IFLASH_PAGE_SIZE/4] ;
|
|
||||||
static uint8_t* _aucPageBuffer = (uint8_t*)_adwPageBuffer;
|
|
||||||
static NO_INIT uint32_t _dwUseIAP ;
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Local macros
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
#define min( a, b ) (((a) < (b)) ? (a) : (b))
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Local functions
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Computes the lock range associated with the given address range.
|
|
||||||
*
|
|
||||||
* \param dwStart Start address of lock range.
|
|
||||||
* \param dwEnd End address of lock range.
|
|
||||||
* \param pdwActualStart Actual start address of lock range.
|
|
||||||
* \param pdwActualEnd Actual end address of lock range.
|
|
||||||
*/
|
|
||||||
static void ComputeLockRange( uint32_t dwStart, uint32_t dwEnd, uint32_t *pdwActualStart, uint32_t *pdwActualEnd )
|
|
||||||
{
|
|
||||||
Efc* pStartEfc ;
|
|
||||||
Efc* pEndEfc ;
|
|
||||||
uint16_t wStartPage ;
|
|
||||||
uint16_t wEndPage ;
|
|
||||||
uint16_t wNumPagesInRegion ;
|
|
||||||
uint16_t wActualStartPage ;
|
|
||||||
uint16_t wActualEndPage ;
|
|
||||||
|
|
||||||
// Convert start and end address in page numbers
|
|
||||||
EFC_TranslateAddress( &pStartEfc, dwStart, &wStartPage, 0 ) ;
|
|
||||||
EFC_TranslateAddress( &pEndEfc, dwEnd, &wEndPage, 0 ) ;
|
|
||||||
|
|
||||||
// Find out the first page of the first region to lock
|
|
||||||
wNumPagesInRegion = IFLASH_LOCK_REGION_SIZE / IFLASH_PAGE_SIZE ;
|
|
||||||
wActualStartPage = wStartPage - (wStartPage % wNumPagesInRegion) ;
|
|
||||||
wActualEndPage = wEndPage ;
|
|
||||||
|
|
||||||
if ( (wEndPage % wNumPagesInRegion) != 0 )
|
|
||||||
{
|
|
||||||
wActualEndPage += wNumPagesInRegion - (wEndPage % wNumPagesInRegion) ;
|
|
||||||
}
|
|
||||||
// Store actual page numbers
|
|
||||||
EFC_ComputeAddress( pStartEfc, wActualStartPage, 0, pdwActualStart ) ;
|
|
||||||
EFC_ComputeAddress( pEndEfc, wActualEndPage, 0, pdwActualEnd ) ;
|
|
||||||
TRACE_DEBUG( "Actual lock range is 0x%06X - 0x%06X\n\r", *pdwActualStart, *pdwActualEnd ) ;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Exported functions
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Initializes the flash driver.
|
|
||||||
*
|
|
||||||
* \param mck Master clock frequency in Hz.
|
|
||||||
*/
|
|
||||||
|
|
||||||
extern void FLASHD_Initialize( uint32_t dwMCk, uint32_t dwUseIAP )
|
|
||||||
{
|
|
||||||
EFC_DisableFrdyIt( EFC ) ;
|
|
||||||
#if 1
|
|
||||||
/* See Revision A errata 46.1.1.3 */
|
|
||||||
EFC_SetWaitState(EFC, 6);
|
|
||||||
#else
|
|
||||||
if ( (dwMCk/1000000) >= 64 )
|
|
||||||
{
|
|
||||||
EFC_SetWaitState( EFC, 2 ) ;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
if ( (dwMCk/1000000) >= 50 )
|
|
||||||
{
|
|
||||||
EFC_SetWaitState( EFC, 1 ) ;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
EFC_SetWaitState( EFC, 0 ) ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
_dwUseIAP=dwUseIAP ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Erases the entire flash.
|
|
||||||
*
|
|
||||||
* \param address Flash start address.
|
|
||||||
* \return 0 if successful; otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_Erase( uint32_t dwAddress )
|
|
||||||
{
|
|
||||||
Efc* pEfc ;
|
|
||||||
uint16_t wPage ;
|
|
||||||
uint16_t wOffset ;
|
|
||||||
uint32_t dwError ;
|
|
||||||
|
|
||||||
assert( (dwAddress >=IFLASH_ADDR) || (dwAddress <= (IFLASH_ADDR + IFLASH_SIZE)) ) ;
|
|
||||||
|
|
||||||
// Translate write address
|
|
||||||
EFC_TranslateAddress( &pEfc, dwAddress, &wPage, &wOffset ) ;
|
|
||||||
dwError = EFC_PerformCommand( pEfc, EFC_FCMD_EA, 0, _dwUseIAP ) ;
|
|
||||||
|
|
||||||
return dwError ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Writes a data buffer in the internal flash
|
|
||||||
*
|
|
||||||
* \note This function works in polling mode, and thus only returns when the
|
|
||||||
* data has been effectively written.
|
|
||||||
* \param address Write address.
|
|
||||||
* \param pBuffer Data buffer.
|
|
||||||
* \param size Size of data buffer in bytes.
|
|
||||||
* \return 0 if successful, otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_Write( uint32_t dwAddress, const void *pvBuffer, uint32_t dwSize )
|
|
||||||
{
|
|
||||||
Efc* pEfc ;
|
|
||||||
uint16_t page ;
|
|
||||||
uint16_t offset ;
|
|
||||||
uint32_t writeSize ;
|
|
||||||
uint32_t pageAddress ;
|
|
||||||
uint16_t padding ;
|
|
||||||
uint32_t dwError ;
|
|
||||||
uint32_t sizeTmp ;
|
|
||||||
uint32_t *pAlignedDestination ;
|
|
||||||
uint32_t *pAlignedSource ;
|
|
||||||
|
|
||||||
assert( pvBuffer ) ;
|
|
||||||
assert( dwAddress >=IFLASH_ADDR ) ;
|
|
||||||
assert( (dwAddress + dwSize) <= (IFLASH_ADDR + IFLASH_SIZE) ) ;
|
|
||||||
|
|
||||||
/* Translate write address */
|
|
||||||
EFC_TranslateAddress( &pEfc, dwAddress, &page, &offset ) ;
|
|
||||||
|
|
||||||
/* Write all pages */
|
|
||||||
while ( dwSize > 0 )
|
|
||||||
{
|
|
||||||
/* Copy data in temporary buffer to avoid alignment problems */
|
|
||||||
writeSize = min((uint32_t)IFLASH_PAGE_SIZE - offset, dwSize ) ;
|
|
||||||
EFC_ComputeAddress(pEfc, page, 0, &pageAddress ) ;
|
|
||||||
padding = IFLASH_PAGE_SIZE - offset - writeSize ;
|
|
||||||
|
|
||||||
/* Pre-buffer data */
|
|
||||||
memcpy( _aucPageBuffer, (void *) pageAddress, offset);
|
|
||||||
|
|
||||||
/* Buffer data */
|
|
||||||
memcpy( _aucPageBuffer + offset, pvBuffer, writeSize);
|
|
||||||
|
|
||||||
/* Post-buffer data */
|
|
||||||
memcpy( _aucPageBuffer + offset + writeSize, (void *) (pageAddress + offset + writeSize), padding);
|
|
||||||
|
|
||||||
/* Write page
|
|
||||||
* Writing 8-bit and 16-bit data is not allowed and may lead to unpredictable data corruption
|
|
||||||
*/
|
|
||||||
pAlignedDestination = (uint32_t*)pageAddress ;
|
|
||||||
pAlignedSource = (uint32_t*)_adwPageBuffer ;
|
|
||||||
sizeTmp = IFLASH_PAGE_SIZE ;
|
|
||||||
|
|
||||||
while ( sizeTmp >= 4 )
|
|
||||||
{
|
|
||||||
*pAlignedDestination++ = *pAlignedSource++;
|
|
||||||
sizeTmp -= 4;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Send writing command */
|
|
||||||
dwError = EFC_PerformCommand( pEfc, EFC_FCMD_EWP, page, _dwUseIAP ) ;
|
|
||||||
if ( dwError )
|
|
||||||
{
|
|
||||||
return dwError ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Progression */
|
|
||||||
dwAddress += IFLASH_PAGE_SIZE ;
|
|
||||||
pvBuffer = (void *)((uint32_t) pvBuffer + writeSize) ;
|
|
||||||
dwSize -= writeSize ;
|
|
||||||
page++;
|
|
||||||
offset = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0 ;
|
|
||||||
}
|
|
||||||
/**
|
|
||||||
* \brief Locks all the regions in the given address range. The actual lock range is
|
|
||||||
* reported through two output parameters.
|
|
||||||
*
|
|
||||||
* \param start Start address of lock range.
|
|
||||||
* \param end End address of lock range.
|
|
||||||
* \param pActualStart Start address of the actual lock range (optional).
|
|
||||||
* \param pActualEnd End address of the actual lock range (optional).
|
|
||||||
* \return 0 if successful, otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_Lock( uint32_t start, uint32_t end, uint32_t *pActualStart, uint32_t *pActualEnd )
|
|
||||||
{
|
|
||||||
Efc *pEfc ;
|
|
||||||
uint32_t actualStart, actualEnd ;
|
|
||||||
uint16_t startPage, endPage ;
|
|
||||||
uint32_t dwError ;
|
|
||||||
uint16_t numPagesInRegion = IFLASH_LOCK_REGION_SIZE / IFLASH_PAGE_SIZE;
|
|
||||||
|
|
||||||
/* Compute actual lock range and store it */
|
|
||||||
ComputeLockRange( start, end, &actualStart, &actualEnd ) ;
|
|
||||||
if ( pActualStart != NULL )
|
|
||||||
{
|
|
||||||
*pActualStart = actualStart ;
|
|
||||||
}
|
|
||||||
if ( pActualEnd != NULL )
|
|
||||||
{
|
|
||||||
*pActualEnd = actualEnd;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Compute page numbers */
|
|
||||||
EFC_TranslateAddress( &pEfc, actualStart, &startPage, 0 ) ;
|
|
||||||
EFC_TranslateAddress( 0, actualEnd, &endPage, 0 ) ;
|
|
||||||
|
|
||||||
/* Lock all pages */
|
|
||||||
while ( startPage < endPage )
|
|
||||||
{
|
|
||||||
dwError = EFC_PerformCommand( pEfc, EFC_FCMD_SLB, startPage, _dwUseIAP ) ;
|
|
||||||
if ( dwError )
|
|
||||||
{
|
|
||||||
return dwError ;
|
|
||||||
}
|
|
||||||
startPage += numPagesInRegion;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0 ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Unlocks all the regions in the given address range. The actual unlock range is
|
|
||||||
* reported through two output parameters.
|
|
||||||
* \param start Start address of unlock range.
|
|
||||||
* \param end End address of unlock range.
|
|
||||||
* \param pActualStart Start address of the actual unlock range (optional).
|
|
||||||
* \param pActualEnd End address of the actual unlock range (optional).
|
|
||||||
* \return 0 if successful, otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_Unlock( uint32_t start, uint32_t end, uint32_t *pActualStart, uint32_t *pActualEnd )
|
|
||||||
{
|
|
||||||
Efc* pEfc ;
|
|
||||||
uint32_t actualStart, actualEnd ;
|
|
||||||
uint16_t startPage, endPage ;
|
|
||||||
uint32_t dwError ;
|
|
||||||
uint16_t numPagesInRegion = IFLASH_LOCK_REGION_SIZE / IFLASH_PAGE_SIZE;
|
|
||||||
|
|
||||||
// Compute actual unlock range and store it
|
|
||||||
ComputeLockRange(start, end, &actualStart, &actualEnd);
|
|
||||||
if ( pActualStart != NULL )
|
|
||||||
{
|
|
||||||
*pActualStart = actualStart ;
|
|
||||||
}
|
|
||||||
if ( pActualEnd != NULL )
|
|
||||||
{
|
|
||||||
*pActualEnd = actualEnd ;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Compute page numbers
|
|
||||||
EFC_TranslateAddress( &pEfc, actualStart, &startPage, 0 ) ;
|
|
||||||
EFC_TranslateAddress( 0, actualEnd, &endPage, 0 ) ;
|
|
||||||
|
|
||||||
// Unlock all pages
|
|
||||||
while ( startPage < endPage )
|
|
||||||
{
|
|
||||||
dwError = EFC_PerformCommand( pEfc, EFC_FCMD_CLB, startPage, _dwUseIAP ) ;
|
|
||||||
if ( dwError )
|
|
||||||
{
|
|
||||||
return dwError ;
|
|
||||||
}
|
|
||||||
startPage += numPagesInRegion ;
|
|
||||||
}
|
|
||||||
return 0 ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Returns the number of locked regions inside the given address range.
|
|
||||||
*
|
|
||||||
* \param start Start address of range
|
|
||||||
* \param end End address of range.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_IsLocked( uint32_t start, uint32_t end )
|
|
||||||
{
|
|
||||||
Efc *pEfc ;
|
|
||||||
uint16_t startPage, endPage ;
|
|
||||||
uint8_t startRegion, endRegion ;
|
|
||||||
uint32_t numPagesInRegion ;
|
|
||||||
uint32_t status ;
|
|
||||||
uint32_t dwError ;
|
|
||||||
uint32_t numLockedRegions = 0 ;
|
|
||||||
|
|
||||||
assert( end >= start ) ;
|
|
||||||
assert( (start >=IFLASH_ADDR) && (end <= IFLASH_ADDR + IFLASH_SIZE) ) ;
|
|
||||||
|
|
||||||
// Compute page numbers
|
|
||||||
EFC_TranslateAddress( &pEfc, start, &startPage, 0 ) ;
|
|
||||||
EFC_TranslateAddress( 0, end, &endPage, 0 ) ;
|
|
||||||
|
|
||||||
// Compute region numbers
|
|
||||||
numPagesInRegion = IFLASH_LOCK_REGION_SIZE / IFLASH_PAGE_SIZE ;
|
|
||||||
startRegion = startPage / numPagesInRegion ;
|
|
||||||
endRegion = endPage / numPagesInRegion ;
|
|
||||||
if ((endPage % numPagesInRegion) != 0)
|
|
||||||
{
|
|
||||||
endRegion++ ;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Retrieve lock status
|
|
||||||
dwError = EFC_PerformCommand( pEfc, EFC_FCMD_GLB, 0, _dwUseIAP ) ;
|
|
||||||
assert( !dwError ) ;
|
|
||||||
status = EFC_GetResult( pEfc ) ;
|
|
||||||
|
|
||||||
// Check status of each involved region
|
|
||||||
while ( startRegion < endRegion )
|
|
||||||
{
|
|
||||||
if ( (status & (1 << startRegion)) != 0 )
|
|
||||||
{
|
|
||||||
numLockedRegions++ ;
|
|
||||||
}
|
|
||||||
startRegion++ ;
|
|
||||||
}
|
|
||||||
|
|
||||||
return numLockedRegions ;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Check if the given GPNVM bit is set or not.
|
|
||||||
*
|
|
||||||
* \param gpnvm GPNVM bit index.
|
|
||||||
* \returns 1 if the given GPNVM bit is currently set; otherwise returns 0.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_IsGPNVMSet( uint8_t ucGPNVM )
|
|
||||||
{
|
|
||||||
uint32_t dwError ;
|
|
||||||
uint32_t dwStatus ;
|
|
||||||
|
|
||||||
assert( ucGPNVM < 2 ) ;
|
|
||||||
|
|
||||||
/* Get GPNVMs status */
|
|
||||||
dwError = EFC_PerformCommand( EFC, EFC_FCMD_GFB, 0, _dwUseIAP ) ;
|
|
||||||
assert( !dwError ) ;
|
|
||||||
dwStatus = EFC_GetResult( EFC ) ;
|
|
||||||
|
|
||||||
/* Check if GPNVM is set */
|
|
||||||
if ( (dwStatus & (1 << ucGPNVM)) != 0 )
|
|
||||||
{
|
|
||||||
return 1 ;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
return 0 ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Sets the selected GPNVM bit.
|
|
||||||
*
|
|
||||||
* \param gpnvm GPNVM bit index.
|
|
||||||
* \returns 0 if successful; otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_SetGPNVM( uint8_t ucGPNVM )
|
|
||||||
{
|
|
||||||
assert( ucGPNVM < 2 ) ;
|
|
||||||
|
|
||||||
if ( !FLASHD_IsGPNVMSet( ucGPNVM ) )
|
|
||||||
{
|
|
||||||
return EFC_PerformCommand( EFC, EFC_FCMD_SFB, ucGPNVM, _dwUseIAP ) ;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
return 0 ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* \brief Clears the selected GPNVM bit.
|
|
||||||
*
|
|
||||||
* \param gpnvm GPNVM bit index.
|
|
||||||
* \returns 0 if successful; otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_ClearGPNVM( uint8_t ucGPNVM )
|
|
||||||
{
|
|
||||||
assert( ucGPNVM < 2 ) ;
|
|
||||||
|
|
||||||
if ( FLASHD_IsGPNVMSet( ucGPNVM ) )
|
|
||||||
{
|
|
||||||
return EFC_PerformCommand( EFC, EFC_FCMD_CFB, ucGPNVM, _dwUseIAP ) ;
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
return 0 ;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
/**
|
|
||||||
* \brief Read the unique ID.
|
|
||||||
*
|
|
||||||
* \param uniqueID pointer on a 4bytes char containing the unique ID value.
|
|
||||||
* \returns 0 if successful; otherwise returns an error code.
|
|
||||||
*/
|
|
||||||
extern uint32_t FLASHD_ReadUniqueID( uint32_t* pdwUniqueID )
|
|
||||||
{
|
|
||||||
uint32_t dwError ;
|
|
||||||
|
|
||||||
assert( pdwUniqueID != NULL ) ;
|
|
||||||
|
|
||||||
pdwUniqueID[0] = 0 ;
|
|
||||||
pdwUniqueID[1] = 0 ;
|
|
||||||
pdwUniqueID[2] = 0 ;
|
|
||||||
pdwUniqueID[3] = 0 ;
|
|
||||||
|
|
||||||
EFC_StartCommand( EFC, EFC_FCMD_STUI, 0 ) ;
|
|
||||||
|
|
||||||
pdwUniqueID[0] = *(uint32_t*) IFLASH_ADDR;
|
|
||||||
pdwUniqueID[1] = *(uint32_t*)(IFLASH_ADDR + 4) ;
|
|
||||||
pdwUniqueID[2] = *(uint32_t*)(IFLASH_ADDR + 8) ;
|
|
||||||
pdwUniqueID[3] = *(uint32_t*)(IFLASH_ADDR + 12) ;
|
|
||||||
|
|
||||||
dwError = EFC_PerformCommand( EFC, EFC_FCMD_SPUI, 0, _dwUseIAP ) ;
|
|
||||||
if ( dwError )
|
|
||||||
{
|
|
||||||
return dwError ;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0 ;
|
|
||||||
}
|
|
||||||
@@ -1,43 +0,0 @@
|
|||||||
#include "chip.h"
|
|
||||||
|
|
||||||
#define EFC_FCMD_STUI 0x0E
|
|
||||||
#define EFC_FCMD_SPUI 0x0F
|
|
||||||
|
|
||||||
__attribute__ ((section(".ramfunc")))
|
|
||||||
void EEFC_ReadUniqueID(unsigned int *pdwUniqueID)
|
|
||||||
{
|
|
||||||
unsigned int status;
|
|
||||||
|
|
||||||
/* Errata / Workaround: Set bit 16 of EEFC Flash Mode Register
|
|
||||||
* to 1 */
|
|
||||||
EFC->EEFC_FMR |= (1 << 16);
|
|
||||||
|
|
||||||
/* Send the Start Read unique Identifier command (STUI) by
|
|
||||||
* writing the Flash Command Register with the STUI command. */
|
|
||||||
EFC->EEFC_FCR = (0x5A << 24) | EFC_FCMD_STUI;
|
|
||||||
|
|
||||||
/* Wait for the FRDY bit to fall */
|
|
||||||
do {
|
|
||||||
status = EFC->EEFC_FSR;
|
|
||||||
} while ((status & EEFC_FSR_FRDY) == EEFC_FSR_FRDY);
|
|
||||||
|
|
||||||
/* The Unique Identifier is located in the first 128 bits of the
|
|
||||||
* Flash memory mapping. So, at the address 0x400000-0x400003.
|
|
||||||
* */
|
|
||||||
pdwUniqueID[0] = *(uint32_t *) IFLASH_ADDR;
|
|
||||||
pdwUniqueID[1] = *(uint32_t *) (IFLASH_ADDR + 4);
|
|
||||||
pdwUniqueID[2] = *(uint32_t *) (IFLASH_ADDR + 8);
|
|
||||||
pdwUniqueID[3] = *(uint32_t *) (IFLASH_ADDR + 12);
|
|
||||||
|
|
||||||
/* To stop the Unique Identifier mode, the user needs to send
|
|
||||||
* the Stop Read unique Identifier command (SPUI) by writing the
|
|
||||||
* Flash Command Register with the SPUI command. */
|
|
||||||
EFC->EEFC_FCR = (0x5A << 24) | EFC_FCMD_SPUI;
|
|
||||||
|
|
||||||
/* When the Stop read Unique Unique Identifier command (SPUI)
|
|
||||||
* has been performed, the FRDY bit in the Flash Programming
|
|
||||||
* Status Register (EEFC_FSR) rises. */
|
|
||||||
do {
|
|
||||||
status = EFC->EEFC_FSR;
|
|
||||||
} while ((status & EEFC_FSR_FRDY) != EEFC_FSR_FRDY);
|
|
||||||
}
|
|
||||||
@@ -1,81 +0,0 @@
|
|||||||
#ifndef _USB_DFU_H
|
|
||||||
#define _USB_DFU_H
|
|
||||||
/* USB Device Firmware Update Implementation for OpenPCD
|
|
||||||
* (C) 2006 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* Protocol definitions for USB DFU
|
|
||||||
*
|
|
||||||
* This ought to be compliant to the USB DFU Spec 1.0 as available from
|
|
||||||
* http://www.usb.org/developers/devclass_docs/usbdfu10.pdf
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
#include <usb/include/USBRequests.h>
|
|
||||||
|
|
||||||
#define USB_DT_DFU 0x21
|
|
||||||
|
|
||||||
struct usb_dfu_func_descriptor {
|
|
||||||
uint8_t bLength;
|
|
||||||
uint8_t bDescriptorType;
|
|
||||||
uint8_t bmAttributes;
|
|
||||||
#define USB_DFU_CAN_DOWNLOAD (1 << 0)
|
|
||||||
#define USB_DFU_CAN_UPLOAD (1 << 1)
|
|
||||||
#define USB_DFU_MANIFEST_TOL (1 << 2)
|
|
||||||
#define USB_DFU_WILL_DETACH (1 << 3)
|
|
||||||
uint16_t wDetachTimeOut;
|
|
||||||
uint16_t wTransferSize;
|
|
||||||
uint16_t bcdDFUVersion;
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
#define USB_DT_DFU_SIZE 9
|
|
||||||
|
|
||||||
/* DFU class-specific requests (Section 3, DFU Rev 1.1) */
|
|
||||||
#define USB_REQ_DFU_DETACH 0x00
|
|
||||||
#define USB_REQ_DFU_DNLOAD 0x01
|
|
||||||
#define USB_REQ_DFU_UPLOAD 0x02
|
|
||||||
#define USB_REQ_DFU_GETSTATUS 0x03
|
|
||||||
#define USB_REQ_DFU_CLRSTATUS 0x04
|
|
||||||
#define USB_REQ_DFU_GETSTATE 0x05
|
|
||||||
#define USB_REQ_DFU_ABORT 0x06
|
|
||||||
|
|
||||||
struct dfu_status {
|
|
||||||
uint8_t bStatus;
|
|
||||||
uint8_t bwPollTimeout[3];
|
|
||||||
uint8_t bState;
|
|
||||||
uint8_t iString;
|
|
||||||
} __attribute__((packed));
|
|
||||||
|
|
||||||
#define DFU_STATUS_OK 0x00
|
|
||||||
#define DFU_STATUS_errTARGET 0x01
|
|
||||||
#define DFU_STATUS_errFILE 0x02
|
|
||||||
#define DFU_STATUS_errWRITE 0x03
|
|
||||||
#define DFU_STATUS_errERASE 0x04
|
|
||||||
#define DFU_STATUS_errCHECK_ERASED 0x05
|
|
||||||
#define DFU_STATUS_errPROG 0x06
|
|
||||||
#define DFU_STATUS_errVERIFY 0x07
|
|
||||||
#define DFU_STATUS_errADDRESS 0x08
|
|
||||||
#define DFU_STATUS_errNOTDONE 0x09
|
|
||||||
#define DFU_STATUS_errFIRMWARE 0x0a
|
|
||||||
#define DFU_STATUS_errVENDOR 0x0b
|
|
||||||
#define DFU_STATUS_errUSBR 0x0c
|
|
||||||
#define DFU_STATUS_errPOR 0x0d
|
|
||||||
#define DFU_STATUS_errUNKNOWN 0x0e
|
|
||||||
#define DFU_STATUS_errSTALLEDPKT 0x0f
|
|
||||||
|
|
||||||
enum dfu_state {
|
|
||||||
DFU_STATE_appIDLE = 0,
|
|
||||||
DFU_STATE_appDETACH = 1,
|
|
||||||
DFU_STATE_dfuIDLE = 2,
|
|
||||||
DFU_STATE_dfuDNLOAD_SYNC = 3,
|
|
||||||
DFU_STATE_dfuDNBUSY = 4,
|
|
||||||
DFU_STATE_dfuDNLOAD_IDLE = 5,
|
|
||||||
DFU_STATE_dfuMANIFEST_SYNC = 6,
|
|
||||||
DFU_STATE_dfuMANIFEST = 7,
|
|
||||||
DFU_STATE_dfuMANIFEST_WAIT_RST = 8,
|
|
||||||
DFU_STATE_dfuUPLOAD_IDLE = 9,
|
|
||||||
DFU_STATE_dfuERROR = 10,
|
|
||||||
};
|
|
||||||
|
|
||||||
#endif /* _USB_DFU_H */
|
|
||||||
@@ -1,49 +0,0 @@
|
|||||||
|
|
||||||
#include <usb/include/USBDescriptors.h>
|
|
||||||
#include <usb/device/dfu/dfu.h>
|
|
||||||
|
|
||||||
|
|
||||||
/* String 1 "SimTrace DFU Interface - Application Partition" */
|
|
||||||
const struct USBStringDescriptor USBDFU_string1 = {
|
|
||||||
.hdr = {
|
|
||||||
.bLength = sizeof(USBGenericDescriptor) + 46 * sizeof(unsigned short),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_STRING,
|
|
||||||
},
|
|
||||||
.wData = { 0x0053, 0x0069, 0x006d, 0x0054, 0x0072, 0x0061,
|
|
||||||
0x0063, 0x0065, 0x0020, 0x0044, 0x0046, 0x0055,
|
|
||||||
0x0020, 0x0049, 0x006e, 0x0074, 0x0065, 0x0072,
|
|
||||||
0x0066, 0x0061, 0x0063, 0x0065, 0x0020, 0x002d,
|
|
||||||
0x0020, 0x0041, 0x0070, 0x0070, 0x006c, 0x0069,
|
|
||||||
0x0063, 0x0061, 0x0074, 0x0069, 0x006f, 0x006e,
|
|
||||||
0x0020, 0x0050, 0x0061, 0x0072, 0x0074, 0x0069,
|
|
||||||
0x0074, 0x0069, 0x006f, 0x006e, },
|
|
||||||
};
|
|
||||||
|
|
||||||
/* String 2 "SimTrace DFU Interface - Bootloader Partition" */
|
|
||||||
const struct USBStringDescriptor USBDFU_string2 = {
|
|
||||||
.hdr = {
|
|
||||||
.bLength = sizeof(USBGenericDescriptor) + 45 * sizeof(unsigned short),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_STRING,
|
|
||||||
},
|
|
||||||
.wData = { 0x0053, 0x0069, 0x006d, 0x0054, 0x0072, 0x0061,
|
|
||||||
0x0063, 0x0065, 0x0020, 0x0044, 0x0046, 0x0055,
|
|
||||||
0x0020, 0x0049, 0x006e, 0x0074, 0x0065, 0x0072,
|
|
||||||
0x0066, 0x0061, 0x0063, 0x0065, 0x0020, 0x002d,
|
|
||||||
0x0020, 0x0042, 0x006f, 0x006f, 0x0074, 0x006c,
|
|
||||||
0x006f, 0x0061, 0x0064, 0x0065, 0x0072, 0x0020,
|
|
||||||
0x0050, 0x0061, 0x0072, 0x0074, 0x0069, 0x0074,
|
|
||||||
0x0069, 0x006f, 0x006e, },
|
|
||||||
};
|
|
||||||
|
|
||||||
/* String 3 "SimTrace DFU Interface - RAM" */
|
|
||||||
const struct USBStringDescriptor USBDFU_string3 = {
|
|
||||||
.hdr = {
|
|
||||||
.bLength = sizeof(USBGenericDescriptor) + 28 * sizeof(unsigned short),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_STRING,
|
|
||||||
},
|
|
||||||
.wData = { 0x0053, 0x0069, 0x006d, 0x0054, 0x0072, 0x0061,
|
|
||||||
0x0063, 0x0065, 0x0020, 0x0044, 0x0046, 0x0055,
|
|
||||||
0x0020, 0x0049, 0x006e, 0x0074, 0x0065, 0x0072,
|
|
||||||
0x0066, 0x0061, 0x0063, 0x0065, 0x0020, 0x002d,
|
|
||||||
0x0020, 0x0052, 0x0041, 0x004d, },
|
|
||||||
};
|
|
||||||
@@ -1,131 +0,0 @@
|
|||||||
#ifndef _USB_DEV_DFU_H
|
|
||||||
#define _USB_DEV_DFU_H
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
#include <board.h>
|
|
||||||
#include <usb/include/USBDescriptors.h>
|
|
||||||
#include <usb/include/USBDDriver.h>
|
|
||||||
|
|
||||||
#if 0
|
|
||||||
/* This is valid for CCID */
|
|
||||||
#define CONFIG_DFU_NUM_APP_IF 1
|
|
||||||
#define CONFIG_DFU_NUM_APP_STR 4
|
|
||||||
#else
|
|
||||||
/* This is valid for CDC-Serial */
|
|
||||||
#define CONFIG_DFU_NUM_APP_IF 2
|
|
||||||
#define CONFIG_DFU_NUM_APP_STR 2
|
|
||||||
#endif
|
|
||||||
|
|
||||||
struct USBStringDescriptor {
|
|
||||||
USBGenericDescriptor hdr;
|
|
||||||
unsigned short wData[];
|
|
||||||
} __attribute__((packed));
|
|
||||||
|
|
||||||
|
|
||||||
#ifdef BOARD_USB_DFU
|
|
||||||
|
|
||||||
#include <usb/common/dfu/usb_dfu.h>
|
|
||||||
|
|
||||||
/* for board-specific config */
|
|
||||||
#include <board.h>
|
|
||||||
|
|
||||||
struct dfu_desc {
|
|
||||||
USBConfigurationDescriptor ucfg;
|
|
||||||
USBInterfaceDescriptor uif[BOARD_DFU_NUM_IF];
|
|
||||||
struct usb_dfu_func_descriptor func_dfu;
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
/* USB DFU functional descriptor */
|
|
||||||
#define DFU_FUNC_DESC { \
|
|
||||||
.bLength = USB_DT_DFU_SIZE, \
|
|
||||||
.bDescriptorType = USB_DT_DFU, \
|
|
||||||
.bmAttributes = USB_DFU_CAN_UPLOAD | USB_DFU_CAN_DOWNLOAD, \
|
|
||||||
.wDetachTimeOut = 0xff00, \
|
|
||||||
.wTransferSize = BOARD_DFU_PAGE_SIZE, \
|
|
||||||
.bcdDFUVersion = 0x0100, \
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Number of DFU interface during runtime mode */
|
|
||||||
#define DFURT_NUM_IF 1
|
|
||||||
|
|
||||||
/* to be used by the runtime as part of its USB descriptor structure
|
|
||||||
* declaration */
|
|
||||||
#define DFURT_IF_DESCRIPTOR_STRUCT \
|
|
||||||
USBInterfaceDescriptor dfu_rt; \
|
|
||||||
struct usb_dfu_func_descriptor func_dfu;
|
|
||||||
|
|
||||||
/* to be used by the runtime as part of its USB Dsecriptor structure
|
|
||||||
* definition */
|
|
||||||
#define DFURT_IF_DESCRIPTOR(dfuIF, dfuSTR) \
|
|
||||||
.dfu_rt = { \
|
|
||||||
.bLength = sizeof(USBInterfaceDescriptor), \
|
|
||||||
.bDescriptorType = USBGenericDescriptor_INTERFACE, \
|
|
||||||
.bInterfaceNumber = dfuIF, \
|
|
||||||
.bAlternateSetting = 0, \
|
|
||||||
.bNumEndpoints = 0, \
|
|
||||||
.bInterfaceClass = 0xFE, \
|
|
||||||
.bInterfaceSubClass = 0x01, \
|
|
||||||
.bInterfaceProtocol = 0x01, \
|
|
||||||
.iInterface = dfuSTR, \
|
|
||||||
}, \
|
|
||||||
.func_dfu = DFU_FUNC_DESC \
|
|
||||||
|
|
||||||
/* provided by dfu_desc.c */
|
|
||||||
extern const struct dfu_desc dfu_cfg_descriptor;
|
|
||||||
extern const USBDDriverDescriptors dfu_descriptors;
|
|
||||||
|
|
||||||
#else /* BOARD_USB_DFU */
|
|
||||||
|
|
||||||
/* no DFU bootloader is being used */
|
|
||||||
#define DFURT_NUM_IF 0
|
|
||||||
#define DFURT_IF_DESCRIPTOR_STRUCT(a, b)
|
|
||||||
#define DFURT_IF_DESCRIPTOR
|
|
||||||
|
|
||||||
#endif /* BOARD_USB_DFU */
|
|
||||||
|
|
||||||
/* magic value we use during boot to detect if we should start in DFU
|
|
||||||
* mode or runtime mode */
|
|
||||||
#define USB_DFU_MAGIC 0xDFDFDFDF
|
|
||||||
|
|
||||||
/* The API between the core DFU handler and the board/soc specific code */
|
|
||||||
|
|
||||||
struct dfudata {
|
|
||||||
uint32_t magic;
|
|
||||||
uint8_t status;
|
|
||||||
uint32_t state;
|
|
||||||
int past_manifest;
|
|
||||||
unsigned int total_bytes;
|
|
||||||
};
|
|
||||||
|
|
||||||
/* RAM address for this magic value above */
|
|
||||||
extern struct dfudata _g_dfu;
|
|
||||||
extern struct dfudata *g_dfu;
|
|
||||||
|
|
||||||
void set_usb_serial_str(const uint8_t *serial_usbstr);
|
|
||||||
|
|
||||||
void DFURT_SwitchToDFU(void);
|
|
||||||
|
|
||||||
/* call-backs from DFU USB function driver to the board/SOC */
|
|
||||||
extern int USBDFU_handle_dnload(uint8_t altif, unsigned int offset,
|
|
||||||
uint8_t *data, unsigned int len);
|
|
||||||
extern int USBDFU_handle_upload(uint8_t altif, unsigned int offset,
|
|
||||||
uint8_t *data, unsigned int req_len);
|
|
||||||
|
|
||||||
/* function to be called at end of EP0 handler during runtime */
|
|
||||||
void USBDFU_Runtime_RequestHandler(const USBGenericRequest *request);
|
|
||||||
|
|
||||||
/* function to be called at end of EP0 handler during DFU mode */
|
|
||||||
void USBDFU_DFU_RequestHandler(const USBGenericRequest *request);
|
|
||||||
|
|
||||||
/* initialization of USB DFU driver (in DFU mode */
|
|
||||||
void USBDFU_Initialize(const USBDDriverDescriptors *pDescriptors);
|
|
||||||
|
|
||||||
/* USBD tells us to switch from DFU mode to application mode */
|
|
||||||
void USBDFU_SwitchToApp(void);
|
|
||||||
|
|
||||||
/* Return values to be used by USBDFU_handle_{dn,up}load */
|
|
||||||
#define DFU_RET_NOTHING 0
|
|
||||||
#define DFU_RET_ZLP 1
|
|
||||||
#define DFU_RET_STALL 2
|
|
||||||
|
|
||||||
#endif
|
|
||||||
@@ -1,214 +0,0 @@
|
|||||||
/* DFU related USB Descriptors */
|
|
||||||
/* (C) 2006-2017 Harald Welte <hwelte@hmw-consulting.de> */
|
|
||||||
|
|
||||||
#include <unistd.h>
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "utils.h"
|
|
||||||
|
|
||||||
#include <usb/include/USBDescriptors.h>
|
|
||||||
|
|
||||||
#include <usb/include/USBDDriver.h>
|
|
||||||
|
|
||||||
#include <usb/common/dfu/usb_dfu.h>
|
|
||||||
#include <usb/device/dfu/dfu.h>
|
|
||||||
|
|
||||||
enum {
|
|
||||||
STR_MANUF = 1,
|
|
||||||
STR_PROD,
|
|
||||||
STR_CONFIG,
|
|
||||||
_STR_FIRST_ALT,
|
|
||||||
STR_SERIAL = (_STR_FIRST_ALT+BOARD_DFU_NUM_IF),
|
|
||||||
};
|
|
||||||
|
|
||||||
static const USBDeviceDescriptor fsDevice = {
|
|
||||||
.bLength = sizeof(USBDeviceDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_DEVICE,
|
|
||||||
.bcdUSB = USBDeviceDescriptor_USB2_00,
|
|
||||||
.bDeviceClass = 0,
|
|
||||||
.bDeviceSubClass = 0,
|
|
||||||
.bDeviceProtocol = 0,
|
|
||||||
.bMaxPacketSize0 = BOARD_USB_ENDPOINTS_MAXPACKETSIZE(0),
|
|
||||||
.idVendor = BOARD_USB_VENDOR,
|
|
||||||
.idProduct = BOARD_USB_PRODUCT,
|
|
||||||
.bcdDevice = BOARD_USB_RELEASE,
|
|
||||||
.iManufacturer = STR_MANUF,
|
|
||||||
.iProduct = STR_PROD,
|
|
||||||
#ifdef BOARD_USB_SERIAL
|
|
||||||
.iSerialNumber = STR_SERIAL,
|
|
||||||
#else
|
|
||||||
.iSerialNumber = 0,
|
|
||||||
#endif
|
|
||||||
.bNumConfigurations = 1,
|
|
||||||
};
|
|
||||||
|
|
||||||
/* Alternate Interface Descriptor, we use one per partition/memory type */
|
|
||||||
#define DFU_IF(ALT) \
|
|
||||||
{ \
|
|
||||||
.bLength = sizeof(USBInterfaceDescriptor), \
|
|
||||||
.bDescriptorType = USBGenericDescriptor_INTERFACE, \
|
|
||||||
.bInterfaceNumber = 0, \
|
|
||||||
.bAlternateSetting = ALT, \
|
|
||||||
.bNumEndpoints = 0, \
|
|
||||||
.bInterfaceClass = 0xfe, \
|
|
||||||
.bInterfaceSubClass = 1, \
|
|
||||||
.iInterface = (_STR_FIRST_ALT+ALT), \
|
|
||||||
.bInterfaceProtocol = 2, \
|
|
||||||
}
|
|
||||||
|
|
||||||
/* overall descriptor for the DFU configuration, including all
|
|
||||||
* descriptors for alternate interfaces */
|
|
||||||
const struct dfu_desc dfu_cfg_descriptor = {
|
|
||||||
.ucfg = {
|
|
||||||
.bLength = sizeof(USBConfigurationDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_CONFIGURATION,
|
|
||||||
.wTotalLength = sizeof(struct dfu_desc),
|
|
||||||
.bNumInterfaces = 1,
|
|
||||||
.bConfigurationValue = 1,
|
|
||||||
.iConfiguration = STR_CONFIG,
|
|
||||||
.bmAttributes = BOARD_USB_BMATTRIBUTES,
|
|
||||||
.bMaxPower = 100,
|
|
||||||
},
|
|
||||||
.uif[0] = DFU_IF(0),
|
|
||||||
#if BOARD_DFU_NUM_IF > 1
|
|
||||||
.uif[1] = DFU_IF(1),
|
|
||||||
#endif
|
|
||||||
#if BOARD_DFU_NUM_IF > 2
|
|
||||||
.uif[2] = DFU_IF(2),
|
|
||||||
#endif
|
|
||||||
#if BOARD_DFU_NUM_IF > 3
|
|
||||||
.uif[3] = DFU_IF(3),
|
|
||||||
#endif
|
|
||||||
#if BOARD_DFU_NUM_IF > 4
|
|
||||||
.uif[4] = DFU_IF(4),
|
|
||||||
#endif
|
|
||||||
.func_dfu = DFU_FUNC_DESC
|
|
||||||
};
|
|
||||||
|
|
||||||
#if 0
|
|
||||||
#include "usb_strings.h"
|
|
||||||
|
|
||||||
|
|
||||||
static const unsigned char *usb_strings[] = {
|
|
||||||
USB_STRINGS_GENERATED
|
|
||||||
#ifdef BOARD_USB_SERIAL
|
|
||||||
NULL
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
|
|
||||||
void set_usb_serial_str(const uint8_t *serial_usbstr)
|
|
||||||
{
|
|
||||||
usb_strings[STR_SERIAL] = serial_usbstr;
|
|
||||||
}
|
|
||||||
#else
|
|
||||||
static const unsigned char langDesc[] = {
|
|
||||||
USBStringDescriptor_LENGTH(1),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_ENGLISH_US
|
|
||||||
};
|
|
||||||
|
|
||||||
static const unsigned char manufStringDescriptor[] = {
|
|
||||||
USBStringDescriptor_LENGTH(24),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('s'),
|
|
||||||
USBStringDescriptor_UNICODE('y'),
|
|
||||||
USBStringDescriptor_UNICODE('s'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('o'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('o'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('-'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('s'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE('f'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('G'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('b'),
|
|
||||||
USBStringDescriptor_UNICODE('H'),
|
|
||||||
};
|
|
||||||
|
|
||||||
static const unsigned char productStringDescriptor[] = {
|
|
||||||
USBStringDescriptor_LENGTH(10),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('2'),
|
|
||||||
};
|
|
||||||
|
|
||||||
|
|
||||||
static const unsigned char configStringDescriptor[] = {
|
|
||||||
USBStringDescriptor_LENGTH(3),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('D'),
|
|
||||||
USBStringDescriptor_UNICODE('F'),
|
|
||||||
USBStringDescriptor_UNICODE('U'),
|
|
||||||
};
|
|
||||||
|
|
||||||
static const unsigned char altRamStringDescriptor[] = {
|
|
||||||
USBStringDescriptor_LENGTH(3),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('R'),
|
|
||||||
USBStringDescriptor_UNICODE('A'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
};
|
|
||||||
|
|
||||||
static const unsigned char altAppStringDescriptor[] = {
|
|
||||||
USBStringDescriptor_LENGTH(11),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('F'),
|
|
||||||
USBStringDescriptor_UNICODE('l'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('s'),
|
|
||||||
USBStringDescriptor_UNICODE('h'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('('),
|
|
||||||
USBStringDescriptor_UNICODE('A'),
|
|
||||||
USBStringDescriptor_UNICODE('p'),
|
|
||||||
USBStringDescriptor_UNICODE('p'),
|
|
||||||
USBStringDescriptor_UNICODE(')'),
|
|
||||||
};
|
|
||||||
|
|
||||||
/** List of string descriptors used by the device */
|
|
||||||
static const unsigned char *usb_strings[] = {
|
|
||||||
langDesc,
|
|
||||||
[STR_MANUF] = manufStringDescriptor,
|
|
||||||
[STR_PROD] = productStringDescriptor,
|
|
||||||
[STR_CONFIG] = configStringDescriptor,
|
|
||||||
[_STR_FIRST_ALT] = altRamStringDescriptor,
|
|
||||||
[_STR_FIRST_ALT+1] = altAppStringDescriptor,
|
|
||||||
};
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static const USBConfigurationDescriptor *conf_desc_arr[] = {
|
|
||||||
&dfu_cfg_descriptor.ucfg,
|
|
||||||
};
|
|
||||||
|
|
||||||
const USBDDriverDescriptors dfu_descriptors = {
|
|
||||||
.pFsDevice = &fsDevice,
|
|
||||||
.pFsConfiguration = (const USBConfigurationDescriptor **)&conf_desc_arr,
|
|
||||||
/* DFU only supports FS for now */
|
|
||||||
.pFsQualifier = NULL,
|
|
||||||
.pFsOtherSpeed = NULL,
|
|
||||||
.pHsDevice = NULL,
|
|
||||||
.pHsConfiguration = NULL,
|
|
||||||
.pHsQualifier = NULL,
|
|
||||||
.pHsOtherSpeed = NULL,
|
|
||||||
.pStrings = usb_strings,
|
|
||||||
.numStrings = ARRAY_SIZE(usb_strings),
|
|
||||||
};
|
|
||||||
@@ -1,478 +0,0 @@
|
|||||||
/* USB Device Firmware Update Implementation for OpenPCD, OpenPICC SIMtrace
|
|
||||||
* (C) 2006-2017 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* This ought to be compliant to the USB DFU Spec 1.0 as available from
|
|
||||||
* http://www.usb.org/developers/devclass_docs/usbdfu10.pdf
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <unistd.h>
|
|
||||||
|
|
||||||
#include <board.h>
|
|
||||||
#include <core_cm3.h>
|
|
||||||
|
|
||||||
#include "trace.h"
|
|
||||||
|
|
||||||
#include <usb/include/USBDescriptors.h>
|
|
||||||
#include <usb/include/USBRequests.h>
|
|
||||||
#include <usb/include/USBD.h>
|
|
||||||
#include <usb/common/dfu/usb_dfu.h>
|
|
||||||
#include <usb/device/dfu/dfu.h>
|
|
||||||
|
|
||||||
/* FIXME: this was used for a special ELF section which then got called
|
|
||||||
* by DFU code and Application code, across flash partitions */
|
|
||||||
#define __dfudata __attribute__ ((section (".dfudata")))
|
|
||||||
#define __dfufunc
|
|
||||||
|
|
||||||
/// Standard device driver instance.
|
|
||||||
static USBDDriver usbdDriver;
|
|
||||||
static unsigned char if_altsettings[1];
|
|
||||||
|
|
||||||
__dfudata struct dfudata _g_dfu = {
|
|
||||||
.state = DFU_STATE_appIDLE,
|
|
||||||
.past_manifest = 0,
|
|
||||||
.total_bytes = 0,
|
|
||||||
};
|
|
||||||
struct dfudata *g_dfu = &_g_dfu;
|
|
||||||
|
|
||||||
WEAK void dfu_drv_updstatus(void)
|
|
||||||
{
|
|
||||||
TRACE_INFO("DFU: updstatus()\n\r");
|
|
||||||
|
|
||||||
/* we transition immediately from MANIFEST_SYNC to MANIFEST,
|
|
||||||
* as the flash-writing is not asynchronous in this
|
|
||||||
* implementation */
|
|
||||||
if (g_dfu->state == DFU_STATE_dfuMANIFEST_SYNC)
|
|
||||||
g_dfu->state = DFU_STATE_dfuMANIFEST;
|
|
||||||
}
|
|
||||||
|
|
||||||
static __dfufunc void handle_getstatus(void)
|
|
||||||
{
|
|
||||||
/* has to be static as USBD_Write is async ? */
|
|
||||||
static struct dfu_status dstat;
|
|
||||||
static const uint8_t poll_timeout_10ms[] = { 10, 0, 0 };
|
|
||||||
|
|
||||||
dfu_drv_updstatus();
|
|
||||||
|
|
||||||
/* send status response */
|
|
||||||
dstat.bStatus = g_dfu->status;
|
|
||||||
dstat.bState = g_dfu->state;
|
|
||||||
dstat.iString = 0;
|
|
||||||
memcpy(&dstat.bwPollTimeout, poll_timeout_10ms, sizeof(dstat.bwPollTimeout));
|
|
||||||
|
|
||||||
TRACE_DEBUG("handle_getstatus(%u, %u)\n\r", dstat.bStatus, dstat.bState);
|
|
||||||
|
|
||||||
USBD_Write(0, (char *)&dstat, sizeof(dstat), NULL, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __dfufunc handle_getstate(void)
|
|
||||||
{
|
|
||||||
uint8_t u8 = g_dfu->state;
|
|
||||||
|
|
||||||
TRACE_DEBUG("handle_getstate(%u)\n\r", g_dfu->state);
|
|
||||||
|
|
||||||
USBD_Write(0, (char *)&u8, sizeof(u8), NULL, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void TerminateCtrlInWithNull(void *pArg,
|
|
||||||
unsigned char status,
|
|
||||||
unsigned long int transferred,
|
|
||||||
unsigned long int remaining)
|
|
||||||
{
|
|
||||||
USBD_Write(0, // Endpoint #0
|
|
||||||
0, // No data buffer
|
|
||||||
0, // No data buffer
|
|
||||||
(TransferCallback) 0,
|
|
||||||
(void *) 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t dfu_buf[BOARD_DFU_PAGE_SIZE];
|
|
||||||
|
|
||||||
/* download of a single page has completed */
|
|
||||||
static void dnload_cb(void *arg, unsigned char status, unsigned long int transferred,
|
|
||||||
unsigned long int remaining)
|
|
||||||
{
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
TRACE_DEBUG("COMPLETE\n\r");
|
|
||||||
|
|
||||||
if (status != USBD_STATUS_SUCCESS) {
|
|
||||||
TRACE_ERROR("USBD download callback status %d\n\r", status);
|
|
||||||
USBD_Stall(0);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
rc = USBDFU_handle_dnload(if_altsettings[0], g_dfu->total_bytes, dfu_buf, transferred);
|
|
||||||
switch (rc) {
|
|
||||||
case DFU_RET_ZLP:
|
|
||||||
g_dfu->total_bytes += transferred;
|
|
||||||
g_dfu->state = DFU_STATE_dfuDNLOAD_IDLE;
|
|
||||||
TerminateCtrlInWithNull(0,0,0,0);
|
|
||||||
break;
|
|
||||||
case DFU_RET_STALL:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
USBD_Stall(0);
|
|
||||||
break;
|
|
||||||
case DFU_RET_NOTHING:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
|
|
||||||
static int handle_dnload(uint16_t val, uint16_t len, int first)
|
|
||||||
{
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
if (len > BOARD_DFU_PAGE_SIZE) {
|
|
||||||
TRACE_ERROR("DFU length exceeds flash page size\n\r");
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
g_dfu->status = DFU_STATUS_errADDRESS;
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (len & 0x03) {
|
|
||||||
TRACE_ERROR("DFU length not four-byte-aligned\n\r");
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
g_dfu->status = DFU_STATUS_errADDRESS;
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (first)
|
|
||||||
g_dfu->total_bytes = 0;
|
|
||||||
|
|
||||||
if (len == 0) {
|
|
||||||
TRACE_DEBUG("zero-size write -> MANIFEST_SYNC\n\r");
|
|
||||||
g_dfu->state = DFU_STATE_dfuMANIFEST_SYNC;
|
|
||||||
return DFU_RET_ZLP;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* else: actually read data */
|
|
||||||
rc = USBD_Read(0, dfu_buf, len, &dnload_cb, 0);
|
|
||||||
if (rc == USBD_STATUS_SUCCESS)
|
|
||||||
return DFU_RET_NOTHING;
|
|
||||||
else
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* upload of a single page has completed */
|
|
||||||
static void upload_cb(void *arg, unsigned char status, unsigned long int transferred,
|
|
||||||
unsigned long int remaining)
|
|
||||||
{
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
TRACE_DEBUG("COMPLETE\n\r");
|
|
||||||
|
|
||||||
if (status != USBD_STATUS_SUCCESS) {
|
|
||||||
TRACE_ERROR("USBD upload callback status %d\n\r", status);
|
|
||||||
USBD_Stall(0);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
g_dfu->total_bytes += transferred;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int handle_upload(uint16_t val, uint16_t len, int first)
|
|
||||||
{
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
if (first)
|
|
||||||
g_dfu->total_bytes = 0;
|
|
||||||
|
|
||||||
if (len > BOARD_DFU_PAGE_SIZE) {
|
|
||||||
TRACE_ERROR("DFU length exceeds flash page size\n\r");
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
g_dfu->status = DFU_STATUS_errADDRESS;
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
|
|
||||||
rc = USBDFU_handle_upload(if_altsettings[0], g_dfu->total_bytes, dfu_buf, len);
|
|
||||||
if (rc < 0) {
|
|
||||||
TRACE_ERROR("application handle_upload() returned %d\n\r", rc);
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (USBD_Write(0, dfu_buf, rc, &upload_cb, 0) == USBD_STATUS_SUCCESS)
|
|
||||||
return rc;
|
|
||||||
|
|
||||||
return DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* this function gets daisy-chained into processing EP0 requests */
|
|
||||||
void USBDFU_DFU_RequestHandler(const USBGenericRequest *request)
|
|
||||||
{
|
|
||||||
uint8_t req = USBGenericRequest_GetRequest(request);
|
|
||||||
uint16_t len = USBGenericRequest_GetLength(request);
|
|
||||||
uint16_t val = USBGenericRequest_GetValue(request);
|
|
||||||
int rc, ret;
|
|
||||||
|
|
||||||
TRACE_DEBUG("type=0x%x, recipient=0x%x val=0x%x len=%u\n\r",
|
|
||||||
USBGenericRequest_GetType(request),
|
|
||||||
USBGenericRequest_GetRecipient(request),
|
|
||||||
val, len);
|
|
||||||
|
|
||||||
/* check for GET_DESCRIPTOR on DFU */
|
|
||||||
if (USBGenericRequest_GetType(request) == USBGenericRequest_STANDARD &&
|
|
||||||
USBGenericRequest_GetRecipient(request) == USBGenericRequest_DEVICE &&
|
|
||||||
USBGenericRequest_GetRequest(request) == USBGenericRequest_GETDESCRIPTOR &&
|
|
||||||
USBGetDescriptorRequest_GetDescriptorType(request) == USB_DT_DFU) {
|
|
||||||
uint16_t length = sizeof(struct usb_dfu_func_descriptor);
|
|
||||||
const USBDeviceDescriptor *pDevice;
|
|
||||||
int terminateWithNull;
|
|
||||||
|
|
||||||
if (USBD_IsHighSpeed())
|
|
||||||
pDevice = usbdDriver.pDescriptors->pHsDevice;
|
|
||||||
else
|
|
||||||
pDevice = usbdDriver.pDescriptors->pFsDevice;
|
|
||||||
|
|
||||||
terminateWithNull = ((length % pDevice->bMaxPacketSize0) == 0);
|
|
||||||
USBD_Write(0, &dfu_cfg_descriptor.func_dfu, length,
|
|
||||||
terminateWithNull ? TerminateCtrlInWithNull : 0, 0);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* forward all non-DFU specific messages to core handler*/
|
|
||||||
if (USBGenericRequest_GetType(request) != USBGenericRequest_CLASS ||
|
|
||||||
USBGenericRequest_GetRecipient(request) != USBGenericRequest_INTERFACE) {
|
|
||||||
TRACE_DEBUG("std_ho_usbd ");
|
|
||||||
USBDDriver_RequestHandler(&usbdDriver, request);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
switch (g_dfu->state) {
|
|
||||||
case DFU_STATE_appIDLE:
|
|
||||||
case DFU_STATE_appDETACH:
|
|
||||||
TRACE_ERROR("Invalid DFU State reached in DFU mode\r\n");
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuIDLE:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_DNLOAD:
|
|
||||||
if (len == 0) {
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
g_dfu->state = DFU_STATE_dfuDNLOAD_SYNC;
|
|
||||||
ret = handle_dnload(val, len, 1);
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_UPLOAD:
|
|
||||||
g_dfu->state = DFU_STATE_dfuUPLOAD_IDLE;
|
|
||||||
handle_upload(val, len, 1);
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_ABORT:
|
|
||||||
/* no zlp? */
|
|
||||||
ret = DFU_RET_ZLP;
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
goto out;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuDNLOAD_SYNC:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
/* FIXME: state transition depending on block completeness */
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuDNBUSY:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
/* FIXME: only accept getstatus if bwPollTimeout
|
|
||||||
* has elapsed */
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuDNLOAD_IDLE:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_DNLOAD:
|
|
||||||
g_dfu->state = DFU_STATE_dfuDNLOAD_SYNC;
|
|
||||||
ret = handle_dnload(val, len, 0);
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_ABORT:
|
|
||||||
g_dfu->state = DFU_STATE_dfuIDLE;
|
|
||||||
ret = DFU_RET_ZLP;
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuMANIFEST_SYNC:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuMANIFEST:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
/* we don't want to change to WAIT_RST, as it
|
|
||||||
* would mean that we can not support another
|
|
||||||
* DFU transaction before doing the actual
|
|
||||||
* reset. Instead, we switch to idle and note
|
|
||||||
* that we've already been through MANIFST in
|
|
||||||
* the global variable 'past_manifest'.
|
|
||||||
*/
|
|
||||||
//g_dfu->state = DFU_STATE_dfuMANIFEST_WAIT_RST;
|
|
||||||
g_dfu->state = DFU_STATE_dfuIDLE;
|
|
||||||
g_dfu->past_manifest = 1;
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuMANIFEST_WAIT_RST:
|
|
||||||
/* we should never go here */
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuUPLOAD_IDLE:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_UPLOAD:
|
|
||||||
/* state transition if less data then requested */
|
|
||||||
rc = handle_upload(val, len, 0);
|
|
||||||
if (rc >= 0 && rc < len)
|
|
||||||
g_dfu->state = DFU_STATE_dfuIDLE;
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_ABORT:
|
|
||||||
g_dfu->state = DFU_STATE_dfuIDLE;
|
|
||||||
/* no zlp? */
|
|
||||||
ret = DFU_RET_ZLP;
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_dfuERROR:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_CLRSTATUS:
|
|
||||||
g_dfu->state = DFU_STATE_dfuIDLE;
|
|
||||||
g_dfu->status = DFU_STATUS_OK;
|
|
||||||
/* no zlp? */
|
|
||||||
ret = DFU_RET_ZLP;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_dfuERROR;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
out:
|
|
||||||
switch (ret) {
|
|
||||||
case DFU_RET_NOTHING:
|
|
||||||
break;
|
|
||||||
case DFU_RET_ZLP:
|
|
||||||
USBD_Write(0, 0, 0, 0, 0);
|
|
||||||
break;
|
|
||||||
case DFU_RET_STALL:
|
|
||||||
USBD_Stall(0);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* we assume the caller has enabled the required clock/PLL for USB */
|
|
||||||
void USBDFU_Initialize(const USBDDriverDescriptors *pDescriptors)
|
|
||||||
{
|
|
||||||
/* We already start in DFU idle mode */
|
|
||||||
g_dfu->state = DFU_STATE_dfuIDLE;
|
|
||||||
|
|
||||||
USBDDriver_Initialize(&usbdDriver, pDescriptors, if_altsettings);
|
|
||||||
USBD_Init();
|
|
||||||
USBD_Connect();
|
|
||||||
//USBD_ConfigureSpeed(1);
|
|
||||||
|
|
||||||
NVIC_EnableIRQ(UDP_IRQn);
|
|
||||||
}
|
|
||||||
|
|
||||||
void USBDFU_SwitchToApp(void)
|
|
||||||
{
|
|
||||||
/* make sure the MAGIC is not set to enter DFU again */
|
|
||||||
g_dfu->magic = 0;
|
|
||||||
|
|
||||||
printf("switching to app\r\n");
|
|
||||||
|
|
||||||
/* disconnect from USB to ensure re-enumeration */
|
|
||||||
USBD_Disconnect();
|
|
||||||
|
|
||||||
/* disable any interrupts during transition */
|
|
||||||
__disable_irq();
|
|
||||||
|
|
||||||
/* Tell the hybrid to execute FTL JUMP! */
|
|
||||||
NVIC_SystemReset();
|
|
||||||
}
|
|
||||||
|
|
||||||
void USBDCallbacks_RequestReceived(const USBGenericRequest *request)
|
|
||||||
{
|
|
||||||
USBDFU_DFU_RequestHandler(request);
|
|
||||||
}
|
|
||||||
@@ -1,200 +0,0 @@
|
|||||||
/* DFU related functions that are active at runtime, i.e. during the
|
|
||||||
* normal operation of the device firmware, *not* during DFU update mode
|
|
||||||
* (C) 2006 Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* This ought to be compliant to the USB DFU Spec 1.0 as available from
|
|
||||||
* http://www.usb.org/developers/devclass_docs/usbdfu10.pdf
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <board.h>
|
|
||||||
#include <core_cm3.h>
|
|
||||||
|
|
||||||
#include <usb/include/USBD.h>
|
|
||||||
#include <usb/device/dfu/dfu.h>
|
|
||||||
|
|
||||||
#include "trace.h"
|
|
||||||
|
|
||||||
#include <usb/include/USBDescriptors.h>
|
|
||||||
#include <usb/include/USBRequests.h>
|
|
||||||
#include <usb/include/USBD.h>
|
|
||||||
#include <usb/common/dfu/usb_dfu.h>
|
|
||||||
#include <usb/device/dfu/dfu.h>
|
|
||||||
|
|
||||||
struct dfudata *g_dfu = (struct dfudata *) IRAM_ADDR;
|
|
||||||
|
|
||||||
/* FIXME: this was used for a special ELF section which then got called
|
|
||||||
* by DFU code and Application code, across flash partitions */
|
|
||||||
#define __dfufunc
|
|
||||||
|
|
||||||
static __dfufunc void handle_getstatus(void)
|
|
||||||
{
|
|
||||||
/* has to be static as USBD_Write is async ? */
|
|
||||||
static struct dfu_status dstat;
|
|
||||||
static const uint8_t poll_timeout_10ms[] = { 10, 0, 0 };
|
|
||||||
|
|
||||||
/* send status response */
|
|
||||||
dstat.bStatus = g_dfu->status;
|
|
||||||
dstat.bState = g_dfu->state;
|
|
||||||
dstat.iString = 0;
|
|
||||||
memcpy(&dstat.bwPollTimeout, poll_timeout_10ms, sizeof(dstat.bwPollTimeout));
|
|
||||||
|
|
||||||
TRACE_DEBUG("handle_getstatus(%u, %u)\n\r", dstat.bStatus, dstat.bState);
|
|
||||||
|
|
||||||
USBD_Write(0, (char *)&dstat, sizeof(dstat), NULL, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __dfufunc handle_getstate(void)
|
|
||||||
{
|
|
||||||
uint8_t u8 = g_dfu->state;
|
|
||||||
|
|
||||||
TRACE_DEBUG("handle_getstate(%u)\n\r", g_dfu->state);
|
|
||||||
|
|
||||||
USBD_Write(0, (char *)&u8, sizeof(u8), NULL, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void TerminateCtrlInWithNull(void *pArg,
|
|
||||||
unsigned char status,
|
|
||||||
unsigned long int transferred,
|
|
||||||
unsigned long int remaining)
|
|
||||||
{
|
|
||||||
USBD_Write(0, // Endpoint #0
|
|
||||||
0, // No data buffer
|
|
||||||
0, // No data buffer
|
|
||||||
(TransferCallback) 0,
|
|
||||||
(void *) 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* this function gets daisy-chained into processing EP0 requests */
|
|
||||||
void USBDFU_Runtime_RequestHandler(const USBGenericRequest *request)
|
|
||||||
{
|
|
||||||
USBDDriver *usbdDriver = USBD_GetDriver();
|
|
||||||
uint8_t req = USBGenericRequest_GetRequest(request);
|
|
||||||
uint16_t len = USBGenericRequest_GetLength(request);
|
|
||||||
uint16_t val = USBGenericRequest_GetValue(request);
|
|
||||||
int rc, ret;
|
|
||||||
|
|
||||||
TRACE_DEBUG("type=0x%x, recipient=0x%x val=0x%x len=%u\n\r",
|
|
||||||
USBGenericRequest_GetType(request),
|
|
||||||
USBGenericRequest_GetRecipient(request),
|
|
||||||
val, len);
|
|
||||||
|
|
||||||
/* check for GET_DESCRIPTOR on DFU */
|
|
||||||
if (USBGenericRequest_GetType(request) == USBGenericRequest_STANDARD &&
|
|
||||||
USBGenericRequest_GetRecipient(request) == USBGenericRequest_DEVICE &&
|
|
||||||
USBGenericRequest_GetRequest(request) == USBGenericRequest_GETDESCRIPTOR &&
|
|
||||||
USBGetDescriptorRequest_GetDescriptorType(request) == USB_DT_DFU) {
|
|
||||||
uint16_t length = sizeof(struct usb_dfu_func_descriptor);
|
|
||||||
const USBDeviceDescriptor *pDevice;
|
|
||||||
int terminateWithNull;
|
|
||||||
|
|
||||||
if (USBD_IsHighSpeed())
|
|
||||||
pDevice = usbdDriver->pDescriptors->pHsDevice;
|
|
||||||
else
|
|
||||||
pDevice = usbdDriver->pDescriptors->pFsDevice;
|
|
||||||
|
|
||||||
terminateWithNull = ((length % pDevice->bMaxPacketSize0) == 0);
|
|
||||||
USBD_Write(0, &dfu_cfg_descriptor.func_dfu, length,
|
|
||||||
terminateWithNull ? TerminateCtrlInWithNull : 0, 0);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* forward all non-DFU specific messages to core handler*/
|
|
||||||
if (USBGenericRequest_GetType(request) != USBGenericRequest_CLASS ||
|
|
||||||
USBGenericRequest_GetRecipient(request) != USBGenericRequest_INTERFACE) {
|
|
||||||
TRACE_DEBUG("std_ho_usbd ");
|
|
||||||
USBDDriver_RequestHandler(usbdDriver, request);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
switch (g_dfu->state) {
|
|
||||||
case DFU_STATE_appIDLE:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_DETACH:
|
|
||||||
/* we switch it DETACH state, send a ZLP and
|
|
||||||
* return. The next USB reset in this state
|
|
||||||
* will then trigger DFURT_SwitchToDFU() below */
|
|
||||||
TRACE_DEBUG("\r\n====dfu_detach\n\r");
|
|
||||||
g_dfu->state = DFU_STATE_appDETACH;
|
|
||||||
ret = DFU_RET_ZLP;
|
|
||||||
goto out;
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DFU_STATE_appDETACH:
|
|
||||||
switch (req) {
|
|
||||||
case USB_REQ_DFU_GETSTATUS:
|
|
||||||
handle_getstatus();
|
|
||||||
break;
|
|
||||||
case USB_REQ_DFU_GETSTATE:
|
|
||||||
handle_getstate();
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
g_dfu->state = DFU_STATE_appIDLE;
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
goto out;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
/* FIXME: implement timer to return to appIDLE */
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
TRACE_ERROR("Invalid DFU State reached in Runtime Mode\r\n");
|
|
||||||
ret = DFU_RET_STALL;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
out:
|
|
||||||
switch (ret) {
|
|
||||||
case DFU_RET_NOTHING:
|
|
||||||
break;
|
|
||||||
case DFU_RET_ZLP:
|
|
||||||
USBD_Write(0, 0, 0, 0, 0);
|
|
||||||
break;
|
|
||||||
case DFU_RET_STALL:
|
|
||||||
USBD_Stall(0);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void DFURT_SwitchToDFU(void)
|
|
||||||
{
|
|
||||||
/* store the magic value that the DFU loader can detect and
|
|
||||||
* activate itself, rather than boot into the application */
|
|
||||||
g_dfu->magic = USB_DFU_MAGIC;
|
|
||||||
|
|
||||||
/* Disconnect the USB by remoting the pull-up */
|
|
||||||
USBD_Disconnect();
|
|
||||||
__disable_irq();
|
|
||||||
|
|
||||||
/* reset the processor, we will start execution with the
|
|
||||||
* ResetVector of the bootloader */
|
|
||||||
NVIC_SystemReset();
|
|
||||||
}
|
|
||||||
|
|
||||||
void USBDCallbacks_RequestReceived(const USBGenericRequest *request)
|
|
||||||
{
|
|
||||||
/* FIXME: integration with CCID control point reqeusts */
|
|
||||||
USBDFU_Runtime_RequestHandler(request);
|
|
||||||
}
|
|
||||||
@@ -1,142 +1,143 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
/* ----------------------------------------------------------------------------
|
||||||
* ATMEL Microcontroller Software Support
|
* ATMEL Microcontroller Software Support
|
||||||
* ----------------------------------------------------------------------------
|
* ----------------------------------------------------------------------------
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
* Copyright (c) 2009, Atmel Corporation
|
||||||
*
|
*
|
||||||
* All rights reserved.
|
* All rights reserved.
|
||||||
*
|
*
|
||||||
* Redistribution and use in source and binary forms, with or without
|
* Redistribution and use in source and binary forms, with or without
|
||||||
* modification, are permitted provided that the following conditions are met:
|
* modification, are permitted provided that the following conditions are met:
|
||||||
*
|
*
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
* - Redistributions of source code must retain the above copyright notice,
|
||||||
* this list of conditions and the disclaimer below.
|
* this list of conditions and the disclaimer below.
|
||||||
*
|
*
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
* Atmel's name may not be used to endorse or promote products derived from
|
||||||
* this software without specific prior written permission.
|
* this software without specific prior written permission.
|
||||||
*
|
*
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||||||
* ----------------------------------------------------------------------------
|
* ----------------------------------------------------------------------------
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
/*------------------------------------------------------------------------------
|
||||||
* Linker script for running in internal FLASH on the ATSAM3S4
|
* Linker script for running in internal FLASH on the ATSAM3S4
|
||||||
*----------------------------------------------------------------------------*/
|
*----------------------------------------------------------------------------*/
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
||||||
OUTPUT_ARCH(arm)
|
OUTPUT_ARCH(arm)
|
||||||
SEARCH_DIR(.)
|
SEARCH_DIR(.)
|
||||||
|
ENTRY(main)
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
/* Memory Spaces Definitions */
|
||||||
{
|
MEMORY
|
||||||
rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00040000 /* flash, 256K */
|
{
|
||||||
ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x0000c000 /* sram, 48K */
|
rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00020000 /* flash, 256K */
|
||||||
}
|
ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x00008000 /* sram, 48K */
|
||||||
|
/* rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00040000 /* flash, 256K */
|
||||||
/* Section Definitions */
|
/*ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x0000c000 /* sram, 48K */
|
||||||
SECTIONS
|
}
|
||||||
{
|
|
||||||
.text :
|
/* Section Definitions */
|
||||||
{
|
SECTIONS
|
||||||
. = ALIGN(4);
|
{
|
||||||
_sfixed = .;
|
.text :
|
||||||
KEEP(*(.vectors .vectors.*))
|
{
|
||||||
*(.text .text.* .gnu.linkonce.t.*)
|
. = ALIGN(4);
|
||||||
*(.glue_7t) *(.glue_7)
|
_sfixed = .;
|
||||||
*(.rodata .rodata* .gnu.linkonce.r.*)
|
KEEP(*(.vectors .vectors.*))
|
||||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
*(.text .text.* .gnu.linkonce.t.*)
|
||||||
|
*(.glue_7t) *(.glue_7)
|
||||||
/* Support C constructors, and C destructors in both user code
|
*(.rodata .rodata* .gnu.linkonce.r.*)
|
||||||
and the C library. This also provides support for C++ code. */
|
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.init))
|
/* Support C constructors, and C destructors in both user code
|
||||||
. = ALIGN(4);
|
and the C library. This also provides support for C++ code. */
|
||||||
__preinit_array_start = .;
|
. = ALIGN(4);
|
||||||
KEEP (*(.preinit_array))
|
KEEP(*(.init))
|
||||||
__preinit_array_end = .;
|
. = ALIGN(4);
|
||||||
|
__preinit_array_start = .;
|
||||||
. = ALIGN(4);
|
KEEP (*(.preinit_array))
|
||||||
__init_array_start = .;
|
__preinit_array_end = .;
|
||||||
KEEP (*(SORT(.init_array.*)))
|
|
||||||
KEEP (*(.init_array))
|
. = ALIGN(4);
|
||||||
__init_array_end = .;
|
__init_array_start = .;
|
||||||
|
KEEP (*(SORT(.init_array.*)))
|
||||||
. = ALIGN(0x4);
|
KEEP (*(.init_array))
|
||||||
KEEP (*crtbegin.o(.ctors))
|
__init_array_end = .;
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
|
||||||
KEEP (*(SORT(.ctors.*)))
|
. = ALIGN(0x4);
|
||||||
KEEP (*crtend.o(.ctors))
|
KEEP (*crtbegin.o(.ctors))
|
||||||
|
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
||||||
. = ALIGN(4);
|
KEEP (*(SORT(.ctors.*)))
|
||||||
KEEP(*(.fini))
|
KEEP (*crtend.o(.ctors))
|
||||||
|
|
||||||
. = ALIGN(4);
|
. = ALIGN(4);
|
||||||
__fini_array_start = .;
|
KEEP(*(.fini))
|
||||||
KEEP (*(.fini_array))
|
|
||||||
KEEP (*(SORT(.fini_array.*)))
|
. = ALIGN(4);
|
||||||
__fini_array_end = .;
|
__fini_array_start = .;
|
||||||
|
KEEP (*(.fini_array))
|
||||||
KEEP (*crtbegin.o(.dtors))
|
KEEP (*(SORT(.fini_array.*)))
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
__fini_array_end = .;
|
||||||
KEEP (*(SORT(.dtors.*)))
|
|
||||||
KEEP (*crtend.o(.dtors))
|
KEEP (*crtbegin.o(.dtors))
|
||||||
|
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
||||||
. = ALIGN(4);
|
KEEP (*(SORT(.dtors.*)))
|
||||||
_efixed = .; /* End of text section */
|
KEEP (*crtend.o(.dtors))
|
||||||
} > rom
|
|
||||||
|
. = ALIGN(4);
|
||||||
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
_efixed = .; /* End of text section */
|
||||||
PROVIDE_HIDDEN (__exidx_start = .);
|
} > rom
|
||||||
.ARM.exidx :
|
|
||||||
{
|
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
||||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
PROVIDE_HIDDEN (__exidx_start = .);
|
||||||
} > rom
|
.ARM.exidx :
|
||||||
PROVIDE_HIDDEN (__exidx_end = .);
|
{
|
||||||
|
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
||||||
. = ALIGN(4);
|
} > rom
|
||||||
_etext = .;
|
PROVIDE_HIDDEN (__exidx_end = .);
|
||||||
|
|
||||||
.relocate : AT (_etext)
|
. = ALIGN(4);
|
||||||
{
|
_etext = .;
|
||||||
. = ALIGN(4);
|
|
||||||
_srelocate = .;
|
.relocate : AT (_etext)
|
||||||
/* we must make sure the .dfudata is linked to start of RAM */
|
{
|
||||||
*(.dfudata .dfudata.*);
|
. = ALIGN(4);
|
||||||
*(.ramfunc .ramfunc.*);
|
_srelocate = .;
|
||||||
*(.data .data.*);
|
*(.ramfunc .ramfunc.*);
|
||||||
. = ALIGN(4);
|
*(.data .data.*);
|
||||||
_erelocate = .;
|
. = ALIGN(4);
|
||||||
} > ram
|
_erelocate = .;
|
||||||
|
} > ram
|
||||||
/* .bss section which is used for uninitialized data */
|
|
||||||
.bss (NOLOAD) :
|
/* .bss section which is used for uninitialized data */
|
||||||
{
|
.bss (NOLOAD) :
|
||||||
. = ALIGN(4);
|
{
|
||||||
_sbss = . ;
|
. = ALIGN(4);
|
||||||
_szero = .;
|
_sbss = . ;
|
||||||
*(.bss .bss.*)
|
_szero = .;
|
||||||
*(COMMON)
|
*(.bss .bss.*)
|
||||||
. = ALIGN(4);
|
*(COMMON)
|
||||||
_ebss = . ;
|
. = ALIGN(4);
|
||||||
_ezero = .;
|
_ebss = . ;
|
||||||
} > ram
|
_ezero = .;
|
||||||
|
} > ram
|
||||||
/* stack section */
|
|
||||||
.stack (NOLOAD):
|
/* stack section */
|
||||||
{
|
.stack (NOLOAD):
|
||||||
. = ALIGN(8);
|
{
|
||||||
*(.stack .stack.*)
|
. = ALIGN(8);
|
||||||
} > ram
|
*(.stack .stack.*)
|
||||||
|
} > ram
|
||||||
. = ALIGN(4);
|
|
||||||
_end = . ;
|
. = ALIGN(4);
|
||||||
}
|
_end = . ;
|
||||||
|
}
|
||||||
@@ -1,12 +1,59 @@
|
|||||||
#pragma once
|
#ifndef _BOARD_
|
||||||
#include "board_common.h"
|
#define _BOARD_
|
||||||
|
|
||||||
|
/** Headers */
|
||||||
|
#include "chip.h"
|
||||||
|
/* We need this for a nop instruction in USB_HAL.c */
|
||||||
|
#define __CC_ARM
|
||||||
|
|
||||||
|
/** Board */
|
||||||
|
#include "board_lowlevel.h"
|
||||||
|
#include "uart_console.h"
|
||||||
|
#include "iso7816_4.h"
|
||||||
|
#include "led.h"
|
||||||
|
#include "cciddriver.h"
|
||||||
|
#include "usart.h"
|
||||||
|
#include "USBD.h"
|
||||||
|
|
||||||
|
#include "USBD_Config.h"
|
||||||
|
#include "USBDDriver.h"
|
||||||
|
|
||||||
|
/** Highlevel */
|
||||||
|
#include "trace.h"
|
||||||
|
#include "stdio.h"
|
||||||
|
#include "stdlib.h"
|
||||||
|
#include "string.h"
|
||||||
|
#include "inttypes.h"
|
||||||
|
|
||||||
|
#include "simtrace.h"
|
||||||
|
|
||||||
|
#define MIN(a, b) ((a < b) ? a : b)
|
||||||
|
|
||||||
|
#ifdef __GNUC__
|
||||||
|
#undef __GNUC__
|
||||||
|
#endif
|
||||||
|
|
||||||
/** Name of the board */
|
/** Name of the board */
|
||||||
#define BOARD_NAME "SAM3S-SIMTRACE"
|
#define BOARD_NAME "SAM3S-SIMTRACE"
|
||||||
/** Board definition */
|
/** Board definition */
|
||||||
#define simtrace
|
#define simtrace
|
||||||
|
/** Family definition (already defined) */
|
||||||
|
#define sam3s
|
||||||
|
/** Core definition */
|
||||||
|
#define cortexm3
|
||||||
|
|
||||||
#define BOARD_MAINOSC 18432000
|
#define BOARD_MAINOSC 18432000
|
||||||
|
#define BOARD_MCK 48000000
|
||||||
|
|
||||||
|
#define LED_RED PIO_PA17
|
||||||
|
#define LED_GREEN PIO_PA18
|
||||||
|
|
||||||
|
#define PIN_LED_RED {LED_RED, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
||||||
|
#define PIN_LED_GREEN {LED_GREEN, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
||||||
|
#define PINS_LEDS PIN_LED_RED, PIN_LED_GREEN
|
||||||
|
|
||||||
|
#define LED_NUM_RED 0
|
||||||
|
#define LED_NUM_GREEN 1
|
||||||
|
|
||||||
/** Phone (SIM card emulator)/CCID Reader/MITM configuration **/
|
/** Phone (SIM card emulator)/CCID Reader/MITM configuration **/
|
||||||
/* Normally the communication lines between phone and SIM card are disconnected */
|
/* Normally the communication lines between phone and SIM card are disconnected */
|
||||||
@@ -25,6 +72,44 @@
|
|||||||
|
|
||||||
#define PINS_SIM_SNIFF_SIM PIN_PHONE_IO, PIN_PHONE_CLK
|
#define PINS_SIM_SNIFF_SIM PIN_PHONE_IO, PIN_PHONE_CLK
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/** USART0 pin RX */
|
||||||
|
#define PIN_USART0_RXD {PIO_PA9A_URXD0, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
||||||
|
/** USART0 pin TX */
|
||||||
|
#define PIN_USART0_TXD {PIO_PA10A_UTXD0, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
||||||
|
|
||||||
|
#define BOARD_PIN_USART_RXD PIN_USART0_RXD
|
||||||
|
#define BOARD_PIN_USART_TXD PIN_USART0_TXD
|
||||||
|
|
||||||
|
#define BOARD_ID_USART ID_USART0
|
||||||
|
#define BOARD_USART_BASE USART0
|
||||||
|
|
||||||
|
#define PINS_UART { PIO_PA9A_URXD0|PIO_PA10A_UTXD0, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
||||||
|
|
||||||
|
/** UART0 */
|
||||||
|
/** Console baudrate always using 115200. */
|
||||||
|
#define CONSOLE_BAUDRATE 115200
|
||||||
|
/** Usart Hw interface used by the console (UART0). */
|
||||||
|
#define CONSOLE_USART UART0
|
||||||
|
/** Usart Hw ID used by the console (UART0). */
|
||||||
|
#define CONSOLE_ID ID_UART0
|
||||||
|
/** Pins description corresponding to Rxd,Txd, (UART pins) */
|
||||||
|
#define CONSOLE_PINS {PINS_UART}
|
||||||
|
|
||||||
|
/// Smartcard detection pin
|
||||||
|
// FIXME: add connect pin as iso pin...should it be periph b or interrupt oder input?
|
||||||
|
#define BOARD_ISO7816_BASE_USART USART0
|
||||||
|
#define BOARD_ISO7816_ID_USART ID_USART0
|
||||||
|
|
||||||
|
#define USART_SIM USART0
|
||||||
|
#define ID_USART_SIM ID_USART0
|
||||||
|
#define USART_PHONE USART1
|
||||||
|
#define ID_USART_PHONE ID_USART1
|
||||||
|
|
||||||
|
#define SIM_PWEN PIO_PA5
|
||||||
|
#define VCC_FWD PIO_PA26
|
||||||
|
|
||||||
#define SIM_PWEN_PIN {PIO_PA5, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
#define SIM_PWEN_PIN {PIO_PA5, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
||||||
|
|
||||||
#define PWR_PINS \
|
#define PWR_PINS \
|
||||||
@@ -33,6 +118,7 @@
|
|||||||
/* Enable second power converter: VCC_PHONE to VCC_SIM; high: on */ \
|
/* Enable second power converter: VCC_PHONE to VCC_SIM; high: on */ \
|
||||||
{VCC_FWD, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
{VCC_FWD, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
||||||
|
|
||||||
|
|
||||||
#define SW_SIM PIO_PA8
|
#define SW_SIM PIO_PA8
|
||||||
#define SMARTCARD_CONNECT_PIN {SW_SIM, PIOA, ID_PIOA, PIO_INPUT, PIO_PULLUP | PIO_DEBOUNCE | PIO_DEGLITCH | PIO_IT_EDGE }
|
#define SMARTCARD_CONNECT_PIN {SW_SIM, PIOA, ID_PIOA, PIO_INPUT, PIO_PULLUP | PIO_DEBOUNCE | PIO_DEGLITCH | PIO_IT_EDGE }
|
||||||
//#define SMARTCARD_CONNECT_PIN {SW_SIM, PIOB, ID_PIOB, PIO_INPUT, PIO_PULLUP | PIO_DEBOUNCE | PIO_IT_EDGE}
|
//#define SMARTCARD_CONNECT_PIN {SW_SIM, PIOB, ID_PIOB, PIO_INPUT, PIO_PULLUP | PIO_DEBOUNCE | PIO_IT_EDGE}
|
||||||
@@ -74,12 +160,31 @@
|
|||||||
/// SPI chip select 0 pin definition (PA11).
|
/// SPI chip select 0 pin definition (PA11).
|
||||||
#define PIN_SPI_NPCS0 {1 << 11, PIOA, PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
#define PIN_SPI_NPCS0 {1 << 11, PIOA, PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
||||||
|
|
||||||
#define SIMTRACE_VENDOR_ID 0x1d50
|
//** USB **/
|
||||||
#define SIMTRACE_PRODUCT_ID 0x60e3
|
// USB pull-up control pin definition (PA16).
|
||||||
#define USB_VENDOR_ID SIMTRACE_VENDOR_ID
|
// Default: 1 (USB Pullup deactivated)
|
||||||
|
#define PIN_USB_PULLUP {1 << 16, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
||||||
|
|
||||||
|
// Board has UDP controller
|
||||||
|
#define BOARD_USB_UDP
|
||||||
|
// D+ has external pull-up
|
||||||
|
#define BOARD_USB_PULLUP_EXTERNAL
|
||||||
|
|
||||||
|
#define BOARD_USB_NUMENDPOINTS 8
|
||||||
|
|
||||||
|
// FIXME: in all other cases return 0?
|
||||||
|
#define BOARD_USB_ENDPOINTS_MAXPACKETSIZE(i) (((i == 4) || (i == 5))? 512 : 64)
|
||||||
|
#define BOARD_USB_ENDPOINTS_BANKS(i) (((i == 0) || (i == 3)) ? 1 : 2)
|
||||||
|
|
||||||
|
/// USB attributes configuration descriptor (bus or self powered, remote wakeup)
|
||||||
|
//#define BOARD_USB_BMATTRIBUTES USBConfigurationDescriptor_SELFPOWERED_NORWAKEUP
|
||||||
|
#define BOARD_USB_BMATTRIBUTES USBConfigurationDescriptor_BUSPOWERED_NORWAKEUP
|
||||||
|
//#define BOARD_USB_BMATTRIBUTES USBConfigurationDescriptor_SELFPOWERED_RWAKEUP
|
||||||
|
|
||||||
|
#define SIMTRACE_VENDOR_ID 0x16c0
|
||||||
|
#define SIMTRACE_PRODUCT_ID 0x0762
|
||||||
|
#define USB_VENDOR_ID OPENPCD_VENDOR_ID
|
||||||
#define USB_PRODUCT_ID SIMTRACE_PRODUCT_ID
|
#define USB_PRODUCT_ID SIMTRACE_PRODUCT_ID
|
||||||
|
|
||||||
#define HAVE_SNIFFER
|
|
||||||
#define HAVE_CCID
|
#endif
|
||||||
#define HAVE_CARDEM
|
|
||||||
#define HAVE_MITM
|
|
||||||
@@ -50,6 +50,8 @@
|
|||||||
|
|
||||||
extern caddr_t _sbrk ( int incr ) ;
|
extern caddr_t _sbrk ( int incr ) ;
|
||||||
|
|
||||||
|
extern int link( char *old, char *new ) ;
|
||||||
|
|
||||||
extern int _close( int file ) ;
|
extern int _close( int file ) ;
|
||||||
|
|
||||||
extern int _fstat( int file, struct stat *st ) ;
|
extern int _fstat( int file, struct stat *st ) ;
|
||||||
@@ -61,5 +63,3 @@ extern int _lseek( int file, int ptr, int dir ) ;
|
|||||||
extern int _read(int file, char *ptr, int len) ;
|
extern int _read(int file, char *ptr, int len) ;
|
||||||
|
|
||||||
extern int _write( int file, char *ptr, int len ) ;
|
extern int _write( int file, char *ptr, int len ) ;
|
||||||
|
|
||||||
extern void mdelay(unsigned int msecs);
|
|
||||||
@@ -52,8 +52,5 @@
|
|||||||
|
|
||||||
#include "trace.h"
|
#include "trace.h"
|
||||||
#include "wdt.h"
|
#include "wdt.h"
|
||||||
#include "unique_id.h"
|
|
||||||
#include "efc.h"
|
|
||||||
#include "flashd.h"
|
|
||||||
|
|
||||||
#endif /* _LIB_SAM3S_ */
|
#endif /* _LIB_SAM3S_ */
|
||||||
@@ -176,7 +176,7 @@ extern void TRACE_CONFIGURE( uint32_t dwBaudRate, uint32_t dwMCk ) ;
|
|||||||
|
|
||||||
/* Trace compilation depends on TRACE_LEVEL value */
|
/* Trace compilation depends on TRACE_LEVEL value */
|
||||||
#if (TRACE_LEVEL >= TRACE_LEVEL_DEBUG)
|
#if (TRACE_LEVEL >= TRACE_LEVEL_DEBUG)
|
||||||
#define TRACE_DEBUG(...) { printf("-D- " __VA_ARGS__); }
|
#define TRACE_DEBUG(...) { printf("-D- " __VA_ARGS__); printf("(%s func. %s)\n\r", __FILE__, __FUNCTION__); }
|
||||||
#define TRACE_DEBUG_WP(...) { printf(__VA_ARGS__); }
|
#define TRACE_DEBUG_WP(...) { printf(__VA_ARGS__); }
|
||||||
#else
|
#else
|
||||||
#define TRACE_DEBUG(...) { }
|
#define TRACE_DEBUG(...) { }
|
||||||
@@ -1,122 +0,0 @@
|
|||||||
#ifndef _BOARD_
|
|
||||||
#define _BOARD_
|
|
||||||
|
|
||||||
/** Headers */
|
|
||||||
#include "chip.h"
|
|
||||||
/* We need this for a nop instruction in USB_HAL.c */
|
|
||||||
#define __CC_ARM
|
|
||||||
|
|
||||||
/** Board */
|
|
||||||
#include "board_lowlevel.h"
|
|
||||||
#include "uart_console.h"
|
|
||||||
#include "iso7816_4.h"
|
|
||||||
#include "led.h"
|
|
||||||
#include "cciddriver.h"
|
|
||||||
#include "usart.h"
|
|
||||||
#include "USBD.h"
|
|
||||||
|
|
||||||
#include "USBD_Config.h"
|
|
||||||
#include "USBDDriver.h"
|
|
||||||
|
|
||||||
/** Highlevel */
|
|
||||||
#include "trace.h"
|
|
||||||
#include "stdio.h"
|
|
||||||
#include "stdlib.h"
|
|
||||||
#include "string.h"
|
|
||||||
#include "inttypes.h"
|
|
||||||
#include "syscalls.h"
|
|
||||||
|
|
||||||
#define MIN(a, b) ((a < b) ? a : b)
|
|
||||||
|
|
||||||
#ifdef __GNUC__
|
|
||||||
#undef __GNUC__
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/** Family definition (already defined) */
|
|
||||||
#define sam3s
|
|
||||||
/** Core definition */
|
|
||||||
#define cortexm3
|
|
||||||
|
|
||||||
#define BOARD_MCK 48000000
|
|
||||||
|
|
||||||
#define LED_RED PIO_PA17
|
|
||||||
#define LED_GREEN PIO_PA18
|
|
||||||
|
|
||||||
#define PIN_LED_RED {LED_RED, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
|
||||||
#define PIN_LED_GREEN {LED_GREEN, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
|
||||||
#define PINS_LEDS PIN_LED_RED, PIN_LED_GREEN
|
|
||||||
|
|
||||||
#define LED_NUM_RED 0
|
|
||||||
#define LED_NUM_GREEN 1
|
|
||||||
|
|
||||||
/** USART0 pin RX */
|
|
||||||
#define PIN_USART0_RXD {PIO_PA9A_URXD0, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
/** USART0 pin TX */
|
|
||||||
#define PIN_USART0_TXD {PIO_PA10A_UTXD0, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
|
|
||||||
#define BOARD_PIN_USART_RXD PIN_USART0_RXD
|
|
||||||
#define BOARD_PIN_USART_TXD PIN_USART0_TXD
|
|
||||||
|
|
||||||
#define BOARD_ID_USART ID_USART0
|
|
||||||
#define BOARD_USART_BASE USART0
|
|
||||||
|
|
||||||
#define PINS_UART { PIO_PA9A_URXD0|PIO_PA10A_UTXD0, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
|
|
||||||
/** UART0 */
|
|
||||||
/** Console baudrate always using 115200. */
|
|
||||||
#define CONSOLE_BAUDRATE 115200
|
|
||||||
/** Usart Hw interface used by the console (UART0). */
|
|
||||||
#define CONSOLE_USART UART0
|
|
||||||
/** Usart Hw ID used by the console (UART0). */
|
|
||||||
#define CONSOLE_ID ID_UART0
|
|
||||||
/** Pins description corresponding to Rxd,Txd, (UART pins) */
|
|
||||||
#define CONSOLE_PINS {PINS_UART}
|
|
||||||
|
|
||||||
/// Smartcard detection pin
|
|
||||||
// FIXME: add connect pin as iso pin...should it be periph b or interrupt oder input?
|
|
||||||
#define BOARD_ISO7816_BASE_USART USART0
|
|
||||||
#define BOARD_ISO7816_ID_USART ID_USART0
|
|
||||||
|
|
||||||
#define USART_SIM USART0
|
|
||||||
#define ID_USART_SIM ID_USART0
|
|
||||||
#define USART_PHONE USART1
|
|
||||||
#define ID_USART_PHONE ID_USART1
|
|
||||||
|
|
||||||
#define SIM_PWEN PIO_PA5
|
|
||||||
#define VCC_FWD PIO_PA26
|
|
||||||
|
|
||||||
|
|
||||||
//** USB **/
|
|
||||||
// USB pull-up control pin definition (PA16).
|
|
||||||
// Default: 1 (USB Pullup deactivated)
|
|
||||||
#define PIN_USB_PULLUP {1 << 16, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
|
||||||
|
|
||||||
// Board has UDP controller
|
|
||||||
#define BOARD_USB_UDP
|
|
||||||
// D+ has external pull-up
|
|
||||||
#define BOARD_USB_PULLUP_EXTERNAL
|
|
||||||
|
|
||||||
#define BOARD_USB_NUMENDPOINTS 8
|
|
||||||
|
|
||||||
// FIXME: in all other cases return 0?
|
|
||||||
#define BOARD_USB_ENDPOINTS_MAXPACKETSIZE(i) (((i == 4) || (i == 5))? 512 : 64)
|
|
||||||
#define BOARD_USB_ENDPOINTS_BANKS(i) (((i == 0) || (i == 3)) ? 1 : 2)
|
|
||||||
|
|
||||||
/// USB attributes configuration descriptor (bus or self powered, remote wakeup)
|
|
||||||
//#define BOARD_USB_BMATTRIBUTES USBConfigurationDescriptor_SELFPOWERED_NORWAKEUP
|
|
||||||
#define BOARD_USB_BMATTRIBUTES USBConfigurationDescriptor_BUSPOWERED_NORWAKEUP
|
|
||||||
//#define BOARD_USB_BMATTRIBUTES USBConfigurationDescriptor_SELFPOWERED_RWAKEUP
|
|
||||||
|
|
||||||
#define BOARD_USB_VENDOR SIMTRACE_VENDOR_ID
|
|
||||||
#define BOARD_USB_PRODUCT SIMTRACE_PRODUCT_ID
|
|
||||||
#define BOARD_USB_RELEASE 0
|
|
||||||
|
|
||||||
#define BOARD_USB_DFU
|
|
||||||
#define BOARD_DFU_BOOT_SIZE (16 * 1024)
|
|
||||||
#define BOARD_DFU_RAM_SIZE (2 * 1024)
|
|
||||||
#define BOARD_DFU_PAGE_SIZE 512
|
|
||||||
#define BOARD_DFU_NUM_IF 2
|
|
||||||
|
|
||||||
extern void board_exec_dbg_cmd(int ch);
|
|
||||||
extern void board_main_top(void);
|
|
||||||
#endif
|
|
||||||
@@ -1,3 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
int get_board_version_adc(void);
|
|
||||||
@@ -1,10 +0,0 @@
|
|||||||
|
|
||||||
#ifndef _MANIFEST_H
|
|
||||||
#define _MANIFEST_H
|
|
||||||
|
|
||||||
extern const char *manifest_application;
|
|
||||||
extern const char *manifest_revision;
|
|
||||||
extern const char *manifest_board;
|
|
||||||
extern const char *manifest_environment;
|
|
||||||
|
|
||||||
#endif /* !_MANIFEST_H */
|
|
||||||
@@ -1,142 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal FLASH on the ATSAM3S1
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
SEARCH_DIR(.)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00010000 /* Flash, 64K */
|
|
||||||
ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x00004000 /* sram, 16K */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Section Definitions */
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sfixed = .;
|
|
||||||
KEEP(*(.vectors .vectors.*))
|
|
||||||
*(.text .text.* .gnu.linkonce.t.*)
|
|
||||||
*(.glue_7t) *(.glue_7)
|
|
||||||
*(.rodata .rodata* .gnu.linkonce.r.*)
|
|
||||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
|
||||||
|
|
||||||
/* Support C constructors, and C destructors in both user code
|
|
||||||
and the C library. This also provides support for C++ code. */
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.init))
|
|
||||||
. = ALIGN(4);
|
|
||||||
__preinit_array_start = .;
|
|
||||||
KEEP (*(.preinit_array))
|
|
||||||
__preinit_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__init_array_start = .;
|
|
||||||
KEEP (*(SORT(.init_array.*)))
|
|
||||||
KEEP (*(.init_array))
|
|
||||||
__init_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(0x4);
|
|
||||||
KEEP (*crtbegin.o(.ctors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
|
||||||
KEEP (*(SORT(.ctors.*)))
|
|
||||||
KEEP (*crtend.o(.ctors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.fini))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__fini_array_start = .;
|
|
||||||
KEEP (*(.fini_array))
|
|
||||||
KEEP (*(SORT(.fini_array.*)))
|
|
||||||
__fini_array_end = .;
|
|
||||||
|
|
||||||
KEEP (*crtbegin.o(.dtors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
|
||||||
KEEP (*(SORT(.dtors.*)))
|
|
||||||
KEEP (*crtend.o(.dtors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_efixed = .; /* End of text section */
|
|
||||||
} > rom
|
|
||||||
|
|
||||||
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
|
||||||
PROVIDE_HIDDEN (__exidx_start = .);
|
|
||||||
.ARM.exidx :
|
|
||||||
{
|
|
||||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
|
||||||
} > rom
|
|
||||||
PROVIDE_HIDDEN (__exidx_end = .);
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
|
|
||||||
.relocate : AT (_etext)
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_srelocate = .;
|
|
||||||
/* we must make sure the .dfudata is linked to start of RAM */
|
|
||||||
*(.dfudata .dfudata.*);
|
|
||||||
*(.ramfunc .ramfunc.*);
|
|
||||||
*(.data .data.*);
|
|
||||||
. = ALIGN(4);
|
|
||||||
_erelocate = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .bss section which is used for uninitialized data */
|
|
||||||
.bss (NOLOAD) :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sbss = . ;
|
|
||||||
_szero = .;
|
|
||||||
*(.bss .bss.*)
|
|
||||||
*(COMMON)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ebss = . ;
|
|
||||||
_ezero = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* stack section */
|
|
||||||
.stack (NOLOAD):
|
|
||||||
{
|
|
||||||
. = ALIGN(8);
|
|
||||||
*(.stack .stack.*)
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_end = . ;
|
|
||||||
}
|
|
||||||
@@ -1,140 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal SRAM on the ATSAM3S1
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
SEARCH_DIR(.)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00010000 /* Flash, 64K */
|
|
||||||
ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x00004000 /* sram, 16K */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Section Definitions */
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sfixed = .;
|
|
||||||
KEEP(*(.vectors .vectors.*))
|
|
||||||
*(.text .text.* .gnu.linkonce.t.*)
|
|
||||||
*(.glue_7t) *(.glue_7)
|
|
||||||
*(.rodata .rodata* .gnu.linkonce.r.*)
|
|
||||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
|
||||||
|
|
||||||
/* Support C constructors, and C destructors in both user code
|
|
||||||
and the C library. This also provides support for C++ code. */
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.init))
|
|
||||||
. = ALIGN(4);
|
|
||||||
__preinit_array_start = .;
|
|
||||||
KEEP (*(.preinit_array))
|
|
||||||
__preinit_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__init_array_start = .;
|
|
||||||
KEEP (*(SORT(.init_array.*)))
|
|
||||||
KEEP (*(.init_array))
|
|
||||||
__init_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(0x4);
|
|
||||||
KEEP (*crtbegin.o(.ctors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
|
||||||
KEEP (*(SORT(.ctors.*)))
|
|
||||||
KEEP (*crtend.o(.ctors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.fini))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__fini_array_start = .;
|
|
||||||
KEEP (*(.fini_array))
|
|
||||||
KEEP (*(SORT(.fini_array.*)))
|
|
||||||
__fini_array_end = .;
|
|
||||||
|
|
||||||
KEEP (*crtbegin.o(.dtors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
|
||||||
KEEP (*(SORT(.dtors.*)))
|
|
||||||
KEEP (*crtend.o(.dtors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_efixed = .; /* End of text section */
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
|
|
||||||
.relocate : AT (_etext)
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_srelocate = .;
|
|
||||||
*(.ramfunc .ramfunc.*);
|
|
||||||
*(.data .data.*);
|
|
||||||
. = ALIGN(4);
|
|
||||||
_erelocate = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .bss section which is used for uninitialized data */
|
|
||||||
.bss (NOLOAD) :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sbss = . ;
|
|
||||||
_szero = .;
|
|
||||||
*(.bss .bss.*)
|
|
||||||
*(COMMON)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ebss = . ;
|
|
||||||
_ezero = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* stack section */
|
|
||||||
.stack (NOLOAD):
|
|
||||||
{
|
|
||||||
. = ALIGN(8);
|
|
||||||
*(.stack .stack.*)
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
|
||||||
PROVIDE_HIDDEN (__exidx_start = .);
|
|
||||||
.ARM.exidx :
|
|
||||||
{
|
|
||||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
|
||||||
} > ram
|
|
||||||
PROVIDE_HIDDEN (__exidx_end = .);
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_end = . ;
|
|
||||||
}
|
|
||||||
@@ -1,91 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal SRAM on the AT91SAM3S1
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
ENTRY(entry)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
romcodesram (W!RX) : ORIGIN = 0x20000000, LENGTH = 0x0800
|
|
||||||
sram (W!RX) : ORIGIN = 0x20000800, LENGTH = 0x00003800 /* sram, 16K - sizeof(romcodesram) */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Entry point */
|
|
||||||
/*ENTRY (ResetException)*/
|
|
||||||
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
/* startup code in the .isr_vector */
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_stext = .;
|
|
||||||
KEEP(*(.isr_vector .isr_vector.*))
|
|
||||||
*(.mailbox)
|
|
||||||
*(.text .text.*)
|
|
||||||
*(.rodata .rodata.*)
|
|
||||||
*(.glue_7)
|
|
||||||
*(.glue_7t)
|
|
||||||
*(.gcc_except_table)
|
|
||||||
*(.rodata .rodata*)
|
|
||||||
*(.gnu.linkonce.r.*)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
} > sram
|
|
||||||
|
|
||||||
/* data */
|
|
||||||
.data :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sidata = .;
|
|
||||||
_sdata = .;
|
|
||||||
|
|
||||||
*(.data)
|
|
||||||
*(.data.*)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_edata = .;
|
|
||||||
} > sram
|
|
||||||
|
|
||||||
.bss (NOLOAD) : {
|
|
||||||
_szero = .;
|
|
||||||
*(.bss)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ezero = .;
|
|
||||||
} >sram
|
|
||||||
|
|
||||||
/* Stack in SRAM */
|
|
||||||
_sstack = 0x20003FFC;
|
|
||||||
}
|
|
||||||
end = .;
|
|
||||||
@@ -1,142 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal FLASH on the ATSAM3S2
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
SEARCH_DIR(.)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00020000 /* flash, 128K */
|
|
||||||
ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x00008000 /* sram, 32K */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Section Definitions */
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sfixed = .;
|
|
||||||
KEEP(*(.vectors .vectors.*))
|
|
||||||
*(.text .text.* .gnu.linkonce.t.*)
|
|
||||||
*(.glue_7t) *(.glue_7)
|
|
||||||
*(.rodata .rodata* .gnu.linkonce.r.*)
|
|
||||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
|
||||||
|
|
||||||
/* Support C constructors, and C destructors in both user code
|
|
||||||
and the C library. This also provides support for C++ code. */
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.init))
|
|
||||||
. = ALIGN(4);
|
|
||||||
__preinit_array_start = .;
|
|
||||||
KEEP (*(.preinit_array))
|
|
||||||
__preinit_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__init_array_start = .;
|
|
||||||
KEEP (*(SORT(.init_array.*)))
|
|
||||||
KEEP (*(.init_array))
|
|
||||||
__init_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(0x4);
|
|
||||||
KEEP (*crtbegin.o(.ctors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
|
||||||
KEEP (*(SORT(.ctors.*)))
|
|
||||||
KEEP (*crtend.o(.ctors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.fini))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__fini_array_start = .;
|
|
||||||
KEEP (*(.fini_array))
|
|
||||||
KEEP (*(SORT(.fini_array.*)))
|
|
||||||
__fini_array_end = .;
|
|
||||||
|
|
||||||
KEEP (*crtbegin.o(.dtors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
|
||||||
KEEP (*(SORT(.dtors.*)))
|
|
||||||
KEEP (*crtend.o(.dtors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_efixed = .; /* End of text section */
|
|
||||||
} > rom
|
|
||||||
|
|
||||||
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
|
||||||
PROVIDE_HIDDEN (__exidx_start = .);
|
|
||||||
.ARM.exidx :
|
|
||||||
{
|
|
||||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
|
||||||
} > rom
|
|
||||||
PROVIDE_HIDDEN (__exidx_end = .);
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
|
|
||||||
.relocate : AT (_etext)
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_srelocate = .;
|
|
||||||
/* we must make sure the .dfudata is linked to start of RAM */
|
|
||||||
*(.dfudata .dfudata.*);
|
|
||||||
*(.ramfunc .ramfunc.*);
|
|
||||||
*(.data .data.*);
|
|
||||||
. = ALIGN(4);
|
|
||||||
_erelocate = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .bss section which is used for uninitialized data */
|
|
||||||
.bss (NOLOAD) :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sbss = . ;
|
|
||||||
_szero = .;
|
|
||||||
*(.bss .bss.*)
|
|
||||||
*(COMMON)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ebss = . ;
|
|
||||||
_ezero = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* stack section */
|
|
||||||
.stack (NOLOAD):
|
|
||||||
{
|
|
||||||
. = ALIGN(8);
|
|
||||||
*(.stack .stack.*)
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_end = . ;
|
|
||||||
}
|
|
||||||
@@ -1,140 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal SRAM on the ATSAM3S2
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT ("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
SEARCH_DIR(.)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00020000 /* flash, 128K */
|
|
||||||
ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x00008000 /* sram, 32K */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Section Definitions */
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sfixed = .;
|
|
||||||
KEEP(*(.vectors .vectors.*))
|
|
||||||
*(.text .text.* .gnu.linkonce.t.*)
|
|
||||||
*(.glue_7t) *(.glue_7)
|
|
||||||
*(.rodata .rodata* .gnu.linkonce.r.*)
|
|
||||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
|
||||||
|
|
||||||
/* Support C constructors, and C destructors in both user code
|
|
||||||
and the C library. This also provides support for C++ code. */
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.init))
|
|
||||||
. = ALIGN(4);
|
|
||||||
__preinit_array_start = .;
|
|
||||||
KEEP (*(.preinit_array))
|
|
||||||
__preinit_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__init_array_start = .;
|
|
||||||
KEEP (*(SORT(.init_array.*)))
|
|
||||||
KEEP (*(.init_array))
|
|
||||||
__init_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(0x4);
|
|
||||||
KEEP (*crtbegin.o(.ctors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
|
||||||
KEEP (*(SORT(.ctors.*)))
|
|
||||||
KEEP (*crtend.o(.ctors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.fini))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__fini_array_start = .;
|
|
||||||
KEEP (*(.fini_array))
|
|
||||||
KEEP (*(SORT(.fini_array.*)))
|
|
||||||
__fini_array_end = .;
|
|
||||||
|
|
||||||
KEEP (*crtbegin.o(.dtors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
|
||||||
KEEP (*(SORT(.dtors.*)))
|
|
||||||
KEEP (*crtend.o(.dtors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_efixed = .; /* End of text section */
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
|
|
||||||
.relocate : AT (_etext)
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_srelocate = .;
|
|
||||||
*(.ramfunc .ramfunc.*);
|
|
||||||
*(.data .data.*);
|
|
||||||
. = ALIGN(4);
|
|
||||||
_erelocate = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .bss section which is used for uninitialized data */
|
|
||||||
.bss (NOLOAD) :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sbss = . ;
|
|
||||||
_szero = .;
|
|
||||||
*(.bss .bss.*)
|
|
||||||
*(COMMON)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ebss = . ;
|
|
||||||
_ezero = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* stack section */
|
|
||||||
.stack (NOLOAD):
|
|
||||||
{
|
|
||||||
. = ALIGN(8);
|
|
||||||
*(.stack .stack.*)
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
|
||||||
PROVIDE_HIDDEN (__exidx_start = .);
|
|
||||||
.ARM.exidx :
|
|
||||||
{
|
|
||||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
|
||||||
} > ram
|
|
||||||
PROVIDE_HIDDEN (__exidx_end = .);
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_end = . ;
|
|
||||||
}
|
|
||||||
@@ -1,91 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal SRAM on the AT91SAM3S2
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
ENTRY(entry)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
romcodesram (W!RX) : ORIGIN = 0x20000000, LENGTH = 0x0800
|
|
||||||
sram (W!RX) : ORIGIN = 0x20000800, LENGTH = 0x00007800 /* sram, 32K - sizeof(romcodesram) */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Entry point */
|
|
||||||
/*ENTRY (ResetException)*/
|
|
||||||
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
/* startup code in the .isr_vector */
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_stext = .;
|
|
||||||
KEEP(*(.isr_vector .isr_vector.*))
|
|
||||||
*(.mailbox)
|
|
||||||
*(.text .text.*)
|
|
||||||
*(.rodata .rodata.*)
|
|
||||||
*(.glue_7)
|
|
||||||
*(.glue_7t)
|
|
||||||
*(.gcc_except_table)
|
|
||||||
*(.rodata .rodata*)
|
|
||||||
*(.gnu.linkonce.r.*)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
} > sram
|
|
||||||
|
|
||||||
/* data */
|
|
||||||
.data :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sidata = .;
|
|
||||||
_sdata = .;
|
|
||||||
|
|
||||||
*(.data)
|
|
||||||
*(.data.*)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_edata = .;
|
|
||||||
} > sram
|
|
||||||
|
|
||||||
.bss (NOLOAD) : {
|
|
||||||
_szero = .;
|
|
||||||
*(.bss)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ezero = .;
|
|
||||||
} >sram
|
|
||||||
|
|
||||||
/* Stack in SRAM */
|
|
||||||
_sstack = 0x20007FFC;
|
|
||||||
}
|
|
||||||
end = .;
|
|
||||||
@@ -1,142 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal FLASH on the ATSAM3S4
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
SEARCH_DIR(.)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
/* reserve the first 16k (= 0x4000) for the DFU bootloader */
|
|
||||||
rom (rx) : ORIGIN = 0x00404000, LENGTH = 0x0003c000 /* flash, 256K */
|
|
||||||
/* reserve the first 32 (= 0x20) bytes for the _g_dfu struct */
|
|
||||||
ram (rwx) : ORIGIN = 0x20000020, LENGTH = 0x0000bfe0 /* sram, 48K */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Section Definitions */
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sfixed = .;
|
|
||||||
KEEP(*(.vectors .vectors.*))
|
|
||||||
*(.text .text.* .gnu.linkonce.t.*)
|
|
||||||
*(.glue_7t) *(.glue_7)
|
|
||||||
*(.rodata .rodata* .gnu.linkonce.r.*)
|
|
||||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
|
||||||
|
|
||||||
/* Support C constructors, and C destructors in both user code
|
|
||||||
and the C library. This also provides support for C++ code. */
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.init))
|
|
||||||
. = ALIGN(4);
|
|
||||||
__preinit_array_start = .;
|
|
||||||
KEEP (*(.preinit_array))
|
|
||||||
__preinit_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__init_array_start = .;
|
|
||||||
KEEP (*(SORT(.init_array.*)))
|
|
||||||
KEEP (*(.init_array))
|
|
||||||
__init_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(0x4);
|
|
||||||
KEEP (*crtbegin.o(.ctors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
|
||||||
KEEP (*(SORT(.ctors.*)))
|
|
||||||
KEEP (*crtend.o(.ctors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.fini))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__fini_array_start = .;
|
|
||||||
KEEP (*(.fini_array))
|
|
||||||
KEEP (*(SORT(.fini_array.*)))
|
|
||||||
__fini_array_end = .;
|
|
||||||
|
|
||||||
KEEP (*crtbegin.o(.dtors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
|
||||||
KEEP (*(SORT(.dtors.*)))
|
|
||||||
KEEP (*crtend.o(.dtors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_efixed = .; /* End of text section */
|
|
||||||
} > rom
|
|
||||||
|
|
||||||
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
|
||||||
PROVIDE_HIDDEN (__exidx_start = .);
|
|
||||||
.ARM.exidx :
|
|
||||||
{
|
|
||||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
|
||||||
} > rom
|
|
||||||
PROVIDE_HIDDEN (__exidx_end = .);
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
|
|
||||||
.relocate : AT (_etext)
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_srelocate = .;
|
|
||||||
*(.ramfunc .ramfunc.*);
|
|
||||||
*(.data .data.*);
|
|
||||||
. = ALIGN(4);
|
|
||||||
_erelocate = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .bss section which is used for uninitialized data */
|
|
||||||
.bss (NOLOAD) :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sbss = . ;
|
|
||||||
_szero = .;
|
|
||||||
*(.bss .bss.*)
|
|
||||||
*(COMMON)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ebss = . ;
|
|
||||||
_ezero = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* stack section */
|
|
||||||
.stack (NOLOAD):
|
|
||||||
{
|
|
||||||
. = ALIGN(8);
|
|
||||||
*(.stack .stack.*)
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_end = . ;
|
|
||||||
}
|
|
||||||
@@ -1,140 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal SRAM on the ATSAM3S4
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
SEARCH_DIR(.)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
rom (rx) : ORIGIN = 0x00400000, LENGTH = 0x00040000 /* flash, 256K */
|
|
||||||
ram (rwx) : ORIGIN = 0x20000000, LENGTH = 0x0000c000 /* sram, 48K */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Section Definitions */
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sfixed = .;
|
|
||||||
KEEP(*(.vectors .vectors.*))
|
|
||||||
*(.text .text.* .gnu.linkonce.t.*)
|
|
||||||
*(.glue_7t) *(.glue_7)
|
|
||||||
*(.rodata .rodata* .gnu.linkonce.r.*)
|
|
||||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
|
||||||
|
|
||||||
/* Support C constructors, and C destructors in both user code
|
|
||||||
and the C library. This also provides support for C++ code. */
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.init))
|
|
||||||
. = ALIGN(4);
|
|
||||||
__preinit_array_start = .;
|
|
||||||
KEEP (*(.preinit_array))
|
|
||||||
__preinit_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__init_array_start = .;
|
|
||||||
KEEP (*(SORT(.init_array.*)))
|
|
||||||
KEEP (*(.init_array))
|
|
||||||
__init_array_end = .;
|
|
||||||
|
|
||||||
. = ALIGN(0x4);
|
|
||||||
KEEP (*crtbegin.o(.ctors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .ctors))
|
|
||||||
KEEP (*(SORT(.ctors.*)))
|
|
||||||
KEEP (*crtend.o(.ctors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
KEEP(*(.fini))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
__fini_array_start = .;
|
|
||||||
KEEP (*(.fini_array))
|
|
||||||
KEEP (*(SORT(.fini_array.*)))
|
|
||||||
__fini_array_end = .;
|
|
||||||
|
|
||||||
KEEP (*crtbegin.o(.dtors))
|
|
||||||
KEEP (*(EXCLUDE_FILE (*crtend.o) .dtors))
|
|
||||||
KEEP (*(SORT(.dtors.*)))
|
|
||||||
KEEP (*crtend.o(.dtors))
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_efixed = .; /* End of text section */
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
|
|
||||||
.relocate : AT (_etext)
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_srelocate = .;
|
|
||||||
*(.ramfunc .ramfunc.*);
|
|
||||||
*(.data .data.*);
|
|
||||||
. = ALIGN(4);
|
|
||||||
_erelocate = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .bss section which is used for uninitialized data */
|
|
||||||
.bss (NOLOAD) :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sbss = . ;
|
|
||||||
_szero = .;
|
|
||||||
*(.bss .bss.*)
|
|
||||||
*(COMMON)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ebss = . ;
|
|
||||||
_ezero = .;
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* stack section */
|
|
||||||
.stack (NOLOAD):
|
|
||||||
{
|
|
||||||
. = ALIGN(8);
|
|
||||||
*(.stack .stack.*)
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
/* .ARM.exidx is sorted, so has to go in its own output section. */
|
|
||||||
PROVIDE_HIDDEN (__exidx_start = .);
|
|
||||||
.ARM.exidx :
|
|
||||||
{
|
|
||||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
|
||||||
} > ram
|
|
||||||
PROVIDE_HIDDEN (__exidx_end = .);
|
|
||||||
|
|
||||||
. = ALIGN(4);
|
|
||||||
_end = . ;
|
|
||||||
}
|
|
||||||
@@ -1,91 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* Linker script for running in internal SRAM on the AT91SAM3S4
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
OUTPUT_FORMAT("elf32-littlearm", "elf32-littlearm", "elf32-littlearm")
|
|
||||||
OUTPUT_ARCH(arm)
|
|
||||||
ENTRY(entry)
|
|
||||||
|
|
||||||
/* Memory Spaces Definitions */
|
|
||||||
MEMORY
|
|
||||||
{
|
|
||||||
romcodesram (W!RX) : ORIGIN = 0x20000000, LENGTH = 0x01000
|
|
||||||
sram (W!RX) : ORIGIN = 0x20001000, LENGTH = 0x0000B000 /* sram, 48K - sizeof(romcodesram) */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Entry point */
|
|
||||||
/*ENTRY (ResetException)*/
|
|
||||||
|
|
||||||
SECTIONS
|
|
||||||
{
|
|
||||||
/* startup code in the .isr_vector */
|
|
||||||
.text :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_stext = .;
|
|
||||||
KEEP(*(.isr_vector .isr_vector.*))
|
|
||||||
*(.mailbox)
|
|
||||||
*(.text .text.*)
|
|
||||||
*(.rodata .rodata.*)
|
|
||||||
*(.glue_7)
|
|
||||||
*(.glue_7t)
|
|
||||||
*(.gcc_except_table)
|
|
||||||
*(.rodata .rodata*)
|
|
||||||
*(.gnu.linkonce.r.*)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_etext = .;
|
|
||||||
} > sram
|
|
||||||
|
|
||||||
/* data */
|
|
||||||
.data :
|
|
||||||
{
|
|
||||||
. = ALIGN(4);
|
|
||||||
_sidata = .;
|
|
||||||
_sdata = .;
|
|
||||||
|
|
||||||
*(.data)
|
|
||||||
*(.data.*)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_edata = .;
|
|
||||||
} > sram
|
|
||||||
|
|
||||||
.bss (NOLOAD) : {
|
|
||||||
_szero = .;
|
|
||||||
*(.bss)
|
|
||||||
. = ALIGN(4);
|
|
||||||
_ezero = .;
|
|
||||||
} >sram
|
|
||||||
|
|
||||||
/* Stack in SRAM */
|
|
||||||
_sstack = 0x2000BFFC;
|
|
||||||
}
|
|
||||||
end = .;
|
|
||||||
@@ -1,31 +0,0 @@
|
|||||||
#*******************************************************
|
|
||||||
#
|
|
||||||
# Connect to J-Link and debug application in flash.
|
|
||||||
#
|
|
||||||
|
|
||||||
# define 'reset' command
|
|
||||||
define reset
|
|
||||||
|
|
||||||
# Connect to the J-Link gdb server
|
|
||||||
target remote localhost:2331
|
|
||||||
# Reset the chip to get to a known state
|
|
||||||
monitor reset
|
|
||||||
|
|
||||||
# Select flash device
|
|
||||||
monitor flash device = AT91SAM3S4C
|
|
||||||
# Enable flash download and flash breakpoints
|
|
||||||
monitor flash download = 1
|
|
||||||
# Load the program
|
|
||||||
load
|
|
||||||
|
|
||||||
# Reset peripheral (RSTC_CR)
|
|
||||||
set *0x400e1400 = 0xA5000004
|
|
||||||
|
|
||||||
# Initializing PC and stack pointer
|
|
||||||
mon reg sp=(0x400000)
|
|
||||||
set *0x400004 = *0x400004 & 0xFFFFFFFE
|
|
||||||
mon reg pc=(0x400004)
|
|
||||||
info reg
|
|
||||||
|
|
||||||
# end of 'reset' command
|
|
||||||
end
|
|
||||||
@@ -1,27 +0,0 @@
|
|||||||
#*************************************************
|
|
||||||
#
|
|
||||||
# Connect to J-Link and debug application in sram on SAM3S
|
|
||||||
#
|
|
||||||
# Note:
|
|
||||||
# First, users should modify Step1 and Step2 according to their project,
|
|
||||||
# then do Step3.
|
|
||||||
|
|
||||||
# Step1: Connect to the J-Link gdb server
|
|
||||||
define reset
|
|
||||||
target remote localhost:2331
|
|
||||||
monitor reset
|
|
||||||
|
|
||||||
# Step2: Load file(eg. getting-started project)
|
|
||||||
load
|
|
||||||
|
|
||||||
# Step3: Reset peripheral (RSTC_CR)
|
|
||||||
set *0x400e1400 = 0xA5000004
|
|
||||||
|
|
||||||
# Step4: Initializing PC and stack pointer
|
|
||||||
# Modify pc value to even before writing pc register
|
|
||||||
mon reg sp=(0x20000000)
|
|
||||||
set *0x20000004 = *0x20000004 & 0xFFFFFFFE
|
|
||||||
mon reg pc=(0x20000004)
|
|
||||||
info reg
|
|
||||||
|
|
||||||
end
|
|
||||||
@@ -1,27 +0,0 @@
|
|||||||
#*************************************************
|
|
||||||
#
|
|
||||||
# Connect to J-Link and debug application in sram on SAM3S
|
|
||||||
#
|
|
||||||
# Note:
|
|
||||||
# First, users should modify Step1 and Step2 according to their project,
|
|
||||||
# then do Step3.
|
|
||||||
|
|
||||||
# Step1: Connect to the J-Link gdb server
|
|
||||||
define reset
|
|
||||||
target remote localhost:2331
|
|
||||||
monitor reset
|
|
||||||
|
|
||||||
# Step2: Load file(eg. getting-started project)
|
|
||||||
load
|
|
||||||
|
|
||||||
# Step3: Reset peripheral (RSTC_CR)
|
|
||||||
set *0x400e1400 = 0xA5000004
|
|
||||||
|
|
||||||
# Step4: Initializing PC and stack pointer
|
|
||||||
# Modify pc value to even before writing pc register
|
|
||||||
mon reg sp=(0x20000000)
|
|
||||||
set *0x20000004 = *0x20000004 & 0xFFFFFFFE
|
|
||||||
mon reg pc=(0x20000004)
|
|
||||||
info reg
|
|
||||||
|
|
||||||
end
|
|
||||||
@@ -1,83 +0,0 @@
|
|||||||
#include "board.h"
|
|
||||||
#include "boardver_adc.h"
|
|
||||||
|
|
||||||
/* FIXME: share this with mode_cardemu.c */
|
|
||||||
#define UV_PER_LSB ((3300 * 1000) / 4096)
|
|
||||||
static uint32_t adc2uv(uint16_t adc)
|
|
||||||
{
|
|
||||||
uint32_t uv = (uint32_t) adc * UV_PER_LSB;
|
|
||||||
return uv;
|
|
||||||
}
|
|
||||||
|
|
||||||
/***********************************************************************
|
|
||||||
* ADC for board version detection
|
|
||||||
***********************************************************************/
|
|
||||||
|
|
||||||
#ifdef PIN_VERSION_DET
|
|
||||||
|
|
||||||
static int adc_sam3s_reva_errata = 0;
|
|
||||||
|
|
||||||
static const Pin pin_version_det = PIN_VERSION_DET;
|
|
||||||
|
|
||||||
/* Warning: Don't call this while other code (like the SIM VCC voltage
|
|
||||||
* reading) is running. The idea is you call this once during board
|
|
||||||
* startup and cache the result in a (global) variable if you need it
|
|
||||||
* later throughout the code */
|
|
||||||
int get_board_version_adc(void)
|
|
||||||
{
|
|
||||||
uint32_t chip_arch = CHIPID->CHIPID_CIDR & CHIPID_CIDR_ARCH_Msk;
|
|
||||||
uint32_t chip_ver = CHIPID->CHIPID_CIDR & CHIPID_CIDR_VERSION_Msk;
|
|
||||||
uint16_t sample;
|
|
||||||
uint32_t uv;
|
|
||||||
|
|
||||||
PIO_Configure(&pin_version_det, 1);
|
|
||||||
|
|
||||||
PMC_EnablePeripheral(ID_ADC);
|
|
||||||
|
|
||||||
ADC->ADC_CR |= ADC_CR_SWRST;
|
|
||||||
if (chip_ver == 0 &&
|
|
||||||
(chip_arch == CHIPID_CIDR_ARCH_SAM3SxA ||
|
|
||||||
chip_arch == CHIPID_CIDR_ARCH_SAM3SxB ||
|
|
||||||
chip_arch == CHIPID_CIDR_ARCH_SAM3SxC)) {
|
|
||||||
TRACE_INFO("Enabling Rev.A ADC Errata work-around\r\n");
|
|
||||||
adc_sam3s_reva_errata = 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (adc_sam3s_reva_errata) {
|
|
||||||
/* Errata Work-Around to clear EOCx flags */
|
|
||||||
volatile uint32_t foo;
|
|
||||||
int i;
|
|
||||||
for (i = 0; i < 16; i++)
|
|
||||||
foo = ADC->ADC_CDR[i];
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Initialize ADC for AD2, fADC=48/24=2MHz */
|
|
||||||
ADC->ADC_MR = ADC_MR_TRGEN_DIS | ADC_MR_LOWRES_BITS_12 |
|
|
||||||
ADC_MR_SLEEP_NORMAL | ADC_MR_FWUP_OFF |
|
|
||||||
ADC_MR_FREERUN_OFF | ADC_MR_PRESCAL(23) |
|
|
||||||
ADC_MR_STARTUP_SUT8 | ADC_MR_SETTLING(3) |
|
|
||||||
ADC_MR_ANACH_NONE | ADC_MR_TRACKTIM(4) |
|
|
||||||
ADC_MR_TRANSFER(1) | ADC_MR_USEQ_NUM_ORDER;
|
|
||||||
/* enable AD2 channel only */
|
|
||||||
ADC->ADC_CHER = ADC_CHER_CH2;
|
|
||||||
|
|
||||||
/* Make sure we don't use interrupts as that's what the SIM card
|
|
||||||
* VCC ADC code is using */
|
|
||||||
ADC->ADC_IER = 0;
|
|
||||||
NVIC_DisableIRQ(ADC_IRQn);
|
|
||||||
|
|
||||||
ADC->ADC_CR |= ADC_CR_START;
|
|
||||||
|
|
||||||
/* busy-wait, actually read the value */
|
|
||||||
do { } while (!(ADC->ADC_ISR & ADC_ISR_EOC2));
|
|
||||||
/* convert to voltage */
|
|
||||||
sample = ADC->ADC_CDR[2];
|
|
||||||
uv = adc2uv(sample);
|
|
||||||
TRACE_INFO("VERSION_DET ADC=%u => %u uV\r\n", sample, uv);
|
|
||||||
|
|
||||||
/* FIXME: convert to board version based on thresholds */
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
#endif /* PIN_VERSION_DET */
|
|
||||||
@@ -1,7 +0,0 @@
|
|||||||
|
|
||||||
#include "manifest.h"
|
|
||||||
|
|
||||||
const char *manifest_application = APPLICATION;
|
|
||||||
const char *manifest_revision = GIT_VERSION;
|
|
||||||
const char *manifest_board = BOARD;
|
|
||||||
const char *manifest_environment = ENVIRONMENT;
|
|
||||||
@@ -1,53 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
#include "board_common.h"
|
|
||||||
|
|
||||||
/** Name of the board */
|
|
||||||
#define BOARD_NAME "OWHW"
|
|
||||||
/** Board definition */
|
|
||||||
#define owhw
|
|
||||||
|
|
||||||
#define BOARD_MAINOSC 18432000
|
|
||||||
|
|
||||||
/* USIM 2 interface (USART) */
|
|
||||||
#define PIN_USIM2_CLK {PIO_PA2, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_IO {PIO_PA6, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
#define PINS_ISO7816_USIM2 PIN_USIM2_CLK, PIN_USIM2_IO
|
|
||||||
|
|
||||||
/* USIM 2 interface (TC) */
|
|
||||||
#define PIN_USIM2_IO_TC {PIO_PA1, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_CLK_TC {PIO_PA4, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PINS_TC_USIM2 PIN_USIM2_IO_TC, PIN_USIM2_CLK_TC
|
|
||||||
|
|
||||||
/* USIM 1 interface (USART) */
|
|
||||||
#define PIN_USIM1_IO {PIO_PA22, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_CLK {PIO_PA23, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
#define PINS_ISO7816_USIM1 PIN_USIM1_CLK, PIN_USIM1_IO
|
|
||||||
|
|
||||||
/* USIM 1 interface (TC) */
|
|
||||||
#define PIN_USIM1_IO_TC {PIO_PA27, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_CLK_TC {PIO_PA29, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PINS_TC_USIM1 PIN_USIM1_IO_TC, PIN_USIM1_CLK_TC
|
|
||||||
|
|
||||||
#define PIN_SET_USIM1_PRES {PIO_PA12, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_nRST {PIO_PA24, PIOA, ID_PIOA, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_VCC {PIO_PB3, PIOB, ID_PIOB, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
|
|
||||||
#define PIN_SET_USIM2_PRES {PIO_PA14, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_nRST {PIO_PA7, PIOA, ID_PIOA, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_VCC {PIO_PB2, PIOB, ID_PIOB, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
|
|
||||||
#define PINS_USIM1 PINS_TC_USIM1, PINS_ISO7816_USIM1, PIN_USIM1_nRST, PIN_SET_USIM1_PRES
|
|
||||||
#define PINS_USIM2 PINS_TC_USIM2, PINS_ISO7816_USIM2, PIN_USIM2_nRST, PIN_SET_USIM2_PRES
|
|
||||||
|
|
||||||
#define PINS_CARDSIM { PIN_SET_USIM1_PRES, PIN_SET_USIM2_PRES }
|
|
||||||
|
|
||||||
#define SIMTRACE_VENDOR_ID 0x1d50
|
|
||||||
#define SIMTRACE_PRODUCT_ID 0x60e3 /* FIXME */
|
|
||||||
#define USB_VENDOR_ID SIMTRACE_VENDOR_ID
|
|
||||||
#define USB_PRODUCT_ID SIMTRACE_PRODUCT_ID
|
|
||||||
|
|
||||||
#define CARDEMU_SECOND_UART
|
|
||||||
/* Disable VCC/ADC detection, as OWHWv2 has no ADCVREF */
|
|
||||||
//#define DETECT_VCC_BY_ADC
|
|
||||||
|
|
||||||
#define HAVE_CARDEM
|
|
||||||
@@ -1,40 +0,0 @@
|
|||||||
/* Card simulator specific functions */
|
|
||||||
/* (C) 2015 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "chip.h"
|
|
||||||
#include "board.h"
|
|
||||||
#include "utils.h"
|
|
||||||
|
|
||||||
static const Pin pins_cardsim[] = PINS_CARDSIM;
|
|
||||||
|
|
||||||
void cardsim_set_simpres(uint8_t slot, int present)
|
|
||||||
{
|
|
||||||
if (slot > 1)
|
|
||||||
return;
|
|
||||||
|
|
||||||
if (present)
|
|
||||||
PIO_Set(&pins_cardsim[slot]);
|
|
||||||
else
|
|
||||||
PIO_Clear(&pins_cardsim[slot]);
|
|
||||||
}
|
|
||||||
|
|
||||||
void cardsim_gpio_init(void)
|
|
||||||
{
|
|
||||||
PIO_Configure(&pins_cardsim, ARRAY_SIZE(pins_cardsim));
|
|
||||||
}
|
|
||||||
@@ -1,66 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
#include "board_common.h"
|
|
||||||
|
|
||||||
/** Name of the board */
|
|
||||||
#define BOARD_NAME "QMOD"
|
|
||||||
/** Board definition */
|
|
||||||
#define qmod
|
|
||||||
|
|
||||||
#define BOARD_MAINOSC 12000000
|
|
||||||
|
|
||||||
/* USIM 2 interface (USART) */
|
|
||||||
#define PIN_USIM2_CLK {PIO_PA2, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_IO {PIO_PA6, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
#define PINS_ISO7816_USIM2 PIN_USIM2_CLK, PIN_USIM2_IO
|
|
||||||
|
|
||||||
/* USIM 2 interface (TC) */
|
|
||||||
#define PIN_USIM2_IO_TC {PIO_PA1, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_CLK_TC {PIO_PA4, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PINS_TC_USIM2 PIN_USIM2_IO_TC, PIN_USIM2_CLK_TC
|
|
||||||
|
|
||||||
/* USIM 1 interface (USART) */
|
|
||||||
#define PIN_USIM1_IO {PIO_PA22, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_CLK {PIO_PA23, PIOA, ID_PIOA, PIO_PERIPH_A, PIO_DEFAULT}
|
|
||||||
#define PINS_ISO7816_USIM1 PIN_USIM1_CLK, PIN_USIM1_IO
|
|
||||||
|
|
||||||
/* USIM 1 interface (TC) */
|
|
||||||
#define PIN_USIM1_IO_TC {PIO_PA27, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_CLK_TC {PIO_PA29, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PINS_TC_USIM1 PIN_USIM1_IO_TC, PIN_USIM1_CLK_TC
|
|
||||||
|
|
||||||
#define PIN_SET_USIM1_PRES {PIO_PA12, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_nRST {PIO_PA24, PIOA, ID_PIOA, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM1_VCC {PIO_PB3, PIOB, ID_PIOB, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
|
|
||||||
#define PIN_SET_USIM2_PRES {PIO_PA14, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_nRST {PIO_PA7, PIOA, ID_PIOA, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
#define PIN_USIM2_VCC {PIO_PB2, PIOB, ID_PIOB, PIO_INPUT, PIO_DEFAULT}
|
|
||||||
|
|
||||||
#define PINS_USIM1 PINS_TC_USIM1, PINS_ISO7816_USIM1, PIN_USIM1_nRST, PIN_SET_USIM1_PRES
|
|
||||||
#define PINS_USIM2 PINS_TC_USIM2, PINS_ISO7816_USIM2, PIN_USIM2_nRST, PIN_SET_USIM2_PRES
|
|
||||||
|
|
||||||
#define PINS_CARDSIM { PIN_SET_USIM1_PRES, PIN_SET_USIM2_PRES }
|
|
||||||
|
|
||||||
#define PIN_PRTPWR_OVERRIDE {PIO_PA8, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
|
||||||
|
|
||||||
/* inputs reading the WWAN LED level */
|
|
||||||
#define PIN_WWAN1 {PIO_PA15, PIOA, ID_PIOA, PIO_INPUT, PIO_PULLUP | PIO_DEGLITCH | PIO_IT_EDGE}
|
|
||||||
#define PIN_WWAN2 {PIO_PA16, PIOA, ID_PIOA, PIO_INPUT, PIO_PULLUP | PIO_DEGLITCH | PIO_IT_EDGE}
|
|
||||||
#define PINS_WWAN_IN { PIN_WWAN1, PIN_WWAN2 }
|
|
||||||
|
|
||||||
/* outputs controlling RESET input of modems */
|
|
||||||
#define PIN_PERST1 {PIO_PA25, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_PULLUP}
|
|
||||||
#define PIN_PERST2 {PIO_PA26, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_PULLUP}
|
|
||||||
#define PINS_PERST { PIN_PERST1, PIN_PERST2 }
|
|
||||||
|
|
||||||
#define PIN_VERSION_DET {PIO_PA19, PIOA, ID_PIOA, PIO_PERIPH_D, PIO_DEFAULT}
|
|
||||||
|
|
||||||
#define SIMTRACE_VENDOR_ID 0x1d50
|
|
||||||
#define SIMTRACE_PRODUCT_ID 0x60e3 /* FIXME */
|
|
||||||
#define USB_VENDOR_ID SIMTRACE_VENDOR_ID
|
|
||||||
#define USB_PRODUCT_ID SIMTRACE_PRODUCT_ID
|
|
||||||
|
|
||||||
#define CARDEMU_SECOND_UART
|
|
||||||
#define DETECT_VCC_BY_ADC
|
|
||||||
|
|
||||||
#define HAVE_CARDEM
|
|
||||||
@@ -1,5 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
void i2c_pin_init(void);
|
|
||||||
int eeprom_write_byte(uint8_t slave, uint8_t addr, uint8_t byte);
|
|
||||||
int eeprom_read_byte(uint8_t slave, uint8_t addr);
|
|
||||||
@@ -1,4 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
int wwan_led_active(int wwan);
|
|
||||||
int wwan_led_init(void);
|
|
||||||
@@ -1,4 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
int wwan_perst_do_reset(int modem_nr);
|
|
||||||
int wwan_perst_init(void);
|
|
||||||
@@ -1,201 +0,0 @@
|
|||||||
/* Quad-modem speciic application code */
|
|
||||||
/* (C) 2016-2016 by Harald Welte <laforge@gnumonks.org> */
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "simtrace.h"
|
|
||||||
#include "utils.h"
|
|
||||||
#include "req_ctx.h"
|
|
||||||
#include "wwan_led.h"
|
|
||||||
#include "wwan_perst.h"
|
|
||||||
#include "boardver_adc.h"
|
|
||||||
#include "osmocom/core/timer.h"
|
|
||||||
|
|
||||||
static const Pin pin_hubpwr_override = PIN_PRTPWR_OVERRIDE;
|
|
||||||
static const Pin pin_hub_rst = {PIO_PA13, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT};
|
|
||||||
static const Pin pin_1234_detect = {PIO_PA14, PIOA, ID_PIOA, PIO_INPUT, PIO_PULLUP};
|
|
||||||
static const Pin pin_peer_rst = {PIO_PA0, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT};
|
|
||||||
static const Pin pin_peer_erase = {PIO_PA11, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT};
|
|
||||||
|
|
||||||
|
|
||||||
static int qmod_sam3_is_12(void)
|
|
||||||
{
|
|
||||||
if (PIO_Get(&pin_1234_detect) == 0)
|
|
||||||
return 1;
|
|
||||||
else
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
const unsigned char __eeprom_bin[256] = {
|
|
||||||
0x23, 0x42, 0x17, 0x25, 0x00, 0x00, 0x9b, 0x20, 0x01, 0x00, 0x00, 0x00, 0x32, 0x32, 0x32, 0x32, /* 0x00 - 0x0f */
|
|
||||||
0x32, 0x04, 0x09, 0x18, 0x0d, 0x00, 0x73, 0x00, 0x79, 0x00, 0x73, 0x00, 0x6d, 0x00, 0x6f, 0x00, /* 0x10 - 0x1f */
|
|
||||||
0x63, 0x00, 0x6f, 0x00, 0x6d, 0x00, 0x20, 0x00, 0x2d, 0x00, 0x20, 0x00, 0x73, 0x00, 0x2e, 0x00, /* 0x20 - 0x2f */
|
|
||||||
0x66, 0x00, 0x2e, 0x00, 0x6d, 0x00, 0x2e, 0x00, 0x63, 0x00, 0x2e, 0x00, 0x20, 0x00, 0x47, 0x00, /* 0x30 - 0x3f */
|
|
||||||
0x6d, 0x00, 0x62, 0x00, 0x48, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x40 - 0x4f */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x71, 0x00, 0x75, 0x00, 0x61, 0x00, 0x64, 0x00, 0x20, 0x00, 0x6d, 0x00, /* 0x50 - 0x5f */
|
|
||||||
0x6f, 0x00, 0x64, 0x00, 0x65, 0x00, 0x6d, 0x00, 0x20, 0x00, 0x76, 0x00, 0x32, 0x00, 0x00, 0x00, /* 0x60 - 0x6f */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x70 - 0x7f */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x80 - 0x8f */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0x90 - 0x9f */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xa0 - 0xaf */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xb0 - 0xbf */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xc0 - 0xcf */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xd0 - 0xdf */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, /* 0xe0 - 0xef */
|
|
||||||
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xA0, 0x56, 0x23, 0x71, 0x04, 0x00, /* 0xf0 - 0xff */
|
|
||||||
};
|
|
||||||
|
|
||||||
#include "i2c.h"
|
|
||||||
static int write_hub_eeprom(void)
|
|
||||||
{
|
|
||||||
const unsigned int __eeprom_bin_len = 256;
|
|
||||||
|
|
||||||
int i;
|
|
||||||
|
|
||||||
/* wait */
|
|
||||||
volatile int v;
|
|
||||||
/* 440ns per cycle here */
|
|
||||||
for (i = 0; i < 1000000; i++) {
|
|
||||||
v = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
TRACE_INFO("Writing EEPROM...\r\n");
|
|
||||||
/* write the EEPROM once */
|
|
||||||
for (i = 0; i < 256; i++) {
|
|
||||||
int rc = eeprom_write_byte(0x50, i, __eeprom_bin[i]);
|
|
||||||
/* if the result was negative, repeat that write */
|
|
||||||
if (rc < 0)
|
|
||||||
i--;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* then pursue re-reading it again and again */
|
|
||||||
TRACE_INFO("Verifying EEPROM...\r\n");
|
|
||||||
for (i = 0; i < 256; i++) {
|
|
||||||
int byte = eeprom_read_byte(0x50, i);
|
|
||||||
TRACE_INFO("0x%02x: %02x\r\n", i, byte);
|
|
||||||
if (byte != __eeprom_bin[i])
|
|
||||||
TRACE_ERROR("Byte %u is wrong, expected 0x%02x, found 0x%02x\r\n",
|
|
||||||
i, __eeprom_bin[i], byte);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* FIXME: Release PIN_PRTPWR_OVERRIDE after we know the hub is
|
|
||||||
* again powering us up */
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* returns '1' in case we should break any endless loop */
|
|
||||||
void board_exec_dbg_cmd(int ch)
|
|
||||||
{
|
|
||||||
uint32_t addr, val;
|
|
||||||
|
|
||||||
switch (ch) {
|
|
||||||
case '?':
|
|
||||||
printf("\t?\thelp\r\n");
|
|
||||||
printf("\tE\tprogram EEPROM\r\n");
|
|
||||||
printf("\tR\treset SAM3\r\n");
|
|
||||||
printf("\tO\tEnable PRTPWR_OVERRIDE\r\n");
|
|
||||||
printf("\to\tDisable PRTPWR_OVERRIDE\r\n");
|
|
||||||
printf("\tH\tRelease HUB RESET (high)\r\n");
|
|
||||||
printf("\th\tAssert HUB RESET (low)\r\n");
|
|
||||||
printf("\tw\tWrite single byte in EEPROM\r\n");
|
|
||||||
printf("\tr\tRead single byte from EEPROM\r\n");
|
|
||||||
printf("\tX\tRelease peer SAM3 from reset\r\n");
|
|
||||||
printf("\tx\tAssert peer SAM3 reset\r\n");
|
|
||||||
printf("\tY\tRelease peer SAM3 ERASE signal\r\n");
|
|
||||||
printf("\ty\tAssert peer SAM3 ERASE signal\r\n");
|
|
||||||
printf("\tU\tProceed to USB Initialization\r\n");
|
|
||||||
printf("\t1\tGenerate 1ms reset pulse on WWAN1\r\n");
|
|
||||||
printf("\t2\tGenerate 1ms reset pulse on WWAN2\r\n");
|
|
||||||
break;
|
|
||||||
case 'E':
|
|
||||||
write_hub_eeprom();
|
|
||||||
break;
|
|
||||||
case 'R':
|
|
||||||
printf("Asking NVIC to reset us\r\n");
|
|
||||||
NVIC_SystemReset();
|
|
||||||
break;
|
|
||||||
case 'O':
|
|
||||||
printf("Setting PRTPWR_OVERRIDE\r\n");
|
|
||||||
PIO_Set(&pin_hubpwr_override);
|
|
||||||
break;
|
|
||||||
case 'o':
|
|
||||||
printf("Clearing PRTPWR_OVERRIDE\r\n");
|
|
||||||
PIO_Clear(&pin_hubpwr_override);
|
|
||||||
break;
|
|
||||||
case 'H':
|
|
||||||
printf("Clearing _HUB_RESET -> HUB_RESET high (inactive)\r\n");
|
|
||||||
PIO_Clear(&pin_hub_rst);
|
|
||||||
break;
|
|
||||||
case 'h':
|
|
||||||
/* high level drives transistor -> HUB_RESET low */
|
|
||||||
printf("Asserting _HUB_RESET -> HUB_RESET low (active)\r\n");
|
|
||||||
PIO_Set(&pin_hub_rst);
|
|
||||||
break;
|
|
||||||
case 'w':
|
|
||||||
if (PIO_GetOutputDataStatus(&pin_hub_rst) == 0)
|
|
||||||
printf("WARNING: attempting EEPROM access while HUB not in reset\r\n");
|
|
||||||
printf("Please enter EEPROM offset:\r\n");
|
|
||||||
UART_GetIntegerMinMax(&addr, 0, 255);
|
|
||||||
printf("Please enter EEPROM value:\r\n");
|
|
||||||
UART_GetIntegerMinMax(&val, 0, 255);
|
|
||||||
printf("Writing value 0x%02x to EEPROM offset 0x%02x\r\n", val, addr);
|
|
||||||
eeprom_write_byte(0x50, addr, val);
|
|
||||||
break;
|
|
||||||
case 'r':
|
|
||||||
printf("Please enter EEPROM offset:\r\n");
|
|
||||||
UART_GetIntegerMinMax(&addr, 0, 255);
|
|
||||||
printf("EEPROM[0x%02x] = 0x%02x\r\n", addr, eeprom_read_byte(0x50, addr));
|
|
||||||
break;
|
|
||||||
case 'X':
|
|
||||||
printf("Clearing _SIMTRACExx_RST -> SIMTRACExx_RST high (inactive)\r\n");
|
|
||||||
PIO_Clear(&pin_peer_rst);
|
|
||||||
break;
|
|
||||||
case 'x':
|
|
||||||
printf("Setting _SIMTRACExx_RST -> SIMTRACExx_RST low (active)\r\n");
|
|
||||||
PIO_Set(&pin_peer_rst);
|
|
||||||
break;
|
|
||||||
case 'Y':
|
|
||||||
printf("Clearing SIMTRACExx_ERASE (inactive)\r\n");
|
|
||||||
PIO_Clear(&pin_peer_erase);
|
|
||||||
break;
|
|
||||||
case 'y':
|
|
||||||
printf("Seetting SIMTRACExx_ERASE (active)\r\n");
|
|
||||||
PIO_Set(&pin_peer_erase);
|
|
||||||
break;
|
|
||||||
case '1':
|
|
||||||
printf("Resetting Modem 1 (of this SAM3)\r\n");
|
|
||||||
wwan_perst_do_reset(1);
|
|
||||||
break;
|
|
||||||
case '2':
|
|
||||||
printf("Resetting Modem 2 (of this SAM3)\r\n");
|
|
||||||
wwan_perst_do_reset(2);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
printf("Unknown command '%c'\r\n", ch);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void board_main_top(void)
|
|
||||||
{
|
|
||||||
wwan_led_init();
|
|
||||||
wwan_perst_init();
|
|
||||||
|
|
||||||
/* set PIN_PRTPWR_OVERRIDE to output-low to avoid the internal
|
|
||||||
* pull-up on the input to keep SIMTRACE12 alive */
|
|
||||||
PIO_Configure(&pin_hubpwr_override, 1);
|
|
||||||
PIO_Configure(&pin_hub_rst, 1);
|
|
||||||
PIO_Configure(&pin_1234_detect, 1);
|
|
||||||
PIO_Configure(&pin_peer_rst, 1);
|
|
||||||
PIO_Configure(&pin_peer_erase, 1);
|
|
||||||
i2c_pin_init();
|
|
||||||
|
|
||||||
if (qmod_sam3_is_12()) {
|
|
||||||
TRACE_INFO("Detected Quad-Modem ST12\r\n");
|
|
||||||
} else {
|
|
||||||
TRACE_INFO("Detected Quad-Modem ST34\r\n");
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Obtain the circuit board version (currently just prints voltage */
|
|
||||||
get_board_version_adc();
|
|
||||||
}
|
|
||||||
@@ -1,203 +0,0 @@
|
|||||||
#include "board.h"
|
|
||||||
#include <stdbool.h>
|
|
||||||
|
|
||||||
/* Low-Level I2C Routines */
|
|
||||||
|
|
||||||
static const Pin pin_sda = {PIO_PA30, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_OPENDRAIN };
|
|
||||||
static const Pin pin_sda_in = {PIO_PA30, PIOA, ID_PIOA, PIO_INPUT, PIO_DEFAULT };
|
|
||||||
static const Pin pin_scl = {PIO_PA31, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_OPENDRAIN };
|
|
||||||
|
|
||||||
static void i2c_delay()
|
|
||||||
{
|
|
||||||
volatile int v;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
/* 100 cycles results in SCL peak length of 44us, so it's about
|
|
||||||
* 440ns per cycle here */
|
|
||||||
for (i = 0; i < 14; i++) {
|
|
||||||
v = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void i2c_pin_init(void)
|
|
||||||
{
|
|
||||||
PIO_Configure(&pin_scl, PIO_LISTSIZE(pin_scl));
|
|
||||||
PIO_Configure(&pin_sda, PIO_LISTSIZE(pin_sda));
|
|
||||||
}
|
|
||||||
|
|
||||||
static void set_scl(void)
|
|
||||||
{
|
|
||||||
PIO_Set(&pin_scl);
|
|
||||||
i2c_delay();
|
|
||||||
}
|
|
||||||
|
|
||||||
static void set_sda(void)
|
|
||||||
{
|
|
||||||
PIO_Set(&pin_sda);
|
|
||||||
i2c_delay();
|
|
||||||
}
|
|
||||||
|
|
||||||
static void clear_scl(void)
|
|
||||||
{
|
|
||||||
PIO_Clear(&pin_scl);
|
|
||||||
i2c_delay();
|
|
||||||
}
|
|
||||||
|
|
||||||
static void clear_sda(void)
|
|
||||||
{
|
|
||||||
PIO_Clear(&pin_sda);
|
|
||||||
i2c_delay();
|
|
||||||
}
|
|
||||||
|
|
||||||
static bool read_sda(void)
|
|
||||||
{
|
|
||||||
bool ret;
|
|
||||||
|
|
||||||
PIO_Configure(&pin_sda_in, PIO_LISTSIZE(pin_sda_in));
|
|
||||||
if (PIO_Get(&pin_sda_in))
|
|
||||||
ret = true;
|
|
||||||
else
|
|
||||||
ret = false;
|
|
||||||
PIO_Configure(&pin_sda, PIO_LISTSIZE(pin_sda));
|
|
||||||
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Core I2C Routines */
|
|
||||||
|
|
||||||
static bool i2c_started = false;
|
|
||||||
|
|
||||||
static void i2c_start_cond(void)
|
|
||||||
{
|
|
||||||
if (i2c_started) {
|
|
||||||
set_sda();
|
|
||||||
set_scl();
|
|
||||||
}
|
|
||||||
|
|
||||||
clear_sda();
|
|
||||||
i2c_delay();
|
|
||||||
clear_scl();
|
|
||||||
i2c_started = true;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void i2c_stop_cond(void)
|
|
||||||
{
|
|
||||||
clear_sda();
|
|
||||||
set_scl();
|
|
||||||
set_sda();
|
|
||||||
i2c_delay();
|
|
||||||
i2c_started = false;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void i2c_write_bit(bool bit)
|
|
||||||
{
|
|
||||||
if (bit)
|
|
||||||
set_sda();
|
|
||||||
else
|
|
||||||
clear_sda();
|
|
||||||
i2c_delay(); // ?
|
|
||||||
set_scl();
|
|
||||||
clear_scl();
|
|
||||||
}
|
|
||||||
|
|
||||||
static bool i2c_read_bit(void)
|
|
||||||
{
|
|
||||||
bool bit;
|
|
||||||
|
|
||||||
set_sda();
|
|
||||||
set_scl();
|
|
||||||
bit = read_sda();
|
|
||||||
clear_scl();
|
|
||||||
|
|
||||||
return bit;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool i2c_write_byte(bool send_start, bool send_stop, uint8_t byte)
|
|
||||||
{
|
|
||||||
uint8_t bit;
|
|
||||||
bool nack;
|
|
||||||
|
|
||||||
if (send_start)
|
|
||||||
i2c_start_cond();
|
|
||||||
|
|
||||||
for (bit = 0; bit < 8; bit++) {
|
|
||||||
i2c_write_bit((byte & 0x80) != 0);
|
|
||||||
byte <<= 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
nack = i2c_read_bit();
|
|
||||||
|
|
||||||
if (send_stop)
|
|
||||||
i2c_stop_cond();
|
|
||||||
|
|
||||||
return nack;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t i2c_read_byte(bool nack, bool send_stop)
|
|
||||||
{
|
|
||||||
uint8_t byte = 0;
|
|
||||||
uint8_t bit;
|
|
||||||
|
|
||||||
for (bit = 0; bit < 8; bit++) {
|
|
||||||
byte = (byte << 1) | i2c_read_bit();
|
|
||||||
}
|
|
||||||
|
|
||||||
i2c_write_bit(nack);
|
|
||||||
|
|
||||||
if (send_stop)
|
|
||||||
i2c_stop_cond();
|
|
||||||
|
|
||||||
return byte;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/* EEPROM related code */
|
|
||||||
|
|
||||||
int eeprom_write_byte(uint8_t slave, uint8_t addr, uint8_t byte)
|
|
||||||
{
|
|
||||||
bool nack;
|
|
||||||
|
|
||||||
/* Write slave address */
|
|
||||||
nack = i2c_write_byte(true, false, slave << 1);
|
|
||||||
if (nack)
|
|
||||||
goto out_stop;
|
|
||||||
nack = i2c_write_byte(false, false, addr);
|
|
||||||
if (nack)
|
|
||||||
goto out_stop;
|
|
||||||
nack = i2c_write_byte(false, true, byte);
|
|
||||||
if (nack)
|
|
||||||
goto out_stop;
|
|
||||||
|
|
||||||
out_stop:
|
|
||||||
i2c_stop_cond();
|
|
||||||
if (nack)
|
|
||||||
return -1;
|
|
||||||
else
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
int eeprom_read_byte(uint8_t slave, uint8_t addr)
|
|
||||||
{
|
|
||||||
bool nack;
|
|
||||||
|
|
||||||
/* dummy write cycle */
|
|
||||||
nack = i2c_write_byte(true, false, slave << 1);
|
|
||||||
if (nack)
|
|
||||||
goto out_stop;
|
|
||||||
nack = i2c_write_byte(false, false, addr);
|
|
||||||
if (nack)
|
|
||||||
goto out_stop;
|
|
||||||
/* Re-start with read */
|
|
||||||
nack = i2c_write_byte(true, false, (slave << 1) | 1);
|
|
||||||
if (nack)
|
|
||||||
goto out_stop;
|
|
||||||
|
|
||||||
return i2c_read_byte(true, true);
|
|
||||||
|
|
||||||
out_stop:
|
|
||||||
i2c_stop_cond();
|
|
||||||
if (nack)
|
|
||||||
return -1;
|
|
||||||
else
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
@@ -1,80 +0,0 @@
|
|||||||
/* Code to read/track the status of the WWAN LEDs of attached modems
|
|
||||||
*
|
|
||||||
* Depending on the board this is running on, it might be possible
|
|
||||||
* for the controller to read the status of the WWAN LED output lines of
|
|
||||||
* the cellular modem. If the board supports this, it sets the
|
|
||||||
* PIN_WWAN1 and/or PIN_WWAN2 defines in its board.h file.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "wwan_led.h"
|
|
||||||
|
|
||||||
#ifdef PIN_WWAN1
|
|
||||||
static const Pin pin_wwan1 = PIN_WWAN1;
|
|
||||||
|
|
||||||
static void wwan1_irqhandler(const Pin *pPin)
|
|
||||||
{
|
|
||||||
int active = wwan_led_active(1);
|
|
||||||
|
|
||||||
TRACE_INFO("WWAN1 LED %u\r\n", active);
|
|
||||||
|
|
||||||
/* TODO: notify host via USB */
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef PIN_WWAN2
|
|
||||||
static const Pin pin_wwan2 = PIN_WWAN2;
|
|
||||||
|
|
||||||
static void wwan2_irqhandler(const Pin *pPin)
|
|
||||||
{
|
|
||||||
int active = wwan_led_active(2);
|
|
||||||
TRACE_INFO("WWAN2 LED %u\r\n", active);
|
|
||||||
|
|
||||||
/* TODO: notify host via USB */
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
/* determine if a tiven WWAN led is currently active or not */
|
|
||||||
int wwan_led_active(int wwan)
|
|
||||||
{
|
|
||||||
const Pin *pin;
|
|
||||||
int active;
|
|
||||||
|
|
||||||
switch (wwan) {
|
|
||||||
#ifdef PIN_WWAN1
|
|
||||||
case 1:
|
|
||||||
pin = &pin_wwan1;
|
|
||||||
break;
|
|
||||||
#endif
|
|
||||||
#ifdef PIN_WWAN2
|
|
||||||
case 2:
|
|
||||||
pin = &pin_wwan2;
|
|
||||||
break;
|
|
||||||
#endif
|
|
||||||
default:
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
active = PIO_Get(&pin_wwan1) ? 0 : 1;
|
|
||||||
return active;
|
|
||||||
}
|
|
||||||
|
|
||||||
int wwan_led_init(void)
|
|
||||||
{
|
|
||||||
int num_leds = 0;
|
|
||||||
|
|
||||||
#ifdef PIN_WWAN1
|
|
||||||
PIO_Configure(&pin_wwan1, 1);
|
|
||||||
PIO_ConfigureIt(&pin_wwan1, wwan1_irqhandler);
|
|
||||||
PIO_EnableIt(&pin_wwan1);
|
|
||||||
num_leds++;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef PIN_WWAN2
|
|
||||||
PIO_Configure(&pin_wwan2, 1);
|
|
||||||
PIO_ConfigureIt(&pin_wwan2, wwan2_irqhandler);
|
|
||||||
PIO_EnableIt(&pin_wwan2);
|
|
||||||
num_leds++;
|
|
||||||
#endif
|
|
||||||
return num_leds;
|
|
||||||
}
|
|
||||||
@@ -1,76 +0,0 @@
|
|||||||
/* Code to control the PERST lines of attached modems
|
|
||||||
*
|
|
||||||
* Depending on the board this is running on, it might be possible
|
|
||||||
* for the controller to set the status of the PERST input line of
|
|
||||||
* the cellular modem. If the board supports this, it sets the
|
|
||||||
* PIN_PERST1 and/or PIN_PERST2 defines in its board.h file.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "wwan_perst.h"
|
|
||||||
#include "osmocom/core/timer.h"
|
|
||||||
|
|
||||||
#define PERST_DURATION_MS 300
|
|
||||||
|
|
||||||
#ifdef PIN_PERST1
|
|
||||||
static const Pin pin_perst1 = PIN_PERST1;
|
|
||||||
static struct osmo_timer_list perst1_timer;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef PIN_PERST2
|
|
||||||
static const Pin pin_perst2 = PIN_PERST2;
|
|
||||||
static struct osmo_timer_list perst2_timer;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static void perst_tmr_cb(void *data)
|
|
||||||
{
|
|
||||||
const Pin *pin = data;
|
|
||||||
/* release the (low-active) reset */
|
|
||||||
PIO_Clear(pin);
|
|
||||||
}
|
|
||||||
|
|
||||||
int wwan_perst_do_reset(int modem_nr)
|
|
||||||
{
|
|
||||||
const Pin *pin;
|
|
||||||
struct osmo_timer_list *tmr;
|
|
||||||
|
|
||||||
switch (modem_nr) {
|
|
||||||
#ifdef PIN_PERST1
|
|
||||||
case 1:
|
|
||||||
pin = &pin_perst1;
|
|
||||||
tmr = &perst1_timer;
|
|
||||||
break;
|
|
||||||
#endif
|
|
||||||
#ifdef PIN_PERST2
|
|
||||||
case 2:
|
|
||||||
pin = &pin_perst2;
|
|
||||||
tmr = &perst2_timer;
|
|
||||||
break;
|
|
||||||
#endif
|
|
||||||
default:
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
PIO_Set(pin);
|
|
||||||
osmo_timer_schedule(tmr, PERST_DURATION_MS/1000, (PERST_DURATION_MS%1000)*1000);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
int wwan_perst_init(void)
|
|
||||||
{
|
|
||||||
int num_perst = 0;
|
|
||||||
#ifdef PIN_PERST1
|
|
||||||
PIO_Configure(&pin_perst1, 1);
|
|
||||||
perst1_timer.cb = perst_tmr_cb;
|
|
||||||
perst1_timer.data = (void *) &pin_perst1;
|
|
||||||
num_perst++;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef PIN_PERST2
|
|
||||||
PIO_Configure(&pin_perst2, 1);
|
|
||||||
perst2_timer.cb = perst_tmr_cb;
|
|
||||||
perst2_timer.data = (void *) &pin_perst2;
|
|
||||||
num_perst++;
|
|
||||||
#endif
|
|
||||||
return num_perst;
|
|
||||||
}
|
|
||||||
@@ -1,115 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2008, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// \unit
|
|
||||||
///
|
|
||||||
/// !Purpose
|
|
||||||
///
|
|
||||||
/// Definition of the ASSERT() and SANITY_CHECK() macros, which are used for
|
|
||||||
/// runtime condition & parameter verifying.
|
|
||||||
///
|
|
||||||
/// !Usage
|
|
||||||
///
|
|
||||||
/// -# Use ASSERT() in your code to check the value of function parameters,
|
|
||||||
/// return values, etc. *Warning:* the ASSERT() condition must not have
|
|
||||||
/// any side-effect; otherwise, the program may not work properly
|
|
||||||
/// anymore when assertions are disabled.
|
|
||||||
/// -# Use SANITY_CHECK() to perform checks with a default error message
|
|
||||||
/// (outputs the file and line number where the error occured). This
|
|
||||||
/// reduces memory overhead caused by assertion error strings.
|
|
||||||
/// -# Initialize the dbgu to see failed assertions at run-time.
|
|
||||||
/// -# Assertions can be entirely disabled by defining the NOASSERT symbol
|
|
||||||
/// at compilation time.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
#ifndef ASSERT_H
|
|
||||||
#define ASSERT_H
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Headers
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
#include <stdio.h>
|
|
||||||
#include "trace.h"
|
|
||||||
|
|
||||||
#define assert ASSERT
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Definitions
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
#if defined(NOASSERT)
|
|
||||||
#define ASSERT(...)
|
|
||||||
#define SANITY_CHECK(...)
|
|
||||||
#else
|
|
||||||
|
|
||||||
#if (TRACE_LEVEL == 0)
|
|
||||||
/// Checks that the given condition is true,
|
|
||||||
/// otherwise stops the program execution.
|
|
||||||
/// \param condition Condition to verify.
|
|
||||||
#define ASSERT(condition) { \
|
|
||||||
if (!(condition)) { \
|
|
||||||
while (1); \
|
|
||||||
} \
|
|
||||||
}
|
|
||||||
|
|
||||||
/// Performs the same duty as the ASSERT() macro
|
|
||||||
/// \param condition Condition to verify.
|
|
||||||
#define SANITY_CHECK(condition) ASSERT(condition, ...)
|
|
||||||
|
|
||||||
#else
|
|
||||||
/// Checks that the given condition is true, otherwise displays an error
|
|
||||||
/// message and stops the program execution.
|
|
||||||
/// \param condition Condition to verify.
|
|
||||||
#define ASSERT(condition) { \
|
|
||||||
if (!(condition)) { \
|
|
||||||
printf("-F- ASSERT: %s %s:%d\r\n", #condition, __BASE_FILE__, __LINE__); \
|
|
||||||
while (1); \
|
|
||||||
} \
|
|
||||||
}
|
|
||||||
#define SANITY_ERROR "Sanity check failed at %s:%d\n\r"
|
|
||||||
|
|
||||||
/// Performs the same duty as the ASSERT() macro, except a default error
|
|
||||||
/// message is output if the condition is false.
|
|
||||||
/// \param condition Condition to verify.
|
|
||||||
#define SANITY_CHECK(condition) ASSERT(condition, SANITY_ERROR, __FILE__, __LINE__)
|
|
||||||
#endif
|
|
||||||
#endif
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
#endif //#ifndef ASSERT_H
|
|
||||||
|
|
||||||
@@ -1,38 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
struct card_handle;
|
|
||||||
|
|
||||||
enum card_io {
|
|
||||||
CARD_IO_VCC,
|
|
||||||
CARD_IO_RST,
|
|
||||||
CARD_IO_CLK,
|
|
||||||
};
|
|
||||||
|
|
||||||
struct card_handle *card_emu_init(uint8_t slot_num, uint8_t tc_chan, uint8_t uart_chan);
|
|
||||||
|
|
||||||
/* process a single byte received from the reader */
|
|
||||||
void card_emu_process_rx_byte(struct card_handle *ch, uint8_t byte);
|
|
||||||
|
|
||||||
/* transmit a single byte to the reader */
|
|
||||||
int card_emu_tx_byte(struct card_handle *ch);
|
|
||||||
|
|
||||||
/* hardware driver informs us that a card I/O signal has changed */
|
|
||||||
void card_emu_io_statechg(struct card_handle *ch, enum card_io io, int active);
|
|
||||||
|
|
||||||
/* User sets a new ATR to be returned during next card reset */
|
|
||||||
int card_emu_set_atr(struct card_handle *ch, const uint8_t *atr, uint8_t len);
|
|
||||||
|
|
||||||
struct llist_head *card_emu_get_uart_tx_queue(struct card_handle *ch);
|
|
||||||
struct llist_head *card_emu_get_usb_tx_queue(struct card_handle *ch);
|
|
||||||
void card_emu_have_new_uart_tx(struct card_handle *ch);
|
|
||||||
void card_emu_report_status(struct card_handle *ch);
|
|
||||||
|
|
||||||
#define ENABLE_TX 0x01
|
|
||||||
#define ENABLE_RX 0x02
|
|
||||||
|
|
||||||
int card_emu_uart_update_fidi(uint8_t uart_chan, unsigned int fidi);
|
|
||||||
int card_emu_uart_tx(uint8_t uart_chan, uint8_t byte);
|
|
||||||
void card_emu_uart_enable(uint8_t uart_chan, uint8_t rxtx);
|
|
||||||
void card_emu_uart_wait_tx_idle(uint8_t uart_chan);
|
|
||||||
@@ -1,135 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
/* Smart Card Emulation USB protocol */
|
|
||||||
|
|
||||||
/* (C) 2015 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
/* DT = Device Terminated. DO = Device Originated */
|
|
||||||
enum cardemu_usb_msg_type {
|
|
||||||
/* Bulk out pipe */
|
|
||||||
CEMU_USB_MSGT_DT_TX_DATA, /* TPDU Date */
|
|
||||||
CEMU_USB_MSGT_DT_SET_ATR, /* Set the ATR stored in simulator */
|
|
||||||
CEMU_USB_MSGT_DT_GET_STATS, /* request DO_STATS */
|
|
||||||
CEMU_USB_MSGT_DT_GET_STATUS, /* request DO_STATUS */
|
|
||||||
CEMU_USB_MSGT_DT_CARDINSERT, /* insert/remove card */
|
|
||||||
|
|
||||||
/* Bulk in pipe */
|
|
||||||
CEMU_USB_MSGT_DO_RX_DATA, /* TPDU data */
|
|
||||||
CEMU_USB_MSGT_DO_STATUS, /* Status information */
|
|
||||||
CEMU_USB_MSGT_DO_STATS, /* Statistics */
|
|
||||||
CEMU_USB_MSGT_DO_PTS, /* Information about PTS */
|
|
||||||
CEMU_USB_MSGT_DO_ERROR, /* Error message */
|
|
||||||
};
|
|
||||||
|
|
||||||
/* generic header, shared by all messages */
|
|
||||||
struct cardemu_usb_msg_hdr {
|
|
||||||
uint8_t msg_type; /* enum cardemu_usb_msg_type */
|
|
||||||
uint8_t seq_nr; /* sequence number */
|
|
||||||
uint16_t msg_len; /* length of message including hdr */
|
|
||||||
uint8_t data[0];
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
/* indicates a TPDU header is present in this message */
|
|
||||||
#define CEMU_DATA_F_TPDU_HDR 0x00000001
|
|
||||||
/* indicates last part of transmission in this direction */
|
|
||||||
#define CEMU_DATA_F_FINAL 0x00000002
|
|
||||||
/* incdicates a PB is present and we should continue with TX */
|
|
||||||
#define CEMU_DATA_F_PB_AND_TX 0x00000004
|
|
||||||
/* incdicates a PB is present and we should continue with RX */
|
|
||||||
#define CEMU_DATA_F_PB_AND_RX 0x00000008
|
|
||||||
|
|
||||||
/* CEMU_USB_MSGT_DT_CARDINSERT */
|
|
||||||
struct cardemu_usb_msg_cardinsert {
|
|
||||||
struct cardemu_usb_msg_hdr hdr;
|
|
||||||
uint8_t card_insert;
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
/* CEMU_USB_MSGT_DT_SET_ATR */
|
|
||||||
struct cardemu_usb_msg_set_atr {
|
|
||||||
struct cardemu_usb_msg_hdr hdr;
|
|
||||||
uint8_t atr_len;
|
|
||||||
/* variable-length ATR data */
|
|
||||||
uint8_t atr[0];
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
/* CEMU_USB_MSGT_DT_TX_DATA */
|
|
||||||
struct cardemu_usb_msg_tx_data {
|
|
||||||
struct cardemu_usb_msg_hdr hdr;
|
|
||||||
uint32_t flags;
|
|
||||||
uint16_t data_len;
|
|
||||||
/* variable-length TPDU data */
|
|
||||||
uint8_t data[0];
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
/* CEMU_USB_MSGT_DO_RX_DATA */
|
|
||||||
struct cardemu_usb_msg_rx_data {
|
|
||||||
struct cardemu_usb_msg_hdr hdr;
|
|
||||||
uint32_t flags;
|
|
||||||
uint16_t data_len;
|
|
||||||
/* variable-length TPDU data */
|
|
||||||
uint8_t data[0];
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
#define CEMU_STATUS_F_VCC_PRESENT 0x00000001
|
|
||||||
#define CEMU_STATUS_F_CLK_ACTIVE 0x00000002
|
|
||||||
#define CEMU_STATUS_F_RCEMU_ACTIVE 0x00000004
|
|
||||||
#define CEMU_STATUS_F_CARD_INSERT 0x00000008
|
|
||||||
#define CEMU_STATUS_F_RESET_ACTIVE 0x00000010
|
|
||||||
|
|
||||||
/* CEMU_USB_MSGT_DO_STATUS */
|
|
||||||
struct cardemu_usb_msg_status {
|
|
||||||
struct cardemu_usb_msg_hdr hdr;
|
|
||||||
uint32_t flags;
|
|
||||||
/* phone-applied target voltage in mV */
|
|
||||||
uint16_t voltage_mv;
|
|
||||||
/* Fi/Di related information */
|
|
||||||
uint8_t fi;
|
|
||||||
uint8_t di;
|
|
||||||
uint8_t wi;
|
|
||||||
uint32_t waiting_time;
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
/* CEMU_USB_MSGT_DO_PTS */
|
|
||||||
struct cardemu_usb_msg_pts_info {
|
|
||||||
struct cardemu_usb_msg_hdr hdr;
|
|
||||||
uint8_t pts_len;
|
|
||||||
/* PTS request as sent from reader */
|
|
||||||
uint8_t req[6];
|
|
||||||
/* PTS response as sent by card */
|
|
||||||
uint8_t resp[6];
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
/* CEMU_USB_MSGT_DO_ERROR */
|
|
||||||
struct cardemu_usb_msg_error {
|
|
||||||
struct cardemu_usb_msg_hdr hdr;
|
|
||||||
uint8_t severity;
|
|
||||||
uint8_t subsystem;
|
|
||||||
uint16_t code;
|
|
||||||
uint8_t msg_len;
|
|
||||||
/* human-readable error message */
|
|
||||||
uint8_t msg[0];
|
|
||||||
} __attribute__ ((packed));
|
|
||||||
|
|
||||||
static inline void cardemu_hdr_set(struct cardemu_usb_msg_hdr *hdr, uint16_t msgt)
|
|
||||||
{
|
|
||||||
memset(hdr, 0, sizeof(*hdr));
|
|
||||||
hdr->msg_type = msgt;
|
|
||||||
}
|
|
||||||
@@ -1,6 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
/* compute the F/D ratio based on Fi and Di values */
|
|
||||||
int compute_fidi_ratio(uint8_t fi, uint8_t di);
|
|
||||||
@@ -1,27 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
#include "osmocom/core/linuxlist.h"
|
|
||||||
|
|
||||||
static inline void llist_add_tail_irqsafe(struct llist_head *_new,
|
|
||||||
struct llist_head *head)
|
|
||||||
{
|
|
||||||
__disable_irq();
|
|
||||||
llist_add_tail(_new, head);
|
|
||||||
__enable_irq();
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline struct llist_head *llist_head_dequeue_irqsafe(struct llist_head *head)
|
|
||||||
{
|
|
||||||
struct llist_head *lh;
|
|
||||||
|
|
||||||
__disable_irq();
|
|
||||||
if (llist_empty(head)) {
|
|
||||||
lh = NULL;
|
|
||||||
} else {
|
|
||||||
lh = head->next;
|
|
||||||
llist_del(lh);
|
|
||||||
}
|
|
||||||
__enable_irq();
|
|
||||||
|
|
||||||
return lh;
|
|
||||||
}
|
|
||||||
@@ -1,61 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
#define RCTX_SIZE_LARGE 960
|
|
||||||
#define RCTX_SIZE_SMALL 320
|
|
||||||
#define MAX_HDRSIZE sizeof(struct openpcd_hdr)
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
#include "osmocom/core/linuxlist.h"
|
|
||||||
|
|
||||||
#define __ramfunc
|
|
||||||
|
|
||||||
enum req_ctx_state {
|
|
||||||
/* free to be allocated */
|
|
||||||
RCTX_S_FREE,
|
|
||||||
|
|
||||||
/* USB -> UART */
|
|
||||||
/* In USB driver, waiting for data from host */
|
|
||||||
RCTX_S_USB_RX_BUSY,
|
|
||||||
/* somewhere in the main loop */
|
|
||||||
RCTX_S_MAIN_PROCESSING,
|
|
||||||
/* pending (in queue) for transmission on UART */
|
|
||||||
RCTX_S_UART_TX_PENDING,
|
|
||||||
/* currently in active transmission on UART */
|
|
||||||
RCTX_S_UART_TX_BUSY,
|
|
||||||
|
|
||||||
/* UART -> USB */
|
|
||||||
/* currently in active reception on UART */
|
|
||||||
RCTX_S_UART_RX_BUSY,
|
|
||||||
/* pending (in queue) for transmission over USB to host */
|
|
||||||
RCTX_S_USB_TX_PENDING,
|
|
||||||
/* currently in transmission over USB to host */
|
|
||||||
RCTX_S_USB_TX_BUSY,
|
|
||||||
|
|
||||||
/* number of states */
|
|
||||||
RCTX_STATE_COUNT
|
|
||||||
};
|
|
||||||
|
|
||||||
struct req_ctx {
|
|
||||||
/* if this req_ctx is on a queue... */
|
|
||||||
struct llist_head list;
|
|
||||||
uint32_t ep;
|
|
||||||
|
|
||||||
/* enum req_ctx_state */
|
|
||||||
volatile uint32_t state;
|
|
||||||
/* size of th 'data' buffer */
|
|
||||||
uint16_t size;
|
|
||||||
/* total number of used bytes in buffer */
|
|
||||||
uint16_t tot_len;
|
|
||||||
/* index into the buffer, user specific */
|
|
||||||
uint16_t idx;
|
|
||||||
/* actual data buffer */
|
|
||||||
uint8_t *data;
|
|
||||||
};
|
|
||||||
|
|
||||||
extern void req_ctx_init(void);
|
|
||||||
extern struct req_ctx __ramfunc *req_ctx_find_get(int large, uint32_t old_state, uint32_t new_state);
|
|
||||||
extern struct req_ctx *req_ctx_find_busy(void);
|
|
||||||
extern void req_ctx_set_state(struct req_ctx *ctx, uint32_t new_state);
|
|
||||||
extern void req_ctx_put(struct req_ctx *ctx);
|
|
||||||
extern uint8_t req_ctx_num(struct req_ctx *ctx);
|
|
||||||
unsigned int req_ctx_count(uint32_t state);
|
|
||||||
@@ -1,23 +0,0 @@
|
|||||||
#ifndef SIMTRACE_RINGBUF_H
|
|
||||||
#define SIMTRACE_RINGBUF_H
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
#include <stdbool.h>
|
|
||||||
#include <sys/types.h>
|
|
||||||
|
|
||||||
#define RING_BUFLEN 128
|
|
||||||
|
|
||||||
typedef struct ringbuf {
|
|
||||||
uint8_t buf[RING_BUFLEN];
|
|
||||||
size_t ird;
|
|
||||||
size_t iwr;
|
|
||||||
} ringbuf;
|
|
||||||
|
|
||||||
void rbuf_reset(volatile ringbuf * rb);
|
|
||||||
uint8_t rbuf_read(volatile ringbuf * rb);
|
|
||||||
uint8_t rbuf_peek(volatile ringbuf * rb);
|
|
||||||
void rbuf_write(volatile ringbuf * rb, uint8_t item);
|
|
||||||
bool rbuf_is_empty(volatile ringbuf * rb);
|
|
||||||
bool rbuf_is_full(volatile ringbuf * rb);
|
|
||||||
|
|
||||||
#endif /* end of include guard: SIMTRACE_RINGBUF_H */
|
|
||||||
@@ -1,32 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
#include <stddef.h>
|
|
||||||
#include <stdarg.h>
|
|
||||||
|
|
||||||
|
|
||||||
#ifndef EOF
|
|
||||||
#define EOF (-1)
|
|
||||||
#endif
|
|
||||||
|
|
||||||
struct File;
|
|
||||||
typedef struct File FILE;
|
|
||||||
|
|
||||||
extern FILE* const stdin;
|
|
||||||
extern FILE* const stdout;
|
|
||||||
extern FILE* const stderr;
|
|
||||||
|
|
||||||
signed int vsnprintf(char *pStr, size_t length, const char *pFormat, va_list ap);
|
|
||||||
signed int snprintf(char *pString, size_t length, const char *pFormat, ...);
|
|
||||||
signed int vsprintf(char *pString, const char *pFormat, va_list ap);
|
|
||||||
signed int vfprintf(FILE *pStream, const char *pFormat, va_list ap);
|
|
||||||
signed int vprintf(const char *pFormat, va_list ap);
|
|
||||||
signed int fprintf(FILE *pStream, const char *pFormat, ...);
|
|
||||||
signed int printf(const char *pFormat, ...);
|
|
||||||
signed int sprintf(char *pStr, const char *pFormat, ...);
|
|
||||||
signed int puts(const char *pStr);
|
|
||||||
|
|
||||||
|
|
||||||
int fputc(int c, FILE *stream);
|
|
||||||
int fputs(const char *s, FILE *stream);
|
|
||||||
|
|
||||||
#define putc(c, stream) fputc(c, stream)
|
|
||||||
#define putchar(c) fputc(c, stdout)
|
|
||||||
@@ -1,11 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
void tc_etu_set_wtime(uint8_t chan_nr, uint16_t wtime);
|
|
||||||
void tc_etu_set_etu(uint8_t chan_nr, uint16_t etu);
|
|
||||||
void tc_etu_init(uint8_t chan_nr, void *handle);
|
|
||||||
void tc_etu_enable(uint8_t chan_nr);
|
|
||||||
void tc_etu_disable(uint8_t chan_nr);
|
|
||||||
|
|
||||||
extern void tc_etu_wtime_half_expired(void *handle);
|
|
||||||
extern void tc_etu_wtime_expired(void *handle);
|
|
||||||
@@ -1,18 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
|
|
||||||
|
|
||||||
#ifdef __ARM
|
|
||||||
#define local_irq_save(x) \
|
|
||||||
({ \
|
|
||||||
x = __get_PRIMASK(); \
|
|
||||||
__disable_irq(); \
|
|
||||||
})
|
|
||||||
|
|
||||||
#define local_irq_restore(x) \
|
|
||||||
__set_PRIMASK(x)
|
|
||||||
#else
|
|
||||||
#warning "local_irq_{save,restore}() not implemented"
|
|
||||||
#define local_irq_save(x)
|
|
||||||
#define local_irq_restore(x)
|
|
||||||
#endif
|
|
||||||
@@ -1,999 +0,0 @@
|
|||||||
/* ISO7816-3 state machine for the card side */
|
|
||||||
/* (C) 2010-2015 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
//#define TRACE_LEVEL 6
|
|
||||||
|
|
||||||
#include <stdio.h>
|
|
||||||
#include <assert.h>
|
|
||||||
#include <errno.h>
|
|
||||||
#include <string.h>
|
|
||||||
#include <stdint.h>
|
|
||||||
#include <sys/types.h>
|
|
||||||
|
|
||||||
#include "utils.h"
|
|
||||||
#include "trace.h"
|
|
||||||
#include "iso7816_fidi.h"
|
|
||||||
#include "tc_etu.h"
|
|
||||||
#include "card_emu.h"
|
|
||||||
#include "req_ctx.h"
|
|
||||||
#include "cardemu_prot.h"
|
|
||||||
#include "osmocom/core/linuxlist.h"
|
|
||||||
|
|
||||||
|
|
||||||
#define NUM_SLOTS 2
|
|
||||||
|
|
||||||
#define ISO7816_3_INIT_WTIME 9600
|
|
||||||
#define ISO7816_3_DEFAULT_WI 10
|
|
||||||
#define ISO7816_3_ATR_LEN_MAX (1+32) /* TS plus 32 chars */
|
|
||||||
|
|
||||||
#define ISO7816_3_PB_NULL 0x60
|
|
||||||
|
|
||||||
enum iso7816_3_card_state {
|
|
||||||
ISO_S_WAIT_POWER, /* waiting for power being applied */
|
|
||||||
ISO_S_WAIT_CLK, /* waiting for clock being applied */
|
|
||||||
ISO_S_WAIT_RST, /* waiting for reset being released */
|
|
||||||
ISO_S_WAIT_ATR, /* waiting for start of ATR */
|
|
||||||
ISO_S_IN_ATR, /* transmitting ATR to reader */
|
|
||||||
ISO_S_IN_PTS, /* transmitting ATR to reader */
|
|
||||||
ISO_S_WAIT_TPDU, /* waiting for data from reader */
|
|
||||||
ISO_S_IN_TPDU, /* inside a TPDU */
|
|
||||||
};
|
|
||||||
|
|
||||||
/* detailed sub-states of ISO_S_IN_PTS */
|
|
||||||
enum pts_state {
|
|
||||||
PTS_S_WAIT_REQ_PTSS,
|
|
||||||
PTS_S_WAIT_REQ_PTS0,
|
|
||||||
PTS_S_WAIT_REQ_PTS1,
|
|
||||||
PTS_S_WAIT_REQ_PTS2,
|
|
||||||
PTS_S_WAIT_REQ_PTS3,
|
|
||||||
PTS_S_WAIT_REQ_PCK,
|
|
||||||
PTS_S_WAIT_RESP_PTSS = PTS_S_WAIT_REQ_PTSS | 0x10,
|
|
||||||
PTS_S_WAIT_RESP_PTS0 = PTS_S_WAIT_REQ_PTS0 | 0x10,
|
|
||||||
PTS_S_WAIT_RESP_PTS1 = PTS_S_WAIT_REQ_PTS1 | 0x10,
|
|
||||||
PTS_S_WAIT_RESP_PTS2 = PTS_S_WAIT_REQ_PTS2 | 0x10,
|
|
||||||
PTS_S_WAIT_RESP_PTS3 = PTS_S_WAIT_REQ_PTS3 | 0x10,
|
|
||||||
PTS_S_WAIT_RESP_PCK = PTS_S_WAIT_REQ_PCK | 0x10,
|
|
||||||
};
|
|
||||||
|
|
||||||
#define _PTSS 0
|
|
||||||
#define _PTS0 1
|
|
||||||
#define _PTS1 2
|
|
||||||
#define _PTS2 3
|
|
||||||
#define _PTS3 4
|
|
||||||
#define _PCK 5
|
|
||||||
|
|
||||||
/* T-PDU state machine states */
|
|
||||||
enum tpdu_state {
|
|
||||||
TPDU_S_WAIT_CLA, /* waiting for CLA byte from reader */
|
|
||||||
TPDU_S_WAIT_INS, /* waiting for INS byte from reader */
|
|
||||||
TPDU_S_WAIT_P1, /* waiting for P1 byte from reader */
|
|
||||||
TPDU_S_WAIT_P2, /* waiting for P2 byte from reader */
|
|
||||||
TPDU_S_WAIT_P3, /* waiting for P3 byte from reader */
|
|
||||||
TPDU_S_WAIT_PB, /* waiting for Tx of procedure byte */
|
|
||||||
TPDU_S_WAIT_RX, /* waiitng for more data from reader */
|
|
||||||
TPDU_S_WAIT_TX, /* waiting for more data to reader */
|
|
||||||
};
|
|
||||||
|
|
||||||
#define _CLA 0
|
|
||||||
#define _INS 1
|
|
||||||
#define _P1 2
|
|
||||||
#define _P2 3
|
|
||||||
#define _P3 4
|
|
||||||
|
|
||||||
struct card_handle {
|
|
||||||
uint32_t num;
|
|
||||||
|
|
||||||
enum iso7816_3_card_state state;
|
|
||||||
|
|
||||||
/* signal levels */
|
|
||||||
uint8_t vcc_active; /* 1 = on, 0 = off */
|
|
||||||
uint8_t in_reset; /* 1 = RST low, 0 = RST high */
|
|
||||||
uint8_t clocked; /* 1 = active, 0 = inactive */
|
|
||||||
|
|
||||||
/* timing parameters, from PTS */
|
|
||||||
uint8_t fi;
|
|
||||||
uint8_t di;
|
|
||||||
uint8_t wi;
|
|
||||||
|
|
||||||
uint8_t tc_chan; /* TC channel number */
|
|
||||||
uint8_t uart_chan; /* UART channel */
|
|
||||||
|
|
||||||
uint32_t waiting_time; /* in clocks */
|
|
||||||
|
|
||||||
/* ATR state machine */
|
|
||||||
struct {
|
|
||||||
uint8_t idx;
|
|
||||||
uint8_t len;
|
|
||||||
//uint8_t hist_len;
|
|
||||||
//uint8_t last_td;
|
|
||||||
uint8_t atr[ISO7816_3_ATR_LEN_MAX];
|
|
||||||
} atr;
|
|
||||||
|
|
||||||
/* PPS / PTS support */
|
|
||||||
struct {
|
|
||||||
enum pts_state state;
|
|
||||||
uint8_t req[6]; /* request bytes */
|
|
||||||
uint8_t resp[6]; /* response bytes */
|
|
||||||
} pts;
|
|
||||||
|
|
||||||
/* TPDU */
|
|
||||||
struct {
|
|
||||||
enum tpdu_state state;
|
|
||||||
uint8_t hdr[5]; /* CLA INS P1 P2 P3 */
|
|
||||||
} tpdu;
|
|
||||||
|
|
||||||
struct req_ctx *uart_rx_ctx; /* UART RX -> USB TX */
|
|
||||||
struct req_ctx *uart_tx_ctx; /* USB RX -> UART TX */
|
|
||||||
|
|
||||||
struct llist_head usb_tx_queue;
|
|
||||||
struct llist_head uart_tx_queue;
|
|
||||||
|
|
||||||
struct {
|
|
||||||
uint32_t tx_bytes;
|
|
||||||
uint32_t rx_bytes;
|
|
||||||
uint32_t pps;
|
|
||||||
} stats;
|
|
||||||
};
|
|
||||||
|
|
||||||
struct llist_head *card_emu_get_usb_tx_queue(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
return &ch->usb_tx_queue;
|
|
||||||
}
|
|
||||||
|
|
||||||
struct llist_head *card_emu_get_uart_tx_queue(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
return &ch->uart_tx_queue;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void set_tpdu_state(struct card_handle *ch, enum tpdu_state new_ts);
|
|
||||||
static void set_pts_state(struct card_handle *ch, enum pts_state new_ptss);
|
|
||||||
|
|
||||||
static void flush_rx_buffer(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
struct cardemu_usb_msg_rx_data *rd;
|
|
||||||
|
|
||||||
rctx = ch->uart_rx_ctx;
|
|
||||||
if (!rctx)
|
|
||||||
return;
|
|
||||||
|
|
||||||
ch->uart_rx_ctx = NULL;
|
|
||||||
|
|
||||||
/* store length of data payload fild in header */
|
|
||||||
rd = (struct cardemu_usb_msg_rx_data *) rctx->data;
|
|
||||||
rd->data_len = rctx->idx;
|
|
||||||
rd->hdr.msg_len = sizeof(*rd) + rd->data_len;
|
|
||||||
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_USB_TX_PENDING);
|
|
||||||
/* no need for irqsafe operation, as the usb_tx_queue is
|
|
||||||
* processed only by the main loop context */
|
|
||||||
llist_add_tail(&rctx->list, &ch->usb_tx_queue);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* convert a non-contiguous PTS request/responsei into a contiguous
|
|
||||||
* buffer, returning the number of bytes used in the buffer */
|
|
||||||
static int serialize_pts(uint8_t *out, const uint8_t *in)
|
|
||||||
{
|
|
||||||
int i = 0;
|
|
||||||
|
|
||||||
out[i++] = in[_PTSS];
|
|
||||||
out[i++] = in[_PTS0];
|
|
||||||
if (in[_PTS0] & (1 << 4))
|
|
||||||
out[i++] = in[_PTS1];
|
|
||||||
if (in[_PTS0] & (1 << 5))
|
|
||||||
out[i++] = in[_PTS2];
|
|
||||||
if (in[_PTS0] & (1 << 6))
|
|
||||||
out[i++] = in[_PTS3];
|
|
||||||
out[i++] = in[_PCK];
|
|
||||||
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint8_t csum_pts(const uint8_t *in)
|
|
||||||
{
|
|
||||||
uint8_t out[6];
|
|
||||||
int len = serialize_pts(out, in);
|
|
||||||
uint8_t csum = 0;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
/* we don't include the PCK byte in the checksumming process */
|
|
||||||
len -= 1;
|
|
||||||
|
|
||||||
for (i = 0; i < len; i++)
|
|
||||||
csum = csum ^ out[i];
|
|
||||||
|
|
||||||
return csum;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void flush_pts(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
struct cardemu_usb_msg_pts_info *ptsi;
|
|
||||||
|
|
||||||
rctx = req_ctx_find_get(0, RCTX_S_FREE, RCTX_S_UART_RX_BUSY);
|
|
||||||
if (!rctx)
|
|
||||||
return;
|
|
||||||
|
|
||||||
ptsi = (struct cardemu_usb_msg_pts_info *) rctx->data;
|
|
||||||
ptsi->hdr.msg_type = CEMU_USB_MSGT_DO_PTS;
|
|
||||||
ptsi->hdr.msg_len = sizeof(*ptsi);
|
|
||||||
ptsi->pts_len = serialize_pts(ptsi->req, ch->pts.req);
|
|
||||||
serialize_pts(ptsi->resp, ch->pts.resp);
|
|
||||||
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_USB_TX_PENDING);
|
|
||||||
/* no need for irqsafe operation, as the usb_tx_queue is
|
|
||||||
* processed only by the main loop context */
|
|
||||||
llist_add_tail(&rctx->list, &ch->usb_tx_queue);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void emu_update_fidi(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
rc = compute_fidi_ratio(ch->fi, ch->di);
|
|
||||||
if (rc > 0 && rc < 0x400) {
|
|
||||||
TRACE_INFO("%u: computed Fi(%u) Di(%u) ratio: %d\r\n",
|
|
||||||
ch->num, ch->fi, ch->di, rc);
|
|
||||||
/* make sure UART uses new F/D ratio */
|
|
||||||
card_emu_uart_update_fidi(ch->uart_chan, rc);
|
|
||||||
/* notify ETU timer about this */
|
|
||||||
tc_etu_set_etu(ch->tc_chan, rc);
|
|
||||||
} else
|
|
||||||
TRACE_INFO("%u: computed FiDi ration %d unsupported\r\n",
|
|
||||||
ch->num, rc);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Update the ISO 7816-3 TPDU receiver state */
|
|
||||||
static void card_set_state(struct card_handle *ch,
|
|
||||||
enum iso7816_3_card_state new_state)
|
|
||||||
{
|
|
||||||
if (ch->state == new_state)
|
|
||||||
return;
|
|
||||||
|
|
||||||
TRACE_DEBUG("%u: 7816 card state %u -> %u\r\n", ch->num,
|
|
||||||
ch->state, new_state);
|
|
||||||
ch->state = new_state;
|
|
||||||
|
|
||||||
switch (new_state) {
|
|
||||||
case ISO_S_WAIT_POWER:
|
|
||||||
case ISO_S_WAIT_CLK:
|
|
||||||
case ISO_S_WAIT_RST:
|
|
||||||
/* disable Rx and Tx of UART */
|
|
||||||
card_emu_uart_enable(ch->uart_chan, 0);
|
|
||||||
break;
|
|
||||||
case ISO_S_WAIT_ATR:
|
|
||||||
set_pts_state(ch, PTS_S_WAIT_REQ_PTSS);
|
|
||||||
/* Reset to initial Fi / Di ratio */
|
|
||||||
ch->fi = 1;
|
|
||||||
ch->di = 1;
|
|
||||||
emu_update_fidi(ch);
|
|
||||||
/* initialize todefault WI, this will be overwritten if we
|
|
||||||
* receive TC2, and it will be programmed into hardware after
|
|
||||||
* ATR is finished */
|
|
||||||
ch->wi = ISO7816_3_DEFAULT_WI;
|
|
||||||
/* update waiting time to initial waiting time */
|
|
||||||
ch->waiting_time = ISO7816_3_INIT_WTIME;
|
|
||||||
tc_etu_set_wtime(ch->tc_chan, ch->waiting_time);
|
|
||||||
/* Set ATR sub-state to initial state */
|
|
||||||
ch->atr.idx = 0;
|
|
||||||
//set_atr_state(ch, ATR_S_WAIT_TS);
|
|
||||||
/* Notice that we are just coming out of reset */
|
|
||||||
//ch->sh.flags |= SIMTRACE_FLAG_ATR;
|
|
||||||
card_emu_uart_enable(ch->uart_chan, ENABLE_TX);
|
|
||||||
break;
|
|
||||||
break;
|
|
||||||
case ISO_S_WAIT_TPDU:
|
|
||||||
/* enable the receiver, disable transmitter */
|
|
||||||
set_tpdu_state(ch, TPDU_S_WAIT_CLA);
|
|
||||||
card_emu_uart_enable(ch->uart_chan, ENABLE_RX);
|
|
||||||
break;
|
|
||||||
case ISO_S_IN_ATR:
|
|
||||||
case ISO_S_IN_PTS:
|
|
||||||
case ISO_S_IN_TPDU:
|
|
||||||
/* do nothing */
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/**********************************************************************
|
|
||||||
* PTS / PPS handling
|
|
||||||
**********************************************************************/
|
|
||||||
|
|
||||||
/* Update the ATR sub-state */
|
|
||||||
static void set_pts_state(struct card_handle *ch, enum pts_state new_ptss)
|
|
||||||
{
|
|
||||||
TRACE_DEBUG("%u: 7816 PTS state %u -> %u\r\n",
|
|
||||||
ch->num, ch->pts.state, new_ptss);
|
|
||||||
ch->pts.state = new_ptss;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Determine the next PTS state */
|
|
||||||
static enum pts_state next_pts_state(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
uint8_t is_resp = ch->pts.state & 0x10;
|
|
||||||
uint8_t sstate = ch->pts.state & 0x0f;
|
|
||||||
uint8_t *pts_ptr;
|
|
||||||
|
|
||||||
if (!is_resp)
|
|
||||||
pts_ptr = ch->pts.req;
|
|
||||||
else
|
|
||||||
pts_ptr = ch->pts.resp;
|
|
||||||
|
|
||||||
switch (sstate) {
|
|
||||||
case PTS_S_WAIT_REQ_PTSS:
|
|
||||||
goto from_ptss;
|
|
||||||
case PTS_S_WAIT_REQ_PTS0:
|
|
||||||
goto from_pts0;
|
|
||||||
case PTS_S_WAIT_REQ_PTS1:
|
|
||||||
goto from_pts1;
|
|
||||||
case PTS_S_WAIT_REQ_PTS2:
|
|
||||||
goto from_pts2;
|
|
||||||
case PTS_S_WAIT_REQ_PTS3:
|
|
||||||
goto from_pts3;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ch->pts.state == PTS_S_WAIT_REQ_PCK)
|
|
||||||
return PTS_S_WAIT_RESP_PTSS;
|
|
||||||
|
|
||||||
from_ptss:
|
|
||||||
return PTS_S_WAIT_REQ_PTS0 | is_resp;
|
|
||||||
from_pts0:
|
|
||||||
if (pts_ptr[_PTS0] & (1 << 4))
|
|
||||||
return PTS_S_WAIT_REQ_PTS1 | is_resp;
|
|
||||||
from_pts1:
|
|
||||||
if (pts_ptr[_PTS0] & (1 << 5))
|
|
||||||
return PTS_S_WAIT_REQ_PTS2 | is_resp;
|
|
||||||
from_pts2:
|
|
||||||
if (pts_ptr[_PTS0] & (1 << 6))
|
|
||||||
return PTS_S_WAIT_REQ_PTS3 | is_resp;
|
|
||||||
from_pts3:
|
|
||||||
return PTS_S_WAIT_REQ_PCK | is_resp;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static int
|
|
||||||
process_byte_pts(struct card_handle *ch, uint8_t byte)
|
|
||||||
{
|
|
||||||
switch (ch->pts.state) {
|
|
||||||
case PTS_S_WAIT_REQ_PTSS:
|
|
||||||
ch->pts.req[_PTSS] = byte;
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_REQ_PTS0:
|
|
||||||
ch->pts.req[_PTS0] = byte;
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_REQ_PTS1:
|
|
||||||
ch->pts.req[_PTS1] = byte;
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_REQ_PTS2:
|
|
||||||
ch->pts.req[_PTS2] = byte;
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_REQ_PTS3:
|
|
||||||
ch->pts.req[_PTS3] = byte;
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_REQ_PCK:
|
|
||||||
ch->pts.req[_PCK] = byte;
|
|
||||||
if (ch->pts.req[_PCK] != csum_pts(ch->pts.req)) {
|
|
||||||
TRACE_ERROR("%u: Error in PTS Checksum!\r\n",
|
|
||||||
ch->num);
|
|
||||||
/* Wait for the next TPDU */
|
|
||||||
set_pts_state(ch, PTS_S_WAIT_REQ_PTSS);
|
|
||||||
return ISO_S_WAIT_TPDU;
|
|
||||||
}
|
|
||||||
/* FIXME: check if proposal matches capabilities in ATR */
|
|
||||||
memcpy(ch->pts.resp, ch->pts.req, sizeof(ch->pts.resp));
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
TRACE_ERROR("%u: process_byte_pts() in invalid state %u\r\n",
|
|
||||||
ch->num, ch->pts.state);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
/* calculate the next state and set it */
|
|
||||||
set_pts_state(ch, next_pts_state(ch));
|
|
||||||
|
|
||||||
if (ch->pts.state == PTS_S_WAIT_RESP_PTSS) {
|
|
||||||
flush_pts(ch);
|
|
||||||
/* activate UART TX to transmit PTS response */
|
|
||||||
card_emu_uart_enable(ch->uart_chan, ENABLE_TX);
|
|
||||||
/* don't fall-through to the 'return ISO_S_IN_PTS'
|
|
||||||
* below, rather keep ISO7816 state as-is, it will be
|
|
||||||
* further updated by the tx-completion handler */
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
return ISO_S_IN_PTS;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* return a single byte to be transmitted to the reader */
|
|
||||||
static int tx_byte_pts(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
uint8_t byte;
|
|
||||||
|
|
||||||
/* 1: Determine the next transmit byte */
|
|
||||||
switch (ch->pts.state) {
|
|
||||||
case PTS_S_WAIT_RESP_PTSS:
|
|
||||||
byte = ch->pts.resp[_PTSS];
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_RESP_PTS0:
|
|
||||||
byte = ch->pts.resp[_PTS0];
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_RESP_PTS1:
|
|
||||||
byte = ch->pts.resp[_PTS1];
|
|
||||||
/* This must be TA1 */
|
|
||||||
ch->fi = byte >> 4;
|
|
||||||
ch->di = byte & 0xf;
|
|
||||||
TRACE_DEBUG("%u: found Fi=%u Di=%u\r\n", ch->num,
|
|
||||||
ch->fi, ch->di);
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_RESP_PTS2:
|
|
||||||
byte = ch->pts.resp[_PTS2];
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_RESP_PTS3:
|
|
||||||
byte = ch->pts.resp[_PTS3];
|
|
||||||
break;
|
|
||||||
case PTS_S_WAIT_RESP_PCK:
|
|
||||||
byte = ch->pts.resp[_PCK];
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
TRACE_ERROR("%u: get_byte_pts() in invalid state %u\r\n",
|
|
||||||
ch->num, ch->pts.state);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* 2: Transmit the byte */
|
|
||||||
card_emu_uart_tx(ch->uart_chan, byte);
|
|
||||||
|
|
||||||
/* 3: Update the state */
|
|
||||||
|
|
||||||
switch (ch->pts.state) {
|
|
||||||
case PTS_S_WAIT_RESP_PCK:
|
|
||||||
card_emu_uart_wait_tx_idle(ch->uart_chan);
|
|
||||||
/* update baud rate generator with Fi/Di */
|
|
||||||
emu_update_fidi(ch);
|
|
||||||
/* Wait for the next TPDU */
|
|
||||||
card_set_state(ch, ISO_S_WAIT_TPDU);
|
|
||||||
set_pts_state(ch, PTS_S_WAIT_REQ_PTSS);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
/* calculate the next state and set it */
|
|
||||||
set_pts_state(ch, next_pts_state(ch));
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* return number of bytes transmitted */
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/**********************************************************************
|
|
||||||
* TPDU handling
|
|
||||||
**********************************************************************/
|
|
||||||
|
|
||||||
|
|
||||||
/* compute number of data bytes according to Chapter 10.3.2 of 7816-3 */
|
|
||||||
static unsigned int t0_num_data_bytes(uint8_t p3, int reader_to_card)
|
|
||||||
{
|
|
||||||
if (reader_to_card) {
|
|
||||||
return p3;
|
|
||||||
} else {
|
|
||||||
if (p3 == 0)
|
|
||||||
return 256;
|
|
||||||
else
|
|
||||||
return p3;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* add a just-received TPDU byte (from reader) to USB buffer */
|
|
||||||
static void add_tpdu_byte(struct card_handle *ch, uint8_t byte)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
struct cardemu_usb_msg_rx_data *rd;
|
|
||||||
unsigned int num_data_bytes = t0_num_data_bytes(ch->tpdu.hdr[_P3], 0);
|
|
||||||
|
|
||||||
/* ensure we have a buffer */
|
|
||||||
if (!ch->uart_rx_ctx) {
|
|
||||||
rctx = ch->uart_rx_ctx = req_ctx_find_get(0, RCTX_S_FREE, RCTX_S_UART_RX_BUSY);
|
|
||||||
if (!ch->uart_rx_ctx) {
|
|
||||||
TRACE_ERROR("%u: Received UART byte but ENOMEM\r\n",
|
|
||||||
ch->num);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
rd = (struct cardemu_usb_msg_rx_data *) ch->uart_rx_ctx->data;
|
|
||||||
cardemu_hdr_set(&rd->hdr, CEMU_USB_MSGT_DO_RX_DATA);
|
|
||||||
rctx->tot_len = sizeof(*rd);
|
|
||||||
rctx->idx = 0;
|
|
||||||
} else
|
|
||||||
rctx = ch->uart_rx_ctx;
|
|
||||||
|
|
||||||
rd = (struct cardemu_usb_msg_rx_data *) rctx->data;
|
|
||||||
|
|
||||||
rd->data[rctx->idx++] = byte;
|
|
||||||
rctx->tot_len++;
|
|
||||||
|
|
||||||
/* check if the buffer is full. If so, send it */
|
|
||||||
if (rctx->tot_len >= sizeof(*rd) + num_data_bytes) {
|
|
||||||
rd->flags |= CEMU_DATA_F_FINAL;
|
|
||||||
flush_rx_buffer(ch);
|
|
||||||
/* We need to transmit the SW now, */
|
|
||||||
set_tpdu_state(ch, TPDU_S_WAIT_TX);
|
|
||||||
} else if (rctx->tot_len >= rctx->size)
|
|
||||||
flush_rx_buffer(ch);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void set_tpdu_state(struct card_handle *ch, enum tpdu_state new_ts)
|
|
||||||
{
|
|
||||||
if (ch->tpdu.state == new_ts)
|
|
||||||
return;
|
|
||||||
|
|
||||||
TRACE_DEBUG("%u: 7816 TPDU state %u -> %u\r\n", ch->num,
|
|
||||||
ch->tpdu.state, new_ts);
|
|
||||||
|
|
||||||
ch->tpdu.state = new_ts;
|
|
||||||
|
|
||||||
switch (new_ts) {
|
|
||||||
case TPDU_S_WAIT_CLA:
|
|
||||||
case TPDU_S_WAIT_RX:
|
|
||||||
card_emu_uart_enable(ch->uart_chan, ENABLE_RX);
|
|
||||||
break;
|
|
||||||
case TPDU_S_WAIT_PB:
|
|
||||||
/* we just completed the TPDU header from reader to card
|
|
||||||
* and now need to disable the receiver, enable the
|
|
||||||
* transmitter and transmit the procedure byte */
|
|
||||||
card_emu_uart_enable(ch->uart_chan, ENABLE_TX);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static enum tpdu_state next_tpdu_state(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
switch (ch->tpdu.state) {
|
|
||||||
case TPDU_S_WAIT_CLA:
|
|
||||||
return TPDU_S_WAIT_INS;
|
|
||||||
case TPDU_S_WAIT_INS:
|
|
||||||
return TPDU_S_WAIT_P1;
|
|
||||||
case TPDU_S_WAIT_P1:
|
|
||||||
return TPDU_S_WAIT_P2;
|
|
||||||
case TPDU_S_WAIT_P2:
|
|
||||||
return TPDU_S_WAIT_P3;
|
|
||||||
case TPDU_S_WAIT_P3:
|
|
||||||
return TPDU_S_WAIT_PB;
|
|
||||||
/* simply stay in Rx or Tx by default */
|
|
||||||
case TPDU_S_WAIT_PB:
|
|
||||||
return TPDU_S_WAIT_PB;
|
|
||||||
case TPDU_S_WAIT_RX:
|
|
||||||
return TPDU_S_WAIT_RX;
|
|
||||||
case TPDU_S_WAIT_TX:
|
|
||||||
return TPDU_S_WAIT_TX;
|
|
||||||
}
|
|
||||||
/* we should never reach here */
|
|
||||||
assert(0);
|
|
||||||
return -1;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void send_tpdu_header(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
struct cardemu_usb_msg_rx_data *rd;
|
|
||||||
|
|
||||||
TRACE_INFO("%u: %s: %02x %02x %02x %02x %02x\r\n",
|
|
||||||
ch->num, __func__,
|
|
||||||
ch->tpdu.hdr[0], ch->tpdu.hdr[1],
|
|
||||||
ch->tpdu.hdr[2], ch->tpdu.hdr[3],
|
|
||||||
ch->tpdu.hdr[4]);
|
|
||||||
|
|
||||||
/* if we already/still have a context, send it off */
|
|
||||||
if (ch->uart_rx_ctx) {
|
|
||||||
TRACE_DEBUG("%u: have old buffer\r\n", ch->num);
|
|
||||||
if (ch->uart_rx_ctx->idx) {
|
|
||||||
TRACE_DEBUG("%u: flushing old buffer\r\n", ch->num);
|
|
||||||
flush_rx_buffer(ch);
|
|
||||||
}
|
|
||||||
} else {
|
|
||||||
TRACE_DEBUG("%u: allocating new buffer\r\n", ch->num);
|
|
||||||
/* ensure we have a new buffer */
|
|
||||||
ch->uart_rx_ctx = req_ctx_find_get(0, RCTX_S_FREE, RCTX_S_UART_RX_BUSY);
|
|
||||||
if (!ch->uart_rx_ctx) {
|
|
||||||
TRACE_ERROR("%u: %s: ENOMEM\r\n", ch->num, __func__);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
rctx = ch->uart_rx_ctx;
|
|
||||||
rd = (struct cardemu_usb_msg_rx_data *) rctx->data;
|
|
||||||
|
|
||||||
/* initializ header */
|
|
||||||
cardemu_hdr_set(&rd->hdr, CEMU_USB_MSGT_DO_RX_DATA);
|
|
||||||
rd->flags = CEMU_DATA_F_TPDU_HDR;
|
|
||||||
rctx->tot_len = sizeof(*rd) + sizeof(ch->tpdu.hdr);
|
|
||||||
rctx->idx = sizeof(ch->tpdu.hdr);
|
|
||||||
|
|
||||||
/* copy TPDU header to data field */
|
|
||||||
memcpy(rd->data, ch->tpdu.hdr, sizeof(ch->tpdu.hdr));
|
|
||||||
/* rd->data_len is set in flush_rx_buffer() */
|
|
||||||
|
|
||||||
flush_rx_buffer(ch);
|
|
||||||
}
|
|
||||||
|
|
||||||
static enum iso7816_3_card_state
|
|
||||||
process_byte_tpdu(struct card_handle *ch, uint8_t byte)
|
|
||||||
{
|
|
||||||
switch (ch->tpdu.state) {
|
|
||||||
case TPDU_S_WAIT_CLA:
|
|
||||||
ch->tpdu.hdr[_CLA] = byte;
|
|
||||||
set_tpdu_state(ch, next_tpdu_state(ch));
|
|
||||||
break;
|
|
||||||
case TPDU_S_WAIT_INS:
|
|
||||||
ch->tpdu.hdr[_INS] = byte;
|
|
||||||
set_tpdu_state(ch, next_tpdu_state(ch));
|
|
||||||
break;
|
|
||||||
case TPDU_S_WAIT_P1:
|
|
||||||
ch->tpdu.hdr[_P1] = byte;
|
|
||||||
set_tpdu_state(ch, next_tpdu_state(ch));
|
|
||||||
break;
|
|
||||||
case TPDU_S_WAIT_P2:
|
|
||||||
ch->tpdu.hdr[_P2] = byte;
|
|
||||||
set_tpdu_state(ch, next_tpdu_state(ch));
|
|
||||||
break;
|
|
||||||
case TPDU_S_WAIT_P3:
|
|
||||||
ch->tpdu.hdr[_P3] = byte;
|
|
||||||
set_tpdu_state(ch, next_tpdu_state(ch));
|
|
||||||
/* FIXME: start timer to transmit further 0x60 */
|
|
||||||
/* send the TPDU header as part of a procedure byte
|
|
||||||
* request to the USB host */
|
|
||||||
send_tpdu_header(ch);
|
|
||||||
break;
|
|
||||||
case TPDU_S_WAIT_RX:
|
|
||||||
add_tpdu_byte(ch, byte);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
TRACE_ERROR("%u: process_byte_tpdu() in invalid state %u\r\n",
|
|
||||||
ch->num, ch->tpdu.state);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* ensure we stay in TPDU ISO state */
|
|
||||||
return ISO_S_IN_TPDU;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* tx a single byte to be transmitted to the reader */
|
|
||||||
static int tx_byte_tpdu(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
struct cardemu_usb_msg_tx_data *td;
|
|
||||||
uint8_t byte;
|
|
||||||
|
|
||||||
/* ensure we are aware of any data that might be pending for
|
|
||||||
* transmit */
|
|
||||||
if (!ch->uart_tx_ctx) {
|
|
||||||
/* uart_tx_queue is filled from main loop, so no need
|
|
||||||
* for irq-safe operations */
|
|
||||||
if (llist_empty(&ch->uart_tx_queue))
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
/* dequeue first at head */
|
|
||||||
ch->uart_tx_ctx = llist_entry(ch->uart_tx_queue.next,
|
|
||||||
struct req_ctx, list);
|
|
||||||
llist_del(&ch->uart_tx_ctx->list);
|
|
||||||
req_ctx_set_state(ch->uart_tx_ctx, RCTX_S_UART_TX_BUSY);
|
|
||||||
|
|
||||||
/* start with index zero */
|
|
||||||
ch->uart_tx_ctx->idx = 0;
|
|
||||||
|
|
||||||
}
|
|
||||||
rctx = ch->uart_tx_ctx;
|
|
||||||
td = (struct cardemu_usb_msg_tx_data *) rctx->data;
|
|
||||||
|
|
||||||
/* take the next pending byte out of the rctx */
|
|
||||||
byte = td->data[rctx->idx++];
|
|
||||||
|
|
||||||
card_emu_uart_tx(ch->uart_chan, byte);
|
|
||||||
|
|
||||||
/* this must happen _after_ the byte has been transmittd */
|
|
||||||
switch (ch->tpdu.state) {
|
|
||||||
case TPDU_S_WAIT_PB:
|
|
||||||
/* if we just transmitted the procedure byte, we need to decide
|
|
||||||
* if we want to continue to receive or transmit */
|
|
||||||
if (td->flags & CEMU_DATA_F_PB_AND_TX)
|
|
||||||
set_tpdu_state(ch, TPDU_S_WAIT_TX);
|
|
||||||
else if (td->flags & CEMU_DATA_F_PB_AND_RX)
|
|
||||||
set_tpdu_state(ch, TPDU_S_WAIT_RX);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* check if the buffer has now been fully transmitted */
|
|
||||||
if ((rctx->idx >= td->data_len) ||
|
|
||||||
(td->data + rctx->idx >= rctx->data + rctx->tot_len)) {
|
|
||||||
if (td->flags & CEMU_DATA_F_PB_AND_RX) {
|
|
||||||
/* we have just sent the procedure byte and now
|
|
||||||
* need to continue receiving */
|
|
||||||
set_tpdu_state(ch, TPDU_S_WAIT_RX);
|
|
||||||
} else {
|
|
||||||
/* we have transmitted all bytes */
|
|
||||||
if (td->flags & CEMU_DATA_F_FINAL) {
|
|
||||||
/* this was the final part of the APDU, go
|
|
||||||
* back to state one */
|
|
||||||
card_set_state(ch, ISO_S_WAIT_TPDU);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_FREE);
|
|
||||||
ch->uart_tx_ctx = NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**********************************************************************
|
|
||||||
* Public API
|
|
||||||
**********************************************************************/
|
|
||||||
|
|
||||||
/* process a single byte received from the reader */
|
|
||||||
void card_emu_process_rx_byte(struct card_handle *ch, uint8_t byte)
|
|
||||||
{
|
|
||||||
int new_state = -1;
|
|
||||||
|
|
||||||
ch->stats.rx_bytes++;
|
|
||||||
|
|
||||||
switch (ch->state) {
|
|
||||||
case ISO_S_WAIT_POWER:
|
|
||||||
case ISO_S_WAIT_CLK:
|
|
||||||
case ISO_S_WAIT_RST:
|
|
||||||
case ISO_S_WAIT_ATR:
|
|
||||||
TRACE_ERROR("%u: Received UART char in invalid 7816 state "
|
|
||||||
"%u\r\n", ch->num, ch->state);
|
|
||||||
/* we shouldn't receive any data from the reader yet! */
|
|
||||||
break;
|
|
||||||
case ISO_S_WAIT_TPDU:
|
|
||||||
if (byte == 0xff) {
|
|
||||||
new_state = process_byte_pts(ch, byte);
|
|
||||||
ch->stats.pps++;
|
|
||||||
goto out_silent;
|
|
||||||
}
|
|
||||||
/* fall-through */
|
|
||||||
case ISO_S_IN_TPDU:
|
|
||||||
new_state = process_byte_tpdu(ch, byte);
|
|
||||||
break;
|
|
||||||
case ISO_S_IN_PTS:
|
|
||||||
new_state = process_byte_pts(ch, byte);
|
|
||||||
goto out_silent;
|
|
||||||
}
|
|
||||||
|
|
||||||
out_silent:
|
|
||||||
if (new_state != -1)
|
|
||||||
card_set_state(ch, new_state);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* transmit a single byte to the reader */
|
|
||||||
int card_emu_tx_byte(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
int rc = 0;
|
|
||||||
|
|
||||||
switch (ch->state) {
|
|
||||||
case ISO_S_IN_ATR:
|
|
||||||
if (ch->atr.idx < ch->atr.len) {
|
|
||||||
uint8_t byte;
|
|
||||||
byte = ch->atr.atr[ch->atr.idx++];
|
|
||||||
rc = 1;
|
|
||||||
|
|
||||||
card_emu_uart_tx(ch->uart_chan, byte);
|
|
||||||
|
|
||||||
/* detect end of ATR */
|
|
||||||
if (ch->atr.idx >= ch->atr.len)
|
|
||||||
card_set_state(ch, ISO_S_WAIT_TPDU);
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case ISO_S_IN_PTS:
|
|
||||||
rc = tx_byte_pts(ch);
|
|
||||||
break;
|
|
||||||
case ISO_S_IN_TPDU:
|
|
||||||
rc = tx_byte_tpdu(ch);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (rc)
|
|
||||||
ch->stats.tx_bytes++;
|
|
||||||
|
|
||||||
/* if we return 0 here, the UART needs to disable transmit-ready
|
|
||||||
* interrupts */
|
|
||||||
return rc;
|
|
||||||
}
|
|
||||||
|
|
||||||
void card_emu_have_new_uart_tx(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
switch (ch->state) {
|
|
||||||
case ISO_S_IN_TPDU:
|
|
||||||
switch (ch->tpdu.state) {
|
|
||||||
case TPDU_S_WAIT_TX:
|
|
||||||
case TPDU_S_WAIT_PB:
|
|
||||||
card_emu_uart_enable(ch->uart_chan, ENABLE_TX);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void card_emu_report_status(struct card_handle *ch)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
struct cardemu_usb_msg_status *sts;
|
|
||||||
|
|
||||||
rctx = req_ctx_find_get(0, RCTX_S_FREE, RCTX_S_UART_RX_BUSY);
|
|
||||||
if (!rctx)
|
|
||||||
return;
|
|
||||||
|
|
||||||
rctx->tot_len = sizeof(*sts);
|
|
||||||
sts = (struct cardemu_usb_msg_status *)rctx->data;
|
|
||||||
sts->hdr.msg_type = CEMU_USB_MSGT_DO_STATUS;
|
|
||||||
sts->hdr.msg_len = sizeof(*sts);
|
|
||||||
sts->flags = 0;
|
|
||||||
if (ch->vcc_active)
|
|
||||||
sts->flags |= CEMU_STATUS_F_VCC_PRESENT;
|
|
||||||
if (ch->clocked)
|
|
||||||
sts->flags |= CEMU_STATUS_F_CLK_ACTIVE;
|
|
||||||
if (ch->in_reset)
|
|
||||||
sts->flags |= CEMU_STATUS_F_RESET_ACTIVE;
|
|
||||||
/* FIXME: voltage + card insert */
|
|
||||||
sts->fi = ch->fi;
|
|
||||||
sts->di = ch->di;
|
|
||||||
sts->wi = ch->wi;
|
|
||||||
sts->waiting_time = ch->waiting_time;
|
|
||||||
|
|
||||||
llist_add_tail(&rctx->list, &ch->usb_tx_queue);
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_USB_TX_PENDING);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* hardware driver informs us that a card I/O signal has changed */
|
|
||||||
void card_emu_io_statechg(struct card_handle *ch, enum card_io io, int active)
|
|
||||||
{
|
|
||||||
switch (io) {
|
|
||||||
case CARD_IO_VCC:
|
|
||||||
if (active == 0 && ch->vcc_active == 1) {
|
|
||||||
TRACE_INFO("%u: VCC deactivated\r\n", ch->num);
|
|
||||||
tc_etu_disable(ch->tc_chan);
|
|
||||||
card_set_state(ch, ISO_S_WAIT_POWER);
|
|
||||||
} else if (active == 1 && ch->vcc_active == 0) {
|
|
||||||
TRACE_INFO("%u: VCC activated\r\n", ch->num);
|
|
||||||
card_set_state(ch, ISO_S_WAIT_CLK);
|
|
||||||
}
|
|
||||||
ch->vcc_active = active;
|
|
||||||
break;
|
|
||||||
case CARD_IO_CLK:
|
|
||||||
if (active == 1 && ch->clocked == 0) {
|
|
||||||
TRACE_INFO("%u: CLK activated\r\n", ch->num);
|
|
||||||
if (ch->state == ISO_S_WAIT_CLK)
|
|
||||||
card_set_state(ch, ISO_S_WAIT_RST);
|
|
||||||
} else if (active == 0 && ch->clocked == 1) {
|
|
||||||
TRACE_INFO("%u: CLK deactivated\r\n", ch->num);
|
|
||||||
}
|
|
||||||
ch->clocked = active;
|
|
||||||
break;
|
|
||||||
case CARD_IO_RST:
|
|
||||||
if (active == 0 && ch->in_reset) {
|
|
||||||
TRACE_INFO("%u: RST released\r\n", ch->num);
|
|
||||||
if (ch->vcc_active && ch->clocked) {
|
|
||||||
/* enable the TC/ETU counter once reset has been released */
|
|
||||||
tc_etu_enable(ch->tc_chan);
|
|
||||||
card_set_state(ch, ISO_S_WAIT_ATR);
|
|
||||||
/* FIXME: wait 400 to 40k clock cycles before sending ATR */
|
|
||||||
card_set_state(ch, ISO_S_IN_ATR);
|
|
||||||
}
|
|
||||||
} else if (active && !ch->in_reset) {
|
|
||||||
TRACE_INFO("%u: RST asserted\r\n", ch->num);
|
|
||||||
tc_etu_disable(ch->tc_chan);
|
|
||||||
}
|
|
||||||
ch->in_reset = active;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* User sets a new ATR to be returned during next card reset */
|
|
||||||
int card_emu_set_atr(struct card_handle *ch, const uint8_t *atr, uint8_t len)
|
|
||||||
{
|
|
||||||
if (len > sizeof(ch->atr.atr))
|
|
||||||
return -1;
|
|
||||||
|
|
||||||
memcpy(ch->atr.atr, atr, len);
|
|
||||||
ch->atr.len = len;
|
|
||||||
ch->atr.idx = 0;
|
|
||||||
|
|
||||||
/* FIXME: race condition with trasmitting ATR to reader? */
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* hardware driver informs us that one (more) ETU has expired */
|
|
||||||
void tc_etu_wtime_half_expired(void *handle)
|
|
||||||
{
|
|
||||||
struct card_handle *ch = handle;
|
|
||||||
/* transmit NULL procedure byte well before waiting time expires */
|
|
||||||
switch (ch->state) {
|
|
||||||
case ISO_S_IN_TPDU:
|
|
||||||
switch (ch->tpdu.state) {
|
|
||||||
case TPDU_S_WAIT_PB:
|
|
||||||
case TPDU_S_WAIT_TX:
|
|
||||||
putchar('N');
|
|
||||||
card_emu_uart_tx(ch->uart_chan, ISO7816_3_PB_NULL);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* hardware driver informs us that one (more) ETU has expired */
|
|
||||||
void tc_etu_wtime_expired(void *handle)
|
|
||||||
{
|
|
||||||
struct card_handle *ch = handle;
|
|
||||||
TRACE_ERROR("%u: wtime_exp\r\n", ch->num);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* shortest ATR found in smartcard_list.txt */
|
|
||||||
static const uint8_t default_atr[] = { 0x3B, 0x02, 0x14, 0x50 };
|
|
||||||
|
|
||||||
static struct card_handle card_handles[NUM_SLOTS];
|
|
||||||
|
|
||||||
struct card_handle *card_emu_init(uint8_t slot_num, uint8_t tc_chan, uint8_t uart_chan)
|
|
||||||
{
|
|
||||||
struct card_handle *ch;
|
|
||||||
|
|
||||||
if (slot_num >= ARRAY_SIZE(card_handles))
|
|
||||||
return NULL;
|
|
||||||
|
|
||||||
ch = &card_handles[slot_num];
|
|
||||||
|
|
||||||
memset(ch, 0, sizeof(*ch));
|
|
||||||
|
|
||||||
INIT_LLIST_HEAD(&ch->usb_tx_queue);
|
|
||||||
INIT_LLIST_HEAD(&ch->uart_tx_queue);
|
|
||||||
|
|
||||||
/* initialize the card_handle with reasonabe defaults */
|
|
||||||
ch->num = slot_num;
|
|
||||||
ch->state = ISO_S_WAIT_POWER;
|
|
||||||
ch->vcc_active = 0;
|
|
||||||
ch->in_reset = 1;
|
|
||||||
ch->clocked = 0;
|
|
||||||
|
|
||||||
ch->fi = 0;
|
|
||||||
ch->di = 1;
|
|
||||||
ch->wi = ISO7816_3_DEFAULT_WI;
|
|
||||||
|
|
||||||
ch->tc_chan = tc_chan;
|
|
||||||
ch->uart_chan = uart_chan;
|
|
||||||
ch->waiting_time = ISO7816_3_INIT_WTIME;
|
|
||||||
|
|
||||||
ch->atr.idx = 0;
|
|
||||||
ch->atr.len = sizeof(default_atr);
|
|
||||||
memcpy(ch->atr.atr, default_atr, ch->atr.len);
|
|
||||||
|
|
||||||
ch->pts.state = PTS_S_WAIT_REQ_PTSS;
|
|
||||||
ch->tpdu.state = TPDU_S_WAIT_CLA;
|
|
||||||
|
|
||||||
tc_etu_init(ch->tc_chan, ch);
|
|
||||||
|
|
||||||
return ch;
|
|
||||||
}
|
|
||||||
@@ -1,15 +0,0 @@
|
|||||||
#include <stdio.h>
|
|
||||||
#include "uart_console.h"
|
|
||||||
|
|
||||||
int fputc(int c, FILE *stream)
|
|
||||||
{
|
|
||||||
UART_PutChar(c);
|
|
||||||
return c;
|
|
||||||
}
|
|
||||||
|
|
||||||
int fputs(const char *s, FILE *stream)
|
|
||||||
{
|
|
||||||
while (*s != '\0')
|
|
||||||
UART_PutChar(*s++);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
@@ -1,126 +0,0 @@
|
|||||||
//#define TRACE_LEVEL 6
|
|
||||||
|
|
||||||
#include <errno.h>
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "req_ctx.h"
|
|
||||||
#include "osmocom/core/linuxlist.h"
|
|
||||||
#include "llist_irqsafe.h"
|
|
||||||
|
|
||||||
static volatile uint32_t usbep_in_progress[BOARD_USB_NUMENDPOINTS];
|
|
||||||
|
|
||||||
/* call-back after (successful?) transfer of a buffer */
|
|
||||||
static void usb_write_cb(uint8_t *arg, uint8_t status, uint32_t transferred,
|
|
||||||
uint32_t remaining)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx = (struct req_ctx *) arg;
|
|
||||||
|
|
||||||
TRACE_DEBUG("%s (EP=%u)\r\n", __func__, rctx->ep);
|
|
||||||
|
|
||||||
__disable_irq();
|
|
||||||
usbep_in_progress[rctx->ep]--;
|
|
||||||
__enable_irq();
|
|
||||||
TRACE_DEBUG("%u: in_progress=%d\n", rctx->ep, usbep_in_progress[rctx->ep]);
|
|
||||||
|
|
||||||
if (status != USBD_STATUS_SUCCESS)
|
|
||||||
TRACE_ERROR("%s error, status=%d\n", __func__, status);
|
|
||||||
|
|
||||||
/* release request contxt to pool */
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_FREE);
|
|
||||||
}
|
|
||||||
|
|
||||||
int usb_refill_to_host(struct llist_head *queue, uint32_t ep)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
__disable_irq();
|
|
||||||
if (usbep_in_progress[ep]) {
|
|
||||||
__enable_irq();
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (llist_empty(queue)) {
|
|
||||||
__enable_irq();
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
usbep_in_progress[ep]++;
|
|
||||||
|
|
||||||
rctx = llist_entry(queue->next, struct req_ctx, list);
|
|
||||||
llist_del(&rctx->list);
|
|
||||||
|
|
||||||
__enable_irq();
|
|
||||||
|
|
||||||
TRACE_DEBUG("%u: in_progress=%d\n", ep, usbep_in_progress[ep]);
|
|
||||||
TRACE_DEBUG("%s (EP=%u)\r\n", __func__, ep);
|
|
||||||
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_USB_TX_BUSY);
|
|
||||||
rctx->ep = ep;
|
|
||||||
|
|
||||||
rc = USBD_Write(ep, rctx->data, rctx->tot_len,
|
|
||||||
(TransferCallback) &usb_write_cb, rctx);
|
|
||||||
if (rc != USBD_STATUS_SUCCESS) {
|
|
||||||
TRACE_ERROR("%s error %x\n", __func__, rc);
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_USB_TX_PENDING);
|
|
||||||
__disable_irq();
|
|
||||||
usbep_in_progress[ep]--;
|
|
||||||
__enable_irq();
|
|
||||||
TRACE_DEBUG("%u: in_progress=%d\n", ep, usbep_in_progress[ep]);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void usb_read_cb(uint8_t *arg, uint8_t status, uint32_t transferred,
|
|
||||||
uint32_t remaining)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx = (struct req_ctx *) arg;
|
|
||||||
struct llist_head *queue = (struct llist_head *) usbep_in_progress[rctx->ep];
|
|
||||||
|
|
||||||
TRACE_DEBUG("%s (EP=%u, len=%u, q=%p)\r\n", __func__,
|
|
||||||
rctx->ep, transferred, queue);
|
|
||||||
|
|
||||||
usbep_in_progress[rctx->ep] = 0;
|
|
||||||
|
|
||||||
if (status != USBD_STATUS_SUCCESS) {
|
|
||||||
TRACE_ERROR("%s error, status=%d\n", __func__, status);
|
|
||||||
/* release request contxt to pool */
|
|
||||||
req_ctx_put(rctx);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
rctx->tot_len = transferred;
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_MAIN_PROCESSING);
|
|
||||||
llist_add_tail_irqsafe(&rctx->list, queue);
|
|
||||||
}
|
|
||||||
|
|
||||||
int usb_refill_from_host(struct llist_head *queue, int ep)
|
|
||||||
{
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
int rc;
|
|
||||||
|
|
||||||
if (usbep_in_progress[ep])
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
TRACE_DEBUG("%s (EP=%u)\r\n", __func__, ep);
|
|
||||||
|
|
||||||
rctx = req_ctx_find_get(0, RCTX_S_FREE, RCTX_S_USB_RX_BUSY);
|
|
||||||
if (!rctx)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
rctx->ep = ep;
|
|
||||||
usbep_in_progress[ep] = (uint32_t) queue;
|
|
||||||
|
|
||||||
rc = USBD_Read(ep, rctx->data, rctx->size,
|
|
||||||
(TransferCallback) &usb_read_cb, rctx);
|
|
||||||
|
|
||||||
if (rc != USBD_STATUS_SUCCESS) {
|
|
||||||
TRACE_ERROR("%s error %x\n", __func__, rc);
|
|
||||||
req_ctx_put(rctx);
|
|
||||||
usbep_in_progress[ep] = 0;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
@@ -1,64 +0,0 @@
|
|||||||
/* ISO7816-3 Fi/Di tables + computation */
|
|
||||||
/* (C) 2010-2015 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
#include <errno.h>
|
|
||||||
|
|
||||||
#include "utils.h"
|
|
||||||
#include "iso7816_fidi.h"
|
|
||||||
|
|
||||||
/* Table 7 of ISO 7816-3:2006 */
|
|
||||||
static const uint16_t fi_table[] = {
|
|
||||||
372, 372, 558, 744, 1116, 1488, 1860, 0,
|
|
||||||
0, 512, 768, 1024, 1536, 2048, 0, 0
|
|
||||||
};
|
|
||||||
|
|
||||||
/* Table 8 from ISO 7816-3:2006 */
|
|
||||||
static const uint8_t di_table[] = {
|
|
||||||
0, 1, 2, 4, 8, 16, 32, 64,
|
|
||||||
12, 20, 2, 4, 8, 16, 32, 64,
|
|
||||||
};
|
|
||||||
|
|
||||||
/* compute the F/D ratio based on Fi and Di values */
|
|
||||||
int compute_fidi_ratio(uint8_t fi, uint8_t di)
|
|
||||||
{
|
|
||||||
uint16_t f, d;
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
if (fi >= ARRAY_SIZE(fi_table) ||
|
|
||||||
di >= ARRAY_SIZE(di_table))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
f = fi_table[fi];
|
|
||||||
if (f == 0)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
d = di_table[di];
|
|
||||||
if (d == 0)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
/* See table 7 of ISO 7816-3: From 1000 on we divide by 1/d,
|
|
||||||
* which equals a multiplication by d */
|
|
||||||
if (di < 8)
|
|
||||||
ret = f / d;
|
|
||||||
else
|
|
||||||
ret = f * d;
|
|
||||||
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
@@ -1,572 +0,0 @@
|
|||||||
//#define TRACE_LEVEL 6
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "simtrace.h"
|
|
||||||
#include "ringbuffer.h"
|
|
||||||
#include "card_emu.h"
|
|
||||||
#include "iso7816_fidi.h"
|
|
||||||
#include "utils.h"
|
|
||||||
#include "osmocom/core/linuxlist.h"
|
|
||||||
#include "llist_irqsafe.h"
|
|
||||||
#include "req_ctx.h"
|
|
||||||
#include "cardemu_prot.h"
|
|
||||||
|
|
||||||
#define TRACE_ENTRY() TRACE_DEBUG("%s entering\r\n", __func__)
|
|
||||||
|
|
||||||
static const Pin pins_cardsim[] = PINS_CARDSIM;
|
|
||||||
|
|
||||||
/* UART pins */
|
|
||||||
static const Pin pins_usim1[] = {PINS_USIM1};
|
|
||||||
static const Pin pin_usim1_rst = PIN_USIM1_nRST;
|
|
||||||
static const Pin pin_usim1_vcc = PIN_USIM1_VCC;
|
|
||||||
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
static const Pin pins_usim2[] = {PINS_USIM2};
|
|
||||||
static const Pin pin_usim2_rst = PIN_USIM2_nRST;
|
|
||||||
static const Pin pin_usim2_vcc = PIN_USIM2_VCC;
|
|
||||||
#endif
|
|
||||||
|
|
||||||
struct cardem_inst {
|
|
||||||
uint32_t num;
|
|
||||||
struct card_handle *ch;
|
|
||||||
struct llist_head usb_out_queue;
|
|
||||||
struct ringbuf rb;
|
|
||||||
struct Usart_info usart_info;
|
|
||||||
int usb_pending_old;
|
|
||||||
uint8_t ep_out;
|
|
||||||
uint8_t ep_in;
|
|
||||||
uint8_t ep_int;
|
|
||||||
const Pin pin_insert;
|
|
||||||
uint32_t vcc_uv;
|
|
||||||
uint32_t vcc_uv_last;
|
|
||||||
};
|
|
||||||
|
|
||||||
static struct cardem_inst cardem_inst[] = {
|
|
||||||
{
|
|
||||||
.num = 0,
|
|
||||||
.usart_info = {
|
|
||||||
.base = USART1,
|
|
||||||
.id = ID_USART1,
|
|
||||||
.state = USART_RCV
|
|
||||||
},
|
|
||||||
.ep_out = PHONE_DATAOUT,
|
|
||||||
.ep_in = PHONE_DATAIN,
|
|
||||||
.ep_int = PHONE_INT,
|
|
||||||
.pin_insert = PIN_SET_USIM1_PRES,
|
|
||||||
},
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
{
|
|
||||||
.num = 1,
|
|
||||||
.usart_info = {
|
|
||||||
.base = USART0,
|
|
||||||
.id = ID_USART0,
|
|
||||||
.state = USART_RCV
|
|
||||||
},
|
|
||||||
.ep_out = CARDEM_USIM2_DATAOUT,
|
|
||||||
.ep_in = CARDEM_USIM2_DATAIN,
|
|
||||||
.ep_int = CARDEM_USIM2_INT,
|
|
||||||
.pin_insert = PIN_SET_USIM2_PRES,
|
|
||||||
},
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
|
|
||||||
static Usart *get_usart_by_chan(uint8_t uart_chan)
|
|
||||||
{
|
|
||||||
switch (uart_chan) {
|
|
||||||
case 0:
|
|
||||||
return USART1;
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
case 1:
|
|
||||||
return USART0;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/***********************************************************************
|
|
||||||
* Call-Backs from card_emu.c
|
|
||||||
***********************************************************************/
|
|
||||||
|
|
||||||
static void wait_tx_idle(Usart *usart)
|
|
||||||
{
|
|
||||||
int i = 1;
|
|
||||||
|
|
||||||
/* wait until last char has been fully transmitted */
|
|
||||||
while ((usart->US_CSR & (US_CSR_TXEMPTY)) == 0) {
|
|
||||||
if (!(i%1000000)) {
|
|
||||||
TRACE_ERROR("s: %x \r\n", usart->US_CSR);
|
|
||||||
}
|
|
||||||
i++;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void card_emu_uart_wait_tx_idle(uint8_t uart_chan)
|
|
||||||
{
|
|
||||||
Usart *usart = get_usart_by_chan(uart_chan);
|
|
||||||
wait_tx_idle(usart);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* call-back from card_emu.c to enable/disable transmit and/or receive */
|
|
||||||
void card_emu_uart_enable(uint8_t uart_chan, uint8_t rxtx)
|
|
||||||
{
|
|
||||||
Usart *usart = get_usart_by_chan(uart_chan);
|
|
||||||
switch (rxtx) {
|
|
||||||
case ENABLE_TX:
|
|
||||||
USART_DisableIt(usart, ~US_IER_TXRDY);
|
|
||||||
/* as irritating as it is, we actually want to keep the
|
|
||||||
* receiver enabled during transmit */
|
|
||||||
USART_SetReceiverEnabled(usart, 1);
|
|
||||||
usart->US_CR = US_CR_RSTSTA | US_CR_RSTIT | US_CR_RSTNACK;
|
|
||||||
USART_EnableIt(usart, US_IER_TXRDY);
|
|
||||||
USART_SetTransmitterEnabled(usart, 1);
|
|
||||||
break;
|
|
||||||
case ENABLE_RX:
|
|
||||||
USART_DisableIt(usart, ~US_IER_RXRDY);
|
|
||||||
/* as irritating as it is, we actually want to keep the
|
|
||||||
* transmitter enabled during receive */
|
|
||||||
USART_SetTransmitterEnabled(usart, 1);
|
|
||||||
wait_tx_idle(usart);
|
|
||||||
usart->US_CR = US_CR_RSTSTA | US_CR_RSTIT | US_CR_RSTNACK;
|
|
||||||
USART_EnableIt(usart, US_IER_RXRDY);
|
|
||||||
USART_SetReceiverEnabled(usart, 1);
|
|
||||||
break;
|
|
||||||
case 0:
|
|
||||||
default:
|
|
||||||
USART_SetTransmitterEnabled(usart, 0);
|
|
||||||
USART_SetReceiverEnabled(usart, 0);
|
|
||||||
USART_DisableIt(usart, 0xFFFFFFFF);
|
|
||||||
usart->US_CR = US_CR_RSTSTA | US_CR_RSTIT | US_CR_RSTNACK;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* call-back from card_emu.c to transmit a byte */
|
|
||||||
int card_emu_uart_tx(uint8_t uart_chan, uint8_t byte)
|
|
||||||
{
|
|
||||||
Usart *usart = get_usart_by_chan(uart_chan);
|
|
||||||
#if 0
|
|
||||||
Usart_info *ui = &usart_info[uart_chan];
|
|
||||||
ISO7816_SendChar(byte, ui);
|
|
||||||
#else
|
|
||||||
int i = 1;
|
|
||||||
while ((usart->US_CSR & (US_CSR_TXRDY)) == 0) {
|
|
||||||
if (!(i%1000000)) {
|
|
||||||
TRACE_ERROR("%u: s: %x %02X\r\n",
|
|
||||||
uart_chan, usart->US_CSR,
|
|
||||||
usart->US_RHR & 0xFF);
|
|
||||||
usart->US_CR = US_CR_RSTTX;
|
|
||||||
usart->US_CR = US_CR_RSTRX;
|
|
||||||
}
|
|
||||||
i++;
|
|
||||||
}
|
|
||||||
usart->US_THR = byte;
|
|
||||||
//TRACE_ERROR("Sx%02x\r\n", byte);
|
|
||||||
#endif
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/* FIXME: integrate this with actual irq handler */
|
|
||||||
static void usart_irq_rx(uint8_t inst_num)
|
|
||||||
{
|
|
||||||
Usart *usart = get_usart_by_chan(inst_num);
|
|
||||||
struct cardem_inst *ci = &cardem_inst[inst_num];
|
|
||||||
uint32_t csr;
|
|
||||||
uint8_t byte = 0;
|
|
||||||
|
|
||||||
csr = usart->US_CSR & usart->US_IMR;
|
|
||||||
|
|
||||||
if (csr & US_CSR_RXRDY) {
|
|
||||||
byte = (usart->US_RHR) & 0xFF;
|
|
||||||
rbuf_write(&ci->rb, byte);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (csr & US_CSR_TXRDY) {
|
|
||||||
if (card_emu_tx_byte(ci->ch) == 0)
|
|
||||||
USART_DisableIt(usart, US_IER_TXRDY);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (csr & (US_CSR_OVRE|US_CSR_FRAME|US_CSR_PARE|
|
|
||||||
US_CSR_TIMEOUT|US_CSR_NACK|(1<<10))) {
|
|
||||||
usart->US_CR = US_CR_RSTSTA | US_CR_RSTIT | US_CR_RSTNACK;
|
|
||||||
TRACE_ERROR("%u e 0x%x st: 0x%x\n", ci->num, byte, csr);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void mode_cardemu_usart0_irq(void)
|
|
||||||
{
|
|
||||||
/* USART0 == Instance 1 == USIM 2 */
|
|
||||||
usart_irq_rx(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
void mode_cardemu_usart1_irq(void)
|
|
||||||
{
|
|
||||||
/* USART1 == Instance 0 == USIM 1 */
|
|
||||||
usart_irq_rx(0);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* call-back from card_emu.c to change UART baud rate */
|
|
||||||
int card_emu_uart_update_fidi(uint8_t uart_chan, unsigned int fidi)
|
|
||||||
{
|
|
||||||
int rc;
|
|
||||||
Usart *usart = get_usart_by_chan(uart_chan);
|
|
||||||
|
|
||||||
usart->US_CR |= US_CR_RXDIS | US_CR_RSTRX;
|
|
||||||
usart->US_FIDI = fidi & 0x3ff;
|
|
||||||
usart->US_CR |= US_CR_RXEN | US_CR_STTTO;
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
/***********************************************************************
|
|
||||||
* ADC for VCC voltage detection
|
|
||||||
***********************************************************************/
|
|
||||||
|
|
||||||
#ifdef DETECT_VCC_BY_ADC
|
|
||||||
|
|
||||||
static int adc_triggered = 0;
|
|
||||||
static int adc_sam3s_reva_errata = 0;
|
|
||||||
|
|
||||||
static int card_vcc_adc_init(void)
|
|
||||||
{
|
|
||||||
uint32_t chip_arch = CHIPID->CHIPID_CIDR & CHIPID_CIDR_ARCH_Msk;
|
|
||||||
uint32_t chip_ver = CHIPID->CHIPID_CIDR & CHIPID_CIDR_VERSION_Msk;
|
|
||||||
|
|
||||||
PMC_EnablePeripheral(ID_ADC);
|
|
||||||
|
|
||||||
ADC->ADC_CR |= ADC_CR_SWRST;
|
|
||||||
if (chip_ver == 0 &&
|
|
||||||
(chip_arch == CHIPID_CIDR_ARCH_SAM3SxA ||
|
|
||||||
chip_arch == CHIPID_CIDR_ARCH_SAM3SxB ||
|
|
||||||
chip_arch == CHIPID_CIDR_ARCH_SAM3SxC)) {
|
|
||||||
TRACE_INFO("Enabling Rev.A ADC Errata work-around\r\n");
|
|
||||||
adc_sam3s_reva_errata = 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (adc_sam3s_reva_errata) {
|
|
||||||
/* Errata Work-Around to clear EOCx flags */
|
|
||||||
volatile uint32_t foo;
|
|
||||||
int i;
|
|
||||||
for (i = 0; i < 16; i++)
|
|
||||||
foo = ADC->ADC_CDR[i];
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Initialize ADC for AD7 / AD6, fADC=48/24=2MHz */
|
|
||||||
ADC->ADC_MR = ADC_MR_TRGEN_DIS | ADC_MR_LOWRES_BITS_12 |
|
|
||||||
ADC_MR_SLEEP_NORMAL | ADC_MR_FWUP_OFF |
|
|
||||||
ADC_MR_FREERUN_OFF | ADC_MR_PRESCAL(23) |
|
|
||||||
ADC_MR_STARTUP_SUT8 | ADC_MR_SETTLING(3) |
|
|
||||||
ADC_MR_ANACH_NONE | ADC_MR_TRACKTIM(4) |
|
|
||||||
ADC_MR_TRANSFER(1) | ADC_MR_USEQ_NUM_ORDER;
|
|
||||||
/* enable AD6 + AD7 channels */
|
|
||||||
ADC->ADC_CHER = ADC_CHER_CH7;
|
|
||||||
ADC->ADC_IER = ADC_IER_EOC7;
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
ADC->ADC_CHER |= ADC_CHER_CH6;
|
|
||||||
ADC->ADC_IER |= ADC_IER_EOC6;
|
|
||||||
#endif
|
|
||||||
NVIC_EnableIRQ(ADC_IRQn);
|
|
||||||
ADC->ADC_CR |= ADC_CR_START;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
#define UV_PER_LSB ((3300 * 1000) / 4096)
|
|
||||||
#define VCC_UV_THRESH_1V8 1500000
|
|
||||||
#define VCC_UV_THRESH_3V 2800000
|
|
||||||
|
|
||||||
static void process_vcc_adc(struct cardem_inst *ci)
|
|
||||||
{
|
|
||||||
if (ci->vcc_uv >= VCC_UV_THRESH_3V &&
|
|
||||||
ci->vcc_uv_last < VCC_UV_THRESH_3V) {
|
|
||||||
card_emu_io_statechg(ci->ch, CARD_IO_VCC, 1);
|
|
||||||
/* FIXME do this for real */
|
|
||||||
card_emu_io_statechg(ci->ch, CARD_IO_CLK, 1);
|
|
||||||
} else if (ci->vcc_uv < VCC_UV_THRESH_3V &&
|
|
||||||
ci->vcc_uv_last >= VCC_UV_THRESH_3V) {
|
|
||||||
/* FIXME do this for real */
|
|
||||||
card_emu_io_statechg(ci->ch, CARD_IO_CLK, 0);
|
|
||||||
card_emu_io_statechg(ci->ch, CARD_IO_VCC, 0);
|
|
||||||
}
|
|
||||||
ci->vcc_uv_last = ci->vcc_uv;
|
|
||||||
}
|
|
||||||
|
|
||||||
static uint32_t adc2uv(uint16_t adc)
|
|
||||||
{
|
|
||||||
uint32_t uv = (uint32_t) adc * UV_PER_LSB;
|
|
||||||
return uv;
|
|
||||||
}
|
|
||||||
|
|
||||||
void ADC_IrqHandler(void)
|
|
||||||
{
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
if (ADC->ADC_ISR & ADC_ISR_EOC6) {
|
|
||||||
uint16_t val = ADC->ADC_CDR[6] & 0xFFF;
|
|
||||||
cardem_inst[1].vcc_uv = adc2uv(val);
|
|
||||||
process_vcc_adc(&cardem_inst[1]);
|
|
||||||
if (adc_sam3s_reva_errata) {
|
|
||||||
/* Errata: START doesn't start a conversion
|
|
||||||
* sequence, but only a single conversion */
|
|
||||||
ADC->ADC_CR |= ADC_CR_START;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
if (ADC->ADC_ISR & ADC_ISR_EOC7) {
|
|
||||||
uint16_t val = ADC->ADC_CDR[7] & 0xFFF;
|
|
||||||
cardem_inst[0].vcc_uv = adc2uv(val);
|
|
||||||
process_vcc_adc(&cardem_inst[0]);
|
|
||||||
ADC->ADC_CR |= ADC_CR_START;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif /* DETECT_VCC_BY_ADC */
|
|
||||||
|
|
||||||
/***********************************************************************
|
|
||||||
* Core USB / mainloop integration
|
|
||||||
***********************************************************************/
|
|
||||||
|
|
||||||
static void usim1_rst_irqhandler(const Pin *pPin)
|
|
||||||
{
|
|
||||||
int active = PIO_Get(&pin_usim1_rst) ? 0 : 1;
|
|
||||||
card_emu_io_statechg(cardem_inst[0].ch, CARD_IO_RST, active);
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifndef DETECT_VCC_BY_ADC
|
|
||||||
static void usim1_vcc_irqhandler(const Pin *pPin)
|
|
||||||
{
|
|
||||||
int active = PIO_Get(&pin_usim1_vcc) ? 1 : 0;
|
|
||||||
card_emu_io_statechg(cardem_inst[0].ch, CARD_IO_VCC, active);
|
|
||||||
/* FIXME do this for real */
|
|
||||||
card_emu_io_statechg(cardem_inst[0].ch, CARD_IO_CLK, active);
|
|
||||||
}
|
|
||||||
#endif /* !DETECT_VCC_BY_ADC */
|
|
||||||
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
static void usim2_rst_irqhandler(const Pin *pPin)
|
|
||||||
{
|
|
||||||
int active = PIO_Get(&pin_usim2_rst) ? 0 : 1;
|
|
||||||
card_emu_io_statechg(cardem_inst[1].ch, CARD_IO_RST, active);
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifndef DETECT_VCC_BY_ADC
|
|
||||||
static void usim2_vcc_irqhandler(const Pin *pPin)
|
|
||||||
{
|
|
||||||
int active = PIO_Get(&pin_usim2_vcc) ? 1 : 0;
|
|
||||||
card_emu_io_statechg(cardem_inst[1].ch, CARD_IO_VCC, active);
|
|
||||||
/* FIXME do this for real */
|
|
||||||
card_emu_io_statechg(cardem_inst[1].ch, CARD_IO_CLK, active);
|
|
||||||
}
|
|
||||||
#endif /* !DETECT_VCC_BY_ADC */
|
|
||||||
#endif /* CARDEMU_SECOND_UART */
|
|
||||||
|
|
||||||
/* executed once at system boot for each config */
|
|
||||||
void mode_cardemu_configure(void)
|
|
||||||
{
|
|
||||||
TRACE_ENTRY();
|
|
||||||
}
|
|
||||||
|
|
||||||
/* called if config is activated */
|
|
||||||
void mode_cardemu_init(void)
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
|
|
||||||
TRACE_ENTRY();
|
|
||||||
|
|
||||||
PIO_Configure(pins_cardsim, PIO_LISTSIZE(pins_cardsim));
|
|
||||||
#ifdef DETECT_VCC_BY_ADC
|
|
||||||
card_vcc_adc_init();
|
|
||||||
#endif /* DETECT_VCC_BY_ADC */
|
|
||||||
|
|
||||||
INIT_LLIST_HEAD(&cardem_inst[0].usb_out_queue);
|
|
||||||
rbuf_reset(&cardem_inst[0].rb);
|
|
||||||
PIO_Configure(pins_usim1, PIO_LISTSIZE(pins_usim1));
|
|
||||||
ISO7816_Init(&cardem_inst[0].usart_info, CLK_SLAVE);
|
|
||||||
NVIC_EnableIRQ(USART1_IRQn);
|
|
||||||
PIO_ConfigureIt(&pin_usim1_rst, usim1_rst_irqhandler);
|
|
||||||
PIO_EnableIt(&pin_usim1_rst);
|
|
||||||
#ifndef DETECT_VCC_BY_ADC
|
|
||||||
PIO_ConfigureIt(&pin_usim1_vcc, usim1_vcc_irqhandler);
|
|
||||||
PIO_EnableIt(&pin_usim1_vcc);
|
|
||||||
#endif /* DETECT_VCC_BY_ADC */
|
|
||||||
cardem_inst[0].ch = card_emu_init(0, 2, 0);
|
|
||||||
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
INIT_LLIST_HEAD(&cardem_inst[1].usb_out_queue);
|
|
||||||
rbuf_reset(&cardem_inst[1].rb);
|
|
||||||
PIO_Configure(pins_usim2, PIO_LISTSIZE(pins_usim2));
|
|
||||||
ISO7816_Init(&cardem_inst[1].usart_info, CLK_SLAVE);
|
|
||||||
NVIC_EnableIRQ(USART0_IRQn);
|
|
||||||
PIO_ConfigureIt(&pin_usim2_rst, usim2_rst_irqhandler);
|
|
||||||
PIO_EnableIt(&pin_usim2_rst);
|
|
||||||
#ifndef DETECT_VCC_BY_ADC
|
|
||||||
PIO_ConfigureIt(&pin_usim2_vcc, usim2_vcc_irqhandler);
|
|
||||||
PIO_EnableIt(&pin_usim2_vcc);
|
|
||||||
#endif /* DETECT_VCC_BY_ADC */
|
|
||||||
cardem_inst[1].ch = card_emu_init(1, 0, 1);
|
|
||||||
#endif /* CARDEMU_SECOND_UART */
|
|
||||||
}
|
|
||||||
|
|
||||||
/* called if config is deactivated */
|
|
||||||
void mode_cardemu_exit(void)
|
|
||||||
{
|
|
||||||
TRACE_ENTRY();
|
|
||||||
|
|
||||||
/* FIXME: stop tc_fdt */
|
|
||||||
/* FIXME: release all rctx, unlink them from any queue */
|
|
||||||
|
|
||||||
PIO_DisableIt(&pin_usim1_rst);
|
|
||||||
PIO_DisableIt(&pin_usim1_vcc);
|
|
||||||
|
|
||||||
NVIC_DisableIRQ(USART1_IRQn);
|
|
||||||
USART_SetTransmitterEnabled(USART1, 0);
|
|
||||||
USART_SetReceiverEnabled(USART1, 0);
|
|
||||||
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
PIO_DisableIt(&pin_usim2_rst);
|
|
||||||
PIO_DisableIt(&pin_usim2_vcc);
|
|
||||||
|
|
||||||
NVIC_DisableIRQ(USART0_IRQn);
|
|
||||||
USART_SetTransmitterEnabled(USART0, 0);
|
|
||||||
USART_SetReceiverEnabled(USART0, 0);
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
/* handle a single USB command as received from the USB host */
|
|
||||||
static void dispatch_usb_command(struct req_ctx *rctx, struct cardem_inst *ci)
|
|
||||||
{
|
|
||||||
struct cardemu_usb_msg_hdr *hdr;
|
|
||||||
struct cardemu_usb_msg_set_atr *atr;
|
|
||||||
struct cardemu_usb_msg_cardinsert *cardins;
|
|
||||||
struct llist_head *queue;
|
|
||||||
|
|
||||||
hdr = (struct cardemu_usb_msg_hdr *) rctx->data;
|
|
||||||
switch (hdr->msg_type) {
|
|
||||||
case CEMU_USB_MSGT_DT_TX_DATA:
|
|
||||||
queue = card_emu_get_uart_tx_queue(ci->ch);
|
|
||||||
req_ctx_set_state(rctx, RCTX_S_UART_TX_PENDING);
|
|
||||||
llist_add_tail(&rctx->list, queue);
|
|
||||||
card_emu_have_new_uart_tx(ci->ch);
|
|
||||||
break;
|
|
||||||
case CEMU_USB_MSGT_DT_SET_ATR:
|
|
||||||
atr = (struct cardemu_usb_msg_set_atr *) hdr;
|
|
||||||
card_emu_set_atr(ci->ch, atr->atr, atr->atr_len);
|
|
||||||
req_ctx_put(rctx);
|
|
||||||
break;
|
|
||||||
case CEMU_USB_MSGT_DT_CARDINSERT:
|
|
||||||
cardins = (struct cardemu_usb_msg_cardinsert *) hdr;
|
|
||||||
TRACE_INFO("%u: set card_insert to %s\r\n", ci->num,
|
|
||||||
cardins->card_insert ? "INSERTED" : "REMOVED");
|
|
||||||
if (cardins->card_insert)
|
|
||||||
PIO_Set(&ci->pin_insert);
|
|
||||||
else
|
|
||||||
PIO_Clear(&ci->pin_insert);
|
|
||||||
req_ctx_put(rctx);
|
|
||||||
break;
|
|
||||||
case CEMU_USB_MSGT_DT_GET_STATUS:
|
|
||||||
card_emu_report_status(ci->ch);
|
|
||||||
break;
|
|
||||||
case CEMU_USB_MSGT_DT_GET_STATS:
|
|
||||||
default:
|
|
||||||
/* FIXME */
|
|
||||||
req_ctx_put(rctx);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void dispatch_received_rctx(struct req_ctx *rctx, struct cardem_inst *ci)
|
|
||||||
{
|
|
||||||
struct req_ctx *segm;
|
|
||||||
struct cardemu_usb_msg_hdr *mh;
|
|
||||||
int i = 0;
|
|
||||||
|
|
||||||
/* check if we have multiple concatenated commands in
|
|
||||||
* one message. USB endpoints are streams that don't
|
|
||||||
* preserve the message boundaries */
|
|
||||||
mh = (struct cardemu_usb_msg_hdr *) rctx->data;
|
|
||||||
if (mh->msg_len == rctx->tot_len) {
|
|
||||||
/* fast path: only one message in buffer */
|
|
||||||
dispatch_usb_command(rctx, ci);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* slow path: iterate over list of messages, allocating one new
|
|
||||||
* reqe_ctx per segment */
|
|
||||||
for (mh = (struct cardemu_usb_msg_hdr *) rctx->data;
|
|
||||||
(uint8_t *)mh < rctx->data + rctx->tot_len;
|
|
||||||
mh = (struct cardemu_usb_msg_hdr * ) ((uint8_t *)mh + mh->msg_len)) {
|
|
||||||
segm = req_ctx_find_get(0, RCTX_S_FREE, RCTX_S_MAIN_PROCESSING);
|
|
||||||
if (!segm) {
|
|
||||||
TRACE_ERROR("%u: ENOMEM during rctx segmentation\r\n",
|
|
||||||
ci->num);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
segm->idx = 0;
|
|
||||||
segm->tot_len = mh->msg_len;
|
|
||||||
memcpy(segm->data, mh, segm->tot_len);
|
|
||||||
dispatch_usb_command(segm, ci);
|
|
||||||
i++;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* release the master req_ctx, as all segments have been
|
|
||||||
* processed now */
|
|
||||||
req_ctx_put(rctx);
|
|
||||||
}
|
|
||||||
|
|
||||||
/* iterate over the queue of incoming USB commands and dispatch/execute
|
|
||||||
* them */
|
|
||||||
static void process_any_usb_commands(struct llist_head *main_q,
|
|
||||||
struct cardem_inst *ci)
|
|
||||||
{
|
|
||||||
struct llist_head *lh;
|
|
||||||
struct req_ctx *rctx;
|
|
||||||
int i;
|
|
||||||
|
|
||||||
/* limit the number of iterations to 10, to ensure we don't get
|
|
||||||
* stuck here without returning to main loop processing */
|
|
||||||
for (i = 0; i < 10; i++) {
|
|
||||||
/* de-queue the list head in an irq-safe way */
|
|
||||||
lh = llist_head_dequeue_irqsafe(main_q);
|
|
||||||
if (!lh)
|
|
||||||
break;
|
|
||||||
rctx = llist_entry(lh, struct req_ctx, list);
|
|
||||||
dispatch_received_rctx(rctx, ci);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/* main loop function, called repeatedly */
|
|
||||||
void mode_cardemu_run(void)
|
|
||||||
{
|
|
||||||
struct llist_head *queue;
|
|
||||||
unsigned int i;
|
|
||||||
|
|
||||||
for (i = 0; i < ARRAY_SIZE(cardem_inst); i++) {
|
|
||||||
struct cardem_inst *ci = &cardem_inst[i];
|
|
||||||
|
|
||||||
/* drain the ring buffer from UART into card_emu */
|
|
||||||
while (1) {
|
|
||||||
__disable_irq();
|
|
||||||
if (rbuf_is_empty(&ci->rb)) {
|
|
||||||
__enable_irq();
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
uint8_t byte = rbuf_read(&ci->rb);
|
|
||||||
__enable_irq();
|
|
||||||
card_emu_process_rx_byte(ci->ch, byte);
|
|
||||||
//TRACE_ERROR("%uRx%02x\r\n", i, byte);
|
|
||||||
}
|
|
||||||
|
|
||||||
queue = card_emu_get_usb_tx_queue(ci->ch);
|
|
||||||
int usb_pending = llist_count(queue);
|
|
||||||
if (usb_pending != ci->usb_pending_old) {
|
|
||||||
TRACE_DEBUG("%u usb_pending=%d\r\n",
|
|
||||||
i, usb_pending);
|
|
||||||
ci->usb_pending_old = usb_pending;
|
|
||||||
}
|
|
||||||
usb_refill_to_host(queue, ci->ep_in);
|
|
||||||
|
|
||||||
/* ensure we can handle incoming USB messages from the
|
|
||||||
* host */
|
|
||||||
queue = &ci->usb_out_queue;
|
|
||||||
usb_refill_from_host(queue, ci->ep_out);
|
|
||||||
process_any_usb_commands(queue, ci);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
@@ -1,140 +0,0 @@
|
|||||||
/* USB Request Context for OpenPCD / OpenPICC / SIMtrace
|
|
||||||
* (C) 2006-2016 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <unistd.h>
|
|
||||||
#include <stdlib.h>
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
#include "chip.h"
|
|
||||||
#include "utils.h"
|
|
||||||
#include "trace.h"
|
|
||||||
#include "req_ctx.h"
|
|
||||||
|
|
||||||
#define NUM_RCTX_SMALL 10
|
|
||||||
#define NUM_RCTX_LARGE 0
|
|
||||||
|
|
||||||
#define NUM_REQ_CTX (NUM_RCTX_SMALL+NUM_RCTX_LARGE)
|
|
||||||
|
|
||||||
static uint8_t rctx_data[NUM_RCTX_SMALL][RCTX_SIZE_SMALL];
|
|
||||||
static uint8_t rctx_data_large[NUM_RCTX_LARGE][RCTX_SIZE_LARGE];
|
|
||||||
|
|
||||||
static struct req_ctx req_ctx[NUM_REQ_CTX];
|
|
||||||
|
|
||||||
struct req_ctx __ramfunc *
|
|
||||||
req_ctx_find_get(int large, uint32_t old_state, uint32_t new_state)
|
|
||||||
{
|
|
||||||
struct req_ctx *toReturn = NULL;
|
|
||||||
unsigned long flags;
|
|
||||||
unsigned int i;
|
|
||||||
|
|
||||||
if (old_state >= RCTX_STATE_COUNT || new_state >= RCTX_STATE_COUNT) {
|
|
||||||
TRACE_DEBUG("Invalid parameters for req_ctx_find_get\r\n");
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
local_irq_save(flags);
|
|
||||||
for (i = 0; i < ARRAY_SIZE(req_ctx); i++) {
|
|
||||||
if (req_ctx[i].state == old_state) {
|
|
||||||
toReturn = &req_ctx[i];
|
|
||||||
toReturn->state = new_state;
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
local_irq_restore(flags);
|
|
||||||
|
|
||||||
TRACE_DEBUG("%s(%u, %u, %u)=%p\r\n", __func__, large, old_state,
|
|
||||||
new_state, toReturn);
|
|
||||||
|
|
||||||
return toReturn;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t req_ctx_num(struct req_ctx *ctx)
|
|
||||||
{
|
|
||||||
return ctx - req_ctx;
|
|
||||||
}
|
|
||||||
|
|
||||||
void req_ctx_set_state(struct req_ctx *ctx, uint32_t new_state)
|
|
||||||
{
|
|
||||||
unsigned long flags;
|
|
||||||
|
|
||||||
TRACE_DEBUG("%s(ctx=%p, new_state=%u)\r\n", __func__, ctx, new_state);
|
|
||||||
|
|
||||||
if (new_state >= RCTX_STATE_COUNT) {
|
|
||||||
TRACE_DEBUG("Invalid new_state for req_ctx_set_state\r\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
local_irq_save(flags);
|
|
||||||
ctx->state = new_state;
|
|
||||||
local_irq_restore(flags);
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef DEBUG_REQCTX
|
|
||||||
void req_print(int state) {
|
|
||||||
int count = 0;
|
|
||||||
struct req_ctx *ctx, *last = NULL;
|
|
||||||
DEBUGP("State [%02i] start <==> ", state);
|
|
||||||
ctx = req_ctx_queues[state];
|
|
||||||
while (ctx) {
|
|
||||||
if (last != ctx->prev)
|
|
||||||
DEBUGP("*INV_PREV* ");
|
|
||||||
DEBUGP("%08X => ", ctx);
|
|
||||||
last = ctx;
|
|
||||||
ctx = ctx->next;
|
|
||||||
count++;
|
|
||||||
if (count > NUM_REQ_CTX) {
|
|
||||||
DEBUGP("*WILD POINTER* => ");
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
TRACE_DEBUG("NULL");
|
|
||||||
if (!req_ctx_queues[state] && req_ctx_tails[state]) {
|
|
||||||
TRACE_DEBUG("NULL head, NON-NULL tail\r\n");
|
|
||||||
}
|
|
||||||
if (last != req_ctx_tails[state]) {
|
|
||||||
TRACE_DEBUG("Tail does not match last element\r\n");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
#endif
|
|
||||||
|
|
||||||
void req_ctx_put(struct req_ctx *ctx)
|
|
||||||
{
|
|
||||||
return req_ctx_set_state(ctx, RCTX_S_FREE);
|
|
||||||
}
|
|
||||||
|
|
||||||
void req_ctx_init(void)
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
for (i = 0; i < NUM_RCTX_SMALL; i++) {
|
|
||||||
req_ctx[i].size = RCTX_SIZE_SMALL;
|
|
||||||
req_ctx[i].tot_len = 0;
|
|
||||||
req_ctx[i].data = rctx_data[i];
|
|
||||||
req_ctx[i].state = RCTX_S_FREE;
|
|
||||||
TRACE_DEBUG("SMALL req_ctx[%02i] initialized at %p, Data: %p => %p\r\n",
|
|
||||||
i, req_ctx + i, req_ctx[i].data, req_ctx[i].data + RCTX_SIZE_SMALL);
|
|
||||||
}
|
|
||||||
|
|
||||||
for (; i < NUM_REQ_CTX; i++) {
|
|
||||||
req_ctx[i].size = RCTX_SIZE_LARGE;
|
|
||||||
req_ctx[i].tot_len = 0;
|
|
||||||
req_ctx[i].data = rctx_data_large[i];
|
|
||||||
req_ctx[i].state = RCTX_S_FREE;
|
|
||||||
TRACE_DEBUG("LARGE req_ctx[%02i] initialized at %p, Data: %p => %p\r\n",
|
|
||||||
i, req_ctx + i, req_ctx[i].data, req_ctx[i].data + RCTX_SIZE_LARGE);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
@@ -1,70 +0,0 @@
|
|||||||
#include "ringbuffer.h"
|
|
||||||
#include "trace.h"
|
|
||||||
#include "utils.h"
|
|
||||||
|
|
||||||
void rbuf_reset(volatile ringbuf * rb)
|
|
||||||
{
|
|
||||||
unsigned long state;
|
|
||||||
|
|
||||||
local_irq_save(state);
|
|
||||||
rb->ird = 0;
|
|
||||||
rb->iwr = 0;
|
|
||||||
local_irq_restore(state);
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t rbuf_read(volatile ringbuf * rb)
|
|
||||||
{
|
|
||||||
unsigned long state;
|
|
||||||
uint8_t val;
|
|
||||||
|
|
||||||
local_irq_save(state);
|
|
||||||
val = rb->buf[rb->ird];
|
|
||||||
rb->ird = (rb->ird + 1) % RING_BUFLEN;
|
|
||||||
local_irq_restore(state);
|
|
||||||
|
|
||||||
return val;
|
|
||||||
}
|
|
||||||
|
|
||||||
uint8_t rbuf_peek(volatile ringbuf * rb)
|
|
||||||
{
|
|
||||||
return rb->buf[rb->ird];
|
|
||||||
}
|
|
||||||
|
|
||||||
bool rbuf_is_empty(volatile ringbuf * rb)
|
|
||||||
{
|
|
||||||
return rb->ird == rb->iwr;
|
|
||||||
}
|
|
||||||
|
|
||||||
static bool __rbuf_is_full(volatile ringbuf * rb)
|
|
||||||
{
|
|
||||||
return rb->ird == (rb->iwr + 1) % RING_BUFLEN;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool rbuf_is_full(volatile ringbuf * rb)
|
|
||||||
{
|
|
||||||
unsigned long state;
|
|
||||||
bool rc;
|
|
||||||
|
|
||||||
local_irq_save(state);
|
|
||||||
rc = rb->ird == (rb->iwr + 1) % RING_BUFLEN;
|
|
||||||
local_irq_restore(state);
|
|
||||||
|
|
||||||
return rc;
|
|
||||||
}
|
|
||||||
|
|
||||||
void rbuf_write(volatile volatile ringbuf * rb, uint8_t item)
|
|
||||||
{
|
|
||||||
unsigned long state;
|
|
||||||
|
|
||||||
local_irq_save(state);
|
|
||||||
if (!__rbuf_is_full(rb)) {
|
|
||||||
rb->buf[rb->iwr] = item;
|
|
||||||
rb->iwr = (rb->iwr + 1) % RING_BUFLEN;
|
|
||||||
local_irq_restore(state);
|
|
||||||
} else {
|
|
||||||
local_irq_restore(state);
|
|
||||||
TRACE_ERROR("Ringbuffer full, losing bytes!");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
@@ -1,512 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2008, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// \unit
|
|
||||||
///
|
|
||||||
/// !Purpose
|
|
||||||
///
|
|
||||||
/// Implementation of several stdio.h methods, such as printf(), sprintf() and
|
|
||||||
/// so on. This reduces the memory footprint of the binary when using those
|
|
||||||
/// methods, compared to the libc implementation.
|
|
||||||
///
|
|
||||||
/// !Usage
|
|
||||||
///
|
|
||||||
/// Adds stdio.c to the list of file to compile for the project. This will
|
|
||||||
/// automatically replace libc methods by the custom ones.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Headers
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
#include <stdio.h>
|
|
||||||
#include <stdarg.h>
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Local Definitions
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
// Maximum string size allowed (in bytes).
|
|
||||||
#define MAX_STRING_SIZE 512
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Global Variables
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
//
|
|
||||||
FILE* const stdin = NULL;
|
|
||||||
FILE* const stdout = NULL;
|
|
||||||
FILE* const stderr = NULL;
|
|
||||||
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Local Functions
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Writes a character inside the given string. Returns 1.
|
|
||||||
// \param pStr Storage string.
|
|
||||||
// \param c Character to write.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int PutChar(char *pStr, char c)
|
|
||||||
{
|
|
||||||
*pStr = c;
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Writes a string inside the given string.
|
|
||||||
// Returns the size of the written
|
|
||||||
// string.
|
|
||||||
// \param pStr Storage string.
|
|
||||||
// \param pSource Source string.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int PutString(char *pStr, const char *pSource)
|
|
||||||
{
|
|
||||||
signed int num = 0;
|
|
||||||
|
|
||||||
while (*pSource != 0) {
|
|
||||||
|
|
||||||
*pStr++ = *pSource++;
|
|
||||||
num++;
|
|
||||||
}
|
|
||||||
|
|
||||||
return num;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Writes an unsigned int inside the given string, using the provided fill &
|
|
||||||
// width parameters.
|
|
||||||
// Returns the size in characters of the written integer.
|
|
||||||
// \param pStr Storage string.
|
|
||||||
// \param fill Fill character.
|
|
||||||
// \param width Minimum integer width.
|
|
||||||
// \param value Integer value.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int PutUnsignedInt(
|
|
||||||
char *pStr,
|
|
||||||
char fill,
|
|
||||||
signed int width,
|
|
||||||
unsigned int value)
|
|
||||||
{
|
|
||||||
signed int num = 0;
|
|
||||||
|
|
||||||
// Take current digit into account when calculating width
|
|
||||||
width--;
|
|
||||||
|
|
||||||
// Recursively write upper digits
|
|
||||||
if ((value / 10) > 0) {
|
|
||||||
|
|
||||||
num = PutUnsignedInt(pStr, fill, width, value / 10);
|
|
||||||
pStr += num;
|
|
||||||
}
|
|
||||||
// Write filler characters
|
|
||||||
else {
|
|
||||||
|
|
||||||
while (width > 0) {
|
|
||||||
|
|
||||||
PutChar(pStr, fill);
|
|
||||||
pStr++;
|
|
||||||
num++;
|
|
||||||
width--;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Write lower digit
|
|
||||||
num += PutChar(pStr, (value % 10) + '0');
|
|
||||||
|
|
||||||
return num;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Writes a signed int inside the given string, using the provided fill & width
|
|
||||||
// parameters.
|
|
||||||
// Returns the size of the written integer.
|
|
||||||
// \param pStr Storage string.
|
|
||||||
// \param fill Fill character.
|
|
||||||
// \param width Minimum integer width.
|
|
||||||
// \param value Signed integer value.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int PutSignedInt(
|
|
||||||
char *pStr,
|
|
||||||
char fill,
|
|
||||||
signed int width,
|
|
||||||
signed int value)
|
|
||||||
{
|
|
||||||
signed int num = 0;
|
|
||||||
unsigned int absolute;
|
|
||||||
|
|
||||||
// Compute absolute value
|
|
||||||
if (value < 0) {
|
|
||||||
|
|
||||||
absolute = -value;
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
|
|
||||||
absolute = value;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Take current digit into account when calculating width
|
|
||||||
width--;
|
|
||||||
|
|
||||||
// Recursively write upper digits
|
|
||||||
if ((absolute / 10) > 0) {
|
|
||||||
|
|
||||||
if (value < 0) {
|
|
||||||
|
|
||||||
num = PutSignedInt(pStr, fill, width, -(absolute / 10));
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
|
|
||||||
num = PutSignedInt(pStr, fill, width, absolute / 10);
|
|
||||||
}
|
|
||||||
pStr += num;
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
|
|
||||||
// Reserve space for sign
|
|
||||||
if (value < 0) {
|
|
||||||
|
|
||||||
width--;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Write filler characters
|
|
||||||
while (width > 0) {
|
|
||||||
|
|
||||||
PutChar(pStr, fill);
|
|
||||||
pStr++;
|
|
||||||
num++;
|
|
||||||
width--;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Write sign
|
|
||||||
if (value < 0) {
|
|
||||||
|
|
||||||
num += PutChar(pStr, '-');
|
|
||||||
pStr++;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Write lower digit
|
|
||||||
num += PutChar(pStr, (absolute % 10) + '0');
|
|
||||||
|
|
||||||
return num;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Writes an hexadecimal value into a string, using the given fill, width &
|
|
||||||
// capital parameters.
|
|
||||||
// Returns the number of char written.
|
|
||||||
// \param pStr Storage string.
|
|
||||||
// \param fill Fill character.
|
|
||||||
// \param width Minimum integer width.
|
|
||||||
// \param maj Indicates if the letters must be printed in lower- or upper-case.
|
|
||||||
// \param value Hexadecimal value.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int PutHexa(
|
|
||||||
char *pStr,
|
|
||||||
char fill,
|
|
||||||
signed int width,
|
|
||||||
unsigned char maj,
|
|
||||||
unsigned int value)
|
|
||||||
{
|
|
||||||
signed int num = 0;
|
|
||||||
|
|
||||||
// Decrement width
|
|
||||||
width--;
|
|
||||||
|
|
||||||
// Recursively output upper digits
|
|
||||||
if ((value >> 4) > 0) {
|
|
||||||
|
|
||||||
num += PutHexa(pStr, fill, width, maj, value >> 4);
|
|
||||||
pStr += num;
|
|
||||||
}
|
|
||||||
// Write filler chars
|
|
||||||
else {
|
|
||||||
|
|
||||||
while (width > 0) {
|
|
||||||
|
|
||||||
PutChar(pStr, fill);
|
|
||||||
pStr++;
|
|
||||||
num++;
|
|
||||||
width--;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Write current digit
|
|
||||||
if ((value & 0xF) < 10) {
|
|
||||||
|
|
||||||
PutChar(pStr, (value & 0xF) + '0');
|
|
||||||
}
|
|
||||||
else if (maj) {
|
|
||||||
|
|
||||||
PutChar(pStr, (value & 0xF) - 10 + 'A');
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
|
|
||||||
PutChar(pStr, (value & 0xF) - 10 + 'a');
|
|
||||||
}
|
|
||||||
num++;
|
|
||||||
|
|
||||||
return num;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Global Functions
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Stores the result of a formatted string into another string. Format
|
|
||||||
/// arguments are given in a va_list instance.
|
|
||||||
/// Return the number of characters written.
|
|
||||||
/// \param pStr Destination string.
|
|
||||||
/// \param length Length of Destination string.
|
|
||||||
/// \param pFormat Format string.
|
|
||||||
/// \param ap Argument list.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int vsnprintf(char *pStr, size_t length, const char *pFormat, va_list ap)
|
|
||||||
{
|
|
||||||
char fill;
|
|
||||||
unsigned char width;
|
|
||||||
signed int num = 0;
|
|
||||||
size_t size = 0;
|
|
||||||
|
|
||||||
// Clear the string
|
|
||||||
if (pStr) {
|
|
||||||
|
|
||||||
*pStr = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Phase string
|
|
||||||
while (*pFormat != 0 && size < length) {
|
|
||||||
|
|
||||||
// Normal character
|
|
||||||
if (*pFormat != '%') {
|
|
||||||
|
|
||||||
*pStr++ = *pFormat++;
|
|
||||||
size++;
|
|
||||||
}
|
|
||||||
// Escaped '%'
|
|
||||||
else if (*(pFormat+1) == '%') {
|
|
||||||
|
|
||||||
*pStr++ = '%';
|
|
||||||
pFormat += 2;
|
|
||||||
size++;
|
|
||||||
}
|
|
||||||
// Token delimiter
|
|
||||||
else {
|
|
||||||
|
|
||||||
fill = ' ';
|
|
||||||
width = 0;
|
|
||||||
pFormat++;
|
|
||||||
|
|
||||||
// Parse filler
|
|
||||||
if (*pFormat == '0') {
|
|
||||||
|
|
||||||
fill = '0';
|
|
||||||
pFormat++;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Parse width
|
|
||||||
while ((*pFormat >= '0') && (*pFormat <= '9')) {
|
|
||||||
|
|
||||||
width = (width*10) + *pFormat-'0';
|
|
||||||
pFormat++;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Check if there is enough space
|
|
||||||
if (size + width > length) {
|
|
||||||
|
|
||||||
width = length - size;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Parse type
|
|
||||||
switch (*pFormat) {
|
|
||||||
case 'd':
|
|
||||||
case 'i': num = PutSignedInt(pStr, fill, width, va_arg(ap, signed int)); break;
|
|
||||||
case 'u': num = PutUnsignedInt(pStr, fill, width, va_arg(ap, unsigned int)); break;
|
|
||||||
case 'x': num = PutHexa(pStr, fill, width, 0, va_arg(ap, unsigned int)); break;
|
|
||||||
case 'X': num = PutHexa(pStr, fill, width, 1, va_arg(ap, unsigned int)); break;
|
|
||||||
case 's': num = PutString(pStr, va_arg(ap, char *)); break;
|
|
||||||
case 'c': num = PutChar(pStr, va_arg(ap, unsigned int)); break;
|
|
||||||
default:
|
|
||||||
return EOF;
|
|
||||||
}
|
|
||||||
|
|
||||||
pFormat++;
|
|
||||||
pStr += num;
|
|
||||||
size += num;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// NULL-terminated (final \0 is not counted)
|
|
||||||
if (size < length) {
|
|
||||||
|
|
||||||
*pStr = 0;
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
|
|
||||||
*(--pStr) = 0;
|
|
||||||
size--;
|
|
||||||
}
|
|
||||||
|
|
||||||
return size;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Stores the result of a formatted string into another string. Format
|
|
||||||
/// arguments are given in a va_list instance.
|
|
||||||
/// Return the number of characters written.
|
|
||||||
/// \param pString Destination string.
|
|
||||||
/// \param length Length of Destination string.
|
|
||||||
/// \param pFormat Format string.
|
|
||||||
/// \param ... Other arguments
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int snprintf(char *pString, size_t length, const char *pFormat, ...)
|
|
||||||
{
|
|
||||||
va_list ap;
|
|
||||||
signed int rc;
|
|
||||||
|
|
||||||
va_start(ap, pFormat);
|
|
||||||
rc = vsnprintf(pString, length, pFormat, ap);
|
|
||||||
va_end(ap);
|
|
||||||
|
|
||||||
return rc;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Stores the result of a formatted string into another string. Format
|
|
||||||
/// arguments are given in a va_list instance.
|
|
||||||
/// Return the number of characters written.
|
|
||||||
/// \param pString Destination string.
|
|
||||||
/// \param pFormat Format string.
|
|
||||||
/// \param ap Argument list.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int vsprintf(char *pString, const char *pFormat, va_list ap)
|
|
||||||
{
|
|
||||||
return vsnprintf(pString, MAX_STRING_SIZE, pFormat, ap);
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Outputs a formatted string on the given stream. Format arguments are given
|
|
||||||
/// in a va_list instance.
|
|
||||||
/// \param pStream Output stream.
|
|
||||||
/// \param pFormat Format string
|
|
||||||
/// \param ap Argument list.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int vfprintf(FILE *pStream, const char *pFormat, va_list ap)
|
|
||||||
{
|
|
||||||
char pStr[MAX_STRING_SIZE];
|
|
||||||
char pError[] = "stdio.c: increase MAX_STRING_SIZE\n\r";
|
|
||||||
|
|
||||||
// Write formatted string in buffer
|
|
||||||
if (vsprintf(pStr, pFormat, ap) >= MAX_STRING_SIZE) {
|
|
||||||
|
|
||||||
fputs(pError, stderr);
|
|
||||||
}
|
|
||||||
|
|
||||||
// Display string
|
|
||||||
return fputs(pStr, pStream);
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Outputs a formatted string on the DBGU stream. Format arguments are given
|
|
||||||
/// in a va_list instance.
|
|
||||||
/// \param pFormat Format string
|
|
||||||
/// \param ap Argument list.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int vprintf(const char *pFormat, va_list ap)
|
|
||||||
{
|
|
||||||
return vfprintf(stdout, pFormat, ap);
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Outputs a formatted string on the given stream, using a variable number of
|
|
||||||
/// arguments.
|
|
||||||
/// \param pStream Output stream.
|
|
||||||
/// \param pFormat Format string.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int fprintf(FILE *pStream, const char *pFormat, ...)
|
|
||||||
{
|
|
||||||
va_list ap;
|
|
||||||
signed int result;
|
|
||||||
|
|
||||||
// Forward call to vfprintf
|
|
||||||
va_start(ap, pFormat);
|
|
||||||
result = vfprintf(pStream, pFormat, ap);
|
|
||||||
va_end(ap);
|
|
||||||
|
|
||||||
return result;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Outputs a formatted string on the DBGU stream, using a variable number of
|
|
||||||
/// arguments.
|
|
||||||
/// \param pFormat Format string.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int printf(const char *pFormat, ...)
|
|
||||||
{
|
|
||||||
va_list ap;
|
|
||||||
signed int result;
|
|
||||||
|
|
||||||
// Forward call to vprintf
|
|
||||||
va_start(ap, pFormat);
|
|
||||||
result = vprintf(pFormat, ap);
|
|
||||||
va_end(ap);
|
|
||||||
|
|
||||||
return result;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Writes a formatted string inside another string.
|
|
||||||
/// \param pStr Storage string.
|
|
||||||
/// \param pFormat Format string.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int sprintf(char *pStr, const char *pFormat, ...)
|
|
||||||
{
|
|
||||||
va_list ap;
|
|
||||||
signed int result;
|
|
||||||
|
|
||||||
// Forward call to vsprintf
|
|
||||||
va_start(ap, pFormat);
|
|
||||||
result = vsprintf(pStr, pFormat, ap);
|
|
||||||
va_end(ap);
|
|
||||||
|
|
||||||
return result;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Outputs a string on stdout.
|
|
||||||
/// \param pStr String to output.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
signed int puts(const char *pStr)
|
|
||||||
{
|
|
||||||
return fputs(pStr, stdout);
|
|
||||||
}
|
|
||||||
|
|
||||||
@@ -1,239 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2008, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// \unit
|
|
||||||
///
|
|
||||||
/// !Purpose
|
|
||||||
///
|
|
||||||
/// Implementation of several methods defined in string.h, for reducing the
|
|
||||||
/// memory footprint when using them (since the whole libc.o file gets included
|
|
||||||
/// even when using a single method).
|
|
||||||
///
|
|
||||||
/// !Usage
|
|
||||||
///
|
|
||||||
/// Add string.c to the list of files to compile for the project. This will
|
|
||||||
/// automatically replace standard libc methods by the custom ones.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Headers
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
#include <string.h>
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
// Global Functions
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Copies data from a source buffer into a destination buffer. The two buffers
|
|
||||||
/// must NOT overlap. Returns the destination buffer.
|
|
||||||
/// \param pDestination Destination buffer.
|
|
||||||
/// \param pSource Source buffer.
|
|
||||||
/// \param num Number of bytes to copy.
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
void * memcpy(void *pDestination, const void *pSource, size_t num)
|
|
||||||
{
|
|
||||||
unsigned char *pByteDestination;
|
|
||||||
unsigned char *pByteSource;
|
|
||||||
unsigned int *pAlignedSource = (unsigned int *) pSource;
|
|
||||||
unsigned int *pAlignedDestination = (unsigned int *) pDestination;
|
|
||||||
|
|
||||||
// If num is more than 4 bytes, and both dest. and source are aligned,
|
|
||||||
// then copy dwords
|
|
||||||
if ((((unsigned int) pAlignedDestination & 0x3) == 0)
|
|
||||||
&& (((unsigned int) pAlignedSource & 0x3) == 0)
|
|
||||||
&& (num >= 4)) {
|
|
||||||
|
|
||||||
while (num >= 4) {
|
|
||||||
|
|
||||||
*pAlignedDestination++ = *pAlignedSource++;
|
|
||||||
num -= 4;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Copy remaining bytes
|
|
||||||
pByteDestination = (unsigned char *) pAlignedDestination;
|
|
||||||
pByteSource = (unsigned char *) pAlignedSource;
|
|
||||||
while (num--) {
|
|
||||||
|
|
||||||
*pByteDestination++ = *pByteSource++;
|
|
||||||
}
|
|
||||||
|
|
||||||
return pDestination;
|
|
||||||
}
|
|
||||||
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
/// Fills a memory region with the given value. Returns a pointer to the
|
|
||||||
/// memory region.
|
|
||||||
/// \param pBuffer Pointer to the start of the memory region to fill
|
|
||||||
/// \param value Value to fill the region with
|
|
||||||
/// \param num Size to fill in bytes
|
|
||||||
//------------------------------------------------------------------------------
|
|
||||||
void * memset(void *pBuffer, int value, size_t num)
|
|
||||||
{
|
|
||||||
unsigned char *pByteDestination;
|
|
||||||
unsigned int *pAlignedDestination = (unsigned int *) pBuffer;
|
|
||||||
unsigned int alignedValue = (value << 24) | (value << 16) | (value << 8) | value;
|
|
||||||
|
|
||||||
// Set words if possible
|
|
||||||
if ((((unsigned int) pAlignedDestination & 0x3) == 0) && (num >= 4)) {
|
|
||||||
while (num >= 4) {
|
|
||||||
*pAlignedDestination++ = alignedValue;
|
|
||||||
num -= 4;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
// Set remaining bytes
|
|
||||||
pByteDestination = (unsigned char *) pAlignedDestination;
|
|
||||||
while (num--) {
|
|
||||||
*pByteDestination++ = value;
|
|
||||||
}
|
|
||||||
return pBuffer;
|
|
||||||
}
|
|
||||||
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
/// Search a character in the given string.
|
|
||||||
/// Returns a pointer to the character location.
|
|
||||||
/// \param pString Pointer to the start of the string to search.
|
|
||||||
/// \param character The character to find.
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
char * strchr(const char *pString, int character)
|
|
||||||
{
|
|
||||||
char * p = (char *)pString;
|
|
||||||
char c = character & 0xFF;
|
|
||||||
|
|
||||||
while(*p != c) {
|
|
||||||
if (*p == 0) {
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
p++;
|
|
||||||
}
|
|
||||||
return p;
|
|
||||||
}
|
|
||||||
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
/// Return the length of a given string
|
|
||||||
/// \param pString Pointer to the start of the string.
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
size_t strlen(const char *pString)
|
|
||||||
{
|
|
||||||
unsigned int length = 0;
|
|
||||||
|
|
||||||
while(*pString++ != 0) {
|
|
||||||
length++;
|
|
||||||
}
|
|
||||||
return length;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
/// Search a character backword from the end of given string.
|
|
||||||
/// Returns a pointer to the character location.
|
|
||||||
/// \param pString Pointer to the start of the string to search.
|
|
||||||
/// \param character The character to find.
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
char * strrchr(const char *pString, int character)
|
|
||||||
{
|
|
||||||
char *p = 0;
|
|
||||||
|
|
||||||
while(*pString != 0) {
|
|
||||||
if (*pString++ == character) {
|
|
||||||
p = (char*)pString;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
return p;
|
|
||||||
}
|
|
||||||
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
/// Copy from source string to destination string
|
|
||||||
/// Return a pointer to the destination string
|
|
||||||
/// \param pDestination Pointer to the destination string.
|
|
||||||
/// \param pSource Pointer to the source string.
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
char * strcpy(char *pDestination, const char *pSource)
|
|
||||||
{
|
|
||||||
char *pSaveDest = pDestination;
|
|
||||||
|
|
||||||
for(; (*pDestination = *pSource) != 0; ++pSource, ++pDestination);
|
|
||||||
return pSaveDest;
|
|
||||||
}
|
|
||||||
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
/// Compare the first specified bytes of 2 given strings
|
|
||||||
/// Return 0 if equals
|
|
||||||
/// Return >0 if 1st string > 2nd string
|
|
||||||
/// Return <0 if 1st string < 2nd string
|
|
||||||
/// \param pString1 Pointer to the start of the 1st string.
|
|
||||||
/// \param pString2 Pointer to the start of the 2nd string.
|
|
||||||
/// \param count Number of bytes that should be compared.
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
int strncmp(const char *pString1, const char *pString2, size_t count)
|
|
||||||
{
|
|
||||||
int r;
|
|
||||||
|
|
||||||
while(count) {
|
|
||||||
r = *pString1 - *pString2;
|
|
||||||
if (r == 0) {
|
|
||||||
if (*pString1 == 0) {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
pString1++;
|
|
||||||
pString2++;
|
|
||||||
count--;
|
|
||||||
continue;
|
|
||||||
}
|
|
||||||
return r;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
/// Copy the first number of bytes from source string to destination string
|
|
||||||
/// Return the pointer to the destination string.
|
|
||||||
/// \param pDestination Pointer to the start of destination string.
|
|
||||||
/// \param pSource Pointer to the start of the source string.
|
|
||||||
/// \param count Number of bytes that should be copied.
|
|
||||||
//-----------------------------------------------------------------------------
|
|
||||||
char * strncpy(char *pDestination, const char *pSource, size_t count)
|
|
||||||
{
|
|
||||||
char *pSaveDest = pDestination;
|
|
||||||
|
|
||||||
while (count) {
|
|
||||||
*pDestination = *pSource;
|
|
||||||
if (*pSource == 0) {
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
pDestination++;
|
|
||||||
pSource++;
|
|
||||||
count--;
|
|
||||||
}
|
|
||||||
return pSaveDest;
|
|
||||||
}
|
|
||||||
|
|
||||||
@@ -1,210 +0,0 @@
|
|||||||
/* SIMtrace TC (Timer / Clock) code for ETU tracking */
|
|
||||||
|
|
||||||
/* (C) 2006-2016 by Harald Welte <hwelte@hmw-consulting.de>
|
|
||||||
*
|
|
||||||
* 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
||||||
*
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <stdint.h>
|
|
||||||
|
|
||||||
#include "utils.h"
|
|
||||||
#include "tc_etu.h"
|
|
||||||
|
|
||||||
#include "chip.h"
|
|
||||||
|
|
||||||
/* pins for Channel 0 of TC-block 0 */
|
|
||||||
#define PIN_TCLK0 {PIO_PA4, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT }
|
|
||||||
#define PIN_TIOA0 {PIO_PA0, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_TIOB0 {PIO_PA1, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
static const Pin pins_tc0[] = { PIN_TCLK0, PIN_TIOA0, PIN_TIOB0 };
|
|
||||||
|
|
||||||
/* pins for Channel 2 of TC-block 0 */
|
|
||||||
#define PIN_TCLK2 {PIO_PA29, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_TIOA2 {PIO_PA26, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
#define PIN_TIOB2 {PIO_PA27, PIOA, ID_PIOA, PIO_PERIPH_B, PIO_DEFAULT}
|
|
||||||
static const Pin pins_tc2[] = { PIN_TCLK2, PIN_TIOA2, PIN_TIOB2 };
|
|
||||||
|
|
||||||
struct tc_etu_state {
|
|
||||||
/* total negotiated waiting time (default = 9600) */
|
|
||||||
uint16_t waiting_time;
|
|
||||||
/* how many clock cycles per ETU (default = 372) */
|
|
||||||
uint16_t clocks_per_etu;
|
|
||||||
/* how many ETUs does waiting time correspond ? */
|
|
||||||
uint16_t wait_events;
|
|
||||||
/* how many ETUs have we seen expire so far? */
|
|
||||||
uint16_t nr_events;
|
|
||||||
/* channel number */
|
|
||||||
uint8_t chan_nr;
|
|
||||||
/* Timer/Counter register pointer */
|
|
||||||
TcChannel *chan;
|
|
||||||
/* User reference */
|
|
||||||
void *handle;
|
|
||||||
};
|
|
||||||
|
|
||||||
#define INIT_TE_STATE(n) { \
|
|
||||||
.waiting_time = 9600, \
|
|
||||||
.clocks_per_etu = 372, \
|
|
||||||
.wait_events = 10, \
|
|
||||||
.nr_events = 0, \
|
|
||||||
.chan_nr = n, \
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct tc_etu_state te_state0 = INIT_TE_STATE(0);
|
|
||||||
static struct tc_etu_state te_state2 = INIT_TE_STATE(2);
|
|
||||||
|
|
||||||
static struct tc_etu_state *get_te(uint8_t chan_nr)
|
|
||||||
{
|
|
||||||
if (chan_nr == 0)
|
|
||||||
return &te_state0;
|
|
||||||
else
|
|
||||||
return &te_state2;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void tc_etu_irq(struct tc_etu_state *te)
|
|
||||||
{
|
|
||||||
uint32_t sr = te->chan->TC_SR;
|
|
||||||
|
|
||||||
if (sr & TC_SR_ETRGS) {
|
|
||||||
/* external trigger, i.e. we have seen a bit on I/O */
|
|
||||||
te->nr_events = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (sr & TC_SR_CPCS) {
|
|
||||||
/* Compare C event has occurred, i.e. 1 ETU expired */
|
|
||||||
te->nr_events++;
|
|
||||||
if (te->nr_events == te->wait_events/2) {
|
|
||||||
/* Indicate that half the waiting tim has expired */
|
|
||||||
tc_etu_wtime_half_expired(te->handle);
|
|
||||||
}
|
|
||||||
if (te->nr_events >= te->wait_events) {
|
|
||||||
TcChannel *chan = te->chan;
|
|
||||||
chan->TC_CMR |= TC_CMR_ENETRG;
|
|
||||||
|
|
||||||
/* disable and re-enable clock to make it stop */
|
|
||||||
chan->TC_CCR = TC_CCR_CLKDIS;
|
|
||||||
chan->TC_CCR = TC_CCR_CLKEN;
|
|
||||||
|
|
||||||
/* Indicate that the waiting tim has expired */
|
|
||||||
tc_etu_wtime_expired(te->handle);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void TC0_IrqHandler(void)
|
|
||||||
{
|
|
||||||
tc_etu_irq(&te_state0);
|
|
||||||
}
|
|
||||||
|
|
||||||
void TC2_IrqHandler(void)
|
|
||||||
{
|
|
||||||
tc_etu_irq(&te_state2);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void recalc_nr_events(struct tc_etu_state *te)
|
|
||||||
{
|
|
||||||
te->wait_events = te->waiting_time / 12;
|
|
||||||
te->chan->TC_RC = te->clocks_per_etu * 12;
|
|
||||||
}
|
|
||||||
|
|
||||||
void tc_etu_set_wtime(uint8_t chan_nr, uint16_t wtime)
|
|
||||||
{
|
|
||||||
struct tc_etu_state *te = get_te(chan_nr);
|
|
||||||
te->waiting_time = wtime;
|
|
||||||
recalc_nr_events(te);
|
|
||||||
}
|
|
||||||
|
|
||||||
void tc_etu_set_etu(uint8_t chan_nr, uint16_t etu)
|
|
||||||
{
|
|
||||||
struct tc_etu_state *te = get_te(chan_nr);
|
|
||||||
te->clocks_per_etu = etu;
|
|
||||||
recalc_nr_events(te);
|
|
||||||
}
|
|
||||||
|
|
||||||
void tc_etu_enable(uint8_t chan_nr)
|
|
||||||
{
|
|
||||||
struct tc_etu_state *te = get_te(chan_nr);
|
|
||||||
|
|
||||||
te->nr_events = 0;
|
|
||||||
te->chan->TC_CCR = TC_CCR_CLKEN|TC_CCR_SWTRG;
|
|
||||||
}
|
|
||||||
|
|
||||||
void tc_etu_disable(uint8_t chan_nr)
|
|
||||||
{
|
|
||||||
struct tc_etu_state *te = get_te(chan_nr);
|
|
||||||
|
|
||||||
te->nr_events = 0;
|
|
||||||
te->chan->TC_CCR = TC_CCR_CLKDIS;
|
|
||||||
}
|
|
||||||
|
|
||||||
void tc_etu_init(uint8_t chan_nr, void *handle)
|
|
||||||
{
|
|
||||||
struct tc_etu_state *te = get_te(chan_nr);
|
|
||||||
uint32_t tc_clks;
|
|
||||||
|
|
||||||
te->handle = handle;
|
|
||||||
|
|
||||||
switch (chan_nr) {
|
|
||||||
case 0:
|
|
||||||
/* Configure PA4(TCLK0), PA0(TIOA0), PA1(TIB0) */
|
|
||||||
PIO_Configure(pins_tc0, ARRAY_SIZE(pins_tc0));
|
|
||||||
PMC_EnablePeripheral(ID_TC0);
|
|
||||||
/* route TCLK0 to XC2 */
|
|
||||||
TC0->TC_BMR &= ~TC_BMR_TC0XC0S_Msk;
|
|
||||||
TC0->TC_BMR |= TC_BMR_TC0XC0S_TCLK0;
|
|
||||||
tc_clks = TC_CMR_TCCLKS_XC0;
|
|
||||||
/* register interrupt handler */
|
|
||||||
NVIC_EnableIRQ(TC0_IRQn);
|
|
||||||
|
|
||||||
te->chan = &TC0->TC_CHANNEL[0];
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
/* Configure PA29(TCLK2), PA26(TIOA2), PA27(TIOB2) */
|
|
||||||
PIO_Configure(pins_tc2, ARRAY_SIZE(pins_tc2));
|
|
||||||
PMC_EnablePeripheral(ID_TC2);
|
|
||||||
/* route TCLK2 to XC2. TC0 really means TCA in this case */
|
|
||||||
TC0->TC_BMR &= ~TC_BMR_TC2XC2S_Msk;
|
|
||||||
TC0->TC_BMR |= TC_BMR_TC2XC2S_TCLK2;
|
|
||||||
tc_clks = TC_CMR_TCCLKS_XC2;
|
|
||||||
/* register interrupt handler */
|
|
||||||
NVIC_EnableIRQ(TC2_IRQn);
|
|
||||||
|
|
||||||
te->chan = &TC0->TC_CHANNEL[2];
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* enable interrupts for Compare-C and external trigger */
|
|
||||||
te->chan->TC_IER = TC_IER_CPCS | TC_IER_ETRGS;
|
|
||||||
|
|
||||||
te->chan->TC_CMR = tc_clks | /* XC(TCLK) clock */
|
|
||||||
TC_CMR_WAVE | /* wave mode */
|
|
||||||
TC_CMR_ETRGEDG_FALLING | /* ext trig on falling edge */
|
|
||||||
TC_CMR_EEVT_TIOB | /* ext trig is TIOB0 */
|
|
||||||
TC_CMR_ENETRG | /* enable ext trig */
|
|
||||||
TC_CMR_WAVSEL_UP_RC | /* wave mode up */
|
|
||||||
TC_CMR_ACPA_SET | /* set TIOA on a compare */
|
|
||||||
TC_CMR_ACPC_CLEAR | /* clear TIOA on C compare */
|
|
||||||
TC_CMR_ASWTRG_CLEAR; /* Clear TIOA on sw trig */
|
|
||||||
|
|
||||||
tc_etu_set_etu(chan_nr, 372);
|
|
||||||
|
|
||||||
/* start with a disabled clock */
|
|
||||||
tc_etu_disable(chan_nr);
|
|
||||||
|
|
||||||
/* Reset to start timers */
|
|
||||||
TC0->TC_BCR = TC_BCR_SYNC;
|
|
||||||
}
|
|
||||||
@@ -1,800 +0,0 @@
|
|||||||
/* ----------------------------------------------------------------------------
|
|
||||||
* ATMEL Microcontroller Software Support
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
* Copyright (c) 2009, Atmel Corporation
|
|
||||||
*
|
|
||||||
* All rights reserved.
|
|
||||||
*
|
|
||||||
* Redistribution and use in source and binary forms, with or without
|
|
||||||
* modification, are permitted provided that the following conditions are met:
|
|
||||||
*
|
|
||||||
* - Redistributions of source code must retain the above copyright notice,
|
|
||||||
* this list of conditions and the disclaimer below.
|
|
||||||
*
|
|
||||||
* Atmel's name may not be used to endorse or promote products derived from
|
|
||||||
* this software without specific prior written permission.
|
|
||||||
*
|
|
||||||
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
||||||
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
||||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
||||||
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
||||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
||||||
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
||||||
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
||||||
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
||||||
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
||||||
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
||||||
* ----------------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Headers
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
#include "board.h"
|
|
||||||
#include "simtrace.h"
|
|
||||||
#include "utils.h"
|
|
||||||
|
|
||||||
#include <cciddriverdescriptors.h>
|
|
||||||
#include <usb/common/dfu/usb_dfu.h>
|
|
||||||
#include <usb/device/dfu/dfu.h>
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* USB String descriptors
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
static const unsigned char langDesc[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(1),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_ENGLISH_US
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char manufStringDescriptor[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(24),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('s'),
|
|
||||||
USBStringDescriptor_UNICODE('y'),
|
|
||||||
USBStringDescriptor_UNICODE('s'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('o'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('o'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('-'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('s'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE('f'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('.'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('G'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('b'),
|
|
||||||
USBStringDescriptor_UNICODE('H'),
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char productStringDescriptor[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(10),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('2'),
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char snifferConfigStringDescriptor[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(16),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('n'),
|
|
||||||
USBStringDescriptor_UNICODE('i'),
|
|
||||||
USBStringDescriptor_UNICODE('f'),
|
|
||||||
USBStringDescriptor_UNICODE('f'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char CCIDConfigStringDescriptor[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(13),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('C'),
|
|
||||||
USBStringDescriptor_UNICODE('C'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('D'),
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char phoneConfigStringDescriptor[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(14),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('P'),
|
|
||||||
USBStringDescriptor_UNICODE('h'),
|
|
||||||
USBStringDescriptor_UNICODE('o'),
|
|
||||||
USBStringDescriptor_UNICODE('n'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char MITMConfigStringDescriptor[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(13),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('c'),
|
|
||||||
USBStringDescriptor_UNICODE('e'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('T'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char cardem_usim1_intf_str[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(18),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('C'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('d'),
|
|
||||||
USBStringDescriptor_UNICODE('E'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('u'),
|
|
||||||
USBStringDescriptor_UNICODE('l'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('o'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('U'),
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('1'),
|
|
||||||
};
|
|
||||||
|
|
||||||
const unsigned char cardem_usim2_intf_str[] = {
|
|
||||||
|
|
||||||
USBStringDescriptor_LENGTH(18),
|
|
||||||
USBGenericDescriptor_STRING,
|
|
||||||
USBStringDescriptor_UNICODE('C'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE('d'),
|
|
||||||
USBStringDescriptor_UNICODE('E'),
|
|
||||||
USBStringDescriptor_UNICODE('m'),
|
|
||||||
USBStringDescriptor_UNICODE('u'),
|
|
||||||
USBStringDescriptor_UNICODE('l'),
|
|
||||||
USBStringDescriptor_UNICODE('a'),
|
|
||||||
USBStringDescriptor_UNICODE('t'),
|
|
||||||
USBStringDescriptor_UNICODE('o'),
|
|
||||||
USBStringDescriptor_UNICODE('r'),
|
|
||||||
USBStringDescriptor_UNICODE(' '),
|
|
||||||
USBStringDescriptor_UNICODE('U'),
|
|
||||||
USBStringDescriptor_UNICODE('S'),
|
|
||||||
USBStringDescriptor_UNICODE('I'),
|
|
||||||
USBStringDescriptor_UNICODE('M'),
|
|
||||||
USBStringDescriptor_UNICODE('2'),
|
|
||||||
};
|
|
||||||
|
|
||||||
enum strDescNum {
|
|
||||||
PRODUCT_STRING = 1,
|
|
||||||
MANUF_STR,
|
|
||||||
SNIFFER_CONF_STR,
|
|
||||||
CCID_CONF_STR,
|
|
||||||
PHONE_CONF_STR,
|
|
||||||
MITM_CONF_STR,
|
|
||||||
CARDEM_USIM1_INTF_STR,
|
|
||||||
CARDEM_USIM2_INTF_STR,
|
|
||||||
STRING_DESC_CNT
|
|
||||||
};
|
|
||||||
|
|
||||||
/** List of string descriptors used by the device */
|
|
||||||
static const unsigned char *stringDescriptors[] = {
|
|
||||||
langDesc,
|
|
||||||
[PRODUCT_STRING] = productStringDescriptor,
|
|
||||||
[MANUF_STR] = manufStringDescriptor,
|
|
||||||
[SNIFFER_CONF_STR] = snifferConfigStringDescriptor,
|
|
||||||
[CCID_CONF_STR] = CCIDConfigStringDescriptor,
|
|
||||||
[PHONE_CONF_STR] = phoneConfigStringDescriptor,
|
|
||||||
[MITM_CONF_STR] = MITMConfigStringDescriptor,
|
|
||||||
[CARDEM_USIM1_INTF_STR] = cardem_usim1_intf_str,
|
|
||||||
[CARDEM_USIM2_INTF_STR] = cardem_usim2_intf_str,
|
|
||||||
};
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------------------
|
|
||||||
* USB Device descriptors
|
|
||||||
*------------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
#ifdef HAVE_SNIFFER
|
|
||||||
typedef struct _SIMTraceDriverConfigurationDescriptorSniffer {
|
|
||||||
|
|
||||||
/** Standard configuration descriptor. */
|
|
||||||
USBConfigurationDescriptor configuration;
|
|
||||||
USBInterfaceDescriptor sniffer;
|
|
||||||
USBEndpointDescriptor sniffer_dataOut;
|
|
||||||
USBEndpointDescriptor sniffer_dataIn;
|
|
||||||
USBEndpointDescriptor sniffer_interruptIn;
|
|
||||||
DFURT_IF_DESCRIPTOR_STRUCT;
|
|
||||||
} __attribute__ ((packed)) SIMTraceDriverConfigurationDescriptorSniffer;
|
|
||||||
|
|
||||||
static const SIMTraceDriverConfigurationDescriptorSniffer
|
|
||||||
configurationDescriptorSniffer = {
|
|
||||||
/* Standard configuration descriptor */
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBConfigurationDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_CONFIGURATION,
|
|
||||||
.wTotalLength = sizeof(SIMTraceDriverConfigurationDescriptorSniffer),
|
|
||||||
.bNumInterfaces = 1+DFURT_NUM_IF,
|
|
||||||
.bConfigurationValue = CFG_NUM_SNIFF,
|
|
||||||
.iConfiguration = SNIFFER_CONF_STR,
|
|
||||||
.bmAttributes = USBD_BMATTRIBUTES,
|
|
||||||
.bMaxPower = USBConfigurationDescriptor_POWER(100),
|
|
||||||
},
|
|
||||||
/* Communication class interface standard descriptor */
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBInterfaceDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_INTERFACE,
|
|
||||||
.bInterfaceNumber = 0,
|
|
||||||
.bAlternateSetting = 0,
|
|
||||||
.bNumEndpoints = 3,
|
|
||||||
.bInterfaceClass = 0xff,
|
|
||||||
.bInterfaceSubClass = 0,
|
|
||||||
.bInterfaceProtocol = 0,
|
|
||||||
.iInterface = SNIFFER_CONF_STR,
|
|
||||||
},
|
|
||||||
/* Bulk-OUT endpoint standard descriptor */
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress = USBEndpointDescriptor_ADDRESS(
|
|
||||||
USBEndpointDescriptor_OUT,
|
|
||||||
PHONE_DATAOUT),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_BULK,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
PHONE_DATAOUT),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
.bInterval = 0,
|
|
||||||
},
|
|
||||||
/* Bulk-IN endpoint descriptor */
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress = USBEndpointDescriptor_ADDRESS(
|
|
||||||
USBEndpointDescriptor_IN,
|
|
||||||
PHONE_DATAIN),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_BULK,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
PHONE_DATAIN),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
.bInterval = 0,
|
|
||||||
},
|
|
||||||
// Notification endpoint descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress = USBEndpointDescriptor_ADDRESS(
|
|
||||||
USBEndpointDescriptor_IN,
|
|
||||||
PHONE_INT),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_INTERRUPT,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
PHONE_INT),
|
|
||||||
USBEndpointDescriptor_MAXINTERRUPTSIZE_FS),
|
|
||||||
.bInterval = 0x10,
|
|
||||||
},
|
|
||||||
DFURT_IF_DESCRIPTOR(1, 0),
|
|
||||||
};
|
|
||||||
#endif /* HAVE_SNIFFER */
|
|
||||||
|
|
||||||
#ifdef HAVE_CCID
|
|
||||||
static const CCIDDriverConfigurationDescriptors configurationDescriptorCCID = {
|
|
||||||
// Standard USB configuration descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBConfigurationDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_CONFIGURATION,
|
|
||||||
.wTotalLength = sizeof(CCIDDriverConfigurationDescriptors),
|
|
||||||
.bNumInterfaces = 1+DFURT_NUM_IF,
|
|
||||||
.bConfigurationValue = CFG_NUM_CCID,
|
|
||||||
.iConfiguration = CCID_CONF_STR,
|
|
||||||
.bmAttributes = BOARD_USB_BMATTRIBUTES,
|
|
||||||
.bMaxPower = USBConfigurationDescriptor_POWER(100),
|
|
||||||
},
|
|
||||||
// CCID interface descriptor
|
|
||||||
// Table 4.3-1 Interface Descriptor
|
|
||||||
// Interface descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBInterfaceDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_INTERFACE,
|
|
||||||
.bInterfaceNumber = 0,
|
|
||||||
.bAlternateSetting = 0,
|
|
||||||
.bNumEndpoints = 3,
|
|
||||||
.bInterfaceClass = SMART_CARD_DEVICE_CLASS,
|
|
||||||
.bInterfaceSubClass = 0,
|
|
||||||
.bInterfaceProtocol = 0,
|
|
||||||
.iInterface = CCID_CONF_STR,
|
|
||||||
},
|
|
||||||
{
|
|
||||||
.bLength = sizeof(CCIDDescriptor),
|
|
||||||
.bDescriptorType = CCID_DECRIPTOR_TYPE,
|
|
||||||
.bcdCCID = CCID1_10, // CCID version
|
|
||||||
.bMaxSlotIndex = 0, // 1 slot
|
|
||||||
.bVoltageSupport = VOLTS_3_0,
|
|
||||||
.dwProtocols = (1 << PROTOCOL_TO),
|
|
||||||
.dwDefaultClock = 3580,
|
|
||||||
.dwMaximumClock = 3580,
|
|
||||||
.bNumClockSupported = 0,
|
|
||||||
.dwDataRate = 9600,
|
|
||||||
.dwMaxDataRate = 9600,
|
|
||||||
.bNumDataRatesSupported = 0,
|
|
||||||
.dwMaxIFSD = 0xfe,
|
|
||||||
.dwSynchProtocols = 0,
|
|
||||||
.dwMechanical = 0,
|
|
||||||
.dwFeatures = CCID_FEATURES_AUTO_CLOCK | CCID_FEATURES_AUTO_BAUD |
|
|
||||||
CCID_FEATURES_AUTO_PCONF | CCID_FEATURES_AUTO_PNEGO |
|
|
||||||
CCID_FEATURES_EXC_TPDU,
|
|
||||||
.dwMaxCCIDMessageLength = 271, /* For extended APDU
|
|
||||||
level the value shall
|
|
||||||
be between 261 + 10 */
|
|
||||||
.bClassGetResponse = 0xFF, // Echoes the class of the APDU
|
|
||||||
.bClassEnvelope = 0xFF, // Echoes the class of the APDU
|
|
||||||
.wLcdLayout = 0, // wLcdLayout: no LCD
|
|
||||||
.bPINSupport = 0, // bPINSupport: No PIN
|
|
||||||
.bMaxCCIDBusySlots = 1,
|
|
||||||
},
|
|
||||||
// Bulk-OUT endpoint descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress =
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT,
|
|
||||||
CCID_EPT_DATA_OUT),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_BULK,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
CCID_EPT_DATA_OUT),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
.bInterval = 0x00,
|
|
||||||
},
|
|
||||||
// Bulk-IN endpoint descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress =
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
CCID_EPT_DATA_IN),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_BULK,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
CCID_EPT_DATA_IN),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
.bInterval = 0x00,
|
|
||||||
},
|
|
||||||
// Notification endpoint descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress =
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
CCID_EPT_NOTIFICATION),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_INTERRUPT,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
CCID_EPT_NOTIFICATION),
|
|
||||||
USBEndpointDescriptor_MAXINTERRUPTSIZE_FS),
|
|
||||||
.bInterval = 0x10,
|
|
||||||
},
|
|
||||||
DFURT_IF_DESCRIPTOR(1, 0),
|
|
||||||
};
|
|
||||||
#endif /* HAVE_CCID */
|
|
||||||
|
|
||||||
#ifdef HAVE_CARDEM
|
|
||||||
/* SIM card emulator */
|
|
||||||
typedef struct _SIMTraceDriverConfigurationDescriptorPhone {
|
|
||||||
/* Standard configuration descriptor. */
|
|
||||||
USBConfigurationDescriptor configuration;
|
|
||||||
USBInterfaceDescriptor phone;
|
|
||||||
USBEndpointDescriptor phone_dataOut;
|
|
||||||
USBEndpointDescriptor phone_dataIn;
|
|
||||||
USBEndpointDescriptor phone_interruptIn;
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
USBInterfaceDescriptor usim2;
|
|
||||||
USBEndpointDescriptor usim2_dataOut;
|
|
||||||
USBEndpointDescriptor usim2_dataIn;
|
|
||||||
USBEndpointDescriptor usim2_interruptIn;
|
|
||||||
#endif
|
|
||||||
DFURT_IF_DESCRIPTOR_STRUCT;
|
|
||||||
} __attribute__ ((packed)) SIMTraceDriverConfigurationDescriptorPhone;
|
|
||||||
|
|
||||||
static const SIMTraceDriverConfigurationDescriptorPhone
|
|
||||||
configurationDescriptorPhone = {
|
|
||||||
/* Standard configuration descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBConfigurationDescriptor),
|
|
||||||
USBGenericDescriptor_CONFIGURATION,
|
|
||||||
sizeof(SIMTraceDriverConfigurationDescriptorPhone),
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
2+DFURT_NUM_IF,
|
|
||||||
#else
|
|
||||||
1+DFURT_NUM_IF, /* There is one interface in this configuration */
|
|
||||||
#endif
|
|
||||||
CFG_NUM_PHONE, /* configuration number */
|
|
||||||
PHONE_CONF_STR, /* string descriptor for this configuration */
|
|
||||||
USBD_BMATTRIBUTES,
|
|
||||||
USBConfigurationDescriptor_POWER(100)
|
|
||||||
},
|
|
||||||
/* Communication class interface standard descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBInterfaceDescriptor),
|
|
||||||
USBGenericDescriptor_INTERFACE,
|
|
||||||
0, /* This is interface #0 */
|
|
||||||
0, /* This is alternate setting #0 for this interface */
|
|
||||||
3, /* Number of endpoints */
|
|
||||||
0xff, /* Descriptor Class: Vendor specific */
|
|
||||||
0, /* No subclass */
|
|
||||||
0, /* No l */
|
|
||||||
CARDEM_USIM1_INTF_STR
|
|
||||||
},
|
|
||||||
/* Bulk-OUT endpoint standard descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT,
|
|
||||||
PHONE_DATAOUT),
|
|
||||||
USBEndpointDescriptor_BULK,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(PHONE_DATAOUT),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
0 /* Must be 0 for full-speed bulk endpoints */
|
|
||||||
},
|
|
||||||
/* Bulk-IN endpoint descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
PHONE_DATAIN),
|
|
||||||
USBEndpointDescriptor_BULK,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(PHONE_DATAIN),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
0 /* Must be 0 for full-speed bulk endpoints */
|
|
||||||
},
|
|
||||||
/* Notification endpoint descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
PHONE_INT),
|
|
||||||
USBEndpointDescriptor_INTERRUPT,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(PHONE_INT),
|
|
||||||
USBEndpointDescriptor_MAXINTERRUPTSIZE_FS),
|
|
||||||
0x10
|
|
||||||
},
|
|
||||||
#ifdef CARDEMU_SECOND_UART
|
|
||||||
/* Communication class interface standard descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBInterfaceDescriptor),
|
|
||||||
USBGenericDescriptor_INTERFACE,
|
|
||||||
1, /* This is interface #1 */
|
|
||||||
0, /* This is alternate setting #0 for this interface */
|
|
||||||
3, /* Number of endpoints */
|
|
||||||
0xff, /* Descriptor Class: Vendor specific */
|
|
||||||
0, /* No subclass */
|
|
||||||
0, /* No l */
|
|
||||||
CARDEM_USIM2_INTF_STR
|
|
||||||
},
|
|
||||||
/* Bulk-OUT endpoint standard descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT,
|
|
||||||
CARDEM_USIM2_DATAOUT),
|
|
||||||
USBEndpointDescriptor_BULK,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(CARDEM_USIM2_DATAOUT),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
0 /* Must be 0 for full-speed bulk endpoints */
|
|
||||||
}
|
|
||||||
,
|
|
||||||
/* Bulk-IN endpoint descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
CARDEM_USIM2_DATAIN),
|
|
||||||
USBEndpointDescriptor_BULK,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(CARDEM_USIM2_DATAIN),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
0 /* Must be 0 for full-speed bulk endpoints */
|
|
||||||
},
|
|
||||||
/* Notification endpoint descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
CARDEM_USIM2_INT),
|
|
||||||
USBEndpointDescriptor_INTERRUPT,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(CARDEM_USIM2_INT),
|
|
||||||
USBEndpointDescriptor_MAXINTERRUPTSIZE_FS),
|
|
||||||
0x10
|
|
||||||
},
|
|
||||||
DFURT_IF_DESCRIPTOR(2, 0),
|
|
||||||
#else
|
|
||||||
DFURT_IF_DESCRIPTOR(1, 0),
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
#endif /* HAVE_CARDEM */
|
|
||||||
|
|
||||||
#ifdef HAVE_MITM
|
|
||||||
typedef struct _SIMTraceDriverConfigurationDescriptorMITM {
|
|
||||||
/* Standard configuration descriptor. */
|
|
||||||
USBConfigurationDescriptor configuration;
|
|
||||||
USBInterfaceDescriptor simcard;
|
|
||||||
/// CCID descriptor
|
|
||||||
CCIDDescriptor ccid;
|
|
||||||
/// Bulk OUT endpoint descriptor
|
|
||||||
USBEndpointDescriptor simcard_dataOut;
|
|
||||||
/// Bulk IN endpoint descriptor
|
|
||||||
USBEndpointDescriptor simcard_dataIn;
|
|
||||||
/// Interrupt OUT endpoint descriptor
|
|
||||||
USBEndpointDescriptor simcard_interruptIn;
|
|
||||||
|
|
||||||
USBInterfaceDescriptor phone;
|
|
||||||
USBEndpointDescriptor phone_dataOut;
|
|
||||||
USBEndpointDescriptor phone_dataIn;
|
|
||||||
USBEndpointDescriptor phone_interruptIn;
|
|
||||||
|
|
||||||
DFURT_IF_DESCRIPTOR_STRUCT;
|
|
||||||
|
|
||||||
} __attribute__ ((packed)) SIMTraceDriverConfigurationDescriptorMITM;
|
|
||||||
|
|
||||||
static const SIMTraceDriverConfigurationDescriptorMITM
|
|
||||||
configurationDescriptorMITM = {
|
|
||||||
/* Standard configuration descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBConfigurationDescriptor),
|
|
||||||
USBGenericDescriptor_CONFIGURATION,
|
|
||||||
sizeof(SIMTraceDriverConfigurationDescriptorMITM),
|
|
||||||
2+DFURT_NUM_IF, /* There are two interfaces in this configuration */
|
|
||||||
CFG_NUM_MITM, /* configuration number */
|
|
||||||
MITM_CONF_STR, /* string descriptor for this configuration */
|
|
||||||
USBD_BMATTRIBUTES,
|
|
||||||
USBConfigurationDescriptor_POWER(100)
|
|
||||||
},
|
|
||||||
// CCID interface descriptor
|
|
||||||
// Table 4.3-1 Interface Descriptor
|
|
||||||
// Interface descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBInterfaceDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_INTERFACE,
|
|
||||||
.bInterfaceNumber = 0,
|
|
||||||
.bAlternateSetting = 0,
|
|
||||||
.bNumEndpoints = 3,
|
|
||||||
.bInterfaceClass = SMART_CARD_DEVICE_CLASS,
|
|
||||||
.bInterfaceSubClass = 0,
|
|
||||||
.bInterfaceProtocol = 0,
|
|
||||||
.iInterface = CCID_CONF_STR,
|
|
||||||
},
|
|
||||||
{
|
|
||||||
.bLength = sizeof(CCIDDescriptor),
|
|
||||||
.bDescriptorType = CCID_DECRIPTOR_TYPE,
|
|
||||||
.bcdCCID = CCID1_10, // CCID version
|
|
||||||
.bMaxSlotIndex = 0, // 1 slot
|
|
||||||
.bVoltageSupport = VOLTS_3_0,
|
|
||||||
.dwProtocols = (1 << PROTOCOL_TO),
|
|
||||||
.dwDefaultClock = 3580,
|
|
||||||
.dwMaximumClock = 3580,
|
|
||||||
.bNumClockSupported = 0,
|
|
||||||
.dwDataRate = 9600,
|
|
||||||
.dwMaxDataRate = 9600,
|
|
||||||
.bNumDataRatesSupported = 0,
|
|
||||||
.dwMaxIFSD = 0xfe,
|
|
||||||
.dwSynchProtocols = 0,
|
|
||||||
.dwMechanical = 0,
|
|
||||||
.dwFeatures = CCID_FEATURES_AUTO_CLOCK | CCID_FEATURES_AUTO_BAUD |
|
|
||||||
CCID_FEATURES_AUTO_PCONF | CCID_FEATURES_AUTO_PNEGO |
|
|
||||||
CCID_FEATURES_EXC_TPDU,
|
|
||||||
.dwMaxCCIDMessageLength = 271, /* For extended APDU
|
|
||||||
level the value shall
|
|
||||||
be between 261 + 10 */
|
|
||||||
.bClassGetResponse = 0xFF, // Echoes the class of the APDU
|
|
||||||
.bClassEnvelope = 0xFF, // Echoes the class of the APDU
|
|
||||||
.wLcdLayout = 0, // wLcdLayout: no LCD
|
|
||||||
.bPINSupport = 0, // bPINSupport: No PIN
|
|
||||||
.bMaxCCIDBusySlots = 1,
|
|
||||||
},
|
|
||||||
// Bulk-OUT endpoint descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress =
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT,
|
|
||||||
CCID_EPT_DATA_OUT),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_BULK,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
CCID_EPT_DATA_OUT),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
.bInterval = 0x00,
|
|
||||||
},
|
|
||||||
// Bulk-IN endpoint descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress =
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
CCID_EPT_DATA_IN),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_BULK,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
CCID_EPT_DATA_IN),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
.bInterval = 0x00,
|
|
||||||
},
|
|
||||||
// Notification endpoint descriptor
|
|
||||||
{
|
|
||||||
.bLength = sizeof(USBEndpointDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_ENDPOINT,
|
|
||||||
.bEndpointAddress =
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
CCID_EPT_NOTIFICATION),
|
|
||||||
.bmAttributes = USBEndpointDescriptor_INTERRUPT,
|
|
||||||
.wMaxPacketSize = MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(
|
|
||||||
CCID_EPT_NOTIFICATION),
|
|
||||||
USBEndpointDescriptor_MAXINTERRUPTSIZE_FS),
|
|
||||||
.bInterval = 0x10,
|
|
||||||
},
|
|
||||||
|
|
||||||
/* Communication class interface standard descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBInterfaceDescriptor),
|
|
||||||
USBGenericDescriptor_INTERFACE,
|
|
||||||
1, /* This is interface #1 */
|
|
||||||
0, /* This is alternate setting #0 for this interface */
|
|
||||||
3, /* Number of endpoints */
|
|
||||||
0xff,
|
|
||||||
0,
|
|
||||||
0,
|
|
||||||
PHONE_CONF_STR, /* string descriptor for this interface */
|
|
||||||
}
|
|
||||||
,
|
|
||||||
/* Bulk-OUT endpoint standard descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT,
|
|
||||||
PHONE_DATAOUT),
|
|
||||||
USBEndpointDescriptor_BULK,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(PHONE_DATAOUT),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
0 /* Must be 0 for full-speed bulk endpoints */
|
|
||||||
}
|
|
||||||
,
|
|
||||||
/* Bulk-IN endpoint descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN,
|
|
||||||
PHONE_DATAIN),
|
|
||||||
USBEndpointDescriptor_BULK,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(PHONE_DATAIN),
|
|
||||||
USBEndpointDescriptor_MAXBULKSIZE_FS),
|
|
||||||
0 /* Must be 0 for full-speed bulk endpoints */
|
|
||||||
}
|
|
||||||
,
|
|
||||||
/* Notification endpoint descriptor */
|
|
||||||
{
|
|
||||||
sizeof(USBEndpointDescriptor),
|
|
||||||
USBGenericDescriptor_ENDPOINT,
|
|
||||||
USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN, PHONE_INT),
|
|
||||||
USBEndpointDescriptor_INTERRUPT,
|
|
||||||
MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(PHONE_INT),
|
|
||||||
USBEndpointDescriptor_MAXINTERRUPTSIZE_FS),
|
|
||||||
0x10},
|
|
||||||
DFURT_IF_DESCRIPTOR(2, 0),
|
|
||||||
};
|
|
||||||
#endif /* HAVE_CARDEM */
|
|
||||||
|
|
||||||
const USBConfigurationDescriptor *configurationDescriptorsArr[] = {
|
|
||||||
#ifdef HAVE_SNIFFER
|
|
||||||
&configurationDescriptorSniffer.configuration,
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_CCID
|
|
||||||
&configurationDescriptorCCID.configuration,
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_CARDEM
|
|
||||||
&configurationDescriptorPhone.configuration,
|
|
||||||
#endif
|
|
||||||
#ifdef HAVE_MITM
|
|
||||||
&configurationDescriptorMITM.configuration,
|
|
||||||
#endif
|
|
||||||
};
|
|
||||||
|
|
||||||
/** Standard USB device descriptor for the CDC serial driver */
|
|
||||||
const USBDeviceDescriptor deviceDescriptor = {
|
|
||||||
.bLength = sizeof(USBDeviceDescriptor),
|
|
||||||
.bDescriptorType = USBGenericDescriptor_DEVICE,
|
|
||||||
.bcdUSB = USBDeviceDescriptor_USB2_00,
|
|
||||||
.bDeviceClass = 0xff,
|
|
||||||
.bDeviceSubClass = 0xff,
|
|
||||||
.bDeviceProtocol = 0xff,
|
|
||||||
.bMaxPacketSize0 = BOARD_USB_ENDPOINTS_MAXPACKETSIZE(0),
|
|
||||||
.idVendor = SIMTRACE_VENDOR_ID,
|
|
||||||
.idProduct = SIMTRACE_PRODUCT_ID,
|
|
||||||
.bcdDevice = 2, /* Release number */
|
|
||||||
.iManufacturer = MANUF_STR,
|
|
||||||
.iProduct = PRODUCT_STRING,
|
|
||||||
.iSerialNumber = 0,
|
|
||||||
.bNumConfigurations = ARRAY_SIZE(configurationDescriptorsArr),
|
|
||||||
};
|
|
||||||
|
|
||||||
/* AT91SAM3S only supports full speed, but not high speed USB */
|
|
||||||
static const USBDDriverDescriptors driverDescriptors = {
|
|
||||||
&deviceDescriptor,
|
|
||||||
(const USBConfigurationDescriptor **)&(configurationDescriptorsArr), /* first full-speed configuration descriptor */
|
|
||||||
0, /* No full-speed device qualifier descriptor */
|
|
||||||
0, /* No full-speed other speed configuration */
|
|
||||||
0, /* No high-speed device descriptor */
|
|
||||||
0, /* No high-speed configuration descriptor */
|
|
||||||
0, /* No high-speed device qualifier descriptor */
|
|
||||||
0, /* No high-speed other speed configuration descriptor */
|
|
||||||
stringDescriptors,
|
|
||||||
STRING_DESC_CNT /* cnt string descriptors in list */
|
|
||||||
};
|
|
||||||
|
|
||||||
/*----------------------------------------------------------------------------
|
|
||||||
* Functions
|
|
||||||
*----------------------------------------------------------------------------*/
|
|
||||||
|
|
||||||
void SIMtrace_USB_Initialize(void)
|
|
||||||
{
|
|
||||||
// Get std USB driver
|
|
||||||
USBDDriver *pUsbd = USBD_GetDriver();
|
|
||||||
|
|
||||||
TRACE_DEBUG(".");
|
|
||||||
|
|
||||||
// Initialize standard USB driver
|
|
||||||
USBDDriver_Initialize(pUsbd, &driverDescriptors, 0); // Multiple interface settings not supported
|
|
||||||
USBD_Init();
|
|
||||||
USBD_Connect();
|
|
||||||
|
|
||||||
NVIC_EnableIRQ(UDP_IRQn);
|
|
||||||
}
|
|
||||||
@@ -1,372 +0,0 @@
|
|||||||
#pragma once
|
|
||||||
|
|
||||||
/*! \defgroup linuxlist Simple doubly linked list implementation
|
|
||||||
* @{
|
|
||||||
*/
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* \file linuxlist.h
|
|
||||||
*
|
|
||||||
* \brief Simple doubly linked list implementation.
|
|
||||||
*
|
|
||||||
* Some of the internal functions ("__xxx") are useful when
|
|
||||||
* manipulating whole llists rather than single entries, as
|
|
||||||
* sometimes we already know the next/prev entries and we can
|
|
||||||
* generate better code by using them directly rather than
|
|
||||||
* using the generic single-entry routines.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <stddef.h>
|
|
||||||
|
|
||||||
#ifndef inline
|
|
||||||
#define inline __inline__
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static inline void prefetch(const void *x) {;}
|
|
||||||
|
|
||||||
/*! \brief cast a member of a structure out to the containing structure
|
|
||||||
*
|
|
||||||
* \param[in] ptr the pointer to the member.
|
|
||||||
* \param[in] type the type of the container struct this is embedded in.
|
|
||||||
* \param[in] member the name of the member within the struct.
|
|
||||||
*/
|
|
||||||
#define container_of(ptr, type, member) ({ \
|
|
||||||
const typeof( ((type *)0)->member ) *__mptr = (ptr); \
|
|
||||||
(type *)( (char *)__mptr - offsetof(type, member) );})
|
|
||||||
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* These are non-NULL pointers that will result in page faults
|
|
||||||
* under normal circumstances, used to verify that nobody uses
|
|
||||||
* non-initialized llist entries.
|
|
||||||
*/
|
|
||||||
#define LLIST_POISON1 ((void *) 0x00100100)
|
|
||||||
#define LLIST_POISON2 ((void *) 0x00200200)
|
|
||||||
|
|
||||||
/*! \brief (double) linked list header structure */
|
|
||||||
struct llist_head {
|
|
||||||
/*! \brief Pointer to next and previous item */
|
|
||||||
struct llist_head *next, *prev;
|
|
||||||
};
|
|
||||||
|
|
||||||
#define LLIST_HEAD_INIT(name) { &(name), &(name) }
|
|
||||||
|
|
||||||
/*! \brief define a statically-initialized \ref llist_head
|
|
||||||
* \param[in] name Variable name
|
|
||||||
*
|
|
||||||
* This is a helper macro that will define a named variable of type
|
|
||||||
* \ref llist_head and initialize it */
|
|
||||||
#define LLIST_HEAD(name) \
|
|
||||||
struct llist_head name = LLIST_HEAD_INIT(name)
|
|
||||||
|
|
||||||
/*! \brief initialize a \ref llist_head to point back to self */
|
|
||||||
#define INIT_LLIST_HEAD(ptr) do { \
|
|
||||||
(ptr)->next = (ptr); (ptr)->prev = (ptr); \
|
|
||||||
} while (0)
|
|
||||||
|
|
||||||
/*! \brief Insert a new entry between two known consecutive entries.
|
|
||||||
*
|
|
||||||
* This is only for internal llist manipulation where we know
|
|
||||||
* the prev/next entries already!
|
|
||||||
*/
|
|
||||||
static inline void __llist_add(struct llist_head *_new,
|
|
||||||
struct llist_head *prev,
|
|
||||||
struct llist_head *next)
|
|
||||||
{
|
|
||||||
next->prev = _new;
|
|
||||||
_new->next = next;
|
|
||||||
_new->prev = prev;
|
|
||||||
prev->next = _new;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief add a new entry into a linked list (at head)
|
|
||||||
* \param _new New entry to be added
|
|
||||||
* \param head \ref llist_head to add it after
|
|
||||||
*
|
|
||||||
* Insert a new entry after the specified head.
|
|
||||||
* This is good for implementing stacks.
|
|
||||||
*/
|
|
||||||
static inline void llist_add(struct llist_head *_new, struct llist_head *head)
|
|
||||||
{
|
|
||||||
__llist_add(_new, head, head->next);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief add a new entry into a linked list (at tail)
|
|
||||||
* \param _new New entry to be added
|
|
||||||
* \param head Head of linked list to whose tail we shall add \a _new
|
|
||||||
*
|
|
||||||
* Insert a new entry before the specified head.
|
|
||||||
* This is useful for implementing queues.
|
|
||||||
*/
|
|
||||||
static inline void llist_add_tail(struct llist_head *_new, struct llist_head *head)
|
|
||||||
{
|
|
||||||
__llist_add(_new, head->prev, head);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Delete a llist entry by making the prev/next entries
|
|
||||||
* point to each other.
|
|
||||||
*
|
|
||||||
* This is only for internal llist manipulation where we know
|
|
||||||
* the prev/next entries already!
|
|
||||||
*/
|
|
||||||
static inline void __llist_del(struct llist_head * prev, struct llist_head * next)
|
|
||||||
{
|
|
||||||
next->prev = prev;
|
|
||||||
prev->next = next;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief Delete entry from linked list
|
|
||||||
* \param entry The element to delete from the llist
|
|
||||||
*
|
|
||||||
* Note: llist_empty on entry does not return true after this, the entry is
|
|
||||||
* in an undefined state.
|
|
||||||
*/
|
|
||||||
static inline void llist_del(struct llist_head *entry)
|
|
||||||
{
|
|
||||||
__llist_del(entry->prev, entry->next);
|
|
||||||
entry->next = (struct llist_head *)LLIST_POISON1;
|
|
||||||
entry->prev = (struct llist_head *)LLIST_POISON2;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief Delete entry from linked list and reinitialize it
|
|
||||||
* \param entry The element to delete from the list
|
|
||||||
*/
|
|
||||||
static inline void llist_del_init(struct llist_head *entry)
|
|
||||||
{
|
|
||||||
__llist_del(entry->prev, entry->next);
|
|
||||||
INIT_LLIST_HEAD(entry);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief Delete from one llist and add as another's head
|
|
||||||
* \param llist The entry to move
|
|
||||||
* \param head The head that will precede our entry
|
|
||||||
*/
|
|
||||||
static inline void llist_move(struct llist_head *llist, struct llist_head *head)
|
|
||||||
{
|
|
||||||
__llist_del(llist->prev, llist->next);
|
|
||||||
llist_add(llist, head);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief Delete from one llist and add as another's tail
|
|
||||||
* \param llist The entry to move
|
|
||||||
* \param head The head that will follow our entry
|
|
||||||
*/
|
|
||||||
static inline void llist_move_tail(struct llist_head *llist,
|
|
||||||
struct llist_head *head)
|
|
||||||
{
|
|
||||||
__llist_del(llist->prev, llist->next);
|
|
||||||
llist_add_tail(llist, head);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief Test whether a linked list is empty
|
|
||||||
* \param[in] head The llist to test.
|
|
||||||
* \returns 1 if the list is empty, 0 otherwise
|
|
||||||
*/
|
|
||||||
static inline int llist_empty(const struct llist_head *head)
|
|
||||||
{
|
|
||||||
return head->next == head;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void __llist_splice(struct llist_head *llist,
|
|
||||||
struct llist_head *head)
|
|
||||||
{
|
|
||||||
struct llist_head *first = llist->next;
|
|
||||||
struct llist_head *last = llist->prev;
|
|
||||||
struct llist_head *at = head->next;
|
|
||||||
|
|
||||||
first->prev = head;
|
|
||||||
head->next = first;
|
|
||||||
|
|
||||||
last->next = at;
|
|
||||||
at->prev = last;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief Join two llists
|
|
||||||
* \param llist The new linked list to add
|
|
||||||
* \param head The place to add \a llist in the other list
|
|
||||||
*/
|
|
||||||
static inline void llist_splice(struct llist_head *llist, struct llist_head *head)
|
|
||||||
{
|
|
||||||
if (!llist_empty(llist))
|
|
||||||
__llist_splice(llist, head);
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief join two llists and reinitialise the emptied llist.
|
|
||||||
* \param llist The new linked list to add.
|
|
||||||
* \param head The place to add it in the first llist.
|
|
||||||
*
|
|
||||||
* The llist at @llist is reinitialised
|
|
||||||
*/
|
|
||||||
static inline void llist_splice_init(struct llist_head *llist,
|
|
||||||
struct llist_head *head)
|
|
||||||
{
|
|
||||||
if (!llist_empty(llist)) {
|
|
||||||
__llist_splice(llist, head);
|
|
||||||
INIT_LLIST_HEAD(llist);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
/*! \brief Get the struct containing this list entry
|
|
||||||
* \param ptr The \ref llist_head pointer
|
|
||||||
* \param type The type of the struct this is embedded in
|
|
||||||
* \param @member The name of the \ref llist_head within the struct
|
|
||||||
*/
|
|
||||||
#define llist_entry(ptr, type, member) \
|
|
||||||
container_of(ptr, type, member)
|
|
||||||
|
|
||||||
/*! \brief Iterate over a linked list
|
|
||||||
* \param pos The \ref llist_head to use as a loop counter
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
*/
|
|
||||||
#define llist_for_each(pos, head) \
|
|
||||||
for (pos = (head)->next, prefetch(pos->next); pos != (head); \
|
|
||||||
pos = pos->next, prefetch(pos->next))
|
|
||||||
|
|
||||||
/*! \brief Iterate over a llist (no prefetch)
|
|
||||||
* \param pos The \ref llist_head to use as a loop counter
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
*
|
|
||||||
* This variant differs from llist_for_each() in that it's the
|
|
||||||
* simplest possible llist iteration code, no prefetching is done.
|
|
||||||
* Use this for code that knows the llist to be very short (empty
|
|
||||||
* or 1 entry) most of the time.
|
|
||||||
*/
|
|
||||||
#define __llist_for_each(pos, head) \
|
|
||||||
for (pos = (head)->next; pos != (head); pos = pos->next)
|
|
||||||
|
|
||||||
/*! \brief Iterate over a llist backwards
|
|
||||||
* \param pos The \ref llist_head to use as a loop counter
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
*/
|
|
||||||
#define llist_for_each_prev(pos, head) \
|
|
||||||
for (pos = (head)->prev, prefetch(pos->prev); pos != (head); \
|
|
||||||
pos = pos->prev, prefetch(pos->prev))
|
|
||||||
|
|
||||||
/*! \brief Iterate over a list; safe against removal of llist entry
|
|
||||||
* \param pos The \ref llist_head to use as a loop counter
|
|
||||||
* \param n Another \ref llist_head to use as temporary storage
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
*/
|
|
||||||
#define llist_for_each_safe(pos, n, head) \
|
|
||||||
for (pos = (head)->next, n = pos->next; pos != (head); \
|
|
||||||
pos = n, n = pos->next)
|
|
||||||
|
|
||||||
/*! \brief Iterate over llist of given type
|
|
||||||
* \param pos The 'type *' to use as a loop counter
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
* \param member The name of the \ref llist_head within struct \a pos
|
|
||||||
*/
|
|
||||||
#define llist_for_each_entry(pos, head, member) \
|
|
||||||
for (pos = llist_entry((head)->next, typeof(*pos), member), \
|
|
||||||
prefetch(pos->member.next); \
|
|
||||||
&pos->member != (head); \
|
|
||||||
pos = llist_entry(pos->member.next, typeof(*pos), member), \
|
|
||||||
prefetch(pos->member.next))
|
|
||||||
|
|
||||||
/*! \brief Iterate backwards over llist of given type.
|
|
||||||
* \param pos The 'type *' to use as a loop counter
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
* \param member The name of the \ref llist_head within struct \a pos
|
|
||||||
*/
|
|
||||||
#define llist_for_each_entry_reverse(pos, head, member) \
|
|
||||||
for (pos = llist_entry((head)->prev, typeof(*pos), member), \
|
|
||||||
prefetch(pos->member.prev); \
|
|
||||||
&pos->member != (head); \
|
|
||||||
pos = llist_entry(pos->member.prev, typeof(*pos), member), \
|
|
||||||
prefetch(pos->member.prev))
|
|
||||||
|
|
||||||
/*! \brief iterate over llist of given type continuing after existing
|
|
||||||
* point
|
|
||||||
* \param pos The 'type *' to use as a loop counter
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
* \param member The name of the \ref llist_head within struct \a pos
|
|
||||||
*/
|
|
||||||
#define llist_for_each_entry_continue(pos, head, member) \
|
|
||||||
for (pos = llist_entry(pos->member.next, typeof(*pos), member), \
|
|
||||||
prefetch(pos->member.next); \
|
|
||||||
&pos->member != (head); \
|
|
||||||
pos = llist_entry(pos->member.next, typeof(*pos), member), \
|
|
||||||
prefetch(pos->member.next))
|
|
||||||
|
|
||||||
/*! \brief iterate over llist of given type, safe against removal of
|
|
||||||
* non-consecutive(!) llist entries
|
|
||||||
* \param pos The 'type *' to use as a loop counter
|
|
||||||
* \param n Another type * to use as temporary storage
|
|
||||||
* \param head The head of the list over which to iterate
|
|
||||||
* \param member The name of the \ref llist_head within struct \a pos
|
|
||||||
*/
|
|
||||||
#define llist_for_each_entry_safe(pos, n, head, member) \
|
|
||||||
for (pos = llist_entry((head)->next, typeof(*pos), member), \
|
|
||||||
n = llist_entry(pos->member.next, typeof(*pos), member); \
|
|
||||||
&pos->member != (head); \
|
|
||||||
pos = n, n = llist_entry(n->member.next, typeof(*n), member))
|
|
||||||
|
|
||||||
/**
|
|
||||||
* llist_for_each_rcu - iterate over an rcu-protected llist
|
|
||||||
* @pos: the &struct llist_head to use as a loop counter.
|
|
||||||
* @head: the head for your llist.
|
|
||||||
*/
|
|
||||||
#define llist_for_each_rcu(pos, head) \
|
|
||||||
for (pos = (head)->next, prefetch(pos->next); pos != (head); \
|
|
||||||
pos = pos->next, ({ smp_read_barrier_depends(); 0;}), prefetch(pos->next))
|
|
||||||
|
|
||||||
#define __llist_for_each_rcu(pos, head) \
|
|
||||||
for (pos = (head)->next; pos != (head); \
|
|
||||||
pos = pos->next, ({ smp_read_barrier_depends(); 0;}))
|
|
||||||
|
|
||||||
/**
|
|
||||||
* llist_for_each_safe_rcu - iterate over an rcu-protected llist safe
|
|
||||||
* against removal of llist entry
|
|
||||||
* @pos: the &struct llist_head to use as a loop counter.
|
|
||||||
* @n: another &struct llist_head to use as temporary storage
|
|
||||||
* @head: the head for your llist.
|
|
||||||
*/
|
|
||||||
#define llist_for_each_safe_rcu(pos, n, head) \
|
|
||||||
for (pos = (head)->next, n = pos->next; pos != (head); \
|
|
||||||
pos = n, ({ smp_read_barrier_depends(); 0;}), n = pos->next)
|
|
||||||
|
|
||||||
/**
|
|
||||||
* llist_for_each_entry_rcu - iterate over rcu llist of given type
|
|
||||||
* @pos: the type * to use as a loop counter.
|
|
||||||
* @head: the head for your llist.
|
|
||||||
* @member: the name of the llist_struct within the struct.
|
|
||||||
*/
|
|
||||||
#define llist_for_each_entry_rcu(pos, head, member) \
|
|
||||||
for (pos = llist_entry((head)->next, typeof(*pos), member), \
|
|
||||||
prefetch(pos->member.next); \
|
|
||||||
&pos->member != (head); \
|
|
||||||
pos = llist_entry(pos->member.next, typeof(*pos), member), \
|
|
||||||
({ smp_read_barrier_depends(); 0;}), \
|
|
||||||
prefetch(pos->member.next))
|
|
||||||
|
|
||||||
|
|
||||||
/**
|
|
||||||
* llist_for_each_continue_rcu - iterate over an rcu-protected llist
|
|
||||||
* continuing after existing point.
|
|
||||||
* @pos: the &struct llist_head to use as a loop counter.
|
|
||||||
* @head: the head for your llist.
|
|
||||||
*/
|
|
||||||
#define llist_for_each_continue_rcu(pos, head) \
|
|
||||||
for ((pos) = (pos)->next, prefetch((pos)->next); (pos) != (head); \
|
|
||||||
(pos) = (pos)->next, ({ smp_read_barrier_depends(); 0;}), prefetch((pos)->next))
|
|
||||||
|
|
||||||
/*! \brief count nr of llist items by iterating.
|
|
||||||
* \param head The llist head to count items of.
|
|
||||||
* \returns Number of items.
|
|
||||||
*
|
|
||||||
* This function is not efficient, mostly useful for small lists and non time
|
|
||||||
* critical cases like unit tests.
|
|
||||||
*/
|
|
||||||
static inline unsigned int llist_count(struct llist_head *head)
|
|
||||||
{
|
|
||||||
struct llist_head *entry;
|
|
||||||
unsigned int i = 0;
|
|
||||||
llist_for_each(entry, head)
|
|
||||||
i++;
|
|
||||||
return i;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*!
|
|
||||||
* }@
|
|
||||||
*/
|
|
||||||
@@ -1,158 +0,0 @@
|
|||||||
/*
|
|
||||||
Red Black Trees
|
|
||||||
(C) 1999 Andrea Arcangeli <andrea@suse.de>
|
|
||||||
|
|
||||||
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 Street, Fifth Floor, Boston,
|
|
||||||
MA 02110-1301, USA.
|
|
||||||
|
|
||||||
linux/include/linux/rbtree.h
|
|
||||||
|
|
||||||
To use rbtrees you'll have to implement your own insert and search cores.
|
|
||||||
This will avoid us to use callbacks and to drop drammatically performances.
|
|
||||||
I know it's not the cleaner way, but in C (not in C++) to get
|
|
||||||
performances and genericity...
|
|
||||||
|
|
||||||
Some example of insert and search follows here. The search is a plain
|
|
||||||
normal search over an ordered tree. The insert instead must be implemented
|
|
||||||
int two steps: as first thing the code must insert the element in
|
|
||||||
order as a red leaf in the tree, then the support library function
|
|
||||||
rb_insert_color() must be called. Such function will do the
|
|
||||||
not trivial work to rebalance the rbtree if necessary.
|
|
||||||
|
|
||||||
-----------------------------------------------------------------------
|
|
||||||
static inline struct page * rb_search_page_cache(struct inode * inode,
|
|
||||||
unsigned long offset)
|
|
||||||
{
|
|
||||||
struct rb_node * n = inode->i_rb_page_cache.rb_node;
|
|
||||||
struct page * page;
|
|
||||||
|
|
||||||
while (n)
|
|
||||||
{
|
|
||||||
page = rb_entry(n, struct page, rb_page_cache);
|
|
||||||
|
|
||||||
if (offset < page->offset)
|
|
||||||
n = n->rb_left;
|
|
||||||
else if (offset > page->offset)
|
|
||||||
n = n->rb_right;
|
|
||||||
else
|
|
||||||
return page;
|
|
||||||
}
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline struct page * __rb_insert_page_cache(struct inode * inode,
|
|
||||||
unsigned long offset,
|
|
||||||
struct rb_node * node)
|
|
||||||
{
|
|
||||||
struct rb_node ** p = &inode->i_rb_page_cache.rb_node;
|
|
||||||
struct rb_node * parent = NULL;
|
|
||||||
struct page * page;
|
|
||||||
|
|
||||||
while (*p)
|
|
||||||
{
|
|
||||||
parent = *p;
|
|
||||||
page = rb_entry(parent, struct page, rb_page_cache);
|
|
||||||
|
|
||||||
if (offset < page->offset)
|
|
||||||
p = &(*p)->rb_left;
|
|
||||||
else if (offset > page->offset)
|
|
||||||
p = &(*p)->rb_right;
|
|
||||||
else
|
|
||||||
return page;
|
|
||||||
}
|
|
||||||
|
|
||||||
rb_link_node(node, parent, p);
|
|
||||||
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline struct page * rb_insert_page_cache(struct inode * inode,
|
|
||||||
unsigned long offset,
|
|
||||||
struct rb_node * node)
|
|
||||||
{
|
|
||||||
struct page * ret;
|
|
||||||
if ((ret = __rb_insert_page_cache(inode, offset, node)))
|
|
||||||
goto out;
|
|
||||||
rb_insert_color(node, &inode->i_rb_page_cache);
|
|
||||||
out:
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
-----------------------------------------------------------------------
|
|
||||||
*/
|
|
||||||
|
|
||||||
#pragma once
|
|
||||||
|
|
||||||
#include <stdlib.h>
|
|
||||||
|
|
||||||
struct rb_node
|
|
||||||
{
|
|
||||||
unsigned long rb_parent_color;
|
|
||||||
#define RB_RED 0
|
|
||||||
#define RB_BLACK 1
|
|
||||||
struct rb_node *rb_right;
|
|
||||||
struct rb_node *rb_left;
|
|
||||||
} __attribute__((aligned(sizeof(long))));
|
|
||||||
/* The alignment might seem pointless, but allegedly CRIS needs it */
|
|
||||||
|
|
||||||
struct rb_root
|
|
||||||
{
|
|
||||||
struct rb_node *rb_node;
|
|
||||||
};
|
|
||||||
|
|
||||||
|
|
||||||
#define rb_parent(r) ((struct rb_node *)((r)->rb_parent_color & ~3))
|
|
||||||
#define rb_color(r) ((r)->rb_parent_color & 1)
|
|
||||||
#define rb_is_red(r) (!rb_color(r))
|
|
||||||
#define rb_is_black(r) rb_color(r)
|
|
||||||
#define rb_set_red(r) do { (r)->rb_parent_color &= ~1; } while (0)
|
|
||||||
#define rb_set_black(r) do { (r)->rb_parent_color |= 1; } while (0)
|
|
||||||
|
|
||||||
static inline void rb_set_parent(struct rb_node *rb, struct rb_node *p)
|
|
||||||
{
|
|
||||||
rb->rb_parent_color = (rb->rb_parent_color & 3) | (unsigned long)p;
|
|
||||||
}
|
|
||||||
static inline void rb_set_color(struct rb_node *rb, int color)
|
|
||||||
{
|
|
||||||
rb->rb_parent_color = (rb->rb_parent_color & ~1) | color;
|
|
||||||
}
|
|
||||||
|
|
||||||
#define RB_ROOT { NULL, }
|
|
||||||
#define rb_entry(ptr, type, member) container_of(ptr, type, member)
|
|
||||||
|
|
||||||
#define RB_EMPTY_ROOT(root) ((root)->rb_node == NULL)
|
|
||||||
#define RB_EMPTY_NODE(node) (rb_parent(node) == node)
|
|
||||||
#define RB_CLEAR_NODE(node) (rb_set_parent(node, node))
|
|
||||||
|
|
||||||
extern void rb_insert_color(struct rb_node *, struct rb_root *);
|
|
||||||
extern void rb_erase(struct rb_node *, struct rb_root *);
|
|
||||||
|
|
||||||
/* Find logical next and previous nodes in a tree */
|
|
||||||
extern struct rb_node *rb_next(const struct rb_node *);
|
|
||||||
extern struct rb_node *rb_prev(const struct rb_node *);
|
|
||||||
extern struct rb_node *rb_first(const struct rb_root *);
|
|
||||||
extern struct rb_node *rb_last(const struct rb_root *);
|
|
||||||
|
|
||||||
/* Fast replacement of a single node without remove/rebalance/add/rebalance */
|
|
||||||
extern void rb_replace_node(struct rb_node *victim, struct rb_node *_new,
|
|
||||||
struct rb_root *root);
|
|
||||||
|
|
||||||
static inline void rb_link_node(struct rb_node * node, struct rb_node * parent,
|
|
||||||
struct rb_node ** rb_link)
|
|
||||||
{
|
|
||||||
node->rb_parent_color = (unsigned long )parent;
|
|
||||||
node->rb_left = node->rb_right = NULL;
|
|
||||||
|
|
||||||
*rb_link = node;
|
|
||||||
}
|
|
||||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user