mirror of
https://github.com/LNH-team/dspico-usb-examples.git
synced 2026-06-02 09:16:50 +02:00
Added usb video example
This commit is contained in:
Gericom
153
examples/usb-video/arm9/Makefile
Normal file
153
examples/usb-video/arm9/Makefile
Normal file
@@ -0,0 +1,153 @@
|
||||
#---------------------------------------------------------------------------------
|
||||
.SUFFIXES:
|
||||
#---------------------------------------------------------------------------------
|
||||
ifeq ($(strip $(DEVKITARM)),)
|
||||
$(error "Please set DEVKITARM in your environment. export DEVKITARM=<path to>devkitARM")
|
||||
endif
|
||||
|
||||
include $(DEVKITARM)/ds_rules
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# BUILD is the directory where object files & intermediate files will be placed
|
||||
# SOURCES is a list of directories containing source code
|
||||
# INCLUDES is a list of directories containing extra header files
|
||||
# DATA is a list of directories containing binary files
|
||||
# all directories are relative to this makefile
|
||||
#---------------------------------------------------------------------------------
|
||||
BUILD := build
|
||||
SOURCES := source \
|
||||
../common \
|
||||
source/core
|
||||
INCLUDES := include source ../common
|
||||
DATA := data
|
||||
GRAPHICS := gfx
|
||||
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# options for code generation
|
||||
#---------------------------------------------------------------------------------
|
||||
ARCH := -marm -mthumb-interwork -DLIBTWL_ARM9 -DARM9
|
||||
|
||||
CFLAGS := -g -Wall -O2\
|
||||
-march=armv5te -mtune=arm946e-s -fomit-frame-pointer\
|
||||
-ffunction-sections -fdata-sections\
|
||||
-ffast-math \
|
||||
-fno-devirtualize-speculatively \
|
||||
-Werror=return-type \
|
||||
$(ARCH)
|
||||
|
||||
CFLAGS += $(INCLUDE)
|
||||
CXXFLAGS := $(CFLAGS) -std=gnu++23 -Wno-volatile -fno-rtti -fno-exceptions -fno-threadsafe-statics\
|
||||
-Wsuggest-override -Werror=suggest-override
|
||||
|
||||
CFLAGS += -Werror=implicit-function-declaration
|
||||
|
||||
ASFLAGS := -g $(ARCH) $(INCLUDE) -march=armv5te -mtune=arm946e-s
|
||||
|
||||
LDFLAGS = -specs=ds_arm9.specs -g $(ARCH) -Wl,-Map,$(notdir $*.map),--gc-sections,--use-blx -ffunction-sections -fdata-sections
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# any extra libraries we wish to link with the project
|
||||
#---------------------------------------------------------------------------------
|
||||
LIBS := -ltwl9 -lnds9
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# list of directories containing libraries, this must be the top level containing
|
||||
# include and lib
|
||||
#---------------------------------------------------------------------------------
|
||||
LIBDIRS := $(LIBNDS) $(CURDIR)/../../../libs/libtwl/libtwl9 $(CURDIR)/../../../libs/libtwl/common
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# no real need to edit anything past this point unless you need to add additional
|
||||
# rules for different file extensions
|
||||
#---------------------------------------------------------------------------------
|
||||
ifneq ($(BUILD),$(notdir $(CURDIR)))
|
||||
#---------------------------------------------------------------------------------
|
||||
|
||||
export ARM9ELF := $(CURDIR)/$(TARGET).elf
|
||||
export DEPSDIR := $(CURDIR)/$(BUILD)
|
||||
|
||||
export VPATH := $(foreach dir,$(SOURCES),$(CURDIR)/$(dir)) \
|
||||
$(foreach dir,$(DATA),$(CURDIR)/$(dir)) \
|
||||
$(foreach dir,$(GRAPHICS),$(CURDIR)/$(dir))
|
||||
|
||||
CFILES := $(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.c)))
|
||||
CPPFILES := $(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.cpp)))
|
||||
SFILES := $(foreach dir,$(SOURCES),$(notdir $(wildcard $(dir)/*.s)))
|
||||
BINFILES := $(foreach dir,$(DATA),$(notdir $(wildcard $(dir)/*.*)))
|
||||
PNGFILES := $(foreach dir,$(GRAPHICS),$(notdir $(wildcard $(dir)/*.png)))
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# use CXX for linking C++ projects, CC for standard C
|
||||
#---------------------------------------------------------------------------------
|
||||
ifeq ($(strip $(CPPFILES)),)
|
||||
#---------------------------------------------------------------------------------
|
||||
export LD := $(CC)
|
||||
#---------------------------------------------------------------------------------
|
||||
else
|
||||
#---------------------------------------------------------------------------------
|
||||
export LD := $(CXX)
|
||||
#---------------------------------------------------------------------------------
|
||||
endif
|
||||
#---------------------------------------------------------------------------------
|
||||
|
||||
export OFILES := $(addsuffix .o,$(BINFILES)) \
|
||||
$(PNGFILES:.png=.o)\
|
||||
$(CPPFILES:.cpp=.o) $(CFILES:.c=.o) $(SFILES:.s=.o)
|
||||
|
||||
export INCLUDE := $(foreach dir,$(INCLUDES),-I$(CURDIR)/$(dir)) \
|
||||
$(foreach dir,$(LIBDIRS),-I$(dir)/include) \
|
||||
-I$(CURDIR)/$(BUILD)
|
||||
|
||||
export LIBPATHS := $(foreach dir,$(LIBDIRS),-L$(dir)/lib)
|
||||
|
||||
.PHONY: $(BUILD) clean
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
$(BUILD):
|
||||
@[ -d $@ ] || mkdir -p $@
|
||||
@$(MAKE) --no-print-directory -C $(BUILD) -f $(CURDIR)/Makefile
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
clean:
|
||||
@echo clean ...
|
||||
@rm -fr $(BUILD) *.elf *.nds* *.bin
|
||||
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
else
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# main targets
|
||||
#---------------------------------------------------------------------------------
|
||||
$(ARM9ELF) : $(OFILES)
|
||||
@echo linking $(notdir $@)
|
||||
@$(LD) $(LDFLAGS) $(OFILES) $(LIBPATHS) $(LIBS) -o $@
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# you need a rule like this for each extension you use as binary data
|
||||
#---------------------------------------------------------------------------------
|
||||
%.bin.o : %.bin
|
||||
#---------------------------------------------------------------------------------
|
||||
@echo $(notdir $<)
|
||||
@$(bin2o)
|
||||
|
||||
%.nft2.o : %.nft2
|
||||
@echo $(notdir $<)
|
||||
@$(bin2o)
|
||||
|
||||
#---------------------------------------------------------------------------------
|
||||
# This rule creates assembly source files using grit
|
||||
# grit takes an image file and a .grit describing how the file is to be processed
|
||||
# add additional rules like this for each image extension
|
||||
# you use in the graphics folders
|
||||
#---------------------------------------------------------------------------------
|
||||
%.s %.h: %.png %.grit
|
||||
#---------------------------------------------------------------------------------
|
||||
grit $< -fts -o$*
|
||||
|
||||
-include $(DEPSDIR)/*.d
|
||||
|
||||
#---------------------------------------------------------------------------------------
|
||||
endif
|
||||
#---------------------------------------------------------------------------------------
|
||||
84
examples/usb-video/arm9/source/Camera.cpp
Normal file
84
examples/usb-video/arm9/source/Camera.cpp
Normal file
@@ -0,0 +1,84 @@
|
||||
#include "common.h"
|
||||
#include <libtwl/sys/swi.h>
|
||||
#include <libtwl/dma/dmaTwl.h>
|
||||
#include <libtwl/rtos/rtosEvent.h>
|
||||
#include <libtwl/ipc/ipcFifoSystem.h>
|
||||
#include "IpcChannels.h"
|
||||
#include "CameraIpcCommand.h"
|
||||
#include "Camera.h"
|
||||
|
||||
#define REG_SCFG_CLK (*(vu32*)0x04004004)
|
||||
#define REG_CAM_MCNT (*(vu16*)0x04004200)
|
||||
#define REG_CAM_CNT (*(vu16*)0x04004202)
|
||||
#define REG_CAM_DAT (*(vu32*)0x04004204)
|
||||
|
||||
static rtos_event_t sEvent;
|
||||
|
||||
static void ipcMessageHandler(u32 channel, u32 data, void* arg)
|
||||
{
|
||||
rtos_signalEvent(&sEvent);
|
||||
}
|
||||
|
||||
void cam_init(bool front)
|
||||
{
|
||||
rtos_createEvent(&sEvent);
|
||||
ipc_setChannelHandler(IPC_CHANNEL_CAMERA, ipcMessageHandler, nullptr);
|
||||
|
||||
REG_SCFG_CLK |= 0x0004;
|
||||
REG_CAM_MCNT = 0x0000;
|
||||
swi_waitByLoop(0x1E);
|
||||
REG_SCFG_CLK |= 0x0100;
|
||||
swi_waitByLoop(0x1E);
|
||||
REG_CAM_MCNT = 0x0022;
|
||||
swi_waitByLoop(0x2008);
|
||||
REG_SCFG_CLK &= ~0x0100;
|
||||
REG_CAM_CNT &= ~0x8000;
|
||||
REG_CAM_CNT |= 0x0020;
|
||||
REG_CAM_CNT = (REG_CAM_CNT & ~0x0300) | 0x0200;
|
||||
REG_CAM_CNT |= 0x0400;
|
||||
REG_CAM_CNT |= 0x0800;
|
||||
REG_SCFG_CLK |= 0x0100;
|
||||
swi_waitByLoop(0x14);
|
||||
|
||||
ipc_sendFifoMessage(IPC_CHANNEL_CAMERA, front ? CAMERA_IPC_CMD_INIT_FRONT : CAMERA_IPC_CMD_INIT_BACK);
|
||||
rtos_waitEvent(&sEvent, false, true);
|
||||
|
||||
REG_SCFG_CLK &= ~0x0100;
|
||||
REG_SCFG_CLK |= 0x0100;
|
||||
|
||||
ipc_sendFifoMessage(IPC_CHANNEL_CAMERA, CAMERA_IPC_CMD_ACTIVATE);
|
||||
rtos_waitEvent(&sEvent, false, true);
|
||||
}
|
||||
|
||||
void cam_stop()
|
||||
{
|
||||
ipc_sendFifoMessage(IPC_CHANNEL_CAMERA, CAMERA_IPC_CMD_DEACTIVATE);
|
||||
rtos_waitEvent(&sEvent, false, true);
|
||||
}
|
||||
|
||||
void cam_switch()
|
||||
{
|
||||
ipc_sendFifoMessage(IPC_CHANNEL_CAMERA, CAMERA_IPC_CMD_SWITCH);
|
||||
rtos_waitEvent(&sEvent, false, true);
|
||||
}
|
||||
|
||||
void cam_dmaStart(int dma, void* dst)
|
||||
{
|
||||
// REG_CAM_CNT |= 0x2000;
|
||||
REG_CAM_CNT &= ~0x2000;
|
||||
REG_CAM_CNT = (REG_CAM_CNT & ~0x000F) | 0x0003;
|
||||
REG_CAM_CNT |= 0x0020;
|
||||
REG_CAM_CNT |= 0x8000;
|
||||
|
||||
dma_twl_config_t dmaConfig =
|
||||
{
|
||||
.src = (const void*)0x04004204,
|
||||
.dst = dst,
|
||||
.totalWordCount = 0x6000,
|
||||
.wordCount = 0x200,
|
||||
.blockInterval = 2,
|
||||
.fillData = 0,
|
||||
.control = 0x8B044000
|
||||
};
|
||||
dma_twlSetParams(dma, &dmaConfig);
|
||||
}
|
||||
6
examples/usb-video/arm9/source/Camera.h
Normal file
6
examples/usb-video/arm9/source/Camera.h
Normal file
@@ -0,0 +1,6 @@
|
||||
#pragma once
|
||||
|
||||
void cam_init(bool front);
|
||||
void cam_stop();
|
||||
void cam_switch();
|
||||
void cam_dmaStart(int dma, void* dst);
|
||||
2
examples/usb-video/arm9/source/common.h
Normal file
2
examples/usb-video/arm9/source/common.h
Normal file
@@ -0,0 +1,2 @@
|
||||
#pragma once
|
||||
#include <nds/ndstypes.h>
|
||||
86
examples/usb-video/arm9/source/main.cpp
Normal file
86
examples/usb-video/arm9/source/main.cpp
Normal file
@@ -0,0 +1,86 @@
|
||||
#include "common.h"
|
||||
#include <nds.h>
|
||||
#include <stdio.h>
|
||||
#include <libtwl/gfx/gfx.h>
|
||||
#include <libtwl/dma/dmaTwl.h>
|
||||
#include <libtwl/gfx/gfxStatus.h>
|
||||
#include <libtwl/mem/memVram.h>
|
||||
#include <libtwl/mem/memExtern.h>
|
||||
#include <libtwl/rtos/rtosIrq.h>
|
||||
#include <libtwl/rtos/rtosThread.h>
|
||||
#include <libtwl/rtos/rtosEvent.h>
|
||||
#include <libtwl/ipc/ipcSync.h>
|
||||
#include <libtwl/ipc/ipcFifoSystem.h>
|
||||
#include "Camera.h"
|
||||
#include "IpcChannels.h"
|
||||
|
||||
#define FRAME_SIZE (256 * 192 * 2)
|
||||
#define NUMBER_OF_FRAME_BUFFERS 3
|
||||
|
||||
static rtos_event_t sVblankEvent;
|
||||
static rtos_event_t sCaptureEvent;
|
||||
|
||||
static u32 sCurrentFrame = 0;
|
||||
static vu32 sRequestedFrame = 0;
|
||||
|
||||
static void vblankIrq(u32 irqMask)
|
||||
{
|
||||
rtos_signalEvent(&sVblankEvent);
|
||||
}
|
||||
|
||||
static void captureIpcMessageHandler(u32 channel, u32 data, void* arg)
|
||||
{
|
||||
sRequestedFrame++;
|
||||
rtos_signalEvent(&sCaptureEvent);
|
||||
}
|
||||
|
||||
int main(int argc, char* argv[])
|
||||
{
|
||||
*(vu32*)0x04000000 = 0x10000;
|
||||
*(vu16*)0x05000000 = 31 << 5;
|
||||
*(vu16*)0x0400006C = 0;
|
||||
|
||||
mem_setDsCartridgeCpu(EXMEMCNT_SLOT1_CPU_ARM7);
|
||||
mem_setMainMemoryPriority(EXMEMCNT_MAIN_MEM_PRIO_ARM7);
|
||||
|
||||
rtos_initIrq();
|
||||
rtos_startMainThread();
|
||||
ipc_initFifoSystem();
|
||||
|
||||
rtos_createEvent(&sVblankEvent);
|
||||
|
||||
while (ipc_getArm7SyncBits() != 7);
|
||||
|
||||
*(vu16*)0x05000000 = 31 << 10;
|
||||
cam_init(false);
|
||||
*(vu16*)0x05000000 = 31;
|
||||
|
||||
rtos_createEvent(&sCaptureEvent);
|
||||
ipc_setChannelHandler(IPC_CHANNEL_CAPTURE, captureIpcMessageHandler, nullptr);
|
||||
|
||||
ipc_setArm9SyncBits(6);
|
||||
|
||||
rtos_setIrqFunc(RTOS_IRQ_VBLANK, vblankIrq);
|
||||
rtos_enableIrqMask(RTOS_IRQ_VBLANK);
|
||||
gfx_setVBlankIrqEnabled(true);
|
||||
|
||||
mem_setVramAMapping(MEM_VRAM_AB_LCDC);
|
||||
REG_DISPCNT = 0x20000;
|
||||
|
||||
u8* frameBuffer = new(std::align_val_t(32)) u8[FRAME_SIZE * NUMBER_OF_FRAME_BUFFERS];
|
||||
ipc_sendFifoMessage(IPC_CHANNEL_CAPTURE, (u32)frameBuffer >> 5);
|
||||
|
||||
while (true)
|
||||
{
|
||||
rtos_waitEvent(&sCaptureEvent, false, true);
|
||||
while (sCurrentFrame != sRequestedFrame)
|
||||
{
|
||||
cam_dmaStart(1, frameBuffer + FRAME_SIZE * (sCurrentFrame % 3));
|
||||
dma_twlWait(1);
|
||||
sCurrentFrame++;
|
||||
ipc_sendFifoMessage(IPC_CHANNEL_CAPTURE, 0);
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
Reference in New Issue
Block a user