--- /dev/null
+/**
+ * @file main.c
+ * @author Copyright(C) 2012 Shinichiro Nakamura
+ * @author Copyright(C) 2012 Maduki Kanazawa
+ * @brief BlueTank ACB-BF592 Application Sample Codes.
+ */
+
+/*
+ * ===============================================================
+ * BlueTank
+ * ===============================================================
+ * Copyright (c) 2012 Shinichiro Nakamura
+ *
+ * Permission is hereby granted, free of charge, to any person
+ * obtaining a copy of this software and associated documentation
+ * files (the "Software"), to deal in the Software without
+ * restriction, including without limitation the rights to use,
+ * copy, modify, merge, publish, distribute, sublicense, and/or
+ * sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following
+ * conditions:
+ *
+ * The above copyright notice and this permission notice shall be
+ * included in all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
+ * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES
+ * OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
+ * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT
+ * HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
+ * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
+ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
+ * OTHER DEALINGS IN THE SOFTWARE.
+ * ===============================================================
+ */
+
+#include <string.h>
+#include "uzura.h"
+#include "effect.h"
+#include "system.h"
+#include "lcd.h"
+#include "led.h"
+#include "rotenc.h"
+#include <window.h>
+#include <filter.h>
+#include <math.h>
+
+/**
+ * @brief FFT calculation size.
+ */
+#define FFT_CALCSIZE (64)
+
+/**
+ * @brief FFT display bands.
+ */
+#define FFT_DISPBANDS (40)
+
+/**
+ * @brief sampling frequency.
+ */
+#define SAMPLE_FREQ (48000)
+
+/**
+ * @brief Check the band.
+ *
+ * @param N band index.
+ */
+#define IS_VALID_BAND(N) (((SAMPLE_FREQ / FFT_CALCSIZE) * (N)) < (SAMPLE_FREQ / 2.00))
+
+/**
+ * @note
+ * FFT calculation size given by FFT_CALCSIZE.
+ * The frequency resolution (fr) of the FFT given by (fs / FFT_CALCSIZE).
+ *
+ * =================================================
+ * fmax[Hz] fmax[Hz]
+ * FFT_CALCSIZE fr[Hz] 8 bands 40 bands
+ * =================================================
+ * 16 3000.0 24,000 120,000
+ * 32 1500.0 12,000 60,000
+ * 64 750.0 6,000 30,000
+ * 128 375.0 3,000 15,000
+ * 256 187.5 1,500 7,500
+ * =================================================
+ *
+ * (Example) fs = 48000, FFT_CALCSIZE = 128
+ * The frequency resolution (fr) is fr = (fs / FFT_CALCSIZE) = 48000 / 128 = 375[Hz].
+ * The maximum display frequency in FFT_BANDS = 40 is fmax = (fr * FFT_BANDS) = 375 * 40 = 15000[Hz].
+ */
+
+/**
+ * @brief FFT calculation data structure.
+ */
+typedef struct {
+ fract16 window[FFT_CALCSIZE];
+ fract16 input[FFT_CALCSIZE];
+ complex_fract16 output[FFT_CALCSIZE];
+ complex_fract16 twiddle[FFT_CALCSIZE / 2];
+} fft_t;
+
+typedef struct {
+ UZURA uzura;
+ int volume;
+ char volmsg[9];
+ fft_t fft;
+ FontSet fontset;
+} work_t;
+
+static void update_volmsg(work_t *w, const int vol)
+{
+ int nnn = (vol == 100) ? 1 : 0;
+ int nn = (vol == 100) ? 0 : (vol / 10);
+ int n = (vol == 100) ? 0 : (vol - (nn * 10));
+ w->volmsg[5] = '0' + nnn;
+ w->volmsg[6] = '0' + nn;
+ w->volmsg[7] = '0' + n;
+}
+
+static fract16 lrmix(int32_t left, int32_t right, fract16 window)
+{
+ int32_t val;
+ asm("%1 >>>= 1; %2 >>>= 1; %1 = %1 + %2; %0.L = %1(RND); %0.L = %0.L * %3.L; %0 = %0.L(X);" : "=d"(val) : "d"(left), "d"(right), "d"(window));
+ return (fract16)val;
+}
+
+static void effect_fft(
+ UZURA *p,
+ const int32_t *src, int32_t *des, int32_t count)
+{
+ int32_t lc, ld;
+ int block_exp;
+
+ /*
+ * Get the user data from the UZURA framework.
+ */
+ work_t *w = (work_t *)UZURA_USER_DATA(p);
+ fract16 *window = w->fft.window;
+ fract16 *input = w->fft.input;
+ complex_fract16 *output = w->fft.output;
+ complex_fract16 *twiddle = w->fft.twiddle;
+
+ /*
+ * Copy data to the destination buffer.
+ */
+ effect_through(p, src, des, count);
+
+ /*
+ * Combine the L/R channel data with the window function.
+ * The destination data bit width is 16bit.
+ */
+ for (lc = 0, ld = 0; lc < FFT_CALCSIZE; lc++, ld += 2) {
+ input[lc] = lrmix(src[ld], src[ld + 1], window[lc]);
+ }
+
+ /*
+ * 16bit real FFT
+ */
+ rfft_fr16(input, output, twiddle, 1, FFT_CALCSIZE, &block_exp, 1);
+}
+
+static void system_speana(UZURA *p)
+{
+ int32_t lc;
+ float re, im, ps;
+ int32_t level;
+ static uint32_t refresh_target = 0;
+
+ /*
+ * Get the user data from the UZURA framework.
+ */
+ work_t *w = (work_t *)UZURA_USER_DATA(p);
+ complex_fract16 *output = w->fft.output;
+
+ /*
+ * Calculate the FFT in floating point.
+ * We need to convert it to fixed point if we need to keep a performance.
+ */
+
+ /*
+ * Calculate the power spectrum.
+ */
+ lc = refresh_target % FFT_DISPBANDS;
+ re = (float)output[lc].re / (float)32768;
+ im = (float)output[lc].im / (float)32768;
+ ps = sqrtf(re * re + im * im);
+
+ /*
+ * Round out the result.
+ */
+ ps = fmax(ps, 0.000030517578125);
+
+ /*
+ * Convert it to dB range.
+ * Normalize it to -10.4 to 0.35.
+ */
+ ps = (float)(20.0 / 8.7) * log10f(ps);
+
+ /*
+ * Clipping in 0 to 7.
+ */
+ level = (int32_t)ps + 8;
+ if (level < 0) {
+ level = 0;
+ }
+ if (7 < level) {
+ level = 7;
+ }
+
+ /*
+ * Update the LCD fonts.
+ */
+ if (lc == 0) {
+ lcd_font_init(&(w->fontset));
+ }
+ if (IS_VALID_BAND(lc)) {
+ lcd_font_draw_line(
+ &(w->fontset), (UserFont)lc / LCD_FONT_WIDTH,
+ lc % LCD_FONT_WIDTH, (LCD_FONT_HEIGHT - 1) - level,
+ lc % LCD_FONT_WIDTH, (LCD_FONT_HEIGHT - 1),
+ 1);
+ } else {
+ lcd_font_draw_line(
+ &(w->fontset), (UserFont)lc / LCD_FONT_WIDTH,
+ lc % LCD_FONT_WIDTH, (LCD_FONT_HEIGHT - 1),
+ lc % LCD_FONT_WIDTH, (LCD_FONT_HEIGHT - 1),
+ 1);
+ }
+ if (((lc + 1) % LCD_FONT_WIDTH) == 0) {
+ lcd_font_setup_single(&(w->fontset), (UserFont)lc / LCD_FONT_WIDTH);
+ }
+
+ /*
+ * Update the volume display.
+ */
+ static int prev_volume = 0;
+ if (prev_volume != w->volume) {
+ update_volmsg(w, w->volume);
+ lcd_goto(0, 1);
+ lcd_puts(w->volmsg);
+ prev_volume = w->volume;
+ }
+
+ refresh_target++;
+}
+
+static void rotenc_callback(RotencAction action, void *extobj)
+{
+ work_t *w = (work_t *)extobj;
+ if (RotencActionPush == action) {
+ // Nothing to do.
+ }
+ if (RotencActionLeft == action) {
+ if (0 < w->volume) {
+ w->volume--;
+ effect_param_volume(w->volume / 100.0, w->volume / 100.0);
+ }
+ }
+ if (RotencActionRight == action) {
+ if (w->volume < 100) {
+ w->volume++;
+ effect_param_volume(w->volume / 100.0, w->volume / 100.0);
+ }
+ }
+}
+
+int main(void)
+{
+ work_t w;
+
+ w.volume = 100;
+ strcpy(w.volmsg, "VOL: 100");
+ lcd_goto(0, 0);
+ lcd_puts("\x08\x09\x0A\x0B\x0C\x0D\x0E\x0F");
+
+ /*
+ * Generate window.
+ */
+#if 0
+ /*
+ * Select window function from the three types of the window.
+ */
+ gen_hamming_fr16(w.fft.window, 1, FFT_CALCSIZE);
+ gen_rectangular_fr16(w.fft.window, 1, FFT_CALCSIZE);
+ gen_hanning_fr16(w.fft.window, 1, FFT_CALCSIZE);
+#else
+ gen_hanning_fr16(w.fft.window, 1, FFT_CALCSIZE);
+#endif
+
+ /*
+ * Generate twiddle factor table.
+ */
+ twidfftrad2_fr16(w.fft.twiddle, FFT_CALCSIZE);
+
+ effect_param_init();
+ uzura_init(&w.uzura, &w);
+ uzura_set_effect(&w.uzura, effect_fft);
+ uzura_set_system(&w.uzura, system_speana);
+ led_write(LedTargetR, 1);
+ led_write(LedTargetG, 1);
+ rotenc_init(rotenc_callback, &w);
+ uzura_execute(&w.uzura);
+
+ return 0;
+}
+
--- /dev/null
+#
+# Project name (also used for output file name)
+#
+PROJECT = bluetank
+
+#
+# Source files and search directories
+#
+CSRC += lcd.c led.c rotenc.c
+CSRC += mmc.c pff.c
+CSRC += twi.c uart.c
+CSRC += ssm2603.c at24c.c
+CSRC += bfin_util.c uzura.c
+CSRC += tinyrand.c
+CSRC += effect.c system.c main.c
+ASRC +=
+VPATH = ../common/
+
+#
+# Optimization level (0, 1, 2, 3, 4 or s)
+#
+OPTIMIZE = s
+
+#
+# C Standard level (c89, gnu89, c99 or gnu99)
+#
+CSTD = gnu89
+
+#
+# Processor type for CSRC/ASRC files.
+#
+CPU = bf592-any
+
+#
+# Linker script for the target MCU
+#
+LINKSCRIPT =
+
+#
+# Output file format (ihex, bin or both) and debugger type
+#
+OUTPUT = ihex
+DEBUG = dwarf-2
+
+#
+# Include dirs, library dirs and definitions
+#
+LIBS =
+LIBDIRS =
+INCDIRS = ../common/
+DEFS =
+ADEFS =
+
+#
+# Warning contorls
+#
+WARNINGS = all extra
+
+#
+# Object output directory
+#
+OBJDIR = obj
+
+#
+# Programs to build porject
+#
+CC = bfin-elf-gcc
+OBJCOPY = bfin-elf-objcopy
+OBJDUMP = bfin-elf-objdump
+SIZE = bfin-elf-size
+NM = bfin-elf-nm
+
+#
+# Define all object files
+#
+COBJ = $(CSRC:.c=.o)
+AOBJ = $(ASRC:.S=.o)
+COBJ := $(addprefix $(OBJDIR)/,$(COBJ))
+AOBJ := $(addprefix $(OBJDIR)/,$(AOBJ))
+PROJECT := $(OBJDIR)/$(PROJECT)
+
+#
+# Flags for C files
+#
+CFLAGS += -std=$(CSTD)
+CFLAGS += -g$(DEBUG)
+CFLAGS += -O$(OPTIMIZE)
+CFLAGS += -fmessage-length=0
+CFLAGS += $(addprefix -W,$(WARNINGS))
+CFLAGS += $(addprefix -I,$(INCDIRS))
+CFLAGS += $(addprefix -D,$(DEFS))
+CFLAGS += -Wp,-M,-MP,-MT,$(OBJDIR)/$(*F).o,-MF,$(OBJDIR)/$(*F).d
+
+#
+# Assembler flags
+#
+ASFLAGS += $(addprefix -D,$(ADEFS)) -Wa,-g$(DEBUG)
+
+#
+# Linker flags
+#
+LDFLAGS += -Wl,-Map=$(PROJECT).map,--cref,--gc-sections
+LDFLAGS += -lc -lgcc -lbfdsp -lm
+LDFLAGS += $(patsubst %,-L%,$(LIBDIRS)) $(patsubst %,-l%,$(LIBS))
+#LDFLAGS += -T$(LINKSCRIPT)
+#LDFLAGS += -nostartfiles
+#LDFLAGS += -nodefaultlibs
+#LDFLAGS += -nostdlib
+#LDFLAGS += -fno-builtin
+
+# Combine all necessary flags and optional flags.
+# Add target processor to flags.
+ALL_CFLAGS = -mcpu=$(CPU) -I. $(CFLAGS)
+ALL_ASFLAGS = -mcpu=$(CPU) -I. -x assembler-with-cpp $(ASFLAGS)
+
+#
+# Default target.
+#
+all: version build size
+
+ifeq ($(OUTPUT),ihex)
+build: elf hex lst sym
+hex: $(PROJECT).hex
+else
+ifeq ($(OUTPUT),binary)
+build: elf bin lst sym
+bin: $(PROJECT).bin
+else
+ifeq ($(OUTPUT),both)
+build: elf hex bin lst sym
+hex: $(PROJECT).hex
+bin: $(PROJECT).bin
+else
+$(error "Invalid format: $(OUTPUT)")
+endif
+endif
+endif
+
+elf: $(PROJECT).elf
+lst: $(PROJECT).lst
+sym: $(PROJECT).sym
+
+#
+# Display compiler version information.
+#
+version :
+ @$(CC) --version
+
+#
+# Create final output file (.hex or .bin) from ELF output file.
+#
+%.hex: %.elf
+ @echo
+ $(OBJCOPY) -O ihex $< $@
+
+%.bin: %.elf
+ @echo
+ $(OBJCOPY) -O binary $< $@
+
+#
+# Create extended listing file from ELF output file.
+#
+%.lst: %.elf
+ @echo
+ $(OBJDUMP) -h -S -C $< > $@
+
+#
+# Create a symbol table from ELF output file.
+#
+%.sym: %.elf
+ @echo
+ $(NM) -n $< > $@
+
+#
+# Display size of file.
+#
+size:
+ @echo
+ $(SIZE) -A $(PROJECT).elf
+
+#
+# Link: create ELF output file from object files.
+#
+%.elf: $(AOBJ) $(COBJ)
+ @echo
+ @echo Linking...
+ $(CC) $(ALL_CFLAGS) $(AOBJ) $(COBJ) --output $@ $(LDFLAGS)
+
+#
+# Compile: create object files from C source files.
+#
+$(COBJ) : $(OBJDIR)/%.o : %.c
+ @echo
+ @echo $< :
+ $(CC) -c $(ALL_CFLAGS) $< -o $@
+
+#
+# Assemble: create object files from assembler source files.
+#
+$(AOBJ) : $(OBJDIR)/%.o : %.S
+ @echo
+ @echo $< :
+ $(CC) -c $(ALL_ASFLAGS) $< -o $@
+
+#
+# Target: clean project.
+#
+clean:
+ @echo
+ rm -f -r $(OBJDIR) | exit 0
+
+#
+# Load: Load ldr for Blackfin
+#
+load:
+ bfin-elf-ldr -T BF592 -c $(PROJECT).ldr $(PROJECT).elf
+ bfin-elf-ldr -l $(PROJECT).ldr /dev/ttyUSB0 -b 57600 -C
+
+#
+# Console: Console
+#
+console:
+ minicom -b 57600 -D /dev/ttyUSB0
+
+#
+# Include the dependency files.
+#
+-include $(shell mkdir $(OBJDIR) 2>/dev/null) $(wildcard $(OBJDIR)/*.d)
+
OSDN Git Service
