diff --git a/Makefile b/Makefile new file mode 100644 index 000000000..8a925f4aa --- /dev/null +++ b/Makefile @@ -0,0 +1,79 @@ +#Derived from Atollic True Studio Makefile by Prof. Greg Egan 2012 + +SHELL=cmd + +# System configuration - UNCOMMENT AS DESIRED + +#Atollic TrueStudio +#CC = "C:\Program Files (x86)\Atollic\TrueSTUDIO for STMicroelectronics STM32 Lite 2.3.0\ARMTools\bin\arm-atollic-eabi-gcc" +# OBJCOPY NOT PERMITTED IN FREEBY! +#OBJCOPY = "C:\Program Files (x86)\Atollic\TrueSTUDIO for STMicroelectronics STM32 Lite 2.3.0\ARMTools\bin\arm-atollic-eabi-objcopy" +#OPT = -Os + +#Yagarto currently gcc 4.6.2 +#CC = "C:\Program Files (x86)\yagarto\bin\arm-none-eabi-gcc" +#OBJCOPY = "C:\Program Files (x86)\yagarto\bin\arm-none-eabi-objcopy" +#OPT = -Os + +#Code Sourcery current gcc 4.6.1 +CC = arm-none-eabi-gcc +OPT = -Os +OBJCOPY = arm-none-eabi-objcopy + +RM = rm -rf + +# Define output directory +OBJECT_DIR = obj +BIN_DIR = $(OBJECT_DIR) +LINK_SCRIPT="stm32_flash.ld" + +# Assembler, Compiler and Linker flags and linker script settings +LINKER_FLAGS=-lm -mthumb -mcpu=cortex-m3 -Wl,--gc-sections -T$(LINK_SCRIPT) -static -Wl,-cref "-Wl,-Map=$(BIN_DIR)/baseflight.map" -Wl,--defsym=malloc_getpagesize_P=0x1000 +ASSEMBLER_FLAGS=-c $(OPT) -mcpu=cortex-m3 -mthumb -x assembler-with-cpp -Isrc -Ilib/STM32F10x_StdPeriph_Driver/inc -Ilib/CMSIS\CM3/CoreSupport -Ilib/CMSIS/CM3/DeviceSupport/ST\STM32F10x +COMPILER_FLAGS=-c -mcpu=cortex-m3 $(OPT) -Wall -ffunction-sections -fdata-sections -mthumb -DSTM32F10X_MD -DUSE_STDPERIPH_DRIVER -Isrc -Ilib/STM32F10x_StdPeriph_Driver/inc -Ilib/CMSIS\CM3/CoreSupport -Ilib/CMSIS/CM3/DeviceSupport/ST\STM32F10x + +# Define sources and objects +SRC := $(wildcard */*/*/*/*/*/*/*.c) \ + $(wildcard */*/*/*/*/*/*.c) \ + $(wildcard */*/*/*/*/*.c) \ + $(wildcard */*/*/*/*.c) \ + $(wildcard */*/*/*.c) \ + $(wildcard */*/*.c) \ + $(wildcard */*.c) +SRCSASM := $(wildcard */*/startup_stm32f10x_md_gcc.s) \ +#SRCSASM := $(wildcard */*/*/*/*/*/*/*/*.s) \ +# $(wildcard */*/*/*/*/*/*/*.s) \ +# $(wildcard */*/*/*/*/*/*.s) \ +# $(wildcard */*/*/*/*/*.s) \ +# $(wildcard */*/*/*/*.s) \ +# $(wildcard */*/*/*.s) \ +# $(wildcard */*/*.s) \ +# $(wildcard */*.s) +OBJS := $(SRC:%.c=$(OBJECT_DIR)/%.o) $(SRCSASM:%.s=$(OBJECT_DIR)/%.o) +OBJS := $(OBJS:%.S=$(OBJECT_DIR)/%.o) + +all: buildelf + $(OBJCOPY) -O ihex "$(BIN_DIR)/baseflight.elf" "$(BIN_DIR)/baseflight.hex" + +buildelf: $(OBJS) + $(CC) -o "$(BIN_DIR)/baseflight.elf" $(OBJS) $(LINKER_FLAGS) + +clean: + $(RM) $(OBJS) "$(BIN_DIR)/*.*" +# $(RM) $(OBJS) "$(BIN_DIR)/baseflight.elf" "$(BIN_DIR)/baseflight.map" "$(BIN_DIR)/src/*.*" "$(BIN_DIR)/lib/*.*" + +$(OBJECT_DIR)/main.o: main.c + @mkdir $(subst /,\,$(dir $@)) 2> NUL || echo off + $(CC) $(COMPILER_FLAGS) main.c -o $(OBJECT_DIR)/main.o + +$(OBJECT_DIR)/%.o: %.c + @mkdir $(subst /,\,$(dir $@)) 2> NUL || echo off + $(CC) $(COMPILER_FLAGS) $< -o $@ + +$(OBJECT_DIR)/%.o: %.s + @mkdir $(subst /,\,$(dir $@)) 2> NUL || echo off + $(CC) $(ASSEMBLER_FLAGS) $< -o $@ + +$(OBJECT_DIR)/%.o: %.S + @mkdir $(subst /,\,$(dir $@)) 2> NUL || echo off + $(CC) $(ASSEMBLER_FLAGS) $< -o $@ diff --git a/baseflight.uvgui.timecop b/baseflight.uvgui.timecop deleted file mode 100755 index 92581a73d..000000000 --- a/baseflight.uvgui.timecop +++ /dev/null @@ -1,8161 +0,0 @@ - - - - -2.1 - -
### uVision Project, (C) Keil Software
- - - - - - 38003 - Registers - 115 100 - - - 346 - Code Coverage - 1136 665 - - - 204 - Performance Analyzer - 1296 194 194 132 - - - - - - 1506 - Symbols - - 133 133 133 - - - 1936 - Watch 1 - - 133 133 133 - - - 1937 - Watch 2 - - 133 133 133 - - - 1935 - Call Stack + Locals - - 133 133 133 - - - 2506 - Trace Data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uild - - -1 - -1 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - DE0000004B000000F8050000EA000000 - - - 16 - DE0000005E000000F8050000FD000000 - - - - 1005 - 1005 - 1 - 0 - 0 - 1 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D7000000D2020000 - - - 16 - 9E000000B10000007801000030030000 - - - - 109 - 109 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D7000000D2020000 - - - 16 - 9E000000B10000007801000030030000 - - - - 1465 - 1465 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1466 - 1466 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1467 - 1467 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1468 - 1468 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1506 - 1506 - 0 - 0 - 0 - 0 - 32767 - 0 - 16384 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 1913 - 1913 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000062000000F5050000D1000000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1935 - 1935 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 1936 - 1936 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 1937 - 1937 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 1939 - 1939 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1940 - 1940 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1941 - 1941 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 1942 - 1942 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 030000006F020000F5050000F2020000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 195 - 195 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D7000000D2020000 - - - 16 - 9E000000B10000007801000030030000 - - - - 196 - 196 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D7000000D2020000 - - - 16 - 9E000000B10000007801000030030000 - - - - 197 - 197 - 1 - 0 - 0 - 1 - 32767 - 0 - 32768 - 0 - - 16 - 0300000006030000FD07000025040000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 198 - 198 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0000000058020000F80500000B030000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 199 - 199 - 1 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0300000006030000FD07000025040000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 203 - 203 - 0 - 0 - 0 - 0 - 32767 - 0 - 8192 - 0 - - 16 - E100000062000000F5050000D1000000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 204 - 204 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000062000000F5050000D1000000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 221 - 221 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 00000000000000000000000000000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 2506 - 2506 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000062000000F5050000D1000000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 343 - 343 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000062000000F5050000D1000000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 346 - 346 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000062000000F5050000D1000000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 35824 - 35824 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000062000000F5050000D1000000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 35885 - 35885 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35886 - 35886 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35887 - 35887 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35888 - 35888 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35889 - 35889 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35890 - 35890 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35891 - 35891 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35892 - 35892 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35893 - 35893 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35894 - 35894 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35895 - 35895 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35896 - 35896 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35897 - 35897 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35898 - 35898 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35899 - 35899 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35900 - 35900 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35901 - 35901 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35902 - 35902 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35903 - 35903 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35904 - 35904 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 35905 - 35905 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000062000000F5050000F2020000 - - - 16 - 9E000000B10000002E02000041020000 - - - - 38003 - 38003 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D7000000D2020000 - - - 16 - 9E000000B10000007801000030030000 - - - - 38007 - 38007 - 1 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0300000006030000FD07000025040000 - - - 16 - 9E000000B10000009A03000050010000 - - - - 49858 - 49858 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49859 - 49859 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49860 - 49860 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49861 - 49861 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49862 - 49862 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49911 - 49911 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49912 - 49912 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49929 - 49929 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49930 - 49930 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49933 - 49933 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49934 - 49934 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49937 - 49937 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49938 - 49938 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49939 - 49939 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49940 - 49940 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49941 - 49941 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49942 - 49942 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49943 - 49943 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49945 - 49945 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49946 - 49946 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49947 - 49947 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49950 - 49950 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49995 - 49995 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50001 - 50001 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50006 - 50006 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50008 - 50008 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50009 - 50009 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50010 - 50010 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50011 - 50011 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50012 - 50012 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50018 - 50018 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50019 - 50019 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50020 - 50020 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50023 - 50023 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50029 - 50029 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50034 - 50034 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50063 - 50063 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50064 - 50064 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50065 - 50065 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50066 - 50066 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50067 - 50067 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50068 - 50068 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50069 - 50069 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50074 - 50074 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50113 - 50113 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50120 - 50120 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50123 - 50123 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50146 - 50146 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50152 - 50152 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50165 - 50165 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50183 - 50183 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50185 - 50185 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50188 - 50188 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50189 - 50189 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50190 - 50190 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50227 - 50227 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50237 - 50237 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50246 - 50246 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50260 - 50260 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50325 - 50325 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50357 - 50357 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50367 - 50367 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50374 - 50374 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50375 - 50375 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50376 - 50376 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50382 - 50382 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50386 - 50386 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50387 - 50387 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50388 - 50388 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50389 - 50389 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50390 - 50390 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50393 - 50393 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50407 - 50407 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50410 - 50410 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50411 - 50411 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50413 - 50413 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50415 - 50415 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50428 - 50428 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50448 - 50448 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50470 - 50470 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50489 - 50489 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50529 - 50529 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50530 - 50530 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50531 - 50531 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50532 - 50532 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50533 - 50533 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50534 - 50534 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50536 - 50536 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50537 - 50537 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50538 - 50538 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50539 - 50539 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50557 - 50557 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50562 - 50562 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50564 - 50564 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50570 - 50570 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50571 - 50571 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50580 - 50580 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50604 - 50604 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50634 - 50634 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50635 - 50635 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50637 - 50637 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50640 - 50640 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50645 - 50645 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50646 - 50646 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50649 - 50649 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50666 - 50666 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50671 - 50671 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50678 - 50678 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50680 - 50680 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50686 - 50686 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50687 - 50687 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50698 - 50698 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50704 - 50704 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50708 - 50708 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50710 - 50710 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50719 - 50719 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50721 - 50721 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50723 - 50723 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50724 - 50724 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50730 - 50730 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50734 - 50734 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50741 - 50741 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50743 - 50743 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50745 - 50745 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50746 - 50746 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50748 - 50748 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50751 - 50751 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50758 - 50758 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50761 - 50761 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50764 - 50764 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50770 - 50770 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50771 - 50771 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50775 - 50775 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50784 - 50784 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50786 - 50786 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50791 - 50791 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50793 - 50793 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50796 - 50796 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50801 - 50801 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50803 - 50803 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50804 - 50804 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50818 - 50818 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50826 - 50826 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50841 - 50841 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50846 - 50846 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50848 - 50848 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50852 - 50852 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50864 - 50864 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50890 - 50890 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50912 - 50912 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50913 - 50913 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50914 - 50914 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50915 - 50915 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000082020000930100009B020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50916 - 50916 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59392 - 59392 - 1 - 0 - 0 - 0 - 882 - 0 - 8192 - 0 - - 16 - 00000000000000007D0300001A000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59393 - 0 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 000000003E0400000008000051040000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59398 - 59398 - 1 - 0 - 0 - 0 - 373 - 0 - 8192 - 1 - - 16 - 000000001A0000008001000034000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 593980 - 59398 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 00000000000000000008000017000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59399 - 59399 - 0 - 0 - 0 - 0 - 602 - 0 - 8192 - 2 - - 16 - 0000000034000000650200004E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 2463 - 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 - - - 59392 - File - - 2002 - 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 - - - 1423 - 2800FFFF01001100434D4643546F6F6C426172427574746F6E00E1000000000000FFFFFFFF000100000000000000010000000000000001000000018001E1000000000000FFFFFFFF000100000000000000010000000000000001000000018003E1000000000000FFFFFFFF0001000000000000000100000000000000010000000180CD7F000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF000000000000000000010000000000000001000000018023E1000000000000FFFFFFFF000100000000000000010000000000000001000000018022E1000000000000FFFFFFFF000100000000000000010000000000000001000000018025E1000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF00000000000000000001000000000000000100000001802BE1000000000000FFFFFFFF00010000000000000001000000000000000100000001802CE1000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF00000000000000000001000000000000000100000001807A8A000000000000FFFFFFFF00010000000000000001000000000000000100000001807B8A000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF0000000000000000000100000000000000010000000180D3B0000000000000FFFFFFFF000100000000000000010000000000000001000000018015B1000000000000FFFFFFFF0001000000000000000100000000000000010000000180F4B0000000000000FFFFFFFF000100000000000000010000000000000001000000018036B1000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF0000000000000000000100000000000000010000000180FF88000000000000FFFFFFFF0001000000000000000100000000000000010000000180FE88000000000000FFFFFFFF00010000000000000001000000000000000100000001800B81000000000000FFFFFFFF00010000000000000001000000000000000100000001800C81000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF0000000000000000000100000000000000010000000180F088000000000000FFFFFFFF0001000000000000000100000000000000010000000180EE7F000000000000FFFFFFFF000100000000000000010000000000000001000000018024E1000000000000FFFFFFFF00010000000000000001000000000000000100000001800A81000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF00000000000000000001000000000000000100000001802280000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF0000000000000000000100000000000000010000000180C488000000000000FFFFFFFF0001000000000000000100000000000000010000000180C988000000000000FFFFFFFF0001000000000000000100000000000000010000000180C788000000000000FFFFFFFF0001000000000000000100000000000000010000000180C888000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF0000000000000000000100000000000000010000000180DD88000000000000FFFFFFFF00010000000000000001000000000000000100000001800000000000000000FFFFFFFF0000000000000000000100000000000000010000000180FB7F000000000000FFFFFFFF000100000000000000010000000000000001000000 - - - 1423 - 2800FFFF01001100434D4643546F6F6C426172427574746F6E00E100000000000000000000000000000000000000000000000100000001000000018001E100000000000001000000000000000000000000000000000100000001000000018003E1000000000000020000000000000000000000000000000001000000010000000180CD7F0000000000000300000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF000000000000000000000000000100000001000000018023E100000000000004000000000000000000000000000000000100000001000000018022E100000000000005000000000000000000000000000000000100000001000000018025E10000000000000600000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF00000000000000000000000000010000000100000001802BE10000000000000700000000000000000000000000000000010000000100000001802CE10000000000000800000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF00000000000000000000000000010000000100000001807A8A0000000000000900000000000000000000000000000000010000000100000001807B8A0000000000000A00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180D3B00000000000000B000000000000000000000000000000000100000001000000018015B10000000000000C0000000000000000000000000000000001000000010000000180F4B00000000000000D000000000000000000000000000000000100000001000000018036B10000000000000E00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180FF880000000000000F0000000000000000000000000000000001000000010000000180FE880000000000001000000000000000000000000000000000010000000100000001800B810000000000001100000000000000000000000000000000010000000100000001800C810000000000001200000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180F088000000000000130000000000000000000000000000000001000000010000000180EE7F00000000000014000000000000000000000000000000000100000001000000018024E10000000000001500000000000000000000000000000000010000000100000001800A810000000000001600000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF000000000000000000000000000100000001000000018022800000000000001700000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180C488000000000000180000000000000000000000000000000001000000010000000180C988000000000000190000000000000000000000000000000001000000010000000180C7880000000000001A0000000000000000000000000000000001000000010000000180C8880000000000001B00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180DD880000000000001C00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180FB7F0000000000001D000000000000000000000000000000000100000001000000 - - - - 59398 - Build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ebug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ebug - - -1 - -1 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - DE0000004B0000000008000012010000 - - - 16 - DE0000005E0000000008000025010000 - - - - 1005 - 1005 - 1 - 0 - 0 - 1 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D700000003030000 - - - 16 - 1A0000002D000000F4000000AC020000 - - - - 109 - 109 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D700000003030000 - - - 16 - 1A0000002D000000F4000000AC020000 - - - - 1465 - 1465 - 1 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1466 - 1466 - 1 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1467 - 1467 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1468 - 1468 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1506 - 1506 - 0 - 0 - 0 - 0 - 32767 - 0 - 16384 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 1913 - 1913 - 0 - 0 - 0 - 0 - 32767 - 0 - 8192 - 0 - - 16 - E100000062000000FD070000F9000000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1935 - 1935 - 1 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 1936 - 1936 - 1 - 0 - 0 - 1 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 1937 - 1937 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 1939 - 1939 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1940 - 1940 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1941 - 1941 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 1942 - 1942 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 0704000037030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 195 - 195 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D700000003030000 - - - 16 - 1A0000002D000000F4000000AC020000 - - - - 196 - 196 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D700000003030000 - - - 16 - 1A0000002D000000F4000000AC020000 - - - - 197 - 197 - 0 - 0 - 0 - 0 - 32767 - 0 - 32768 - 0 - - 16 - 03000000A2030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 198 - 198 - 1 - 0 - 0 - 1 - 32767 - 0 - 32768 - 0 - - 16 - 0000000020030000000400003E040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 199 - 199 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 03000000A2030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 203 - 203 - 1 - 0 - 0 - 1 - 32767 - 0 - 8192 - 0 - - 16 - DE0000005F0000000008000012010000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 204 - 204 - 0 - 0 - 0 - 0 - 32767 - 0 - 8192 - 0 - - 16 - E100000062000000FD070000F9000000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 221 - 221 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 00000000000000000000000000000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 2506 - 2506 - 0 - 0 - 0 - 0 - 32767 - 0 - 8192 - 0 - - 16 - E100000062000000FD070000F9000000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 343 - 343 - 0 - 0 - 0 - 0 - 32767 - 0 - 8192 - 0 - - 16 - E100000062000000FD070000F9000000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 346 - 346 - 0 - 0 - 0 - 0 - 32767 - 0 - 8192 - 0 - - 16 - E100000062000000FD070000F9000000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 35824 - 35824 - 0 - 0 - 0 - 0 - 32767 - 0 - 8192 - 0 - - 16 - E100000062000000FD070000F9000000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 35885 - 35885 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35886 - 35886 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35887 - 35887 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35888 - 35888 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35889 - 35889 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35890 - 35890 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35891 - 35891 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35892 - 35892 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35893 - 35893 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35894 - 35894 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35895 - 35895 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35896 - 35896 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35897 - 35897 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35898 - 35898 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35899 - 35899 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35900 - 35900 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35901 - 35901 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35902 - 35902 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35903 - 35903 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35904 - 35904 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 35905 - 35905 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000062000000FD07000003030000 - - - 16 - 1A0000002D000000AA010000BD010000 - - - - 38003 - 38003 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0300000062000000D700000003030000 - - - 16 - 1A0000002D000000F4000000AC020000 - - - - 38007 - 38007 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 03000000A2030000FD07000025040000 - - - 16 - 1A0000002D00000016030000CC000000 - - - - 49858 - 49858 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49859 - 49859 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49860 - 49860 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49861 - 49861 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49862 - 49862 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49911 - 49911 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49912 - 49912 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49929 - 49929 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49930 - 49930 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49933 - 49933 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49934 - 49934 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49937 - 49937 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49938 - 49938 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49939 - 49939 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49940 - 49940 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49941 - 49941 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49942 - 49942 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49943 - 49943 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49945 - 49945 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49946 - 49946 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49947 - 49947 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49950 - 49950 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 49995 - 49995 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50001 - 50001 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50006 - 50006 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50008 - 50008 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50009 - 50009 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50010 - 50010 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50018 - 50018 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50019 - 50019 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50020 - 50020 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50023 - 50023 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50034 - 50034 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50063 - 50063 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50064 - 50064 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50065 - 50065 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50066 - 50066 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400003F0200009705000058020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50067 - 50067 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400003F0200009705000058020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50068 - 50068 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400003F0200009705000058020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50069 - 50069 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50074 - 50074 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50113 - 50113 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50120 - 50120 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50123 - 50123 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50146 - 50146 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50152 - 50152 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50165 - 50165 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50183 - 50183 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50185 - 50185 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50188 - 50188 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50189 - 50189 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50190 - 50190 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50227 - 50227 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50237 - 50237 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50246 - 50246 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50325 - 50325 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50357 - 50357 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50367 - 50367 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50374 - 50374 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50375 - 50375 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50382 - 50382 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50387 - 50387 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50390 - 50390 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50393 - 50393 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50407 - 50407 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50410 - 50410 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50411 - 50411 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50415 - 50415 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50428 - 50428 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50470 - 50470 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50529 - 50529 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50530 - 50530 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50531 - 50531 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50532 - 50532 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50533 - 50533 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50534 - 50534 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50536 - 50536 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50537 - 50537 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50538 - 50538 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400009302000097050000AC020000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50539 - 50539 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50564 - 50564 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50570 - 50570 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50571 - 50571 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50580 - 50580 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50604 - 50604 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50645 - 50645 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50646 - 50646 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50649 - 50649 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50666 - 50666 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50671 - 50671 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50686 - 50686 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50687 - 50687 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50698 - 50698 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50704 - 50704 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 6B04000075000000F50500008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50708 - 50708 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50710 - 50710 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50724 - 50724 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000690600008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50731 - 50731 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7006000072000000000800008B000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50741 - 50741 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50743 - 50743 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50745 - 50745 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50746 - 50746 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50748 - 50748 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000690600008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50751 - 50751 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50758 - 50758 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50761 - 50761 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50764 - 50764 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50770 - 50770 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50771 - 50771 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50775 - 50775 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50784 - 50784 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50786 - 50786 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50791 - 50791 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50793 - 50793 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50801 - 50801 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50803 - 50803 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50804 - 50804 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50818 - 50818 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50826 - 50826 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50846 - 50846 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7306000075000000FD0700008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50848 - 50848 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50852 - 50852 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 070400004A0300009705000063030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50864 - 50864 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - E100000075000000690600008E000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50890 - 50890 - 0 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 0704000023030000970500003C030000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 50977 - 50977 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 7006000072000000000800008B000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59392 - 59392 - 1 - 0 - 0 - 0 - 882 - 0 - 8192 - 0 - - 16 - 00000000000000007D0300001A000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59393 - 0 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 000000003E0400000008000051040000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59398 - 59398 - 0 - 0 - 0 - 0 - 373 - 0 - 8192 - 1 - - 16 - 000000001A0000008001000034000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 593980 - 59398 - 1 - 0 - 0 - 0 - 32767 - 0 - 4096 - 0 - - 16 - 00000000000000000008000017000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 59399 - 59399 - 1 - 0 - 0 - 0 - 602 - 0 - 8192 - 2 - - 16 - 000000001A0000006502000034000000 - - - 16 - 0A0000000A0000006E0000006E000000 - - - - 2466 - 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 - - - 59392 - File - - 2002 - 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 - - - 1423 - 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 - - - 1423 - 2800FFFF01001100434D4643546F6F6C426172427574746F6E00E100000000000000000000000000000000000000000000000100000001000000018001E100000000000001000000000000000000000000000000000100000001000000018003E1000000000000020000000000000000000000000000000001000000010000000180CD7F0000000000000300000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF000000000000000000000000000100000001000000018023E100000000000004000000000000000000000000000000000100000001000000018022E100000000000005000000000000000000000000000000000100000001000000018025E10000000000000600000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF00000000000000000000000000010000000100000001802BE10000000000000700000000000000000000000000000000010000000100000001802CE10000000000000800000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF00000000000000000000000000010000000100000001807A8A0000000000000900000000000000000000000000000000010000000100000001807B8A0000000000000A00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180D3B00000000000000B000000000000000000000000000000000100000001000000018015B10000000000000C0000000000000000000000000000000001000000010000000180F4B00000000000000D000000000000000000000000000000000100000001000000018036B10000000000000E00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180FF880000000000000F0000000000000000000000000000000001000000010000000180FE880000000000001000000000000000000000000000000000010000000100000001800B810000000000001100000000000000000000000000000000010000000100000001800C810000000000001200000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180F088000000000000130000000000000000000000000000000001000000010000000180EE7F00000000000014000000000000000000000000000000000100000001000000018024E10000000000001500000000000000000000000000000000010000000100000001800A810000000000001600000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF000000000000000000000000000100000001000000018022800000000000001700000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180C488000000000000180000000000000000000000000000000001000000010000000180C988000000000000190000000000000000000000000000000001000000010000000180C7880000000000001A0000000000000000000000000000000001000000010000000180C8880000000000001B00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180DD880000000000001C00000000000000000000000000000000010000000100000001800000000001000000FFFFFFFF0000000000000000000000000001000000010000000180FB7F0000000000001D000000000000000000000000000000000100000001000000 - - - - 59398 - Build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ebug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fly_122\projects\baseflight\drv_uart.h - 0 - 1 - 9 - - - C:\Keil\ARM\RV31\Inc\stdlib.h - 0 - 477 - 477 - - - - - 1 - 0 - - 100 - 0 - - .\cli.c - 47 - 58 - 90 - - - .\serial.c - 0 - 12 - 25 - - - .\drv_uart.c - 0 - 110 - 144 - - - drv_uart.h - 0 - 1 - 9 - - - .\startup_stm32f10x_md.s - 0 - 133 - 150 - - - .\mw.c - 0 - 660 - 679 - - - .\imu.c - 52 - 85 - 113 - - - .\drv_i2c.c - 0 - 122 - 131 - - - board.h - 26 - 14 - 38 - - - .\drv_system.c - 16 - 142 - 159 - - - C:\Keil\ARM\RV31\Inc\stdlib.h - 0 - 477 - 477 - - - .\sensors.c - 1 - 121 - 159 - - - mw.h - 48 - 72 - 72 - - - .\config.c - 15 - 109 - 122 - - - .\mixer.c - 0 - 268 - 268 - - - .\main.c - 0 - 1 - 16 - - - - - diff --git a/mw-svn/EEPROM.cpp b/mw-svn/EEPROM.cpp deleted file mode 100755 index 09b3438d5..000000000 --- a/mw-svn/EEPROM.cpp +++ /dev/null @@ -1,121 +0,0 @@ -#include - -static uint8_t checkNewConf = 150; - -struct eep_entry_t { - void *var; - uint8_t size; -}; - -// ************************************************************************************************************ -// EEPROM Layout definition -// ************************************************************************************************************ -static eep_entry_t eep_entry[] = { - {&checkNewConf, sizeof(checkNewConf)} - , {&P8, sizeof(P8)} - , {&I8, sizeof(I8)} - , {&D8, sizeof(D8)} - , {&rcRate8, sizeof(rcRate8)} - , {&rcExpo8, sizeof(rcExpo8)} - , {&rollPitchRate, sizeof(rollPitchRate)} - , {&yawRate, sizeof(yawRate)} - , {&dynThrPID, sizeof(dynThrPID)} - , {&accZero, sizeof(accZero)} - , {&magZero, sizeof(magZero)} - , {&accTrim, sizeof(accTrim)} - , {&activate1, sizeof(activate1)} - , {&activate2, sizeof(activate2)} - , {&powerTrigger1, sizeof(powerTrigger1)} -#ifdef FLYING_WING - , {&wing_left_mid, sizeof(wing_left_mid)} - , {&wing_right_mid, sizeof(wing_right_mid)} -#endif -#ifdef TRI - , {&tri_yaw_middle, sizeof(tri_yaw_middle)} -#endif - -}; -#define EEBLOCK_SIZE sizeof(eep_entry)/sizeof(eep_entry_t) -// ************************************************************************************************************ - -void readEEPROM() -{ - uint8_t i, _address = eep_entry[0].size; - for (i = 1; i < EEBLOCK_SIZE; i++) { - eeprom_read_block(eep_entry[i].var, (void *) (_address), eep_entry[i].size); - _address += eep_entry[i].size; - } -#if defined(POWERMETER) - pAlarm = (uint32_t) powerTrigger1 *(uint32_t) PLEVELSCALE *(uint32_t) PLEVELDIV; // need to cast before multiplying -#endif - for (i = 0; i < 7; i++) - lookupRX[i] = (2500 + rcExpo8 * (i * i - 25)) * i * (int32_t) rcRate8 / 1250; -#ifdef FLYING_WING - wing_left_mid = constrain(wing_left_mid, WING_LEFT_MIN, WING_LEFT_MAX); //LEFT - wing_right_mid = constrain(wing_right_mid, WING_RIGHT_MIN, WING_RIGHT_MAX); //RIGHT -#endif -#ifdef TRI - tri_yaw_middle = constrain(tri_yaw_middle, TRI_YAW_CONSTRAINT_MIN, TRI_YAW_CONSTRAINT_MAX); //REAR -#endif -} - -void writeParams() -{ - uint8_t i, _address = 0; - for (i = 0; i < EEBLOCK_SIZE; i++) { - eeprom_write_block(eep_entry[i].var, (void *) (_address), eep_entry[i].size); - _address += eep_entry[i].size; - } - readEEPROM(); - blinkLED(15, 20, 1); -} - -void checkFirstTime() -{ - uint8_t test_val; - eeprom_read_block((void *) &test_val, (void *) (0), sizeof(test_val)); - if (test_val == checkNewConf) - return; - P8[ROLL] = 40; - I8[ROLL] = 30; - D8[ROLL] = 23; - P8[PITCH] = 40; - I8[PITCH] = 30; - D8[PITCH] = 23; - P8[YAW] = 85; - I8[YAW] = 0; - D8[YAW] = 0; - P8[PIDALT] = 47; - I8[PIDALT] = 0; - D8[PIDALT] = 30; - P8[PIDGPS] = 10; - I8[PIDGPS] = 0; - D8[PIDGPS] = 0; - P8[PIDVEL] = 0; - I8[PIDVEL] = 0; - D8[PIDVEL] = 0; - P8[PIDLEVEL] = 90; - I8[PIDLEVEL] = 45; - D8[PIDLEVEL] = 100; - P8[PIDMAG] = 40; - rcRate8 = 45; // = 0.9 in GUI - rcExpo8 = 65; - rollPitchRate = 0; - yawRate = 0; - dynThrPID = 0; - for (uint8_t i = 0; i < CHECKBOXITEMS; i++) { - activate1[i] = 0; - activate2[i] = 0; - } - accTrim[0] = 0; - accTrim[1] = 0; - powerTrigger1 = 0; -#ifdef FLYING_WING - wing_left_mid = WING_LEFT_MID; - wing_right_mid = WING_RIGHT_MID; -#endif -#ifdef TRI - tri_yaw_middle = TRI_YAW_MIDDLE; -#endif - writeParams(); -} diff --git a/mw-svn/GPS.cpp b/mw-svn/GPS.cpp deleted file mode 100755 index 866e4540d..000000000 --- a/mw-svn/GPS.cpp +++ /dev/null @@ -1,120 +0,0 @@ -/* this is an equirectangular approximation to calculate distance and bearing between 2 GPS points (lat/long) - it's much more faster than an exact calculation - the error is neglectible for few kilometers assuming a constant R for earth - input: lat1/long1 <-> lat2/long2 unit: 1/100000 degree - output: distance in meters, bearing in degrees -*/ -void GPS_distance(int32_t lat1, int32_t lon1, int32_t lat2, int32_t lon2, uint16_t * dist, int16_t * bearing) -{ - float dLat = ((lat2 - lat1)); // difference of latitude in 1/100000 degrees - float dLon = ((lon2 - lon1)) * cos(lat1 * (PI / 180 / 100000.0)); // difference of longitude in 1/100000 degrees - *dist = 6372795 / 100000.0 * PI / 180 * (sqrt(sq(dLat) + sq(dLon))); - if (lat1 != lat2) - *bearing = 180 / PI * (atan2(dLon, dLat)); - else - *bearing = 0; -} - -/* The latitude or longitude is coded this way in NMEA frames - dm.m coded as degrees + minutes + minute decimal - Where: - - d can be 1 or more char long. generally: 2 char long for latitude, 3 char long for longitude - - m is always 2 char long - - m can be 1 or more char long - This function converts this format in a unique unsigned long where 1 degree = 100 000 -*/ -uint32_t GPS_coord_to_degrees(char *s) -{ - char *p, *d = s; - uint32_t sec, m = 1000; - uint16_t min, dec = 0; - - if (!*s) - return 0; - for (p = s; *p != 0; p++) { - if (d != s) { - *p -= '0'; - dec += *p * m; - m /= 10; - } - if (*p == '.') - d = p; - } - m = 10000; - min = *--d - '0' + (*--d - '0') * 10; - sec = (m * min + dec) / 6; - while (d != s) { - m *= 10; - *--d -= '0'; - sec += *d * m; - } - return sec; -} - - -/* This is a light implementation of a GPS frame decoding - This should work with most of modern GPS devices configured to output NMEA frames. - It assumes there are some NMEA GGA frames to decode on the serial bus - Here we use only the following data : - - latitude - - longitude - - GPS fix is/is not ok - - GPS num sat (4 is enough to be +/- reliable) -*/ -bool GPS_newFrame(char c) -{ - uint8_t frameOK = 0; - static uint8_t param = 0, offset = 0, parity = 0; - static char string[15]; - static uint8_t checksum_param, GPGGA_frame = 0; - - if (c == '$') { - param = 0; - offset = 0; - parity = 0; - } else if (c == ',' || c == '*') { - string[offset] = 0; - if (param == 0) { //frame identification - if (string[0] == 'G' && string[1] == 'P' && string[2] == 'G' && string[3] == 'G' && string[4] == 'A') - GPGGA_frame = 1; - else - GPGGA_frame = 0; - } else if (GPGGA_frame == 1) { - if (param == 2) { - GPS_latitude = GPS_coord_to_degrees(string); - } else if (param == 3 && string[0] == 'S') - GPS_latitude = -GPS_latitude; - else if (param == 4) { - GPS_longitude = GPS_coord_to_degrees(string); - } else if (param == 5 && string[0] == 'W') - GPS_longitude = -GPS_longitude; - else if (param == 6) { - GPS_fix = string[0] > '0'; - } else if (param == 7) { - if (offset > 1) - GPS_numSat = (string[0] - '0') * 10 + string[1] - '0'; - else - GPS_numSat = string[0] - '0'; - } - } - param++; - offset = 0; - if (c == '*') - checksum_param = 1; - else - parity ^= c; - } else if (c == '\r' || c == '\n') { - if (checksum_param) { //parity checksum - uint8_t checksum = 16 * ((string[0] >= 'A') ? string[0] - 'A' + 10 : string[0] - '0') + ((string[1] >= 'A') ? string[1] - 'A' + 10 : string[1] - '0'); - if (checksum == parity) - frameOK = 1; - } - checksum_param = 0; - } else { - if (offset < 15) - string[offset++] = c; - if (!checksum_param) - parity ^= c; - } - return frameOK && GPGGA_frame; -} diff --git a/mw-svn/IMU.cpp b/mw-svn/IMU.cpp deleted file mode 100755 index 46acf4e0c..000000000 --- a/mw-svn/IMU.cpp +++ /dev/null @@ -1,343 +0,0 @@ - -void computeIMU() -{ - uint8_t axis; - static int16_t gyroADCprevious[3] = { 0, 0, 0 }; - int16_t gyroADCp[3]; - int16_t gyroADCinter[3]; - static uint32_t timeInterleave = 0; -#if defined(TRI) - static int16_t gyroYawSmooth = 0; -#endif - - if (MAG) - Mag_getADC(); - if (BARO) - Baro_update(); - - //we separate the 2 situations because reading gyro values with a gyro only setup can be acchieved at a higher rate - //gyro+nunchuk: we must wait for a quite high delay betwwen 2 reads to get both WM+ and Nunchuk data. It works with 3ms - //gyro only: the delay to read 2 consecutive values can be reduced to only 0.65ms - if (!ACC && nunchuk) { - annexCode(); - while ((micros() - timeInterleave) < INTERLEAVING_DELAY); //interleaving delay between 2 consecutive reads - timeInterleave = micros(); - WMP_getRawADC(); - getEstimatedAttitude(); // computation time must last less than one interleaving delay -#if BARO - getEstimatedAltitude(); -#endif - while ((micros() - timeInterleave) < INTERLEAVING_DELAY); //interleaving delay between 2 consecutive reads - timeInterleave = micros(); - while (WMP_getRawADC() != 1); // For this interleaving reading, we must have a gyro update at this point (less delay) - - for (axis = 0; axis < 3; axis++) { - // empirical, we take a weighted value of the current and the previous values - // /4 is to average 4 values, note: overflow is not possible for WMP gyro here - gyroData[axis] = (gyroADC[axis] * 3 + gyroADCprevious[axis] + 2) / 4; - gyroADCprevious[axis] = gyroADC[axis]; - } - } else { - if (ACC) { - ACC_getADC(); - getEstimatedAttitude(); - if (BARO) - getEstimatedAltitude(); - } - if (GYRO) - Gyro_getADC(); - else - WMP_getRawADC(); - for (axis = 0; axis < 3; axis++) - gyroADCp[axis] = gyroADC[axis]; - timeInterleave = micros(); - annexCode(); - if ((micros() - timeInterleave) > 650) { - annex650_overrun_count++; - } else { - while ((micros() - timeInterleave) < 650); //empirical, interleaving delay between 2 consecutive reads - } - if (GYRO) - Gyro_getADC(); - else - WMP_getRawADC(); - for (axis = 0; axis < 3; axis++) { - gyroADCinter[axis] = gyroADC[axis] + gyroADCp[axis]; - // empirical, we take a weighted value of the current and the previous values - gyroData[axis] = (gyroADCinter[axis] + gyroADCprevious[axis] + 1) / 3; - gyroADCprevious[axis] = gyroADCinter[axis] / 2; - if (!ACC) - accADC[axis] = 0; - } - } -#if defined(TRI) - gyroData[YAW] = (gyroYawSmooth * 2 + gyroData[YAW] + 1) / 3; - gyroYawSmooth = gyroData[YAW]; -#endif -} - -// ************************************************** -// Simplified IMU based on "Complementary Filter" -// Inspired by http://starlino.com/imu_guide.html -// -// adapted by ziss_dm : http://www.multiwii.com/forum/viewtopic.php?f=8&t=198 -// -// The following ideas was used in this project: -// 1) Rotation matrix: http://en.wikipedia.org/wiki/Rotation_matrix -// 2) Small-angle approximation: http://en.wikipedia.org/wiki/Small-angle_approximation -// 3) C. Hastings approximation for atan2() -// 4) Optimization tricks: http://www.hackersdelight.org/ -// -// Currently Magnetometer uses separate CF which is used only -// for heading approximation. -// -// Modified: 19/04/2011 by ziss_dm -// Version: V1.1 -// -// code size deduction and tmp vector intermediate step for vector rotation computation: October 2011 by Alex -// ************************************************** - -//****** advanced users settings ******************* -/* Set the Low Pass Filter factor for ACC */ -/* Increasing this value would reduce ACC noise (visible in GUI), but would increase ACC lag time*/ -/* Comment this if you do not want filter at all.*/ -/* Default WMC value: 8*/ -#define ACC_LPF_FACTOR 4 - -/* Set the Low Pass Filter factor for Magnetometer */ -/* Increasing this value would reduce Magnetometer noise (not visible in GUI), but would increase Magnetometer lag time*/ -/* Comment this if you do not want filter at all.*/ -/* Default WMC value: n/a*/ -//#define MG_LPF_FACTOR 4 - -/* Set the Gyro Weight for Gyro/Acc complementary filter */ -/* Increasing this value would reduce and delay Acc influence on the output of the filter*/ -/* Default WMC value: 300*/ -#define GYR_CMPF_FACTOR 310.0f - -/* Set the Gyro Weight for Gyro/Magnetometer complementary filter */ -/* Increasing this value would reduce and delay Magnetometer influence on the output of the filter*/ -/* Default WMC value: n/a*/ -#define GYR_CMPFM_FACTOR 200.0f - -//****** end of advanced users settings ************* - -#define INV_GYR_CMPF_FACTOR (1.0f / (GYR_CMPF_FACTOR + 1.0f)) -#define INV_GYR_CMPFM_FACTOR (1.0f / (GYR_CMPFM_FACTOR + 1.0f)) -#if GYRO -#define GYRO_SCALE ((2380 * PI)/((32767.0f / 4.0f ) * 180.0f * 1000000.0f)) //should be 2279.44 but 2380 gives better result - // +-2000/sec deg scale - //#define GYRO_SCALE ((200.0f * PI)/((32768.0f / 5.0f / 4.0f ) * 180.0f * 1000000.0f) * 1.5f) - // +- 200/sec deg scale - // 1.5 is emperical, not sure what it means - // should be in rad/sec -#else -#define GYRO_SCALE (1.0f/200e6f) - // empirical, depends on WMP on IDG datasheet, tied of deg/ms sensibility - // !!!!should be adjusted to the rad/sec -#endif -// Small angle approximation -#define ssin(val) (val) -#define scos(val) 1.0f - -typedef struct fp_vector { - float X; - float Y; - float Z; -} t_fp_vector_def; - -typedef union { - float A[3]; - t_fp_vector_def V; -} t_fp_vector; - -int16_t _atan2(float y, float x) -{ -#define fp_is_neg(val) ((((byte*)&val)[3] & 0x80) != 0) - float z = y / x; - int16_t zi = abs(int16_t(z * 100)); - int8_t y_neg = fp_is_neg(y); - if (zi < 100) { - if (zi > 10) - z = z / (1.0f + 0.28f * z * z); - if (fp_is_neg(x)) { - if (y_neg) - z -= PI; - else - z += PI; - } - } else { - z = (PI / 2.0f) - z / (z * z + 0.28f); - if (y_neg) - z -= PI; - } - z *= (180.0f / PI * 10); - return z; -} - -// Rotate Estimated vector(s) with small angle approximation, according to the gyro data -void rotateV(struct fp_vector *v, float *delta) -{ - fp_vector v_tmp = *v; - v->Z -= delta[ROLL] * v_tmp.X + delta[PITCH] * v_tmp.Y; - v->X += delta[ROLL] * v_tmp.Z - delta[YAW] * v_tmp.Y; - v->Y += delta[PITCH] * v_tmp.Z + delta[YAW] * v_tmp.X; -} - -void getEstimatedAttitude() -{ - uint8_t axis; - int32_t accMag = 0; - static t_fp_vector EstG; -#if MAG - static t_fp_vector EstM; -#endif -#if defined(MG_LPF_FACTOR) - static int16_t mgSmooth[3]; -#endif -#if defined(ACC_LPF_FACTOR) - static int16_t accTemp[3]; //projection of smoothed and normalized magnetic vector on x/y/z axis, as measured by magnetometer -#endif - static uint16_t previousT; - uint16_t currentT = micros(); - float scale, deltaGyroAngle[3]; - - scale = (currentT - previousT) * GYRO_SCALE; - previousT = currentT; - - // Initialization - for (axis = 0; axis < 3; axis++) { - deltaGyroAngle[axis] = gyroADC[axis] * scale; -#if defined(ACC_LPF_FACTOR) - accTemp[axis] = (accTemp[axis] - (accTemp[axis] >> ACC_LPF_FACTOR)) + accADC[axis]; - accSmooth[axis] = accTemp[axis] >> ACC_LPF_FACTOR; -#define ACC_VALUE accSmooth[axis] -#else - accSmooth[axis] = accADC[axis]; -#define ACC_VALUE accADC[axis] -#endif -// accMag += (ACC_VALUE * 10 / (int16_t)acc_1G) * (ACC_VALUE * 10 / (int16_t)acc_1G); - accMag += (int32_t) ACC_VALUE *ACC_VALUE; -#if MAG -#if defined(MG_LPF_FACTOR) - mgSmooth[axis] = (mgSmooth[axis] * (MG_LPF_FACTOR - 1) + magADC[axis]) / MG_LPF_FACTOR; // LPF for Magnetometer values -#define MAG_VALUE mgSmooth[axis] -#else -#define MAG_VALUE magADC[axis] -#endif -#endif - } - accMag = accMag * 100 / ((int32_t) acc_1G * acc_1G); - - rotateV(&EstG.V, deltaGyroAngle); -#if MAG - rotateV(&EstM.V, deltaGyroAngle); -#endif - - if (abs(accSmooth[ROLL]) < acc_25deg && abs(accSmooth[PITCH]) < acc_25deg && accSmooth[YAW] > 0) - smallAngle25 = 1; - else - smallAngle25 = 0; - - // Apply complimentary filter (Gyro drift correction) - // If accel magnitude >1.4G or <0.6G and ACC vector outside of the limit range => we neutralize the effect of accelerometers in the angle estimation. - // To do that, we just skip filter, as EstV already rotated by Gyro - if ((36 < accMag && accMag < 196) || smallAngle25) - for (axis = 0; axis < 3; axis++) { - int16_t acc = ACC_VALUE; -#if not defined(TRUSTED_ACCZ) - if (smallAngle25 && axis == YAW) - //We consider ACCZ = acc_1G when the acc on other axis is small. - //It's a tweak to deal with some configs where ACC_Z tends to a value < acc_1G when high throttle is applied. - //This tweak applies only when the multi is not in inverted position - acc = acc_1G; -#endif - EstG.A[axis] = (EstG.A[axis] * GYR_CMPF_FACTOR + acc) * INV_GYR_CMPF_FACTOR; - } -#if MAG - for (axis = 0; axis < 3; axis++) - EstM.A[axis] = (EstM.A[axis] * GYR_CMPFM_FACTOR + MAG_VALUE) * INV_GYR_CMPFM_FACTOR; -#endif - - // Attitude of the estimated vector - angle[ROLL] = _atan2(EstG.V.X, EstG.V.Z); - angle[PITCH] = _atan2(EstG.V.Y, EstG.V.Z); -#if MAG - // Attitude of the cross product vector GxM - heading = _atan2(EstG.V.X * EstM.V.Z - EstG.V.Z * EstM.V.X, EstG.V.Z * EstM.V.Y - EstG.V.Y * EstM.V.Z) / 10; -#endif -} - -float InvSqrt(float x) -{ - union { - int32_t i; - float f; - } conv; - conv.f = x; - conv.i = 0x5f3759df - (conv.i >> 1); - return 0.5f * conv.f * (3.0f - x * conv.f * conv.f); -} - -int32_t isq(int32_t x) -{ - return x * x; -} - -#define UPDATE_INTERVAL 25000 // 40hz update rate (20hz LPF on acc) -#define INIT_DELAY 4000000 // 4 sec initialization delay -#define Kp1 5.5f // PI observer velocity gain -#define Kp2 10.0f // PI observer position gain -#define Ki 0.01f // PI observer integral gain (bias cancellation) -#define dt (UPDATE_INTERVAL / 1000000.0f) - -void getEstimatedAltitude() -{ - static uint8_t inited = 0; - static int16_t AltErrorI = 0; - static float AccScale; - static uint32_t deadLine = INIT_DELAY; - int16_t AltError; - int16_t InstAcc; - static int32_t tmpAlt; - static int16_t EstVelocity = 0; - static uint32_t velTimer; - static int16_t lastAlt; - - if (currentTime < deadLine) - return; - deadLine = currentTime + UPDATE_INTERVAL; - // Soft start - - if (!inited) { - inited = 1; - tmpAlt = BaroAlt * 10; - AccScale = 100 * 9.80665f / acc_1G; - } - // Estimation Error - AltError = BaroAlt - EstAlt; - AltErrorI += AltError; - AltErrorI = constrain(AltErrorI, -2500, +2500); - // Gravity vector correction and projection to the local Z - //InstAcc = (accADC[YAW] * (1 - acc_1G * InvSqrt(isq(accADC[ROLL]) + isq(accADC[PITCH]) + isq(accADC[YAW])))) * AccScale + (Ki) * AltErrorI; -#if defined(TRUSTED_ACCZ) - InstAcc = (accADC[YAW] * (1 - acc_1G * InvSqrt(isq(accADC[ROLL]) + isq(accADC[PITCH]) + isq(accADC[YAW])))) * AccScale + AltErrorI / 100; -#else - InstAcc = AltErrorI / 100; -#endif - - // Integrators - tmpAlt += EstVelocity * (dt * dt) + (Kp2 * dt) * AltError; - EstVelocity += InstAcc + Kp1 * AltError; - EstVelocity = constrain(EstVelocity, -10000, +10000); - - EstAlt = tmpAlt / 10; - - if (currentTime < velTimer) - return; - velTimer = currentTime + 500000; - zVelocity = tmpAlt - lastAlt; - lastAlt = tmpAlt; - - debug4 = zVelocity; -} diff --git a/mw-svn/LCD.cpp b/mw-svn/LCD.cpp deleted file mode 100755 index 4106be973..000000000 --- a/mw-svn/LCD.cpp +++ /dev/null @@ -1,1063 +0,0 @@ -// ************************************************************************************************************ -// LCD & display & monitoring -// ************************************************************************************************************ -#if defined(LCD_CONF) || defined(LCD_TELEMETRY) -static char line1[17], line2[17]; - -#if defined(LCD_ETPP) - // ********************* - // i2c Eagle Tree Power Panel primitives - // ********************* -void i2c_ETPP_init() -{ - i2c_rep_start(0x76 + 0); // LCD_ETPP i2c address: 0x3B in 7 bit form. Shift left one bit and concatenate i2c write command bit of zero = 0x76 in 8 bit form. - i2c_write(0x00); // LCD_ETPP command register - i2c_write(0x24); // Function Set 001D0MSL D : data length for parallel interface only; M: 0 = 1x32 , 1 = 2x16; S: 0 = 1:18 multiplex drive mode, 1x32 or 2x16 character display, 1 = 1:9 multiplex drive mode, 1x16 character display; H: 0 = basic instruction set plus standard instruction set, 1 = basic instruction set plus extended instruction set - i2c_write(0x0C); // Display on 00001DCB D : 0 = Display Off, 1 = Display On; C : 0 = Underline Cursor Off, 1 = Underline Cursor On; B : 0 = Blinking Cursor Off, 1 = Blinking Cursor On - i2c_write(0x06); // Cursor Move 000001IS I : 0 = DDRAM or CGRAM address decrements by 1, cursor moves to the left, 1 = DDRAM or CGRAM address increments by 1, cursor moves to the right; S : 0 = display does not shift, 1 = display does shifts - LCDclear(); -} - -void i2c_ETPP_send_cmd(byte c) -{ - i2c_rep_start(0x76 + 0); // I2C write direction - i2c_write(0x00); // LCD_ETPP command register - i2c_write(c); -} -void i2c_ETPP_send_char(char c) -{ - if (c > 0x0f) - c |= 0x80; // LCD_ETPP uses character set "R", which has A->z mapped same as ascii + high bit; don't mess with custom chars. - i2c_rep_start(0x76 + 0); // I2C write direction - i2c_write(0x40); // LCD_ETPP data register - i2c_write(c); -} - -void i2c_ETPP_set_cursor(byte addr) -{ - i2c_ETPP_send_cmd(0x80 | addr); // High bit is "Set DDRAM" command, remaing bits are addr. -} - -void i2c_ETPP_set_cursor(byte col, byte row) -{ - row = min(row, 1); - col = min(col, 15); - byte addr = col + row * 0x40; // Why 0x40? RAM in this controller has many more bytes than are displayed. In particular, the start of the second line (line 1 char 0) is 0x40 in DDRAM. The bytes between 0x0F (last char of line 1) and 0x40 are not displayable (unless the display is placed in marquee scroll mode) - i2c_ETPP_set_cursor(addr); -} - -void i2c_ETPP_create_char(byte idx, uint8_t * array) -{ - i2c_ETPP_send_cmd(0x80); // CGRAM and DDRAM share an address register, but you can't set certain bits with the CGRAM address command. Use DDRAM address command to be sure high order address bits are zero. - i2c_ETPP_send_cmd(0x40 | byte(idx * 8)); // Set CGRAM address - i2c_rep_start(0x76 + 0); // I2C write direction - i2c_write(0x40); // LCD_ETPP data register - for (byte i = 0; i < 8; i++) { - i2c_write(*array); - array++; - } -} - -static boolean charsInitialized; // chars for servo signals are initialized -void ETPP_barGraph(byte num, int val) -{ // num chars in graph; percent as 1 to 100 - if (!charsInitialized) { - charsInitialized = true; - - static byte bars[8] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x15, }; - static byte less[8] = { 0x00, 0x04, 0x0C, 0x1C, 0x0C, 0x04, 0x00, 0x15, }; - static byte grt[8] = { 0x00, 0x04, 0x06, 0x07, 0x06, 0x04, 0x00, 0x15, }; - - byte pattern = 0x10; - for (int8_t i = 0; i <= 5; i++) { - for (int8_t j = 0; j < 7; j++) { - bars[j] = pattern; - } - i2c_ETPP_create_char(i, bars); - pattern >>= 1; - } - i2c_ETPP_create_char(6, less); - i2c_ETPP_create_char(7, grt); - } - - static char bar[16]; - for (int8_t i = 0; i < num; i++) { - bar[i] = 5; - } - - if (val < -100 || val > 100) { - bar[0] = 6; - bar[num] = 7; - } // invalid - else if (val < 0) { - bar[0] = 6; - } // <... - else if (val >= 100) { - bar[3] = 7; - } // ...> - else { - bar[val / (100 / num)] = (val % (100 / num)) / 5; - } // ..|. - - for (int8_t i = 0; i < num; i++) { - i2c_ETPP_send_char(bar[i]); - } -} -#endif //LCD_ETPP - -#if defined(LCD_LCD03) // LCD_LCD03 - // ********************* - // I2C LCD03 primitives - // ********************* -void i2c_LCD03_init() -{ - i2c_rep_start(0xC6); // The LCD03 is located on the I2C bus at address 0xC6 - i2c_write(0x00); // Command register - i2c_write(04); // Hide cursor - i2c_write(12); // Clear screen - i2c_write(19); // Backlight on -} - -void i2c_LCD03_send_cmd(byte c) -{ - i2c_rep_start(0xC6); - i2c_write(0x00); - i2c_write(c); -} -void i2c_LCD03_send_char(char c) -{ - i2c_rep_start(0xC6); - i2c_write(0x00); - i2c_write(c); -} - -void i2c_LCD03_set_cursor(byte col, byte row) -{ - row = min(row, 1); - col = min(col, 15); - i2c_LCD03_send_cmd(03); // set cursor (row, column) - i2c_LCD03_send_cmd(row + 1); - i2c_LCD03_send_cmd(col + 1); -} -#endif // LCD_LCD03 -/* ------------------------------------------------------------------ */ -void LCDprint(uint8_t i) -{ -#if defined(LCD_SERIAL3W) - // 1000000 / 9600 = 104 microseconds at 9600 baud. - // we set it below to take some margin with the running interrupts -#define BITDELAY 102 - LCDPIN_OFF; - delayMicroseconds(BITDELAY); - for (uint8_t mask = 0x01; mask; mask <<= 1) { - if (i & mask) { - LCDPIN_ON; - } else { - LCDPIN_OFF; - } // choose bit - delayMicroseconds(BITDELAY); - } - LCDPIN_ON //switch ON digital PIN 0 - delayMicroseconds(BITDELAY); -#elif defined(LCD_TEXTSTAR) || defined(LCD_VT100) - SerialWrite(0, i); -#elif defined(LCD_ETPP) - i2c_ETPP_send_char(i); -#elif defined(LCD_LCD03) - i2c_LCD03_send_char(i); -#endif -} - -void LCDprintChar(const char *s) -{ - while (*s) { - LCDprint(*s++); - } -} - -void LCDclear() -{ -#if defined(LCD_SERIAL3W) - LCDprint(0xFE); - LCDprint(0x01); - delay(10); - LCDprint(0xFE); - LCDprint(0x02); - delay(10); // clear screen, cursor line 1, pos 0 for serial LCD Sparkfun - contrib by flyman777 -#elif defined(LCD_TEXTSTAR) - LCDprint(0x0c); -#elif defined(LCD_VT100) - //LCDprint(0x1b); LCDprint(0x5b); LCDprintChar("2J"); //ED2 - LCDprint(0x1b); - LCDprint(0x5b); - LCDprint('K'); //EL0 -#elif defined(LCD_ETPP) - i2c_ETPP_send_cmd(0x01); // Clear display command, which does NOT clear an Eagle Tree because character set "R" has a '>' at 0x20 - for (byte i = 0; i < 80; i++) - i2c_ETPP_send_char(' '); // Blanks for all 80 bytes of RAM in the controller, not just the 2x16 display -#elif defined(LCD_LCD03) - i2c_LCD03_send_cmd(12); // clear screen -#endif -} - -void LCDsetLine(byte line) -{ // Line = 1 or 2 -#if defined(LCD_SERIAL3W) - if (line == 1) { - LCDprint(0xFE); - LCDprint(128); - } else { - LCDprint(0xFE); - LCDprint(192); - } -#elif defined(LCD_TEXTSTAR) - LCDprintChar("\r\n"); - LCDprint(0xfe); - LCDprint('L'); - LCDprint(line); -#elif defined(LCD_VT100) - if (line == 1) { - //LCDprint(0x1b); LCDprint(0x5b); LCDprintChar("f"); //hvhome - LCDprintChar("\r\n"); - LCDprint(0x1b); - LCDprint(0x5b); - LCDprintChar("001;001H"); //pos 1 1 - } else { - //LCDprint(0x1b); LCDprint('E'); //NEL - LCDprintChar("\r\n"); - LCDprint(0x1b); - LCDprint(0x5b); - LCDprintChar("002;001H"); //pos 2 1 - } - //LCDprint(0x1b); LCDprint(0x5b); LCDprint('K'); //EL0 -#elif defined(LCD_ETPP) - i2c_ETPP_set_cursor(0, line - 1); -#elif defined(LCD_LCD03) - i2c_LCD03_set_cursor(0, line - 1); -#endif -} - -void initLCD() -{ - blinkLED(20, 30, 1); -#if defined(LCD_SERIAL3W) - SerialEnd(0); - //init LCD - PINMODE_LCD; //TX PIN for LCD = Arduino RX PIN (more convenient to connect a servo plug on arduino pro mini) -#elif defined(LCD_TEXTSTAR) - // Cat's Whisker Technologies 'TextStar' Module CW-LCD-02 - // http://cats-whisker.com/resources/documents/cw-lcd-02_datasheet.pdf - // Modified by Luca Brizzi aka gtrick90 @ RCG - //LCDprint(0xFE);LCDprint(0x43);LCDprint(0x02); //cursor blink mode - LCDprint(0xFE); - LCDprint('R'); //reset -#elif defined(LCD_VT100) - LCDprint(0x1b); - LCDprint('c'); //RIS -#elif defined(LCD_ETPP) - // Eagle Tree Power Panel - I2C & Daylight Readable LCD - // Contributed by Danal - i2c_ETPP_init(); -#elif defined(LCD_LCD03) - // LCD03 - I2C LCD - // http://www.robot-electronics.co.uk/htm/Lcd03tech.htm - // by Th0rsten - i2c_LCD03_init(); -#endif - LCDclear(); - strcpy_P(line1, PSTR("MultiWii V1.9+")); - LCDsetLine(1); - LCDprintChar(line1); -#if defined(LCD_TEXTSTAR) || defined(LCD_VT100) - delay(2500); - LCDclear(); -#endif - if (cycleTime == 0) { //Called from Setup() - strcpy_P(line1, PSTR("Ready to Fly")); - LCDsetLine(2); - LCDprintChar(line1); - } else { - strcpy_P(line1, PSTR("Config All Parms")); - LCDsetLine(2); - LCDprintChar(line1); - } -} -#endif //Support functions for LCD_CONF and LCD_TELEMETRY - - -#ifdef LCD_CONF - -typedef void (*formatter_func_ptr) (void *, uint8_t, uint8_t); -typedef void (*inc_func_ptr) (void *, int8_t); - -typedef struct lcd_type_desc_t { - formatter_func_ptr fmt; - inc_func_ptr inc; -}; - -static lcd_type_desc_t LTU8 = { &__u8Fmt, &__u8Inc }; -static lcd_type_desc_t LTU16 = { &__u16Fmt, &__u16Inc }; -static lcd_type_desc_t LPMM = { &__upMFmt, &__nullInc }; -static lcd_type_desc_t LPMS = { &__upSFmt, &__nullInc }; -static lcd_type_desc_t LAUX = { &__uAuxFmt, &__u8Inc }; - -typedef struct lcd_param_def_t { - lcd_type_desc_t *type; - uint8_t decimal; - uint8_t multiplier; - uint8_t increment; -}; - -//typedef struct lcd_param_t{ -// char* paramText; -// void * var; -// lcd_param_def_t * def; -//}; - -// ************************************************************************************************************ -// LCD Layout definition -// ************************************************************************************************************ -// Descriptors -static lcd_param_def_t __P = { <U8, 1, 1, 1 }; -static lcd_param_def_t __I = { <U8, 3, 1, 2 }; -static lcd_param_def_t __D = { <U8, 0, 1, 1 }; -static lcd_param_def_t __RCR = { <U8, 2, 2, 2 }; -static lcd_param_def_t __RC = { <U8, 2, 1, 2 }; -static lcd_param_def_t __PM = { &LPMM, 1, 1, 0 }; -static lcd_param_def_t __PS = { &LPMS, 1, 1, 0 }; -static lcd_param_def_t __PT = { <U8, 0, 1, 1 }; -static lcd_param_def_t __VB = { <U8, 1, 1, 0 }; -static lcd_param_def_t __L = { <U8, 0, 1, 0 }; -static lcd_param_def_t __FS = { <U8, 1, 1, 0 }; -static lcd_param_def_t __SE = { <U16, 0, 1, 10 }; -static lcd_param_def_t __AUX = { &LAUX, 0, 1, 1 }; - -// Program Space Strings - These sit in program flash, not SRAM. -// Rewrite to support PROGMEM strings 21/21/2011 by Danal - -PROGMEM prog_char lcd_param_text01[] = "Pitch&Roll P"; -PROGMEM prog_char lcd_param_text02[] = "Roll P"; -PROGMEM prog_char lcd_param_text03[] = "Roll I"; -PROGMEM prog_char lcd_param_text04[] = "Roll D"; -PROGMEM prog_char lcd_param_text05[] = "Pitch P"; -PROGMEM prog_char lcd_param_text06[] = "Pitch I"; -PROGMEM prog_char lcd_param_text07[] = "Pitch D"; -PROGMEM prog_char lcd_param_text08[] = "Yaw P"; -PROGMEM prog_char lcd_param_text09[] = "Yaw I"; -PROGMEM prog_char lcd_param_text10[] = "Yaw D"; -#if BARO -PROGMEM prog_char lcd_param_text11[] = "Alt P"; -PROGMEM prog_char lcd_param_text12[] = "Alt I"; -PROGMEM prog_char lcd_param_text13[] = "Alt D"; -PROGMEM prog_char lcd_param_text14[] = "Vel P"; -PROGMEM prog_char lcd_param_text15[] = "Vel I"; -PROGMEM prog_char lcd_param_text16[] = "Vel D"; -#endif -PROGMEM prog_char lcd_param_text17[] = "Level P"; -PROGMEM prog_char lcd_param_text18[] = "Level I"; -#if MAG -PROGMEM prog_char lcd_param_text19[] = "Mag P"; -#endif -PROGMEM prog_char lcd_param_text20[] = "RC Rate"; -PROGMEM prog_char lcd_param_text21[] = "RC Expo"; -PROGMEM prog_char lcd_param_text22[] = "Pitch&Roll Rate"; -PROGMEM prog_char lcd_param_text23[] = "Yaw Rate"; -PROGMEM prog_char lcd_param_text24[] = "Throttle PID"; -#ifdef LOG_VALUES -#if (LOG_VALUES == 2) -PROGMEM prog_char lcd_param_text25[] = "pMeter M0"; -PROGMEM prog_char lcd_param_text26[] = "pMeter M1"; -PROGMEM prog_char lcd_param_text27[] = "pMeter M2"; -PROGMEM prog_char lcd_param_text28[] = "pMeter M3"; -PROGMEM prog_char lcd_param_text29[] = "pMeter M4"; -PROGMEM prog_char lcd_param_text30[] = "pMeter M5"; -PROGMEM prog_char lcd_param_text31[] = "pMeter M6"; -PROGMEM prog_char lcd_param_text32[] = "pMeter M7"; -#endif -#endif -#ifdef POWERMETER -PROGMEM prog_char lcd_param_text33[] = "pMeter Sum"; -PROGMEM prog_char lcd_param_text34[] = "pAlarm /50"; // change text to represent PLEVELSCALE value -#endif -#ifdef VBAT -PROGMEM prog_char lcd_param_text35[] = "Batt Volt"; -#endif -#ifdef FLYING_WING -PROGMEM prog_char lcd_param_text36[] = "Trim Servo1"; -PROGMEM prog_char lcd_param_text37[] = "Trim Servo2"; -#endif -#ifdef TRI -PROGMEM prog_char lcd_param_text38[] = "Trim ServoTail"; -#endif -#ifdef LOG_VALUES -PROGMEM prog_char lcd_param_text39[] = "Failsafes"; -PROGMEM prog_char lcd_param_text40[] = "i2c Errors"; -PROGMEM prog_char lcd_param_text41[] = "annex overruns"; -#endif -#if defined(LCD_CONF_AUX_12) || defined(LCD_CONF_AUX_1234) -PROGMEM prog_char lcd_param_text42[] = "AUX1/2 level"; -PROGMEM prog_char lcd_param_text43[] = "AUX1/2 baro"; -PROGMEM prog_char lcd_param_text44[] = "AUX1/2 mag"; -PROGMEM prog_char lcd_param_text45[] = "AUX1/2 cam stab"; -PROGMEM prog_char lcd_param_text46[] = "AUX1/2 cam trig"; -PROGMEM prog_char lcd_param_text47[] = "AUX1/2 arm"; -PROGMEM prog_char lcd_param_text48[] = "AUX1/2 gps home"; -PROGMEM prog_char lcd_param_text49[] = "AUX1/2 gps hold"; -PROGMEM prog_char lcd_param_text50[] = "AUX1/2 passthru"; -PROGMEM prog_char lcd_param_text51[] = "AUX1/2 headfree"; -PROGMEM prog_char lcd_param_text52[] = "AUX1/2 beeper"; -// 53 to 61 reserved -#endif -#if defined(LCD_CONF_AUX_1234) -// aux3/4 -PROGMEM prog_char lcd_param_text62[] = "AUX3/4 level"; -PROGMEM prog_char lcd_param_text63[] = "AUX3/4 baro"; -PROGMEM prog_char lcd_param_text64[] = "AUX3/4 mag"; -PROGMEM prog_char lcd_param_text65[] = "AUX3/4 cam stab"; -PROGMEM prog_char lcd_param_text66[] = "AUX3/4 cam trig"; -PROGMEM prog_char lcd_param_text67[] = "AUX3/4 arm"; -PROGMEM prog_char lcd_param_text68[] = "AUX3/4 gps home"; -PROGMEM prog_char lcd_param_text69[] = "AUX3/4 gps hold"; -PROGMEM prog_char lcd_param_text70[] = "AUX3/4 passthru"; -PROGMEM prog_char lcd_param_text71[] = "AUX3/4 headfree"; -PROGMEM prog_char lcd_param_text72[] = "AUX3/4 beeper"; -// 73 to 81 reserved -#endif -// 0123456789.12345 - -PROGMEM const prog_void *lcd_param_ptr_table[] = { - &lcd_param_text01, &P8[ROLL], &__P, - &lcd_param_text02, &P8[ROLL], &__P, - &lcd_param_text03, &I8[ROLL], &__I, - &lcd_param_text04, &D8[ROLL], &__D, - &lcd_param_text05, &P8[PITCH], &__P, - &lcd_param_text06, &I8[PITCH], &__I, - &lcd_param_text07, &D8[PITCH], &__D, - &lcd_param_text08, &P8[YAW], &__P, - &lcd_param_text09, &I8[YAW], &__I, - &lcd_param_text10, &D8[YAW], &__D, -#if BARO - &lcd_param_text11, &P8[PIDALT], &__P, - &lcd_param_text12, &I8[PIDALT], &__I, - &lcd_param_text13, &D8[PIDALT], &__D, - &lcd_param_text14, &P8[PIDVEL], &__P, - &lcd_param_text15, &I8[PIDVEL], &__I, - &lcd_param_text16, &D8[PIDVEL], &__D, -#endif - &lcd_param_text17, &P8[PIDLEVEL], &__P, - &lcd_param_text18, &I8[PIDLEVEL], &__I, -#if MAG - &lcd_param_text19, &P8[PIDMAG], &__P, -#endif - &lcd_param_text20, &rcRate8, &__RCR, - &lcd_param_text21, &rcExpo8, &__RC, - &lcd_param_text22, &rollPitchRate, &__RC, - &lcd_param_text23, &yawRate, &__RC, - &lcd_param_text24, &dynThrPID, &__RC, -#ifdef LCD_CONF_AUX_12 - &lcd_param_text42, &activate1[BOXACC], &__AUX, - &lcd_param_text43, &activate1[BOXBARO], &__AUX, - &lcd_param_text44, &activate1[BOXMAG], &__AUX, - &lcd_param_text45, &activate1[BOXCAMSTAB], &__AUX, - &lcd_param_text46, &activate1[BOXCAMTRIG], &__AUX, - &lcd_param_text47, &activate1[BOXARM], &__AUX, - &lcd_param_text48, &activate1[BOXGPSHOME], &__AUX, - &lcd_param_text49, &activate1[BOXGPSHOLD], &__AUX, - &lcd_param_text50, &activate1[BOXPASSTHRU], &__AUX, - &lcd_param_text51, &activate1[BOXHEADFREE], &__AUX, - &lcd_param_text52, &activate1[BOXBEEPERON], &__AUX, -#endif -#ifdef LCD_CONF_AUX_1234 - &lcd_param_text42, &activate1[BOXACC], &__AUX, - &lcd_param_text62, &activate2[BOXACC], &__AUX, - &lcd_param_text43, &activate1[BOXBARO], &__AUX, - &lcd_param_text63, &activate2[BOXBARO], &__AUX, - &lcd_param_text44, &activate1[BOXMAG], &__AUX, - &lcd_param_text64, &activate2[BOXMAG], &__AUX, - &lcd_param_text45, &activate1[BOXCAMSTAB], &__AUX, - &lcd_param_text65, &activate2[BOXCAMSTAB], &__AUX, - &lcd_param_text46, &activate1[BOXCAMTRIG], &__AUX, - &lcd_param_text66, &activate2[BOXCAMTRIG], &__AUX, - &lcd_param_text47, &activate1[BOXARM], &__AUX, - &lcd_param_text67, &activate2[BOXARM], &__AUX, - &lcd_param_text48, &activate1[BOXGPSHOME], &__AUX, - &lcd_param_text68, &activate2[BOXGPSHOME], &__AUX, - &lcd_param_text49, &activate1[BOXGPSHOLD], &__AUX, - &lcd_param_text69, &activate2[BOXGPSHOLD], &__AUX, - &lcd_param_text50, &activate1[BOXPASSTHRU], &__AUX, - &lcd_param_text70, &activate2[BOXPASSTHRU], &__AUX, - &lcd_param_text51, &activate1[BOXHEADFREE], &__AUX, - &lcd_param_text71, &activate2[BOXHEADFREE], &__AUX, - &lcd_param_text52, &activate1[BOXBEEPERON], &__AUX, - &lcd_param_text72, &activate2[BOXBEEPERON], &__AUX, -#endif -#ifdef LOG_VALUES -#if (LOG_VALUES == 2) - &lcd_param_text25, &pMeter[0], &__PM, - &lcd_param_text26, &pMeter[1], &__PM, - &lcd_param_text27, &pMeter[2], &__PM, - &lcd_param_text28, &pMeter[3], &__PM, - &lcd_param_text29, &pMeter[4], &__PM, - &lcd_param_text30, &pMeter[5], &__PM, - &lcd_param_text31, &pMeter[6], &__PM, - &lcd_param_text32, &pMeter[7], &__PM, -#endif -#endif -#ifdef POWERMETER - &lcd_param_text33, &pMeter[PMOTOR_SUM], &__PS, - &lcd_param_text34, &powerTrigger1, &__PT, -#endif -#ifdef VBAT - &lcd_param_text35, &vbat, &__VB, -#endif -#ifdef FLYING_WING - &lcd_param_text36, &wing_left_mid, &__SE, - &lcd_param_text37, &wing_right_mid, &__SE, -#endif -#ifdef TRI - &lcd_param_text38, &tri_yaw_middle, &__SE, -#endif -#ifdef LOG_VALUES - &lcd_param_text39, &failsafeEvents, &__FS, - &lcd_param_text40, &i2c_errors_count, &__L, - &lcd_param_text41, &annex650_overrun_count, &__L -#endif -}; -#define PARAMMAX (sizeof(lcd_param_ptr_table)/6 - 1) -// ************************************************************************************************************ - -void __u8Inc(void *var, int8_t inc) -{ - *(uint8_t *) var += inc; -}; -void __u16Inc(void *var, int8_t inc) -{ - *(uint16_t *) var += inc; -}; -void __nullInc(void *var, int8_t inc) -{ -}; - -void __u8Fmt(void *var, uint8_t mul, uint8_t dec) -{ - uint16_t unit = *(uint8_t *) var; - unit *= mul; - char c1 = '0' + unit / 100; - char c2 = '0' + unit / 10 - (unit / 100) * 10; - char c3 = '0' + unit - (unit / 10) * 10; - switch (dec) { - case 0: - line2[6] = c1; - line2[7] = c2; - line2[8] = c3; - break; - case 1: - line2[5] = c1; - line2[6] = c2; - line2[7] = '.'; - line2[8] = c3; - break; - case 2: - line2[5] = c1; - line2[6] = '.'; - line2[7] = c2; - line2[8] = c3; - break; - case 3: - line2[4] = '0'; - line2[5] = '.'; - line2[6] = c1; - line2[7] = c2; - line2[8] = c3; - break; - } -} - -void __u16Fmt(void *var, uint8_t mul, uint8_t dec) -{ - uint16_t unit = *(uint16_t *) var; - unit *= mul; - line2[4] = '0' + unit / 10000; - line2[5] = '0' + unit / 1000 - (unit / 10000) * 10; - line2[6] = '0' + unit / 100 - (unit / 1000) * 10; - line2[7] = '0' + unit / 10 - (unit / 100) * 10; - line2[8] = '0' + unit - (unit / 10) * 10; -} - -void __uAuxFmt(void *var, uint8_t mul, uint8_t dec) -{ - uint8_t unit = *(uint8_t *) var; - line2[0] = 'L'; - line2[1] = 'M'; - line2[2] = 'H'; - line2[4] = (unit & 1 << 0 ? 'X' : '.'); - line2[5] = (unit & 1 << 1 ? 'X' : '.'); - line2[6] = (unit & 1 << 2 ? 'X' : '.'); - line2[8] = (unit & 1 << 3 ? 'X' : '.'); - line2[9] = (unit & 1 << 4 ? 'X' : '.'); - line2[10] = (unit & 1 << 5 ? 'X' : '.'); -} - -void __upMFmt(void *var, uint8_t mul, uint8_t dec) -{ - uint32_t unit = *(uint32_t *) var; - // pmeter values need special treatment, too many digits to fit standard 8 bit scheme - unit = unit / PLEVELDIVSOFT; // [0:1000] * 1000/3 samples per second(loop time) * 60 seconds *5 minutes -> [0:10000 e4] per motor - // (that is full throttle for 5 minutes sampling with high sampling rate for wmp only) - // times 6 for a maximum of 6 motors equals [0:60000 e4] for the sum - // we are only interested in the big picture, so divide by 10.000 - __u16Fmt(&unit, mul, dec); -} - -void __upSFmt(void *var, uint8_t mul, uint8_t dec) -{ - uint32_t unit = *(uint32_t *) var; -#if defined(POWERMETER_SOFT) - unit = unit / PLEVELDIVSOFT; -#elif defined(POWERMETER_HARD) - unit = unit / PLEVELDIV; -#endif - __u16Fmt(&unit, mul, dec); -} - -static uint8_t lcdStickState[3]; -#define IsLow(x) (lcdStickState[x] & 0x1) -#define IsHigh(x) (lcdStickState[x] & 0x2) -#define IsMid(x) (!lcdStickState[x]) - -/* keys to navigate the LCD menu (preset to LCD_TEXTSTAR key-depress codes)*/ -#define LCD_MENU_PREV 'a' -#define LCD_MENU_NEXT 'c' -#define LCD_VALUE_UP 'd' -#define LCD_VALUE_DOWN 'b' - -void configurationLoop() -{ - uint8_t i, p; - uint8_t LCD = 1; - uint8_t refreshLCD = 1; - uint8_t key = 0; - initLCD(); - p = 0; - while (LCD == 1) { - if (refreshLCD) { - blinkLED(10, 20, 1); - strcpy_P(line1, PSTR(" ")); - strcpy(line2, line1); - strcpy_P(line1, (char *) - pgm_read_word(&(lcd_param_ptr_table[p * 3]))); - lcd_param_def_t *deft = (lcd_param_def_t *) pgm_read_word(&(lcd_param_ptr_table[(p * 3) + 2])); - deft->type->fmt((void *) - pgm_read_word(&(lcd_param_ptr_table[(p * 3) + 1])), deft->multiplier, deft->decimal); - LCDclear(); - LCDsetLine(1); - LCDprintChar(line1); //refresh line 1 of LCD - LCDsetLine(2); - LCDprintChar(line2); //refresh line 2 of LCD - refreshLCD = 0; - } -#if defined(LCD_TEXTSTAR) || defined(LCD_VT100) // textstar or vt100 can send keys - key = (SerialAvailable(0) ? SerialRead(0) : 0); -#endif -#ifdef LCD_CONF_DEBUG - delay(1000); - if (key == LCD_MENU_NEXT) - key = LCD_VALUE_UP; - else - key = LCD_MENU_NEXT; -#endif - for (i = ROLL; i < THROTTLE; i++) { - uint16_t Tmp = readRawRC(i); - lcdStickState[i] = (Tmp < MINCHECK) | ((Tmp > MAXCHECK) << 1); - }; - if (IsLow(YAW) && IsHigh(PITCH)) - LCD = 0; // save and exit - else if (IsHigh(YAW) && IsHigh(PITCH)) - LCD = 2; // exit without save: eeprom has only 100.000 write cycles - else if (key == LCD_MENU_NEXT || (IsLow(PITCH))) { //switch config param with pitch - refreshLCD = 1; - p++; - if (p > PARAMMAX) - p = 0; - } else if (key == LCD_MENU_PREV || (IsHigh(PITCH))) { - refreshLCD = 1; - p--; - if (p == 0xFF) - p = PARAMMAX; - } else if (key == LCD_VALUE_DOWN || (IsLow(ROLL))) { //+ or - param with low and high roll - refreshLCD = 1; - lcd_param_def_t *deft = (lcd_param_def_t *) pgm_read_word(&(lcd_param_ptr_table[(p * 3) + 2])); - deft->type->inc((void *) - pgm_read_word(&(lcd_param_ptr_table[(p * 3) + 1])), -deft->increment); - if (p == 0) - P8[PITCH] = P8[ROLL]; - } else if (key == LCD_VALUE_UP || (IsHigh(ROLL))) { - refreshLCD = 1; - lcd_param_def_t *deft = (lcd_param_def_t *) pgm_read_word(&(lcd_param_ptr_table[(p * 3) + 2])); - deft->type->inc((void *) - pgm_read_word(&(lcd_param_ptr_table[(p * 3) + 1])), +deft->increment); - if (p == 0) - P8[PITCH] = P8[ROLL]; - } - } // while (LCD == 1) - blinkLED(20, 30, 1); - - LCDclear(); - LCDsetLine(1); - if (LCD == 0) { - strcpy_P(line1, PSTR("Saving...")); - LCDprintChar(line1); - } else { - strcpy_P(line1, PSTR("Aborting")); - LCDprintChar(line1); - } - if (LCD == 0) - writeParams(); - LCDsetLine(2); - strcpy_P(line1, PSTR("Exit")); - LCDprintChar(line1); -#if defined(LCD_LCD03) - delay(2000); // wait for two seconds then clear screen and show initial message - initLCD(); -#endif -#if defined(LCD_SERIAL3W) - SerialOpen(0, 115200); -#endif -#ifdef LCD_TELEMETRY - delay(1500); // keep exit message visible for one and one half seconds even if (auto)telemetry continues writing in main loop -#endif -} -#endif // LCD_CONF - - -// -------------------- telemetry output to LCD over serial/i2c ---------------------------------- - -#ifdef LCD_TELEMETRY - - // LCDbar(n,v) : draw a bar graph - n number of chars for width, v value in % to display -void LCDbar(uint8_t n, uint8_t v) -{ -#if defined(LCD_SERIAL3W) - for (uint8_t i = 0; i < n; i++) - LCDprint((i < n * v / 100 ? '=' : '.')); -#elif defined(LCD_TEXTSTAR) - LCDprint(0xFE); - LCDprint('b'); - LCDprint(n); - LCDprint(v); -#elif defined(LCD_VT100) - for (uint8_t i = 0; i < n; i++) - LCDprint((i < n * v / 100 ? '=' : '.')); -#elif defined(LCD_ETPP) - ETPP_barGraph(n, v); -#elif defined(LCD_LCD03) - for (uint8_t i = 0; i < n; i++) - LCDprint((i < n * v / 100 ? '=' : '.')); -#endif -} - -void lcd_telemetry() -{ - uint16_t intPowerMeterSum; - static uint8_t linenr = 0; - switch (telemetry) { // output telemetry data, if one of four modes is set - uint16_t unit; - case 1: // button A on Textstar LCD -> angles - case '1': - if (linenr++ % 2) { - strcpy_P(line1, PSTR("Deg ---.- ---.-")); - // 0123456789.12345 - if (angle[0] < 0) { - unit = -angle[0]; - line1[3] = '-'; - } else - unit = angle[0]; - line1[4] = '0' + unit / 1000; - line1[5] = '0' + unit / 100 - (unit / 1000) * 10; - line1[6] = '0' + unit / 10 - (unit / 100) * 10; - line1[8] = '0' + unit - (unit / 10) * 10; - if (angle[1] < 0) { - unit = -angle[1]; - line1[10] = '-'; - } else - unit = angle[1]; - line1[11] = '0' + unit / 1000; - line1[12] = '0' + unit / 100 - (unit / 1000) * 10; - line1[13] = '0' + unit / 10 - (unit / 100) * 10; - line1[15] = '0' + unit - (unit / 10) * 10; - LCDsetLine(1); - LCDprintChar(line1); - } else { - strcpy_P(line2, PSTR("---,-A max---,-A")); -#ifdef LOG_VALUES - unit = powerValue * PINT2mA; - line2[0] = '0' + unit / 10000; - line2[1] = '0' + unit / 1000 - (unit / 10000) * 10; - line2[2] = '0' + unit / 100 - (unit / 1000) * 10; - line2[4] = '0' + unit / 10 - (unit / 100) * 10; - unit = powerMax * PINT2mA; - line2[10] = '0' + unit / 10000; - line2[11] = '0' + unit / 1000 - (unit / 10000) * 10; - line2[12] = '0' + unit / 100 - (unit / 1000) * 10; - line2[14] = '0' + unit / 10 - (unit / 100) * 10; -#endif - LCDsetLine(2); - LCDprintChar(line2); - } - break; - - case 2: // button B on Textstar LCD -> Voltage, PowerSum and power alarm trigger value - case '2': - if (linenr++ % 2) { - strcpy_P(line1, PSTR("--.-V -----mAh")); // uint8_t vbat, intPowerMeterSum - // 0123456789.12345 -#ifdef VBAT - line1[0] = '0' + vbat / 100; - line1[1] = '0' + vbat / 10 - (vbat / 100) * 10; - line1[3] = '0' + vbat - (vbat / 10) * 10; -#endif -#ifdef POWERMETER - intPowerMeterSum = (pMeter[PMOTOR_SUM] / PLEVELDIV); - line1[8] = '0' + intPowerMeterSum / 10000; - line1[9] = '0' + intPowerMeterSum / 1000 - (intPowerMeterSum / 10000) * 10; - line1[10] = '0' + intPowerMeterSum / 100 - (intPowerMeterSum / 1000) * 10; - line1[11] = '0' + intPowerMeterSum / 10 - (intPowerMeterSum / 100) * 10; - line1[12] = '0' + intPowerMeterSum - (intPowerMeterSum / 10) * 10; -#endif - if (buzzerState) { // buzzer on? then add some blink for attention - line1[5] = '+'; - line1[6] = '+'; - line1[7] = '+'; - } - // set mark, if we had i2c errors, failsafes or annex650 overruns - if (i2c_errors_count || failsafeEvents || annex650_overrun_count) - line1[6] = '!'; - LCDsetLine(1); - LCDprintChar(line1); - } else { - LCDsetLine(2); -#ifdef VBAT - LCDbar(7, (((vbat - VBATLEVEL1_3S) * 100) / VBATREF)); - LCDprint(' '); -#else - LCDprintChar(" "); -#endif -#ifdef POWERMETER - // intPowerMeterSum = (pMeter[PMOTOR_SUM]/PLEVELDIV); - // pAlarm = (uint32_t) powerTrigger1 * (uint32_t) PLEVELSCALE * (uint32_t) PLEVELDIV; // need to cast before multiplying - intPowerMeterSum = (pMeter[PMOTOR_SUM] / PLEVELDIV); - if (powerTrigger1) - LCDbar(8, (intPowerMeterSum / (uint16_t) powerTrigger1) * 2); // bar graph powermeter (scale intPowerMeterSum/powerTrigger1 with *100/PLEVELSCALE) -#endif - } - break; - - case 3: // button C on Textstar LCD -> cycle time - case '3': - if (linenr++ % 2) { - strcpy_P(line1, PSTR("Cycle -----us")); //uin16_t cycleTime - // 0123456789.12345*/ - //strcpy_P(line2,PSTR("(-----, -----)us")); //uin16_t cycleTimeMax - line1[9] = '0' + cycleTime / 10000; - line1[10] = '0' + cycleTime / 1000 - (cycleTime / 10000) * 10; - line1[11] = '0' + cycleTime / 100 - (cycleTime / 1000) * 10; - line1[12] = '0' + cycleTime / 10 - (cycleTime / 100) * 10; - line1[13] = '0' + cycleTime - (cycleTime / 10) * 10; - LCDsetLine(1); - LCDprintChar(line1); - } else { -#ifdef LOG_VALUES - strcpy_P(line2, PSTR("(-----, -----)us")); //uin16_t cycleTimeMax - line2[1] = '0' + cycleTimeMin / 10000; - line2[2] = '0' + cycleTimeMin / 1000 - (cycleTimeMin / 10000) * 10; - line2[3] = '0' + cycleTimeMin / 100 - (cycleTimeMin / 1000) * 10; - line2[4] = '0' + cycleTimeMin / 10 - (cycleTimeMin / 100) * 10; - line2[5] = '0' + cycleTimeMin - (cycleTimeMin / 10) * 10; - line2[8] = '0' + cycleTimeMax / 10000; - line2[9] = '0' + cycleTimeMax / 1000 - (cycleTimeMax / 10000) * 10; - line2[10] = '0' + cycleTimeMax / 100 - (cycleTimeMax / 1000) * 10; - line2[11] = '0' + cycleTimeMax / 10 - (cycleTimeMax / 100) * 10; - line2[12] = '0' + cycleTimeMax - (cycleTimeMax / 10) * 10; - LCDsetLine(2); - LCDprintChar(line2); -#endif - } - break; - - case 4: // button D on Textstar LCD -> sensors - case '4': -#define GYROLIMIT 30 // threshold: for larger values replace bar with dots -#define ACCLIMIT 40 // threshold: for larger values replace bar with dots - if (linenr++ % 2) { - LCDsetLine(1); - LCDprintChar("G "); //refresh line 1 of LCD - if (abs(gyroData[0]) < GYROLIMIT) { - LCDbar(4, (GYROLIMIT + gyroData[0]) * 50 / GYROLIMIT); - } else - LCDprintChar("...."); - LCDprint(' '); - if (abs(gyroData[1]) < GYROLIMIT) { - LCDbar(4, (GYROLIMIT + gyroData[1]) * 50 / GYROLIMIT); - } else - LCDprintChar("...."); - LCDprint(' '); - if (abs(gyroData[2]) < GYROLIMIT) { - LCDbar(4, (GYROLIMIT + gyroData[2]) * 50 / GYROLIMIT); - } else - LCDprintChar("...."); - } else { - LCDsetLine(2); - LCDprintChar("A "); //refresh line 2 of LCD - if (abs(accSmooth[0]) < ACCLIMIT) { - LCDbar(4, (ACCLIMIT + accSmooth[0]) * 50 / ACCLIMIT); - } else - LCDprintChar("...."); - LCDprint(' '); - if (abs(accSmooth[1]) < ACCLIMIT) { - LCDbar(4, (ACCLIMIT + accSmooth[1]) * 50 / ACCLIMIT); - } else - LCDprintChar("...."); - LCDprint(' '); - if (abs(accSmooth[2] - acc_1G) < ACCLIMIT) { - LCDbar(4, (ACCLIMIT + accSmooth[2] - acc_1G) * 50 / ACCLIMIT); - } else - LCDprintChar("...."); - } - break; - - case 5: // No button. Displays with auto telemetry only - case '5': - if (linenr++ % 2) { - strcpy_P(line1, PSTR("Fails i2c t-errs")); - LCDsetLine(1); - LCDprintChar(line1); - } else { - // 0123456789012345 - strcpy_P(line2, PSTR("---- ---- ----")); - unit = failsafeEvents; - line2[0] = '0' + unit / 1000 - (unit / 10000) * 10; - line2[1] = '0' + unit / 100 - (unit / 1000) * 10; - line2[2] = '0' + unit / 10 - (unit / 100) * 10; - line2[3] = '0' + unit - (unit / 10) * 10; - unit = i2c_errors_count; - line2[6] = '0' + unit / 1000 - (unit / 10000) * 10; - line2[7] = '0' + unit / 100 - (unit / 1000) * 10; - line2[8] = '0' + unit / 10 - (unit / 100) * 10; - line2[9] = '0' + unit - (unit / 10) * 10; - unit = annex650_overrun_count; - line2[12] = '0' + unit / 1000 - (unit / 10000) * 10; - line2[13] = '0' + unit / 100 - (unit / 1000) * 10; - line2[14] = '0' + unit / 10 - (unit / 100) * 10; - line2[15] = '0' + unit - (unit / 10) * 10; - LCDsetLine(2); - LCDprintChar(line2); - } - break; - - case 6: // No button. Displays with auto telemetry only - case '6': - if (linenr++ % 2) { - strcpy_P(line1, PSTR("Roll Pitch Throt")); - if (armed) - line2[14] = 'A'; - else - line2[14] = 'a'; - if (failsafeCnt > 5) - line2[15] = 'F'; - else - line2[15] = 'f'; - LCDsetLine(1); - LCDprintChar(line1); - } else { - // 0123456789012345 - strcpy_P(line2, PSTR("---- ---- ----xx")); - line2[0] = '0' + rcData[ROLL] / 1000 - (rcData[ROLL] / 10000) * 10; - line2[1] = '0' + rcData[ROLL] / 100 - (rcData[ROLL] / 1000) * 10; - line2[2] = '0' + rcData[ROLL] / 10 - (rcData[ROLL] / 100) * 10; - line2[3] = '0' + rcData[ROLL] - (rcData[ROLL] / 10) * 10; - line2[5] = '0' + rcData[PITCH] / 1000 - (rcData[PITCH] / 10000) * 10; - line2[6] = '0' + rcData[PITCH] / 100 - (rcData[PITCH] / 1000) * 10; - line2[7] = '0' + rcData[PITCH] / 10 - (rcData[PITCH] / 100) * 10; - line2[8] = '0' + rcData[PITCH] - (rcData[PITCH] / 10) * 10; - line2[10] = '0' + rcData[THROTTLE] / 1000 - (rcData[THROTTLE] / 10000) * 10; - line2[11] = '0' + rcData[THROTTLE] / 100 - (rcData[THROTTLE] / 1000) * 10; - line2[12] = '0' + rcData[THROTTLE] / 10 - (rcData[THROTTLE] / 100) * 10; - line2[13] = '0' + rcData[THROTTLE] - (rcData[THROTTLE] / 10) * 10; - LCDsetLine(2); - LCDprintChar(line2); - } - break; - - case 7: // No button. Displays with auto telemetry only - case '7': // contributed by PatrikE - if (linenr++ % 2) { - strcpy_P(line1, PSTR("Lat Lon --")); - // 0123456789012345 - if (armed) - line1[14] = 'A'; - else - line1[14] = 'a'; - if (failsafeCnt > 5) - line1[15] = 'F'; - else - line1[15] = 'f'; - LCDsetLine(1); - LCDprintChar(line1); - } else { - strcpy_P(line2, PSTR("------- -------")); -#if defined(GPS) - line2[0] = '0' + GPS_latitude / 1000000 - (GPS_latitude / 10000000) * 10; - line2[1] = '0' + GPS_latitude / 100000 - (GPS_latitude / 1000000) * 10; - line2[2] = '0' + GPS_latitude / 10000 - (GPS_latitude / 100000) * 10; - line2[3] = '0' + GPS_latitude / 1000 - (GPS_latitude / 10000) * 10; - line2[4] = '0' + GPS_latitude / 100 - (GPS_latitude / 1000) * 10; - line2[5] = '0' + GPS_latitude / 10 - (GPS_latitude / 100) * 10; - line2[6] = '0' + GPS_latitude - (GPS_latitude / 10) * 10; - line2[9] = '0' + GPS_longitude / 1000000 - (GPS_longitude / 10000000) * 10; - line2[10] = '0' + GPS_longitude / 100000 - (GPS_longitude / 1000000) * 10; - line2[11] = '0' + GPS_longitude / 10000 - (GPS_longitude / 100000) * 10; - line2[12] = '0' + GPS_longitude / 1000 - (GPS_longitude / 10000) * 10; - line2[13] = '0' + GPS_longitude / 100 - (GPS_longitude / 1000) * 10; - line2[14] = '0' + GPS_longitude / 10 - (GPS_longitude / 100) * 10; - line2[15] = '0' + GPS_longitude - (GPS_longitude / 10) * 10; -#endif - LCDsetLine(2); - LCDprintChar(line2); - } - break; - -#if defined(LOG_VALUES) && defined(DEBUG) - case 'R': - //Reset logvalues -#if defined(LOG_VALUES) && defined(DEBUG) - cycleTimeMax = 0; // reset min/max on transition on->off - cycleTimeMin = 65535; -#endif - telemetry = 0; // no use to repeat this forever - break; -#endif // case R - -#ifdef DEBUG - case 'F': - extern unsigned int __bss_end; - extern unsigned int __heap_start; - extern void *__brkval; - int free_memory; - if ((int) __brkval == 0) - free_memory = ((int) &free_memory) - ((int) &__bss_end); - else - free_memory = ((int) &free_memory) - ((int) __brkval); - strcpy_P(line1, PSTR(" Free ----")); // uint8_t free_memory - line1[6] = '0' + free_memory / 1000 - (free_memory / 10000) * 10; - line1[7] = '0' + free_memory / 100 - (free_memory / 1000) * 10; - line1[8] = '0' + free_memory / 10 - (free_memory / 100) * 10; - line1[9] = '0' + free_memory - (free_memory / 10) * 10; - LCDsetLine(1); - LCDprintChar(line1); - break; -#endif // DEBUG - - // WARNING: if you add another case here, you should also add a case: in Serial.pde, so users can access your case via terminal input - } // end switch (telemetry) -} // end function -#endif // LCD_TELEMETRY diff --git a/mw-svn/LED.cpp b/mw-svn/LED.cpp deleted file mode 100755 index 2a90d1884..000000000 --- a/mw-svn/LED.cpp +++ /dev/null @@ -1,54 +0,0 @@ -#if defined(LED_RING) - -#define LED_RING_ADDRESS 0xDA //8 bits -- my initial :) - -void i2CLedRingState() -{ - uint8_t b[10]; - static uint8_t state; - - if (state == 0) { - b[0] = 'z'; - b[1] = (180 - heading) / 2; // 1 unit = 2 degrees; - i2c_rep_start(LED_RING_ADDRESS); - for (uint8_t i = 0; i < 2; i++) - i2c_write(b[i]); - i2c_stop(); - state = 1; - } else if (state == 1) { - b[0] = 'y'; - b[1] = constrain(angle[ROLL] / 10 + 90, 0, 180); - b[2] = constrain(angle[PITCH] / 10 + 90, 0, 180); - i2c_rep_start(LED_RING_ADDRESS); - for (uint8_t i = 0; i < 3; i++) - i2c_write(b[i]); - i2c_stop(); - state = 2; - } else if (state == 2) { - b[0] = 'd'; // all unicolor GREEN - b[1] = 1; - if (armed) - b[2] = 1; - else - b[2] = 0; - i2c_rep_start(LED_RING_ADDRESS); - for (uint8_t i = 0; i < 3; i++) - i2c_write(b[i]); - i2c_stop(); - state = 0; - } -} - -void blinkLedRing() -{ - uint8_t b[3]; - b[0] = 'k'; - b[1] = 10; - b[2] = 10; - i2c_rep_start(LED_RING_ADDRESS); - for (uint8_t i = 0; i < 3; i++) - i2c_write(b[i]); - i2c_stop(); -} - -#endif diff --git a/mw-svn/MultiWii.cpp b/mw-svn/MultiWii.cpp deleted file mode 100755 index 8f428772e..000000000 --- a/mw-svn/MultiWii.cpp +++ /dev/null @@ -1,784 +0,0 @@ -/* -MultiWiiCopter by Alexandre Dubus -www.multiwii.com -December 2011 V1.dev - 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 3 of the License, or - any later version. see -*/ - -#include "config.h" -#include "def.h" -#include -#define VERSION 19 - -/*********** RC alias *****************/ -#define ROLL 0 -#define PITCH 1 -#define YAW 2 -#define THROTTLE 3 -#define AUX1 4 -#define AUX2 5 -#define AUX3 6 -#define AUX4 7 - -#define PIDALT 3 -#define PIDVEL 4 -#define PIDGPS 5 -#define PIDLEVEL 6 -#define PIDMAG 7 - -#define BOXACC 0 -#define BOXBARO 1 -#define BOXMAG 2 -#define BOXCAMSTAB 3 -#define BOXCAMTRIG 4 -#define BOXARM 5 -#define BOXGPSHOME 6 -#define BOXGPSHOLD 7 -#define BOXPASSTHRU 8 -#define BOXHEADFREE 9 -#define BOXBEEPERON 10 - -#define CHECKBOXITEMS 11 -#define PIDITEMS 8 - -static uint32_t currentTime = 0; -static uint16_t previousTime = 0; -static uint16_t cycleTime = 0; // this is the number in micro second to achieve a full loop, it can differ a little and is taken into account in the PID loop -static uint16_t calibratingA = 0; // the calibration is done is the main loop. Calibrating decreases at each cycle down to 0, then we enter in a normal mode. -static uint8_t calibratingM = 0; -static uint16_t calibratingG; -static uint8_t armed = 0; -static uint16_t acc_1G; // this is the 1G measured acceleration -static int16_t acc_25deg; -static uint8_t nunchuk = 0; -static uint8_t accMode = 0; // if level mode is a activated -static uint8_t magMode = 0; // if compass heading hold is a activated -static uint8_t baroMode = 0; // if altitude hold is activated -static uint8_t GPSModeHome = 0; // if GPS RTH is activated -static uint8_t GPSModeHold = 0; // if GPS PH is activated -static uint8_t headFreeMode = 0; // if head free mode is a activated -static uint8_t passThruMode = 0; // if passthrough mode is activated -static int16_t headFreeModeHold; -static int16_t gyroADC[3], accADC[3], accSmooth[3], magADC[3]; -static int16_t accTrim[2] = { 0, 0 }; -static int16_t heading, magHold; -static uint8_t calibratedACC = 0; -static uint8_t vbat; // battery voltage in 0.1V steps -static uint8_t okToArm = 0; -static uint8_t rcOptions1, rcOptions2; -static int32_t pressure; -static int16_t BaroAlt; -static int16_t EstAlt; // in cm -static int16_t zVelocity; -static uint8_t buzzerState = 0; -static int16_t debug1, debug2, debug3, debug4; - -//for log -static uint16_t cycleTimeMax = 0; // highest ever cycle timen -static uint16_t cycleTimeMin = 65535; // lowest ever cycle timen -static uint16_t powerMax = 0; // highest ever current - -static int16_t i2c_errors_count = 0; -static int16_t annex650_overrun_count = 0; - -// ********************** -//Automatic ACC Offset Calibration -// ********************** -static uint16_t InflightcalibratingA = 0; -static int16_t AccInflightCalibrationArmed; -static uint16_t AccInflightCalibrationMeasurementDone = 0; -static uint16_t AccInflightCalibrationSavetoEEProm = 0; - -// ********************** -// power meter -// ********************** -#define PMOTOR_SUM 8 // index into pMeter[] for sum -static uint32_t pMeter[PMOTOR_SUM + 1]; //we use [0:7] for eight motors,one extra for sum -static uint8_t pMeterV; // dummy to satisfy the paramStruct logic in ConfigurationLoop() -static uint32_t pAlarm; // we scale the eeprom value from [0:255] to this value we can directly compare to the sum in pMeter[6] -static uint8_t powerTrigger1 = 0; // trigger for alarm based on power consumption -static uint16_t powerValue = 0; // last known current -static uint16_t intPowerMeterSum, intPowerTrigger1; - -// ********************** -// telemetry -// ********************** -static uint8_t telemetry = 0; -static uint8_t telemetry_auto = 0; - -// ****************** -// rc functions -// ****************** -#define MINCHECK 1100 -#define MAXCHECK 1900 - -volatile int16_t failsafeCnt = 0; -static int16_t failsafeEvents = 0; -static int16_t rcData[8]; // interval [1000;2000] -static int16_t rcCommand[4]; // interval [1000;2000] for THROTTLE and [-500;+500] for ROLL/PITCH/YAW -static uint8_t rcRate8; -static uint8_t rcExpo8; -static int16_t lookupRX[7]; // lookup table for expo & RC rate -volatile uint8_t rcFrameComplete; //for serial rc receiver Spektrum - - -// ************** -// gyro+acc IMU -// ************** -static int16_t gyroData[3] = { 0, 0, 0 }; -static int16_t gyroZero[3] = { 0, 0, 0 }; -static int16_t accZero[3] = { 0, 0, 0 }; -static int16_t magZero[3] = { 0, 0, 0 }; -static int16_t angle[2] = { 0, 0 }; // absolute angle inclination in multiple of 0.1 degree 180 deg = 1800 -static int8_t smallAngle25 = 1; - -// ************************* -// motor and servo functions -// ************************* -static int16_t axisPID[3]; -static int16_t motor[8]; -static int16_t servo[8] = { 1500, 1500, 1500, 1500, 1500, 1500, 1500, 1500 }; -static uint16_t wing_left_mid = WING_LEFT_MID; -static uint16_t wing_right_mid = WING_RIGHT_MID; -static uint16_t tri_yaw_middle = TRI_YAW_MIDDLE; - -// ********************** -// EEPROM & LCD functions -// ********************** -static uint8_t P8[8], I8[8], D8[8]; //8 bits is much faster and the code is much shorter -static uint8_t dynP8[3], dynI8[3], dynD8[3]; -static uint8_t rollPitchRate; -static uint8_t yawRate; -static uint8_t dynThrPID; -static uint8_t activate1[CHECKBOXITEMS]; -static uint8_t activate2[CHECKBOXITEMS]; - -// ********************** -// GPS -// ********************** -static int32_t GPS_latitude, GPS_longitude; -static int32_t GPS_latitude_home, GPS_longitude_home; -static uint8_t GPS_fix, GPS_fix_home = 0; -static uint8_t GPS_numSat; -static uint16_t GPS_distanceToHome; // in meters -static int16_t GPS_directionToHome = 0; // in degrees -static uint8_t GPS_update = 0; // it's a binary toogle to distinct a GPS position update -static int16_t GPS_angle[2]; // it's the angles that must be applied for GPS correction - -void blinkLED(uint8_t num, uint8_t wait, uint8_t repeat) -{ - uint8_t i, r; - for (r = 0; r < repeat; r++) { - for (i = 0; i < num; i++) { - LEDPIN_TOGGLE; //switch LEDPIN state - BUZZERPIN_ON; - delay(wait); - BUZZERPIN_OFF; - } - delay(60); - } -} - -void annexCode() -{ //this code is excetuted at each loop and won't interfere with control loop if it lasts less than 650 microseconds - static uint32_t buzzerTime, calibratedAccTime; -#if defined(LCD_TELEMETRY) - static uint16_t telemetryTimer = 0, telemetryAutoTimer = 0, psensorTimer = 0; -#endif -#if defined(LCD_TELEMETRY) - static uint8_t telemetryAutoIndex = 0; - static char telemetryAutoSequence[] = LCD_TELEMETRY_AUTO; -#endif -#ifdef VBAT - static uint8_t vbatTimer = 0; -#endif - static uint8_t buzzerFreq; //delay between buzzer ring - uint8_t axis, prop1, prop2; -#if defined(POWERMETER_HARD) - uint16_t pMeterRaw; //used for current reading -#endif - - //PITCH & ROLL only dynamic PID adjustemnt, depending on throttle value - if (rcData[THROTTLE] < 1500) { - prop2 = 100; - } else if (rcData[THROTTLE] < 2000) { - prop2 = 100 - (uint16_t) dynThrPID *(rcData[THROTTLE] - 1500) / 500; - } else { - prop2 = 100 - dynThrPID; - } - - for (axis = 0; axis < 3; axis++) { - uint16_t tmp = min(abs(rcData[axis] - MIDRC), 500); -#if defined(DEADBAND) - if (tmp > DEADBAND) { - tmp -= DEADBAND; - } else { - tmp = 0; - } -#endif - if (axis != 2) { //ROLL & PITCH - uint16_t tmp2 = tmp / 100; - rcCommand[axis] = lookupRX[tmp2] + (tmp - tmp2 * 100) * (lookupRX[tmp2 + 1] - lookupRX[tmp2]) / 100; - prop1 = 100 - (uint16_t) rollPitchRate *tmp / 500; - prop1 = (uint16_t) prop1 *prop2 / 100; - } else { //YAW - rcCommand[axis] = tmp; - prop1 = 100 - (uint16_t) yawRate *tmp / 500; - } - dynP8[axis] = (uint16_t) P8[axis] * prop1 / 100; - dynD8[axis] = (uint16_t) D8[axis] * prop1 / 100; - if (rcData[axis] < MIDRC) - rcCommand[axis] = -rcCommand[axis]; - } - rcCommand[THROTTLE] = MINTHROTTLE + (int32_t) (MAXTHROTTLE - MINTHROTTLE) * (rcData[THROTTLE] - MINCHECK) / (2000 - MINCHECK); - - if (headFreeMode) { - float radDiff = (heading - headFreeModeHold) * 0.0174533f; // where PI/180 ~= 0.0174533 - float cosDiff = cos(radDiff); - float sinDiff = sin(radDiff); - int16_t rcCommand_PITCH = rcCommand[PITCH] * cosDiff + rcCommand[ROLL] * sinDiff; - rcCommand[ROLL] = rcCommand[ROLL] * cosDiff - rcCommand[PITCH] * sinDiff; - rcCommand[PITCH] = rcCommand_PITCH; - } -#if defined(POWERMETER_HARD) - if (!(++psensorTimer % PSENSORFREQ)) { - pMeterRaw = analogRead(PSENSORPIN); - powerValue = (PSENSORNULL > pMeterRaw ? PSENSORNULL - pMeterRaw : pMeterRaw - PSENSORNULL); // do not use abs(), it would induce implicit cast to uint and overrun - if (powerValue < 333) { // only accept reasonable values. 333 is empirical -#ifdef LOG_VALUES - if (powerValue > powerMax) - powerMax = powerValue; -#endif - } else { - powerValue = 333; - } - pMeter[PMOTOR_SUM] += (uint32_t) powerValue; - } -#endif - -#if defined(VBAT) - static uint8_t ind = 0; - uint16_t vbatRaw = 0; - static uint16_t vbatRawArray[8]; - if (!(++vbatTimer % VBATFREQ)) { - ADCSRA |= _BV(ADPS2); - ADCSRA &= ~_BV(ADPS1); - ADCSRA &= ~_BV(ADPS0); //this speeds up analogRead without loosing too much resolution: http://www.arduino.cc/cgi-bin/yabb2/YaBB.pl?num=1208715493/11 - vbatRawArray[(ind++) % 8] = analogRead(V_BATPIN); - for (uint8_t i = 0; i < 8; i++) - vbatRaw += vbatRawArray[i]; - vbat = vbatRaw / (VBATSCALE / 2); // result is Vbatt in 0.1V steps - } - if ((rcOptions1 & activate1[BOXBEEPERON]) || (rcOptions2 & activate2[BOXBEEPERON])) { // unconditional beeper on via AUXn switch - buzzerFreq = 7; - } else if (((vbat > VBATLEVEL1_3S) -#if defined(POWERMETER) - && ((pMeter[PMOTOR_SUM] < pAlarm) || (pAlarm == 0)) -#endif - ) || (NO_VBAT > vbat)) // ToLuSe - { //VBAT ok AND powermeter ok, buzzer off - buzzerFreq = 0; - buzzerState = 0; - BUZZERPIN_OFF; -#if defined(POWERMETER) - } else if (pMeter[PMOTOR_SUM] > pAlarm) { // sound alarm for powermeter - buzzerFreq = 4; -#endif - } else if (vbat > VBATLEVEL2_3S) - buzzerFreq = 1; - else if (vbat > VBATLEVEL3_3S) - buzzerFreq = 2; - else - buzzerFreq = 4; - if (buzzerFreq) { - if (buzzerState && (currentTime > buzzerTime + 250000)) { - buzzerState = 0; - BUZZERPIN_OFF; - buzzerTime = currentTime; - } else if (!buzzerState && (currentTime > (buzzerTime + (2000000 >> buzzerFreq)))) { - buzzerState = 1; - BUZZERPIN_ON; - buzzerTime = currentTime; - } - } -#endif - - if ((calibratingA > 0 && (ACC || nunchuk)) || (calibratingG > 0)) { // Calibration phasis - LEDPIN_TOGGLE; - } else { - if (calibratedACC == 1) { - LEDPIN_OFF; - } - if (armed) { - LEDPIN_ON; - } - } - -#if defined(LED_RING) - static uint32_t LEDTime; - if (currentTime > LEDTime) { - LEDTime = currentTime + 50000; - i2CLedRingState(); - } -#endif - - if (currentTime > calibratedAccTime) { - if (smallAngle25 == 0) { - calibratedACC = 0; //the multi uses ACC and is not calibrated or is too much inclinated - LEDPIN_TOGGLE; - calibratedAccTime = currentTime + 500000; - } else - calibratedACC = 1; - } - - serialCom(); - -#if defined(POWERMETER) - intPowerMeterSum = (pMeter[PMOTOR_SUM] / PLEVELDIV); - intPowerTrigger1 = powerTrigger1 * PLEVELSCALE; -#endif - -#ifdef LCD_TELEMETRY_AUTO - if ((telemetry_auto) - && (!(++telemetryAutoTimer % LCD_TELEMETRY_AUTO_FREQ))) { - telemetry = telemetryAutoSequence[++telemetryAutoIndex % strlen(telemetryAutoSequence)]; - LCDclear(); // make sure to clear away remnants - } -#endif -#ifdef LCD_TELEMETRY - if (!(++telemetryTimer % LCD_TELEMETRY_FREQ)) { -#if (LCD_TELEMETRY_DEBUG+0 > 0) - telemetry = LCD_TELEMETRY_DEBUG; -#endif - if (telemetry) - lcd_telemetry(); - } -#endif - -#if defined(GPS) - static uint32_t GPSLEDTime; - if (currentTime > GPSLEDTime && (GPS_fix_home == 1)) { - GPSLEDTime = currentTime + 150000; - LEDPIN_TOGGLE; - } -#endif -} - - -void setup() -{ - SerialOpen(0, 115200); - LEDPIN_PINMODE; - POWERPIN_PINMODE; - BUZZERPIN_PINMODE; - STABLEPIN_PINMODE; - POWERPIN_OFF; - initOutput(); - readEEPROM(); - checkFirstTime(); - configureReceiver(); - initSensors(); - previousTime = micros(); -#if defined(GIMBAL) - calibratingA = 400; -#endif - calibratingG = 400; -#if defined(POWERMETER) - for (uint8_t i = 0; i <= PMOTOR_SUM; i++) - pMeter[i] = 0; -#endif -#if defined(GPS) - SerialOpen(GPS_SERIAL, GPS_BAUD); -#endif -#if defined(LCD_ETPP) - initLCD(); -#elif defined(LCD_LCD03) - initLCD(); -#endif -#ifdef LCD_TELEMETRY_DEBUG - telemetry_auto = 1; -#endif -#ifdef LCD_CONF_DEBUG - configurationLoop(); -#endif - - -} - -// ******** Main Loop ********* -void loop() -{ - static uint8_t rcDelayCommand; // this indicates the number of time (multiple of RC measurement at 50Hz) the sticks must be maintained to run or switch off motors - uint8_t axis, i; - int16_t error, errorAngle; - int16_t delta, deltaSum; - int16_t PTerm, ITerm, DTerm; - static int16_t lastGyro[3] = { 0, 0, 0 }; - static int16_t delta1[3], delta2[3]; - static int16_t errorGyroI[3] = { 0, 0, 0 }; - static int16_t errorAngleI[2] = { 0, 0 }; - static uint32_t rcTime = 0; - static int16_t initialThrottleHold; - static int16_t errorAltitudeI = 0; - int16_t AltPID = 0; - static int16_t AltHold; - -#if defined(SPEKTRUM) - if (rcFrameComplete) - computeRC(); -#endif - - if (currentTime > rcTime) { // 50Hz - rcTime = currentTime + 20000; -#if !(defined(SPEKTRUM) ||defined(BTSERIAL)) - computeRC(); -#endif - // Failsafe routine - added by MIS -#if defined(FAILSAFE) - if (failsafeCnt > (5 * FAILSAVE_DELAY) && armed == 1) { // Stabilize, and set Throttle to specified level - for (i = 0; i < 3; i++) - rcData[i] = MIDRC; // after specified guard time after RC signal is lost (in 0.1sec) - rcData[THROTTLE] = FAILSAVE_THR0TTLE; - if (failsafeCnt > 5 * (FAILSAVE_DELAY + FAILSAVE_OFF_DELAY)) { // Turn OFF motors after specified Time (in 0.1sec) - armed = 0; //This will prevent the copter to automatically rearm if failsafe shuts it down and prevents - okToArm = 0; //to restart accidentely by just reconnect to the tx - you will have to switch off first to rearm - } - failsafeEvents++; - } - failsafeCnt++; -#endif - // end of failsave routine - next change is made with RcOptions setting - if (rcData[THROTTLE] < MINCHECK) { - errorGyroI[ROLL] = 0; - errorGyroI[PITCH] = 0; - errorGyroI[YAW] = 0; - errorAngleI[ROLL] = 0; - errorAngleI[PITCH] = 0; - rcDelayCommand++; - if (rcData[YAW] < MINCHECK && rcData[PITCH] < MINCHECK && armed == 0) { - if (rcDelayCommand == 20) - calibratingG = 400; - } else if (rcData[YAW] > MAXCHECK && rcData[PITCH] > MAXCHECK && armed == 0) { - if (rcDelayCommand == 20) { - servo[0] = 1500; //we center the yaw gyro in conf mode - writeServos(); -#if defined(LCD_CONF) - configurationLoop(); //beginning LCD configuration -#endif - previousTime = micros(); - } - } -#if defined(InflightAccCalibration) - else if (armed == 0 && rcData[YAW] < MINCHECK && rcData[PITCH] > MAXCHECK && rcData[ROLL] > MAXCHECK) { - if (rcDelayCommand == 20) { - if (AccInflightCalibrationMeasurementDone) { //trigger saving into eeprom after landing - AccInflightCalibrationMeasurementDone = 0; - AccInflightCalibrationSavetoEEProm = 1; - } else { - AccInflightCalibrationArmed = !AccInflightCalibrationArmed; - if (AccInflightCalibrationArmed) { - blinkLED(10, 1, 2); - } else { - blinkLED(10, 10, 3); - } - } - } - } -#endif - else if ((activate1[BOXARM] > 0) || (activate2[BOXARM] > 0)) { - if (((rcOptions1 & activate1[BOXARM]) - || (rcOptions2 & activate2[BOXARM])) && okToArm) { - armed = 1; - headFreeModeHold = heading; - } else if (armed) - armed = 0; - rcDelayCommand = 0; - } else if ((rcData[YAW] < MINCHECK || rcData[ROLL] < MINCHECK) - && armed == 1) { - if (rcDelayCommand == 20) - armed = 0; // rcDelayCommand = 20 => 20x20ms = 0.4s = time to wait for a specific RC command to be acknowledged - } else if ((rcData[YAW] > MAXCHECK || rcData[ROLL] > MAXCHECK) - && rcData[PITCH] < MAXCHECK && armed == 0 && calibratingG == 0 && calibratedACC == 1) { - if (rcDelayCommand == 20) { - armed = 1; - headFreeModeHold = heading; - } -#ifdef LCD_TELEMETRY_AUTO - } else if (rcData[ROLL] < MINCHECK && rcData[PITCH] > MAXCHECK && armed == 0) { - if (rcDelayCommand == 20) { - if (telemetry_auto) { - telemetry_auto = 0; - telemetry = 0; - } else - telemetry_auto = 1; - } -#endif - } else - rcDelayCommand = 0; - } else if (rcData[THROTTLE] > MAXCHECK && armed == 0) { - if (rcData[YAW] < MINCHECK && rcData[PITCH] < MINCHECK) { //throttle=max, yaw=left, pitch=min - if (rcDelayCommand == 20) - calibratingA = 400; - rcDelayCommand++; - } else if (rcData[YAW] > MAXCHECK && rcData[PITCH] < MINCHECK) { //throttle=max, yaw=right, pitch=min - if (rcDelayCommand == 20) - calibratingM = 1; // MAG calibration request - rcDelayCommand++; - } else if (rcData[PITCH] > MAXCHECK) { - accTrim[PITCH] += 2; - writeParams(); -#if defined(LED_RING) - blinkLedRing(); -#endif - } else if (rcData[PITCH] < MINCHECK) { - accTrim[PITCH] -= 2; - writeParams(); -#if defined(LED_RING) - blinkLedRing(); -#endif - } else if (rcData[ROLL] > MAXCHECK) { - accTrim[ROLL] += 2; - writeParams(); -#if defined(LED_RING) - blinkLedRing(); -#endif - } else if (rcData[ROLL] < MINCHECK) { - accTrim[ROLL] -= 2; - writeParams(); -#if defined(LED_RING) - blinkLedRing(); -#endif - } else { - rcDelayCommand = 0; - } - } -#ifdef LOG_VALUES - if (cycleTime > cycleTimeMax) - cycleTimeMax = cycleTime; // remember highscore - if (cycleTime < cycleTimeMin) - cycleTimeMin = cycleTime; // remember lowscore -#endif - -#if defined(InflightAccCalibration) - if (AccInflightCalibrationArmed && armed == 1 && rcData[THROTTLE] > MINCHECK && !((rcOptions1 & activate1[BOXARM]) || (rcOptions2 & activate2[BOXARM]))) { // Copter is airborne and you are turning it off via boxarm : start measurement - InflightcalibratingA = 50; - AccInflightCalibrationArmed = 0; - } - if ((rcOptions1 & activate1[BOXPASSTHRU]) || (rcOptions2 & activate2[BOXPASSTHRU])) { //Use the Passthru Option to activate : Passthru = TRUE Meausrement started, Land and passtrhu = 0 measurement stored - if (!AccInflightCalibrationArmed) { - AccInflightCalibrationArmed = 1; - InflightcalibratingA = 50; - } - } else if (AccInflightCalibrationMeasurementDone && armed == 0) { - AccInflightCalibrationArmed = 0; - AccInflightCalibrationMeasurementDone = 0; - AccInflightCalibrationSavetoEEProm = 1; - } -#endif - - rcOptions1 = (rcData[AUX1] < 1300) + (1300 < rcData[AUX1] - && rcData[AUX1] < 1700) * 2 + (rcData[AUX1] > 1700) * 4 + (rcData[AUX2] < 1300) * 8 + (1300 < rcData[AUX2] - && rcData[AUX2] < 1700) * 16 + (rcData[AUX2] > 1700) * 32; - rcOptions2 = (rcData[AUX3] < 1300) + (1300 < rcData[AUX3] - && rcData[AUX3] < 1700) * 2 + (rcData[AUX3] > 1700) * 4 + (rcData[AUX4] < 1300) * 8 + (1300 < rcData[AUX4] - && rcData[AUX4] < 1700) * 16 + (rcData[AUX4] > 1700) * 32; - - //note: if FAILSAFE is disable, failsafeCnt > 5*FAILSAVE_DELAY is always false - if (((rcOptions1 & activate1[BOXACC]) - || (rcOptions2 & activate2[BOXACC]) - || (failsafeCnt > 5 * FAILSAVE_DELAY)) && (ACC || nunchuk)) { - // bumpless transfer to Level mode - if (!accMode) { - errorAngleI[ROLL] = 0; - errorAngleI[PITCH] = 0; - accMode = 1; - } - } else - accMode = 0; // modified by MIS for failsave support - - if ((rcOptions1 & activate1[BOXARM]) == 0 || (rcOptions2 & activate2[BOXARM]) == 0) - okToArm = 1; - if (accMode == 1) - STABLEPIN_ON; - else - STABLEPIN_OFF; - - if (BARO) { - if ((rcOptions1 & activate1[BOXBARO]) - || (rcOptions2 & activate2[BOXBARO])) { - if (baroMode == 0) { - baroMode = 1; - AltHold = EstAlt; - initialThrottleHold = rcCommand[THROTTLE]; - errorAltitudeI = 0; - } - } else - baroMode = 0; - } - if (MAG) { - if ((rcOptions1 & activate1[BOXMAG]) - || (rcOptions2 & activate2[BOXMAG])) { - if (magMode == 0) { - magMode = 1; - magHold = heading; - } - } else - magMode = 0; - if ((rcOptions1 & activate1[BOXHEADFREE]) - || (rcOptions2 & activate2[BOXHEADFREE])) { - if (headFreeMode == 0) { - headFreeMode = 1; - } - } else - headFreeMode = 0; - } -#if defined(GPS) - if ((rcOptions1 & activate1[BOXGPSHOME]) - || (rcOptions2 & activate2[BOXGPSHOME])) { - GPSModeHome = 1; - } else - GPSModeHome = 0; - if ((rcOptions1 & activate1[BOXGPSHOLD]) - || (rcOptions2 & activate2[BOXGPSHOLD])) { - GPSModeHold = 1; - } else - GPSModeHold = 0; -#endif - if ((rcOptions1 & activate1[BOXPASSTHRU]) - || (rcOptions2 & activate2[BOXPASSTHRU])) { - passThruMode = 1; - } else - passThruMode = 0; - } - - computeIMU(); - // Measure loop rate just afer reading the sensors - currentTime = micros(); - cycleTime = currentTime - previousTime; - previousTime = currentTime; - - if (MAG) { - if (abs(rcCommand[YAW]) < 70 && magMode) { - int16_t dif = heading - magHold; - if (dif <= -180) - dif += 360; - if (dif >= +180) - dif -= 360; - if (smallAngle25) - rcCommand[YAW] -= dif * P8[PIDMAG] / 30; //18 deg - } else - magHold = heading; - } - - if (BARO) { - if (baroMode) { - if (abs(rcCommand[THROTTLE] - initialThrottleHold) > 20) { - AltHold = EstAlt; - initialThrottleHold = rcCommand[THROTTLE]; - errorAltitudeI = 0; - } - //**** Alt. Set Point stabilization PID **** - error = constrain(AltHold - EstAlt, -100, 100); // +/-10m, 1 decimeter accuracy - errorAltitudeI += error; - errorAltitudeI = constrain(errorAltitudeI, -5000, 5000); - - PTerm = P8[PIDALT] * error / 10; // 16 bits is ok here - - if (abs(error) > 5) // under 50cm error, we neutralize Iterm - ITerm = (int32_t) I8[PIDALT] * errorAltitudeI / 4000; - else - ITerm = 0; - - AltPID = PTerm + ITerm; - - //AltPID is reduced, depending of the zVelocity magnitude - AltPID = AltPID * (D8[PIDALT] - min(abs(zVelocity), D8[PIDALT] * 4 / 5)) / (D8[PIDALT] + 1); - debug3 = AltPID; - - rcCommand[THROTTLE] = initialThrottleHold + constrain(AltPID, -100, +100); - } - } -#if defined(GPS) - if ((GPSModeHome == 1)) { - float radDiff = (GPS_directionToHome - heading) * 0.0174533f; - GPS_angle[ROLL] = constrain(P8[PIDGPS] * sin(radDiff) * GPS_distanceToHome / 10, -D8[PIDGPS] * 10, +D8[PIDGPS] * 10); // with P=5, 1 meter = 0.5deg inclination - GPS_angle[PITCH] = constrain(P8[PIDGPS] * cos(radDiff) * GPS_distanceToHome / 10, -D8[PIDGPS] * 10, +D8[PIDGPS] * 10); // max inclination = D deg - } else { - GPS_angle[ROLL] = 0; - GPS_angle[PITCH] = 0; - } -#endif - - //**** PITCH & ROLL & YAW PID **** - for (axis = 0; axis < 3; axis++) { - if (accMode == 1 && axis < 2) { //LEVEL MODE - // 50 degrees max inclination - errorAngle = constrain(2 * rcCommand[axis] - GPS_angle[axis], -500, +500) - angle[axis] + accTrim[axis]; //16 bits is ok here -#ifdef LEVEL_PDF - PTerm = -(int32_t) angle[axis] * P8[PIDLEVEL] / 100; -#else - PTerm = (int32_t) errorAngle *P8[PIDLEVEL] / 100; //32 bits is needed for calculation: errorAngle*P8[PIDLEVEL] could exceed 32768 16 bits is ok for result -#endif - PTerm = constrain(PTerm, -D8[PIDLEVEL], +D8[PIDLEVEL]); - - errorAngleI[axis] = constrain(errorAngleI[axis] + errorAngle, -10000, +10000); //WindUp //16 bits is ok here - ITerm = ((int32_t) errorAngleI[axis] * I8[PIDLEVEL]) >> 12; //32 bits is needed for calculation:10000*I8 could exceed 32768 16 bits is ok for result - } else { //ACRO MODE or YAW axis - if (abs(rcCommand[axis]) < 350) - error = rcCommand[axis] * 10 * 8 / P8[axis]; //16 bits is needed for calculation: 350*10*8 = 28000 16 bits is ok for result if P8>2 (P>0.2) - else - error = (int32_t) rcCommand[axis] * 10 * 8 / P8[axis]; //32 bits is needed for calculation: 500*5*10*8 = 200000 16 bits is ok for result if P8>2 (P>0.2) - error -= gyroData[axis]; - - PTerm = rcCommand[axis]; - - errorGyroI[axis] = constrain(errorGyroI[axis] + error, -16000, +16000); //WindUp //16 bits is ok here - if (abs(gyroData[axis]) > 640) - errorGyroI[axis] = 0; - ITerm = (errorGyroI[axis] / 125 * I8[axis]) >> 6; //16 bits is ok here 16000/125 = 128 ; 128*250 = 32000 - } - if (abs(gyroData[axis]) < 160) - PTerm -= gyroData[axis] * dynP8[axis] / 10 / 8; //16 bits is needed for calculation 160*200 = 32000 16 bits is ok for result - else - PTerm -= (int32_t) gyroData[axis] * dynP8[axis] / 10 / 8; //32 bits is needed for calculation - - delta = gyroData[axis] - lastGyro[axis]; //16 bits is ok here, the dif between 2 consecutive gyro reads is limited to 800 - lastGyro[axis] = gyroData[axis]; - deltaSum = delta1[axis] + delta2[axis] + delta; - delta2[axis] = delta1[axis]; - delta1[axis] = delta; - - if (abs(deltaSum) < 640) - DTerm = (deltaSum * dynD8[axis]) >> 5; //16 bits is needed for calculation 640*50 = 32000 16 bits is ok for result - else - DTerm = ((int32_t) deltaSum * dynD8[axis]) >> 5; //32 bits is needed for calculation - - axisPID[axis] = PTerm + ITerm - DTerm; - } - - mixTable(); - writeServos(); - writeMotors(); - -#if defined(GPS) - while (SerialAvailable(GPS_SERIAL)) { - if (GPS_newFrame(SerialRead(GPS_SERIAL))) { - if (GPS_update == 1) - GPS_update = 0; - else - GPS_update = 1; - if (GPS_fix == 1 && GPS_numSat == 4) { - if (GPS_fix_home == 0) { - GPS_fix_home = 1; - GPS_latitude_home = GPS_latitude; - GPS_longitude_home = GPS_longitude; - } - GPS_distance(GPS_latitude_home, GPS_longitude_home, GPS_latitude, GPS_longitude, &GPS_distanceToHome, &GPS_directionToHome); - } - } - } -#endif -} diff --git a/mw-svn/Output.cpp b/mw-svn/Output.cpp deleted file mode 100755 index ddf256099..000000000 --- a/mw-svn/Output.cpp +++ /dev/null @@ -1,647 +0,0 @@ - -#if defined(BI) || defined(TRI) || defined(SERVO_TILT) || defined(GIMBAL) || defined(FLYING_WING) || defined(CAMTRIG) -#define SERVO -#endif - -#if defined(GIMBAL) -#define NUMBER_MOTOR 0 -#define PRI_SERVO_FROM 1 // use servo from 1 to 2 -#define PRI_SERVO_TO 2 -#elif defined(FLYING_WING) -#define NUMBER_MOTOR 1 -#define PRI_SERVO_FROM 1 // use servo from 1 to 2 -#define PRI_SERVO_TO 2 -#elif defined(BI) -#define NUMBER_MOTOR 2 -#define PRI_SERVO_FROM 5 // use servo from 5 to 6 -#define PRI_SERVO_TO 6 -#elif defined(TRI) -#define NUMBER_MOTOR 3 -#define PRI_SERVO_FROM 5 // use only servo 5 -#define PRI_SERVO_TO 5 -#elif defined(QUADP) || defined(QUADX) || defined(Y4) -#define NUMBER_MOTOR 4 -#elif defined(Y6) || defined(HEX6) || defined(HEX6X) -#define NUMBER_MOTOR 6 -#elif defined(OCTOX8) || defined(OCTOFLATP) || defined(OCTOFLATX) -#define NUMBER_MOTOR 8 -#endif - -#if defined(SERVO_TILT) && defined(CAMTRIG) -#define SEC_SERVO_FROM 1 // use servo from 1 to 3 -#define SEC_SERVO_TO 3 -#else -#if defined(SERVO_TILT) - // if A0 and A1 is taken by motors, we can use A2 and 12 for Servo tilt -#if defined(A0_A1_PIN_HEX) && (NUMBER_MOTOR == 6) && defined(PROMINI) -#define SEC_SERVO_FROM 3 // use servo from 3 to 4 -#define SEC_SERVO_TO 4 -#else -#define SEC_SERVO_FROM 1 // use servo from 1 to 2 -#define SEC_SERVO_TO 2 -#endif -#endif -#if defined(CAMTRIG) -#define SEC_SERVO_FROM 3 // use servo 3 -#define SEC_SERVO_TO 3 -#endif -#endif - - -uint8_t PWM_PIN[8] = { MOTOR_ORDER }; -// so we need a servo pin array -volatile uint8_t atomicServo[8] = { 125, 125, 125, 125, 125, 125, 125, 125 }; - -//for HEX Y6 and HEX6/HEX6X flat and for promini -volatile uint8_t atomicPWM_PIN5_lowState; -volatile uint8_t atomicPWM_PIN5_highState; -volatile uint8_t atomicPWM_PIN6_lowState; -volatile uint8_t atomicPWM_PIN6_highState; -//for OCTO on promini -volatile uint8_t atomicPWM_PINA2_lowState; -volatile uint8_t atomicPWM_PINA2_highState; -volatile uint8_t atomicPWM_PIN12_lowState; -volatile uint8_t atomicPWM_PIN12_highState; - -void writeServos() -{ -#if defined(SERVO) - // write primary servos -#if defined(PRI_SERVO_FROM) - for (uint8_t i = (PRI_SERVO_FROM - 1); i < PRI_SERVO_TO; i++) { - atomicServo[i] = (servo[i] - 1000) >> 2; - } -#endif - // write secundary servos -#if defined(SEC_SERVO_FROM) - for (uint8_t i = (SEC_SERVO_FROM - 1); i < SEC_SERVO_TO; i++) { - atomicServo[i] = (servo[i] - 1000) >> 2; - } -#endif -#endif -} - -void writeMotors() -{ // [1000;2000] => [125;250] -#if defined(MEGA) -#if (NUMBER_MOTOR > 0) - OCR3C = motor[0] >> 3; // pin 3 -#endif -#if (NUMBER_MOTOR > 1) - OCR3A = motor[1] >> 3; // pin 5 -#endif -#if (NUMBER_MOTOR > 2) - OCR4A = motor[2] >> 3; // pin 6 -#endif -#if (NUMBER_MOTOR > 3) - OCR3B = motor[3] >> 3; // pin 2 -#endif -#if (NUMBER_MOTOR > 4) - OCR4B = motor[4] >> 3; // pin 7 - OCR4C = motor[5] >> 3; // pin 8 -#endif -#if (NUMBER_MOTOR > 6) - OCR2B = motor[6] >> 3; // pin 9 - OCR2A = motor[7] >> 3; // pin 10 -#endif -#endif -#if defined(PROMINI) -#if (NUMBER_MOTOR > 0) -#ifndef EXT_MOTOR_RANGE - OCR1A = motor[0] >> 3; // pin 9 -#else - OCR1A = ((motor[0] >> 2) - 250) + 2) -#endif -#endif -#if (NUMBER_MOTOR > 1) -#ifndef EXT_MOTOR_RANGE - OCR1B = motor[1] >> 3; // pin 10 -#else - OCR1B = ((motor[1] >> 2) - 250) + 2) -#endif -#endif -#if (NUMBER_MOTOR > 2) -#ifndef EXT_MOTOR_RANGE - OCR2A = motor[2] >> 3; // pin 11 -#else - OCR2A = ((motor[2] >> 2) - 250) + 2) -#endif -#endif -#if (NUMBER_MOTOR > 3) -#ifndef EXT_MOTOR_RANGE - OCR2B = motor[3] >> 3; // pin 3 -#else - OCR2B = ((motor[3] >> 2) - 250) + 2) -#endif -#endif -#if (NUMBER_MOTOR > 4) - atomicPWM_PIN5_highState = ((motor[5] - 1000) / 4.08) + 5; - atomicPWM_PIN5_lowState = 255 - atomicPWM_PIN5_highState; - atomicPWM_PIN6_highState = ((motor[4] - 1000) / 4.08) + 5; - atomicPWM_PIN6_lowState = 255 - atomicPWM_PIN6_highState; -#endif -#if (NUMBER_MOTOR > 6) - atomicPWM_PINA2_highState = ((motor[6] - 1000) / 4.08) + 5; - atomicPWM_PINA2_lowState = 255 - atomicPWM_PINA2_highState; - atomicPWM_PIN12_highState = ((motor[7] - 1000) / 4.08) + 5; - atomicPWM_PIN12_lowState = 255 - atomicPWM_PIN12_highState; -#endif -#endif -} - -void writeAllMotors(int16_t mc) { // Sends commands to all motors - for (uint8_t i = 0; i < NUMBER_MOTOR; i++) - motor[i] = mc; - writeMotors(); -} - -void initOutput() { -#if defined(MEGA) - for (uint8_t i = 0; i < NUMBER_MOTOR; i++) - pinMode(PWM_PIN[i], OUTPUT); -#if (NUMBER_MOTOR > 0) - TCCR3A |= _BV(COM3C1); // connect pin 3 to timer 3 channel C -#endif -#if (NUMBER_MOTOR > 1) - TCCR3A |= _BV(COM3A1); // connect pin 5 to timer 3 channel A -#endif -#if (NUMBER_MOTOR > 2) - TCCR4A |= _BV(COM4A1); // connect pin 6 to timer 4 channel A -#endif -#if (NUMBER_MOTOR > 3) - TCCR3A |= _BV(COM3B1); // connect pin 2 to timer 3 channel B -#endif -#if (NUMBER_MOTOR > 4) - TCCR4A |= _BV(COM4B1); // connect pin 7 to timer 4 channel B - TCCR4A |= _BV(COM4C1); // connect pin 8 to timer 4 channel C -#endif -#if (NUMBER_MOTOR > 6) - TCCR2A |= _BV(COM2B1); // connect pin 9 to timer 2 channel B - TCCR2A |= _BV(COM2A1); // connect pin 10 to timer 2 channel A -#endif -#endif -#if defined(PROMINI) - for (uint8_t i = 0; i < min(NUMBER_MOTOR, 4); i++) - pinMode(PWM_PIN[i], OUTPUT); -#if (NUMBER_MOTOR > 0) - TCCR1A |= _BV(COM1A1); // connect pin 9 to timer 1 channel A -#endif -#if (NUMBER_MOTOR > 1) - TCCR1A |= _BV(COM1B1); // connect pin 10 to timer 1 channel B -#endif -#if (NUMBER_MOTOR > 2) - TCCR2A |= _BV(COM2A1); // connect pin 11 to timer 2 channel A -#endif -#if (NUMBER_MOTOR > 3) - TCCR2A |= _BV(COM2B1); // connect pin 3 to timer 2 channel B -#endif -#endif - - writeAllMotors(1000); - delay(300); -#if defined(SERVO) - initializeServo(); -#endif -#if (NUMBER_MOTOR == 6) && defined(PROMINI) - initializeSoftPWM(); -#if defined(A0_A1_PIN_HEX) - pinMode(5, INPUT); - pinMode(6, INPUT); // we reactivate the INPUT affectation for these two PINs - pinMode(A0, OUTPUT); - pinMode(A1, OUTPUT); -#endif -#elif (NUMBER_MOTOR == 8) && defined(PROMINI) - initializeSoftPWM(); -#if defined(A0_A1_PIN_HEX) - pinMode(5, INPUT); - pinMode(6, INPUT); // we reactivate the INPUT affectation for these two PINs - pinMode(A0, OUTPUT); - pinMode(A1, OUTPUT); -#endif -#endif -} - -#if defined(SERVO) -void initializeServo() { -#if (PRI_SERVO_FROM == 1) || (SEC_SERVO_FROM == 1) - SERVO_1_PINMODE; -#endif -#if (PRI_SERVO_FROM <= 2 && PRI_SERVO_TO >= 2) || (SEC_SERVO_FROM <= 2 && SEC_SERVO_TO >= 2) - SERVO_2_PINMODE; -#endif -#if (PRI_SERVO_FROM <= 3 && PRI_SERVO_TO >= 3) || (SEC_SERVO_FROM <= 3 && SEC_SERVO_TO >= 3) - SERVO_3_PINMODE; -#endif -#if (PRI_SERVO_FROM <= 4 && PRI_SERVO_TO >= 4) || (SEC_SERVO_FROM <= 4 && SEC_SERVO_TO >= 4) - SERVO_4_PINMODE; -#endif -#if (PRI_SERVO_FROM <= 5 && PRI_SERVO_TO >= 5) || (SEC_SERVO_FROM <= 5 && SEC_SERVO_TO >= 5) - SERVO_5_PINMODE; -#endif -#if (PRI_SERVO_FROM <= 6 && PRI_SERVO_TO >= 6) || (SEC_SERVO_FROM <= 6 && SEC_SERVO_TO >= 6) - SERVO_6_PINMODE; -#endif -#if (PRI_SERVO_FROM <= 7 && PRI_SERVO_TO >= 7) || (SEC_SERVO_FROM <= 7 && SEC_SERVO_TO >= 7) - SERVO_7_PINMODE; -#endif -#if (PRI_SERVO_FROM <= 8 && PRI_SERVO_TO >= 8) || (SEC_SERVO_FROM <= 8 && SEC_SERVO_TO >= 8) - SERVO_8_PINMODE; -#endif - - TCCR0A = 0; // normal counting mode - TIMSK0 |= (1 << OCIE0A); // Enable CTC interrupt - - // timer 0B for hex with servo tilt -#if (NUMBER_MOTOR == 6) && defined(PROMINI) - TIMSK0 |= (1 << OCIE0B); -#endif -} - -// ****servo yaw with a 50Hz refresh rate**** -// prescaler is set by default to 64 on Timer0 -// Duemilanove : 16MHz / 64 => 4 us -// 256 steps = 1 counter cycle = 1024 us -ISR(TIMER0_COMPA_vect) { - static uint8_t state = 0; - static uint8_t count; - if (state == 0) { - //http://billgrundmann.wordpress.com/2009/03/03/to-use-or-not-use-writedigital/ - -#if (PRI_SERVO_FROM == 1) || (SEC_SERVO_FROM == 1) - SERVO_1_PIN_HIGH; -#endif - OCR0A += 250; // 1000 us - state++; - } else if (state == 1) { - OCR0A += atomicServo[0]; // 1000 + [0-1020] us - state++; - } else if (state == 2) { -#if (PRI_SERVO_FROM == 1) || (SEC_SERVO_FROM == 1) - SERVO_1_PIN_LOW; -#endif -#if (PRI_SERVO_FROM <= 2 && PRI_SERVO_TO >= 2) || (SEC_SERVO_FROM <= 2 && SEC_SERVO_TO >= 2) - SERVO_2_PIN_HIGH; -#endif - OCR0A += 250; // 1000 us - state++; - } else if (state == 3) { - OCR0A += atomicServo[1]; // 1000 + [0-1020] us - state++; - } else if (state == 4) { -#if (PRI_SERVO_FROM <= 2 && PRI_SERVO_TO >= 2) || (SEC_SERVO_FROM <= 2 && SEC_SERVO_TO >= 2) - SERVO_2_PIN_LOW; -#endif -#if (PRI_SERVO_FROM <= 3 && PRI_SERVO_TO >= 3) || (SEC_SERVO_FROM <= 3 && SEC_SERVO_TO >= 3) - SERVO_3_PIN_HIGH; -#endif - state++; - OCR0A += 250; // 1000 us - } else if (state == 5) { - OCR0A += atomicServo[2]; // 1000 + [0-1020] us - state++; - } else if (state == 6) { -#if (PRI_SERVO_FROM <= 3 && PRI_SERVO_TO >= 3) || (SEC_SERVO_FROM <= 3 && SEC_SERVO_TO >= 3) - SERVO_3_PIN_LOW; -#endif -#if (PRI_SERVO_FROM <= 4 && PRI_SERVO_TO >= 4) || (SEC_SERVO_FROM <= 4 && SEC_SERVO_TO >= 4) - SERVO_4_PIN_HIGH; -#endif - state++; - OCR0A += 250; // 1000 us - } else if (state == 7) { - OCR0A += atomicServo[3]; // 1000 + [0-1020] us - state++; - } else if (state == 8) { -#if (PRI_SERVO_FROM <= 4 && PRI_SERVO_TO >= 4) || (SEC_SERVO_FROM <= 4 && SEC_SERVO_TO >= 4) - SERVO_4_PIN_LOW; -#endif -#if (PRI_SERVO_FROM <= 5 && PRI_SERVO_TO >= 5) || (SEC_SERVO_FROM <= 5 && SEC_SERVO_TO >= 5) - SERVO_5_PIN_HIGH;; -#endif - state++; - OCR0A += 250; // 1000 us - } else if (state == 9) { - OCR0A += atomicServo[4]; // 1000 + [0-1020] us - state++; - } else if (state == 10) { -#if (PRI_SERVO_FROM <= 5 && PRI_SERVO_TO >= 5) || (SEC_SERVO_FROM <= 5 && SEC_SERVO_TO >= 5) - SERVO_5_PIN_LOW; -#endif -#if (PRI_SERVO_FROM <= 6 && PRI_SERVO_TO >= 6) || (SEC_SERVO_FROM <= 6 && SEC_SERVO_TO >= 6) - SERVO_6_PIN_HIGH;; -#endif - state++; - OCR0A += 250; // 1000 us - } else if (state == 11) { - OCR0A += atomicServo[5]; // 1000 + [0-1020] us - state++; - } else if (state == 12) { -#if (PRI_SERVO_FROM <= 6 && PRI_SERVO_TO >= 6) || (SEC_SERVO_FROM <= 6 && SEC_SERVO_TO >= 6) - SERVO_6_PIN_LOW; -#endif -#if (PRI_SERVO_FROM <= 7 && PRI_SERVO_TO >= 7) || (SEC_SERVO_FROM <= 7 && SEC_SERVO_TO >= 7) - SERVO_7_PIN_HIGH; -#endif - state++; - OCR0A += 250; // 1000 us - } else if (state == 13) { - OCR0A += atomicServo[6]; // 1000 + [0-1020] us - state++; - } else if (state == 14) { -#if (PRI_SERVO_FROM <= 7 && PRI_SERVO_TO >= 7) || (SEC_SERVO_FROM <= 7 && SEC_SERVO_TO >= 7) - SERVO_7_PIN_LOW; -#endif -#if (PRI_SERVO_FROM <= 8 && PRI_SERVO_TO >= 8) || (SEC_SERVO_FROM <= 8 && SEC_SERVO_TO >= 8) - SERVO_8_PIN_HIGH; -#endif - state++; - OCR0A += 250; // 1000 us - } else if (state == 15) { - OCR0A += atomicServo[7]; // 1000 + [0-1020] us - state++; - } else if (state == 16) { -#if (PRI_SERVO_FROM <= 8 && PRI_SERVO_TO >= 8) || (SEC_SERVO_FROM <= 8 && SEC_SERVO_TO >= 8) - SERVO_8_PIN_LOW; -#endif - count = 2; - state++; - OCR0A += 250; // 1000 us - } else if (state == 17) { - if (count > 0) - count--; - else - state = 0; - OCR0A += 250; - } -} -#endif - -#if (NUMBER_MOTOR > 4) && defined(PROMINI) -void initializeSoftPWM() { - // if there are servos its alredy done -#if (NUMBER_MOTOR == 6) && not defined(SERVO) - TCCR0A = 0; // normal counting mode - TIMSK0 |= (1 << OCIE0B); // Enable CTC interrupt -#endif - -#if (NUMBER_MOTOR > 6) - TCCR0A = 0; // normal counting mode - TIMSK0 |= (1 << OCIE0A); // Enable CTC interrupt - TIMSK0 |= (1 << OCIE0B); -#endif -} - - // HEXA with just OCR0B -ISR(TIMER0_COMPB_vect) { - static uint8_t state = 0; - if (state == 0) { -#if not defined(A0_A1_PIN_HEX) - PORTD |= 1 << 5; //digital PIN 5 high -#else - PORTC |= 1 << 0; //PIN A0 -#endif - OCR0B += atomicPWM_PIN5_highState; - state = 1; - } else if (state == 1) { -#if not defined(A0_A1_PIN_HEX) - PORTD &= ~(1 << 6); -#else - PORTC &= ~(1 << 1); -#endif - OCR0B += atomicPWM_PIN6_lowState; - state = 2; - } else if (state == 2) { -#if not defined(A0_A1_PIN_HEX) - PORTD |= 1 << 6; -#else - PORTC |= 1 << 1; //PIN A1 -#endif - OCR0B += atomicPWM_PIN6_highState; - state = 3; - } else if (state == 3) { -#if not defined(A0_A1_PIN_HEX) - PORTD &= ~(1 << 5); //digital PIN 5 low -#else - PORTC &= ~(1 << 0); -#endif - OCR0B += atomicPWM_PIN5_lowState; - state = 0; - } -} - - //the same with digital PIN A2 & 12 OCR0A counter for OCTO -#if (NUMBER_MOTOR > 6) -ISR(TIMER0_COMPA_vect) { - static uint8_t state = 0; - if (state == 0) { - PORTC |= 1 << 2; //digital PIN A2 high - OCR0A += atomicPWM_PINA2_highState; - state = 1; - } else if (state == 1) { - PORTB &= ~(1 << 4); //digital PIN 12 low - OCR0A += atomicPWM_PIN12_lowState; - state = 2; - } else if (state == 2) { - PORTB |= 1 << 4; //digital PIN 12 high - OCR0A += atomicPWM_PIN12_highState; - state = 3; - } else if (state == 3) { - PORTC &= ~(1 << 2); //digital PIN A2 low - OCR0A += atomicPWM_PINA2_lowState; - state = 0; - } -} -#endif - -#endif - -void mixTable() { - int16_t maxMotor; - uint8_t i, axis; - static uint8_t camCycle = 0; - static uint8_t camState = 0; - static uint32_t camTime = 0; - -#define PIDMIX(X,Y,Z) rcCommand[THROTTLE] + axisPID[ROLL]*X + axisPID[PITCH]*Y + YAW_DIRECTION * axisPID[YAW]*Z - -#if NUMBER_MOTOR > 3 - //prevent "yaw jump" during yaw correction - axisPID[YAW] = constrain(axisPID[YAW], -100 - abs(rcCommand[YAW]), +100 + abs(rcCommand[YAW])); -#endif -#ifdef BI - motor[0] = PIDMIX(+1, 0, 0); //LEFT - motor[1] = PIDMIX(-1, 0, 0); //RIGHT - servo[4] = constrain(1500 + YAW_DIRECTION * (axisPID[YAW] + axisPID[PITCH]), 1020, 2000); //LEFT - servo[5] = constrain(1500 + YAW_DIRECTION * (axisPID[YAW] - axisPID[PITCH]), 1020, 2000); //RIGHT -#endif -#ifdef TRI - motor[0] = PIDMIX(0, +4 / 3, 0); //REAR - motor[1] = PIDMIX(-1, -2 / 3, 0); //RIGHT - motor[2] = PIDMIX(+1, -2 / 3, 0); //LEFT - servo[4] = constrain(TRI_YAW_MIDDLE + YAW_DIRECTION * axisPID[YAW], TRI_YAW_CONSTRAINT_MIN, TRI_YAW_CONSTRAINT_MAX); //REAR -#endif -#ifdef QUADP - motor[0] = PIDMIX(0, +1, -1); //REAR - motor[1] = PIDMIX(-1, 0, +1); //RIGHT - motor[2] = PIDMIX(+1, 0, +1); //LEFT - motor[3] = PIDMIX(0, -1, -1); //FRONT -#endif -#ifdef QUADX - motor[0] = PIDMIX(-1, +1, -1); //REAR_R - motor[1] = PIDMIX(-1, -1, +1); //FRONT_R - motor[2] = PIDMIX(+1, +1, +1); //REAR_L - motor[3] = PIDMIX(+1, -1, -1); //FRONT_L -#endif -#ifdef Y4 - motor[0] = PIDMIX(+0, +1, -1); //REAR_1 CW - motor[1] = PIDMIX(-1, -1, 0); //FRONT_R CCW - motor[2] = PIDMIX(+0, +1, +1); //REAR_2 CCW - motor[3] = PIDMIX(+1, -1, 0); //FRONT_L CW -#endif -#ifdef Y6 - motor[0] = PIDMIX(+0, +4 / 3, +1); //REAR - motor[1] = PIDMIX(-1, -2 / 3, -1); //RIGHT - motor[2] = PIDMIX(+1, -2 / 3, -1); //LEFT - motor[3] = PIDMIX(+0, +4 / 3, -1); //UNDER_REAR - motor[4] = PIDMIX(-1, -2 / 3, +1); //UNDER_RIGHT - motor[5] = PIDMIX(+1, -2 / 3, +1); //UNDER_LEFT -#endif -#ifdef HEX6 - motor[0] = PIDMIX(-1 / 2, +1 / 2, +1); //REAR_R - motor[1] = PIDMIX(-1 / 2, -1 / 2, -1); //FRONT_R - motor[2] = PIDMIX(+1 / 2, +1 / 2, +1); //REAR_L - motor[3] = PIDMIX(+1 / 2, -1 / 2, -1); //FRONT_L - motor[4] = PIDMIX(+0, -1, +1); //FRONT - motor[5] = PIDMIX(+0, +1, -1); //REAR -#endif -#ifdef HEX6X - motor[0] = PIDMIX(-1 / 2, +1 / 2, +1); //REAR_R - motor[1] = PIDMIX(-1 / 2, -1 / 2, +1); //FRONT_R - motor[2] = PIDMIX(+1 / 2, +1 / 2, -1); //REAR_L - motor[3] = PIDMIX(+1 / 2, -1 / 2, -1); //FRONT_L - motor[4] = PIDMIX(-1, +0, -1); //RIGHT - motor[5] = PIDMIX(+1, +0, +1); //LEFT -#endif -#ifdef OCTOX8 - motor[0] = PIDMIX(-1, +1, -1); //REAR_R - motor[1] = PIDMIX(-1, -1, +1); //FRONT_R - motor[2] = PIDMIX(+1, +1, +1); //REAR_L - motor[3] = PIDMIX(+1, -1, -1); //FRONT_L - motor[4] = PIDMIX(-1, +1, +1); //UNDER_REAR_R - motor[5] = PIDMIX(-1, -1, -1); //UNDER_FRONT_R - motor[6] = PIDMIX(+1, +1, -1); //UNDER_REAR_L - motor[7] = PIDMIX(+1, -1, +1); //UNDER_FRONT_L -#endif -#ifdef OCTOFLATP - motor[0] = PIDMIX(+7 / 10, -7 / 10, +1); //FRONT_L - motor[1] = PIDMIX(-7 / 10, -7 / 10, +1); //FRONT_R - motor[2] = PIDMIX(-7 / 10, +7 / 10, +1); //REAR_R - motor[3] = PIDMIX(+7 / 10, +7 / 10, +1); //REAR_L - motor[4] = PIDMIX(+0, -1, -1); //FRONT - motor[5] = PIDMIX(-1, +0, -1); //RIGHT - motor[6] = PIDMIX(+0, +1, -1); //REAR - motor[7] = PIDMIX(+1, +0, -1); //LEFT -#endif -#ifdef OCTOFLATX - motor[0] = PIDMIX(+1, -1 / 2, +1); //MIDFRONT_L - motor[1] = PIDMIX(-1 / 2, -1, +1); //FRONT_R - motor[2] = PIDMIX(-1, +1 / 2, +1); //MIDREAR_R - motor[3] = PIDMIX(+1 / 2, +1, +1); //REAR_L - motor[4] = PIDMIX(+1 / 2, -1, -1); //FRONT_L - motor[5] = PIDMIX(-1, -1 / 2, -1); //MIDFRONT_R - motor[6] = PIDMIX(-1 / 2, +1, -1); //REAR_R - motor[7] = PIDMIX(+1, +1 / 2, -1); //MIDREAR_L -#endif - -#ifdef SERVO_TILT - if ((rcOptions1 & activate1[BOXCAMSTAB]) - || (rcOptions2 & activate2[BOXCAMSTAB])) { - servo[0] = constrain(TILT_PITCH_MIDDLE + TILT_PITCH_PROP * angle[PITCH] / 16 + rcData[AUX3] - 1500, TILT_PITCH_MIN, TILT_PITCH_MAX); - servo[1] = constrain(TILT_ROLL_MIDDLE + TILT_ROLL_PROP * angle[ROLL] / 16 + rcData[AUX4] - 1500, TILT_ROLL_MIN, TILT_ROLL_MAX); - } else { - // to use it with A0_A1_PIN_HEX -#if defined(A0_A1_PIN_HEX) && (NUMBER_MOTOR == 6) && defined(PROMINI) - servo[2] = constrain(TILT_PITCH_MIDDLE + rcData[AUX3] - 1500, TILT_PITCH_MIN, TILT_PITCH_MAX); - servo[3] = constrain(TILT_ROLL_MIDDLE + rcData[AUX4] - 1500, TILT_ROLL_MIN, TILT_ROLL_MAX); -#else - servo[0] = constrain(TILT_PITCH_MIDDLE + rcData[AUX3] - 1500, TILT_PITCH_MIN, TILT_PITCH_MAX); - servo[1] = constrain(TILT_ROLL_MIDDLE + rcData[AUX4] - 1500, TILT_ROLL_MIN, TILT_ROLL_MAX); -#endif - } -#endif -#ifdef GIMBAL - servo[0] = constrain(TILT_PITCH_MIDDLE + TILT_PITCH_PROP * angle[PITCH] / 16 + rcCommand[PITCH], TILT_PITCH_MIN, TILT_PITCH_MAX); - servo[1] = constrain(TILT_ROLL_MIDDLE + TILT_ROLL_PROP * angle[ROLL] / 16 + rcCommand[ROLL], TILT_ROLL_MIN, TILT_ROLL_MAX); -#endif -#ifdef FLYING_WING - motor[0] = rcCommand[THROTTLE]; - if (passThruMode) { // use raw stick values to drive output - servo[0] = constrain(wing_left_mid + PITCH_DIRECTION_L * (rcData[PITCH] - MIDRC) + ROLL_DIRECTION_L * (rcData[ROLL] - MIDRC), WING_LEFT_MIN, WING_LEFT_MAX); //LEFT - servo[1] = constrain(wing_right_mid + PITCH_DIRECTION_R * (rcData[PITCH] - MIDRC) + ROLL_DIRECTION_R * (rcData[ROLL] - MIDRC), WING_RIGHT_MIN, WING_RIGHT_MAX); //RIGHT - } else { // use sensors to correct (gyro only or gyro+acc according to aux1/aux2 configuration - servo[0] = constrain(wing_left_mid + PITCH_DIRECTION_L * axisPID[PITCH] + ROLL_DIRECTION_L * axisPID[ROLL], WING_LEFT_MIN, WING_LEFT_MAX); //LEFT - servo[1] = constrain(wing_right_mid + PITCH_DIRECTION_R * axisPID[PITCH] + ROLL_DIRECTION_R * axisPID[ROLL], WING_RIGHT_MIN, WING_RIGHT_MAX); //RIGHT - } -#endif -#if defined(CAMTRIG) - if (camCycle == 1) { - if (camState == 0) { - servo[2] = CAM_SERVO_HIGH; - camState = 1; - camTime = millis(); - } else if (camState == 1) { - if ((millis() - camTime) > CAM_TIME_HIGH) { - servo[2] = CAM_SERVO_LOW; - camState = 2; - camTime = millis(); - } - } else { //camState ==2 - if ((millis() - camTime) > CAM_TIME_LOW) { - camState = 0; - camCycle = 0; - } - } - } - if ((rcOptions1 & activate1[BOXCAMTRIG]) - || (rcOptions1 & activate2[BOXCAMTRIG])) - camCycle = 1; -#endif - - maxMotor = motor[0]; - for (i = 1; i < NUMBER_MOTOR; i++) - if (motor[i] > maxMotor) - maxMotor = motor[i]; - for (i = 0; i < NUMBER_MOTOR; i++) { - if (maxMotor > MAXTHROTTLE) // this is a way to still have good gyro corrections if at least one motor reaches its max. - motor[i] -= maxMotor - MAXTHROTTLE; - motor[i] = constrain(motor[i], MINTHROTTLE, MAXTHROTTLE); - if ((rcData[THROTTLE]) < MINCHECK) -#ifndef MOTOR_STOP - motor[i] = MINTHROTTLE; -#else - motor[i] = MINCOMMAND; -#endif - if (armed == 0) - motor[i] = MINCOMMAND; - } - -#if (LOG_VALUES == 2) || defined(POWERMETER_SOFT) - uint32_t amp; - /* true cubic function; when divided by vbat_max=126 (12.6V) for 3 cell battery this gives maximum value of ~ 500 */ - /* Lookup table moved to PROGMEM 11/21/2001 by Danal */ - static uint16_t amperes[64] = { - 0, 2, 6, 15, 30, 52, 82, 123, 175, 240, 320, 415, 528, 659, 811, 984, 1181, 1402, 1648, 1923, 2226, 2559, 2924, 3322, 3755, 4224, 4730, 5276, 5861, 6489, 7160, 7875, 8637, 9446, 10304, 11213, 12173, 13187, 14256, 15381, 16564, 17805, 19108, 20472, 21900, 23392, 24951, 26578, 28274, 30041, 31879, 33792, 35779, 37843, 39984, 42205, 44507, 46890, 49358, 51910, 54549, 57276, 60093, 63000}; - - if (vbat) { // by all means - must avoid division by zero - for (uint8_t i = 0; i < NUMBER_MOTOR; i++) { - amp = amperes[((motor[i] - 1000) >> 4)] / vbat; // range mapped from [1000:2000] => [0:1000]; then break that up into 64 ranges; lookup amp -#if (LOG_VALUES == 2) - pMeter[i] += amp; // sum up over time the mapped ESC input -#endif -#if defined(POWERMETER_SOFT) - pMeter[PMOTOR_SUM] += amp; // total sum over all motors -#endif - } - } -#endif -} diff --git a/mw-svn/RX.cpp b/mw-svn/RX.cpp deleted file mode 100755 index 7a0ae8228..000000000 --- a/mw-svn/RX.cpp +++ /dev/null @@ -1,285 +0,0 @@ -volatile uint16_t rcValue[18] = {1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502, 1502}; // interval [1000;2000] -#if defined(SERIAL_SUM_PPM) - static uint8_t rcChannel[8] = {SERIAL_SUM_PPM}; -#elif defined(SBUS) - // for 16 + 2 Channels SBUS. The 10 extra channels 8->17 are not used by MultiWii, but it should be easy to integrate them. - static uint8_t rcChannel[18] = {PITCH,YAW,THROTTLE,ROLL,AUX1,AUX2,AUX3,AUX4,8,9,10,11,12,13,14,15,16,17}; - static uint16_t sbusIndex=0; -#else - static uint8_t rcChannel[8] = {ROLLPIN, PITCHPIN, YAWPIN, THROTTLEPIN, AUX1PIN,AUX2PIN,AUX3PIN,AUX4PIN}; -#endif -#if defined(SPEKTRUM) - #define SPEK_MAX_CHANNEL 7 - #define SPEK_FRAME_SIZE 16 - #if (SPEKTRUM == 1024) - #define SPEK_CHAN_SHIFT 2 // Assumes 10 bit frames, that is 1024 mode. - #define SPEK_CHAN_MASK 0x03 // Assumes 10 bit frames, that is 1024 mode. - #endif - #if (SPEKTRUM == 2048) - #define SPEK_CHAN_SHIFT 3 // Assumes 11 bit frames, that is 2048 mode. - #define SPEK_CHAN_MASK 0x07 // Assumes 11 bit frames, that is 2048 mode. - #endif - volatile uint8_t spekFrame[SPEK_FRAME_SIZE]; -#endif - -// Configure each rc pin for PCINT -void configureReceiver() { - #if !defined(SERIAL_SUM_PPM) && !defined(SPEKTRUM) && !defined(SBUS) && !defined(BTSERIAL) - #if defined(PROMINI) - // PCINT activated only for specific pin inside [D0-D7] , [D2 D4 D5 D6 D7] for this multicopter - PORTD = (1<<2) | (1<<4) | (1<<5) | (1<<6) | (1<<7); //enable internal pull ups on the PINs of PORTD (no high impedence PINs) - PCMSK2 |= (1<<2) | (1<<4) | (1<<5) | (1<<6) | (1<<7); - PCICR = (1<<2) ; // PCINT activated only for the port dealing with [D0-D7] PINs on port B - #if defined(RCAUXPIN) - PCICR |= (1<<0) ; // PCINT activated also for PINS [D8-D13] on port B - #if defined(RCAUXPIN8) - PCMSK0 = (1<<0); - #endif - #if defined(RCAUXPIN12) - PCMSK0 = (1<<4); - #endif - #endif - #endif - #if defined(MEGA) - // PCINT activated only for specific pin inside [A8-A15] - DDRK = 0; // defined PORTK as a digital port ([A8-A15] are consired as digital PINs and not analogical) - PORTK = (1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<4) | (1<<5) | (1<<6) | (1<<7); //enable internal pull ups on the PINs of PORTK - PCMSK2 |= (1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<4) | (1<<5) | (1<<6) | (1<<7); - PCICR = 1<<2; // PCINT activated only for PORTK dealing with [A8-A15] PINs - #endif - #endif - #if defined(SERIAL_SUM_PPM) - PPM_PIN_INTERRUPT; - #endif - #if defined (SPEKTRUM) - SerialOpen(1,115200); - #endif - #if defined(SBUS) - SerialOpen(1,100000); - #endif -} - -#if !defined(SERIAL_SUM_PPM) && !defined(SPEKTRUM) && !defined(SBUS) && !defined(BTSERIAL) - ISR(PCINT2_vect) { //this ISR is common to every receiver channel, it is call everytime a change state occurs on a digital pin [D2-D7] - uint8_t mask; - uint8_t pin; - uint16_t cTime,dTime; - static uint16_t edgeTime[8]; - static uint8_t PCintLast; - - #if defined(PROMINI) - pin = PIND; // PIND indicates the state of each PIN for the arduino port dealing with [D0-D7] digital pins (8 bits variable) - #endif - #if defined(MEGA) - pin = PINK; // PINK indicates the state of each PIN for the arduino port dealing with [A8-A15] digital pins (8 bits variable) - #endif - mask = pin ^ PCintLast; // doing a ^ between the current interruption and the last one indicates wich pin changed - sei(); // re enable other interrupts at this point, the rest of this interrupt is not so time critical and can be interrupted safely - PCintLast = pin; // we memorize the current state of all PINs [D0-D7] - - cTime = micros(); // micros() return a uint32_t, but it is not usefull to keep the whole bits => we keep only 16 bits - - // mask is pins [D0-D7] that have changed // the principle is the same on the MEGA for PORTK and [A8-A15] PINs - // chan = pin sequence of the port. chan begins at D2 and ends at D7 - if (mask & 1<<2) //indicates the bit 2 of the arduino port [D0-D7], that is to say digital pin 2, if 1 => this pin has just changed - if (!(pin & 1<<2)) { //indicates if the bit 2 of the arduino port [D0-D7] is not at a high state (so that we match here only descending PPM pulse) - dTime = cTime-edgeTime[2]; if (900 20) failsafeCnt -= 20; else failsafeCnt = 0; } - #endif - } - - #if defined(RCAUXPIN) - /* this ISR is a simplication of the previous one for PROMINI on port D - it's simplier because we know the interruption deals only with on PIN: - bit 0 of PORT B, ie Arduino PIN 8 - or bit 4 of PORTB, ie Arduino PIN 12 - => no need to check which PIN has changed */ - ISR(PCINT0_vect) { - uint8_t pin; - uint16_t cTime,dTime; - static uint16_t edgeTime; - - pin = PINB; - sei(); - cTime = micros(); - #if defined(RCAUXPIN8) - if (!(pin & 1<<0)) { //indicates if the bit 0 of the arduino port [B0-B7] is not at a high state (so that we match here only descending PPM pulse) - #endif - #if defined(RCAUXPIN12) - if (!(pin & 1<<4)) { //indicates if the bit 4 of the arduino port [B0-B7] is not at a high state (so that we match here only descending PPM pulse) - #endif - dTime = cTime-edgeTime; if (9003000) chan = 0; - else { - if(900 20) failsafeCnt -= 20; else failsafeCnt = 0; // clear FailSafe counter - added by MIS //incompatible to quadroppm - #endif - } - chan++; - } -} -#endif - -#if defined(SPEKTRUM) - ISR(SPEK_SERIAL_VECT) { - uint32_t spekTime; - static uint32_t spekTimeLast, spekTimeInterval; - static uint8_t spekFramePosition; - spekTime=micros(); - spekTimeInterval = spekTime - spekTimeLast; - spekTimeLast = spekTime; - if (spekTimeInterval > 5000) spekFramePosition = 0; - spekFrame[spekFramePosition] = SPEK_DATA_REG; - if (spekFramePosition == SPEK_FRAME_SIZE - 1) { - rcFrameComplete = 1; - #if defined(FAILSAFE) - if(failsafeCnt > 20) failsafeCnt -= 20; else failsafeCnt = 0; // clear FailSafe counter - #endif - } else { - spekFramePosition++; - } - } -#endif - -#if defined(SBUS) -void readSBus(){ - #define SBUS_SYNCBYTE 0x0F // Not 100% sure: at the beginning of coding it was 0xF0 !!! - static uint16_t sbus[25]={0}; - while(SerialAvailable(1)){ - int val = SerialRead(1); - if(sbusIndex==0 && val != SBUS_SYNCBYTE) - continue; - sbus[sbusIndex++] = val; - if(sbusIndex==25){ - sbusIndex=0; - rcValue[0] = ((sbus[1]|sbus[2]<< 8) & 0x07FF)/2+976; // Perhaps you may change the term "/2+976" -> center will be 1486 - rcValue[1] = ((sbus[2]>>3|sbus[3]<<5) & 0x07FF)/2+976; - rcValue[2] = ((sbus[3]>>6|sbus[4]<<2|sbus[5]<<10) & 0x07FF)/2+976; - rcValue[3] = ((sbus[5]>>1|sbus[6]<<7) & 0x07FF)/2+976; - rcValue[4] = ((sbus[6]>>4|sbus[7]<<4) & 0x07FF)/2+976; - rcValue[5] = ((sbus[7]>>7|sbus[8]<<1|sbus[9]<<9) & 0x07FF)/2+976; - rcValue[6] = ((sbus[9]>>2|sbus[10]<<6) & 0x07FF)/2+976; - rcValue[7] = ((sbus[10]>>5|sbus[11]<<3) & 0x07FF)/2+976; // & the other 8 + 2 channels if you need them - //The following lines: If you need more than 8 channels, max 16 analog + 2 digital. Must comment the not needed channels! - rcValue[8] = ((sbus[12]|sbus[13]<< 8) & 0x07FF)/2+976; - rcValue[9] = ((sbus[13]>>3|sbus[14]<<5) & 0x07FF)/2+976; - rcValue[10] = ((sbus[14]>>6|sbus[15]<<2|sbus[16]<<10) & 0x07FF)/2+976; - rcValue[11] = ((sbus[16]>>1|sbus[17]<<7) & 0x07FF)/2+976; - rcValue[12] = ((sbus[17]>>4|sbus[18]<<4) & 0x07FF)/2+976; - rcValue[13] = ((sbus[18]>>7|sbus[19]<<1|sbus[20]<<9) & 0x07FF)/2+976; - rcValue[14] = ((sbus[20]>>2|sbus[21]<<6) & 0x07FF)/2+976; - rcValue[15] = ((sbus[21]>>5|sbus[22]<<3) & 0x07FF)/2+976; - // now the two Digital-Channels - if ((sbus[23]) & 0x0001) rcValue[16] = 2000; else rcValue[16] = 1000; - if ((sbus[23] >> 1) & 0x0001) rcValue[17] = 2000; else rcValue[17] = 1000; - - // Failsafe: there is one Bit in the SBUS-protocol (Byte 25, Bit 4) whitch is the failsafe-indicator-bit - #if defined(FAILSAFE) - if (!((sbus[23] >> 3) & 0x0001)) - {if(failsafeCnt > 20) failsafeCnt -= 20; else failsafeCnt = 0;} // clear FailSafe counter - #endif - } - } -} -#endif - -uint16_t readRawRC(uint8_t chan) { - uint16_t data; - uint8_t oldSREG; - oldSREG = SREG; cli(); // Let's disable interrupts - data = rcValue[rcChannel[chan]]; // Let's copy the data Atomically - #if defined(SPEKTRUM) - static uint32_t spekChannelData[SPEK_MAX_CHANNEL]; - if (rcFrameComplete) { - for (uint8_t b = 3; b < SPEK_FRAME_SIZE; b += 2) { - uint8_t spekChannel = 0x0F & (spekFrame[b - 1] >> SPEK_CHAN_SHIFT); - if (spekChannel < SPEK_MAX_CHANNEL) spekChannelData[spekChannel] = (long(spekFrame[b - 1] & SPEK_CHAN_MASK) << 8) + spekFrame[b]; - } - rcFrameComplete = 0; - } - #endif - SREG = oldSREG; sei();// Let's enable the interrupts - #if defined(SPEKTRUM) - static uint8_t spekRcChannelMap[SPEK_MAX_CHANNEL] = {1,2,3,0,4,5,6}; - if (chan >= SPEK_MAX_CHANNEL) { - data = 1500; - } else { - #if (SPEKTRUM == 1024) - data = 988 + spekChannelData[spekRcChannelMap[chan]]; // 1024 mode - #endif - #if (SPEKTRUM == 2048) - data = 988 + (spekChannelData[spekRcChannelMap[chan]] >> 1); // 2048 mode - #endif - } - #endif - return data; // We return the value correctly copied when the IRQ's where disabled -} - -void computeRC() { - static int16_t rcData4Values[8][4], rcDataMean[8]; - static uint8_t rc4ValuesIndex = 0; - uint8_t chan,a,ind; - - #if defined(SBUS) - readSBus(); - #endif - rc4ValuesIndex++; - for (chan = 0; chan < 8; chan++) { - rcData4Values[chan][rc4ValuesIndex%4] = readRawRC(chan); - rcDataMean[chan] = 0; - for (a=0;a<4;a++) rcDataMean[chan] += rcData4Values[chan][a]; - rcDataMean[chan]= (rcDataMean[chan]+2)/4; - if ( rcDataMean[chan] < rcData[chan] -3) rcData[chan] = rcDataMean[chan]+2; - if ( rcDataMean[chan] > rcData[chan] +3) rcData[chan] = rcDataMean[chan]-2; - } -} - diff --git a/mw-svn/Sensors.cpp b/mw-svn/Sensors.cpp deleted file mode 100755 index 376ae5e9b..000000000 --- a/mw-svn/Sensors.cpp +++ /dev/null @@ -1,1207 +0,0 @@ -// ************************************************************************************************************ -// board orientation and setup -// ************************************************************************************************************ -//default board orientation -#if !defined(ACC_ORIENTATION) -#define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} -#endif -#if !defined(GYRO_ORIENTATION) -#define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} -#endif -#if !defined(MAG_ORIENTATION) -#define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = X; magADC[PITCH] = Y; magADC[YAW] = Z;} -#endif - -/*** I2C address ***/ -#if !defined(ADXL345_ADDRESS) -#define ADXL345_ADDRESS 0x3A - //#define ADXL345_ADDRESS 0xA6 //WARNING: Conflicts with a Wii Motion plus! -#endif - -#if !defined(BMA180_ADDRESS) -#define BMA180_ADDRESS 0x80 - //#define BMA180_ADDRESS 0x82 -#endif - -#if !defined(ITG3200_ADDRESS) -#define ITG3200_ADDRESS 0XD0 - //#define ITG3200_ADDRESS 0XD2 -#endif - -#if !defined(MPU6050_ADDRESS) -#define MPU6050_ADDRESS 0xD0 // address pin AD0 low (GND), default for FreeIMU v0.4 and InvenSense evaluation board - //#define MPU6050_ADDRESS 0xD2 // address pin AD0 high (VCC) -#endif - -#if !defined(MS561101BA_ADDRESS) -#define MS561101BA_ADDRESS 0xEE //CBR=0 0xEE I2C address when pin CSB is connected to LOW (GND) - //#define MS561101BA_ADDRESS 0xEF //CBR=1 0xEF I2C address when pin CSB is connected to HIGH (VCC) -#endif - -//ITG3200 and ITG3205 Gyro LPF setting -#if defined(ITG3200_LPF_256HZ) || defined(ITG3200_LPF_188HZ) || defined(ITG3200_LPF_98HZ) || defined(ITG3200_LPF_42HZ) || defined(ITG3200_LPF_20HZ) || defined(ITG3200_LPF_10HZ) -#if defined(ITG3200_LPF_256HZ) -#define ITG3200_SMPLRT_DIV 0 //8000Hz -#define ITG3200_DLPF_CFG 0 -#endif -#if defined(ITG3200_LPF_188HZ) -#define ITG3200_SMPLRT_DIV 0 //1000Hz -#define ITG3200_DLPF_CFG 1 -#endif -#if defined(ITG3200_LPF_98HZ) -#define ITG3200_SMPLRT_DIV 0 -#define ITG3200_DLPF_CFG 2 -#endif -#if defined(ITG3200_LPF_42HZ) -#define ITG3200_SMPLRT_DIV 0 -#define ITG3200_DLPF_CFG 3 -#endif -#if defined(ITG3200_LPF_20HZ) -#define ITG3200_SMPLRT_DIV 0 -#define ITG3200_DLPF_CFG 4 -#endif -#if defined(ITG3200_LPF_10HZ) -#define ITG3200_SMPLRT_DIV 0 -#define ITG3200_DLPF_CFG 5 -#endif -#else - //Default settings LPF 256Hz/8000Hz sample -#define ITG3200_SMPLRT_DIV 0 //8000Hz -#define ITG3200_DLPF_CFG 0 -#endif - -//MPU6050 Gyro LPF setting -#if defined(MPU6050_LPF_256HZ) || defined(MPU6050_LPF_188HZ) || defined(MPU6050_LPF_98HZ) || defined(MPU6050_LPF_42HZ) || defined(MPU6050_LPF_20HZ) || defined(MPU6050_LPF_10HZ) -#if defined(MPU6050_LPF_256HZ) -#define MPU6050_SMPLRT_DIV 0 //8000Hz -#define MPU6050_DLPF_CFG 0 -#endif -#if defined(MPU6050_LPF_188HZ) -#define MPU6050_SMPLRT_DIV 0 //1000Hz -#define MPU6050_DLPF_CFG 1 -#endif -#if defined(MPU6050_LPF_98HZ) -#define MPU6050_SMPLRT_DIV 0 -#define MPU6050_DLPF_CFG 2 -#endif -#if defined(MPU6050_LPF_42HZ) -#define MPU6050_SMPLRT_DIV 0 -#define MPU6050_DLPF_CFG 3 -#endif -#if defined(MPU6050_LPF_20HZ) -#define MPU6050_SMPLRT_DIV 0 -#define MPU6050_DLPF_CFG 4 -#endif -#if defined(MPU6050_LPF_10HZ) -#define MPU6050_SMPLRT_DIV 0 -#define MPU6050_DLPF_CFG 5 -#endif -#else - //Default settings LPF 256Hz/8000Hz sample -#define MPU6050_SMPLRT_DIV 0 //8000Hz -#define MPU6050_DLPF_CFG 0 -#endif - -uint8_t rawADC[6]; -static uint32_t neutralizeTime = 0; - -// ************************************************************************************************************ -// I2C general functions -// ************************************************************************************************************ - -void i2c_init(void) -{ -#if defined(INTERNAL_I2C_PULLUPS) - I2C_PULLUPS_ENABLE -#else - I2C_PULLUPS_DISABLE -#endif - TWSR = 0; // no prescaler => prescaler = 1 - TWBR = ((16000000L / I2C_SPEED) - 16) / 2; // change the I2C clock rate - TWCR = 1 << TWEN; // enable twi module, no interrupt -} - -void i2c_rep_start(uint8_t address) -{ - TWCR = (1 << TWINT) | (1 << TWSTA) | (1 << TWEN); // send REPEAT START condition - waitTransmissionI2C(); // wait until transmission completed - TWDR = address; // send device address - TWCR = (1 << TWINT) | (1 << TWEN); - waitTransmissionI2C(); // wail until transmission completed -} - -void i2c_stop(void) -{ - TWCR = (1 << TWINT) | (1 << TWEN) | (1 << TWSTO); - // while(TWCR & (1< we don't insist - TWCR = 0; //and we force a reset on TWINT register - neutralizeTime = micros(); //we take a timestamp here to neutralize the value during a short delay - i2c_errors_count++; - break; - } - } -} - -void i2c_getSixRawADC(uint8_t add, uint8_t reg) -{ - i2c_rep_start(add); - i2c_write(reg); // Start multiple read at the reg register - i2c_rep_start(add + 1); // I2C read direction => I2C address + 1 - for (uint8_t i = 0; i < 5; i++) - rawADC[i] = i2c_readAck(); - rawADC[5] = i2c_readNak(); -} - -void i2c_writeReg(uint8_t add, uint8_t reg, uint8_t val) -{ - i2c_rep_start(add + 0); // I2C write direction - i2c_write(reg); // register selection - i2c_write(val); // value to write in register - i2c_stop(); -} - -uint8_t i2c_readReg(uint8_t add, uint8_t reg) -{ - i2c_rep_start(add + 0); // I2C write direction - i2c_write(reg); // register selection - i2c_rep_start(add + 1); // I2C read direction - return i2c_readNak(); // Read single register and return value -} - -// **************** -// GYRO common part -// **************** -void GYRO_Common() -{ - static int16_t previousGyroADC[3] = { 0, 0, 0 }; - static int32_t g[3]; - uint8_t axis; - - if (calibratingG > 0) { - for (axis = 0; axis < 3; axis++) { - // Reset g[axis] at start of calibration - if (calibratingG == 400) - g[axis] = 0; - // Sum up 400 readings - g[axis] += gyroADC[axis]; - // Clear global variables for next reading - gyroADC[axis] = 0; - gyroZero[axis] = 0; - if (calibratingG == 1) { - gyroZero[axis] = g[axis] / 400; - blinkLED(10, 15, 1 + 3 * nunchuk); - } - } - calibratingG--; - } - for (axis = 0; axis < 3; axis++) { - gyroADC[axis] -= gyroZero[axis]; - //anti gyro glitch, limit the variation between two consecutive readings - gyroADC[axis] = constrain(gyroADC[axis], previousGyroADC[axis] - 800, previousGyroADC[axis] + 800); - previousGyroADC[axis] = gyroADC[axis]; - } -} - -// **************** -// ACC common part -// **************** -void ACC_Common() -{ - static int32_t a[3]; - - if (calibratingA > 0) { - for (uint8_t axis = 0; axis < 3; axis++) { - // Reset a[axis] at start of calibration - if (calibratingA == 400) - a[axis] = 0; - // Sum up 400 readings - a[axis] += accADC[axis]; - // Clear global variables for next reading - accADC[axis] = 0; - accZero[axis] = 0; - } - // Calculate average, shift Z down by acc_1G and store values in EEPROM at end of calibration - if (calibratingA == 1) { - accZero[ROLL] = a[ROLL] / 400; - accZero[PITCH] = a[PITCH] / 400; - accZero[YAW] = a[YAW] / 400 - acc_1G; // for nunchuk 200=1G - accTrim[ROLL] = 0; - accTrim[PITCH] = 0; - writeParams(); // write accZero in EEPROM - } - calibratingA--; - } -#if defined(InflightAccCalibration) - static int32_t b[3]; - static int16_t accZero_saved[3] = { 0, 0, 0 }; - static int16_t accTrim_saved[2] = { 0, 0 }; - //Saving old zeropoints before measurement - if (InflightcalibratingA == 50) { - accZero_saved[ROLL] = accZero[ROLL]; - accZero_saved[PITCH] = accZero[PITCH]; - accZero_saved[YAW] = accZero[YAW]; - accTrim_saved[ROLL] = accTrim[ROLL]; - accTrim_saved[PITCH] = accTrim[PITCH]; - } - if (InflightcalibratingA > 0) { - for (uint8_t axis = 0; axis < 3; axis++) { - // Reset a[axis] at start of calibration - if (InflightcalibratingA == 50) - b[axis] = 0; - // Sum up 50 readings - b[axis] += accADC[axis]; - // Clear global variables for next reading - accADC[axis] = 0; - accZero[axis] = 0; - } - //all values are measured - if (InflightcalibratingA == 1) { - AccInflightCalibrationMeasurementDone = 1; - blinkLED(10, 10, 2); //buzzer for indicatiing the start inflight - // recover saved values to maintain current flight behavior until new values are transferred - accZero[ROLL] = accZero_saved[ROLL]; - accZero[PITCH] = accZero_saved[PITCH]; - accZero[YAW] = accZero_saved[YAW]; - accTrim[ROLL] = accTrim_saved[ROLL]; - accTrim[PITCH] = accTrim_saved[PITCH]; - } - InflightcalibratingA--; - } - // Calculate average, shift Z down by acc_1G and store values in EEPROM at end of calibration - if (AccInflightCalibrationSavetoEEProm == 1) { //the copter is landed, disarmed and the combo has been done again - AccInflightCalibrationSavetoEEProm = 0; - accZero[ROLL] = b[ROLL] / 50; - accZero[PITCH] = b[PITCH] / 50; - accZero[YAW] = b[YAW] / 50 - acc_1G; // for nunchuk 200=1G - accTrim[ROLL] = 0; - accTrim[PITCH] = 0; - writeParams(); // write accZero in EEPROM - } -#endif - accADC[ROLL] -= accZero[ROLL]; - accADC[PITCH] -= accZero[PITCH]; - accADC[YAW] -= accZero[YAW]; -} - - -// ************************************************************************************************************ -// I2C Barometer BOSCH BMP085 -// ************************************************************************************************************ -// I2C adress: 0xEE (8bit) 0x77 (7bit) -// principle: -// 1) read the calibration register (only once at the initialization) -// 2) read uncompensated temperature (not mandatory at every cycle) -// 3) read uncompensated pressure -// 4) raw temp + raw pressure => calculation of the adjusted pressure -// the following code uses the maximum precision setting (oversampling setting 3) -// ************************************************************************************************************ - -#if defined(BMP085) -#define BMP085_ADDRESS 0xEE -static struct { - // sensor registers from the BOSCH BMP085 datasheet - int16_t ac1, ac2, ac3, b1, b2, mb, mc, md; - uint16_t ac4, ac5, ac6; - union { - uint16_t val; - uint8_t raw[2]; - } ut; //uncompensated T - union { - uint32_t val; - uint8_t raw[4]; - } up; //uncompensated P - uint8_t state; - uint32_t deadline; -} bmp085_ctx; -#define OSS 3 - -void i2c_BMP085_readCalibration() -{ - delay(10); - bmp085_ctx.ac1 = i2c_BMP085_readIntRegister(0xAA); - bmp085_ctx.ac2 = i2c_BMP085_readIntRegister(0xAC); - bmp085_ctx.ac3 = i2c_BMP085_readIntRegister(0xAE); - bmp085_ctx.ac4 = i2c_BMP085_readIntRegister(0xB0); - bmp085_ctx.ac5 = i2c_BMP085_readIntRegister(0xB2); - bmp085_ctx.ac6 = i2c_BMP085_readIntRegister(0xB4); - bmp085_ctx.b1 = i2c_BMP085_readIntRegister(0xB6); - bmp085_ctx.b2 = i2c_BMP085_readIntRegister(0xB8); - bmp085_ctx.mb = i2c_BMP085_readIntRegister(0xBA); - bmp085_ctx.mc = i2c_BMP085_readIntRegister(0xBC); - bmp085_ctx.md = i2c_BMP085_readIntRegister(0xBE); -} - -void Baro_init() -{ - delay(10); - i2c_BMP085_readCalibration(); - i2c_BMP085_UT_Start(); - delay(5); - i2c_BMP085_UT_Read(); -} - -// read a 16 bit register -int16_t i2c_BMP085_readIntRegister(uint8_t r) -{ - union { - int16_t val; - uint8_t raw[2]; - } data; - i2c_rep_start(BMP085_ADDRESS + 0); - i2c_write(r); - i2c_rep_start(BMP085_ADDRESS + 1); //I2C read direction => 1 - data.raw[1] = i2c_readAck(); - data.raw[0] = i2c_readNak(); - return data.val; -} - -// read uncompensated temperature value: send command first -void i2c_BMP085_UT_Start() -{ - i2c_writeReg(BMP085_ADDRESS, 0xf4, 0x2e); - i2c_rep_start(BMP085_ADDRESS + 0); - i2c_write(0xF6); - i2c_stop(); -} - -// read uncompensated pressure value: send command first -void i2c_BMP085_UP_Start() -{ - i2c_writeReg(BMP085_ADDRESS, 0xf4, 0x34 + (OSS << 6)); // control register value for oversampling setting 3 - i2c_rep_start(BMP085_ADDRESS + 0); //I2C write direction => 0 - i2c_write(0xF6); - i2c_stop(); -} - -// read uncompensated pressure value: read result bytes -// the datasheet suggests a delay of 25.5 ms (oversampling settings 3) after the send command -void i2c_BMP085_UP_Read() -{ - i2c_rep_start(BMP085_ADDRESS + 1); //I2C read direction => 1 - bmp085_ctx.up.raw[2] = i2c_readAck(); - bmp085_ctx.up.raw[1] = i2c_readAck(); - bmp085_ctx.up.raw[0] = i2c_readNak(); -} - -// read uncompensated temperature value: read result bytes -// the datasheet suggests a delay of 4.5 ms after the send command -void i2c_BMP085_UT_Read() -{ - i2c_rep_start(BMP085_ADDRESS + 1); //I2C read direction => 1 - bmp085_ctx.ut.raw[1] = i2c_readAck(); - bmp085_ctx.ut.raw[0] = i2c_readNak(); -} - -void i2c_BMP085_Calculate() -{ - int32_t x1, x2, x3, b3, b5, b6, p, tmp; - uint32_t b4, b7; - // Temperature calculations - x1 = ((int32_t) bmp085_ctx.ut.val - bmp085_ctx.ac6) * bmp085_ctx.ac5 >> 15; - x2 = ((int32_t) bmp085_ctx.mc << 11) / (x1 + bmp085_ctx.md); - b5 = x1 + x2; - // Pressure calculations - b6 = b5 - 4000; - x1 = (bmp085_ctx.b2 * (b6 * b6 >> 12)) >> 11; - x2 = bmp085_ctx.ac2 * b6 >> 11; - x3 = x1 + x2; - tmp = bmp085_ctx.ac1; - tmp = (tmp * 4 + x3) << OSS; - b3 = (tmp + 2) / 4; - x1 = bmp085_ctx.ac3 * b6 >> 13; - x2 = (bmp085_ctx.b1 * (b6 * b6 >> 12)) >> 16; - x3 = ((x1 + x2) + 2) >> 2; - b4 = (bmp085_ctx.ac4 * (uint32_t) (x3 + 32768)) >> 15; - b7 = ((uint32_t) (bmp085_ctx.up.val >> (8 - OSS)) - b3) * (50000 >> OSS); - p = b7 < 0x80000000 ? (b7 * 2) / b4 : (b7 / b4) * 2; - x1 = (p >> 8) * (p >> 8); - x1 = (x1 * 3038) >> 16; - x2 = (-7357 * p) >> 16; - pressure = p + ((x1 + x2 + 3791) >> 4); -} - -void Baro_update() -{ - if (currentTime < bmp085_ctx.deadline) - return; - bmp085_ctx.deadline = currentTime; - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz, BMP085 is ok with this speed - switch (bmp085_ctx.state) { - case 0: - i2c_BMP085_UT_Start(); - bmp085_ctx.state++; - bmp085_ctx.deadline += 4600; - break; - case 1: - i2c_BMP085_UT_Read(); - bmp085_ctx.state++; - break; - case 2: - i2c_BMP085_UP_Start(); - bmp085_ctx.state++; - bmp085_ctx.deadline += 26000; - break; - case 3: - i2c_BMP085_UP_Read(); - i2c_BMP085_Calculate(); - BaroAlt = (1.0f - pow(pressure / 101325.0f, 0.190295f)) * 443300.0f; //decimeter - bmp085_ctx.state = 0; - bmp085_ctx.deadline += 20000; - break; - } -} -#endif - -// ************************************************************************************************************ -// I2C Barometer MS561101BA -// ************************************************************************************************************ -// first contribution from Fabio -// modification from Alex (September 2011) -// -// specs are here: http://www.meas-spec.com/downloads/MS5611-01BA03.pdf -// useful info on pages 7 -> 12 -#if defined(MS561101BA) - -// registers of the device -#define MS561101BA_PRESSURE 0x40 -#define MS561101BA_TEMPERATURE 0x50 -#define MS561101BA_RESET 0x1E - -// OSR (Over Sampling Ratio) constants -#define MS561101BA_OSR_256 0x00 -#define MS561101BA_OSR_512 0x02 -#define MS561101BA_OSR_1024 0x04 -#define MS561101BA_OSR_2048 0x06 -#define MS561101BA_OSR_4096 0x08 - -#define OSR MS561101BA_OSR_4096 - -static struct { - // sensor registers from the MS561101BA datasheet - uint16_t c[7]; - union { - uint32_t val; - uint8_t raw[4]; - } ut; //uncompensated T - union { - uint32_t val; - uint8_t raw[4]; - } up; //uncompensated P - uint8_t state; - uint32_t deadline; -} ms561101ba_ctx; - -void i2c_MS561101BA_reset() -{ - i2c_writeReg(MS561101BA_ADDRESS, MS561101BA_RESET, 0); -} - -void i2c_MS561101BA_readCalibration() -{ - union { - uint16_t val; - uint8_t raw[2]; - } data; - delay(10); - for (uint8_t i = 0; i < 6; i++) { - i2c_rep_start(MS561101BA_ADDRESS + 0); - i2c_write(0xA2 + 2 * i); - i2c_rep_start(MS561101BA_ADDRESS + 1); //I2C read direction => 1 - data.raw[1] = i2c_readAck(); // read a 16 bit register - data.raw[0] = i2c_readNak(); - ms561101ba_ctx.c[i + 1] = data.val; - } -} - -void Baro_init() -{ - delay(10); - i2c_MS561101BA_reset(); - delay(100); - i2c_MS561101BA_readCalibration(); -} - -// read uncompensated temperature value: send command first -void i2c_MS561101BA_UT_Start() -{ - i2c_rep_start(MS561101BA_ADDRESS + 0); // I2C write direction - i2c_write(MS561101BA_TEMPERATURE + OSR); // register selection - i2c_stop(); -} - -// read uncompensated pressure value: send command first -void i2c_MS561101BA_UP_Start() -{ - i2c_rep_start(MS561101BA_ADDRESS + 0); // I2C write direction - i2c_write(MS561101BA_PRESSURE + OSR); // register selection - i2c_stop(); -} - -// read uncompensated pressure value: read result bytes -void i2c_MS561101BA_UP_Read() -{ - i2c_rep_start(MS561101BA_ADDRESS + 0); - i2c_write(0); - i2c_rep_start(MS561101BA_ADDRESS + 1); - ms561101ba_ctx.up.raw[2] = i2c_readAck(); - ms561101ba_ctx.up.raw[1] = i2c_readAck(); - ms561101ba_ctx.up.raw[0] = i2c_readNak(); -} - -// read uncompensated temperature value: read result bytes -void i2c_MS561101BA_UT_Read() -{ - i2c_rep_start(MS561101BA_ADDRESS + 0); - i2c_write(0); - i2c_rep_start(MS561101BA_ADDRESS + 1); - ms561101ba_ctx.ut.raw[2] = i2c_readAck(); - ms561101ba_ctx.ut.raw[1] = i2c_readAck(); - ms561101ba_ctx.ut.raw[0] = i2c_readNak(); -} - -void i2c_MS561101BA_Calculate() -{ - int64_t dT = ms561101ba_ctx.ut.val - ((uint32_t) ms561101ba_ctx.c[5] << 8); //int32_t according to the spec, but int64_t here to avoid cast after - int64_t off = ((uint32_t) ms561101ba_ctx.c[2] << 16) + ((dT * ms561101ba_ctx.c[4]) >> 7); - int64_t sens = ((uint32_t) ms561101ba_ctx.c[1] << 15) + ((dT * ms561101ba_ctx.c[3]) >> 8); - pressure = (((ms561101ba_ctx.up.val * sens) >> 21) - off) >> 15; -} - -void Baro_update() -{ - if (currentTime < ms561101ba_ctx.deadline) - return; - ms561101ba_ctx.deadline = currentTime; - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz, MS5611 is ok with this speed - switch (ms561101ba_ctx.state) { - case 0: - i2c_MS561101BA_UT_Start(); - ms561101ba_ctx.state++; - ms561101ba_ctx.deadline += 15000; //according to the specs, the pause should be at least 8.22ms - break; - case 1: - i2c_MS561101BA_UT_Read(); - ms561101ba_ctx.state++; - break; - case 2: - i2c_MS561101BA_UP_Start(); - ms561101ba_ctx.state++; - ms561101ba_ctx.deadline += 15000; //according to the specs, the pause should be at least 8.22ms - break; - case 3: - i2c_MS561101BA_UP_Read(); - i2c_MS561101BA_Calculate(); - BaroAlt = (1.0f - pow(pressure / 101325.0f, 0.190295f)) * 443300.0f; //decimeter - ms561101ba_ctx.state = 0; - ms561101ba_ctx.deadline += 35000; - break; - } -} -#endif - - -// ************************************************************************************************************ -// I2C Accelerometer ADXL345 -// ************************************************************************************************************ -// I2C adress: 0x3A (8bit) 0x1D (7bit) -// Resolution: 10bit (Full range - 14bit, but this is autoscaling 10bit ADC to the range +- 16g) -// principle: -// 1) CS PIN must be linked to VCC to select the I2C mode -// 2) SD0 PIN must be linked to VCC to select the right I2C adress -// 3) bit b00000100 must be set on register 0x2D to read data (only once at the initialization) -// 4) bits b00001011 must be set on register 0x31 to select the data format (only once at the initialization) -// ************************************************************************************************************ -#if defined(ADXL345) -void ACC_init() -{ - delay(10); - i2c_writeReg(ADXL345_ADDRESS, 0x2D, 1 << 3); // register: Power CTRL -- value: Set measure bit 3 on - i2c_writeReg(ADXL345_ADDRESS, 0x31, 0x0B); // register: DATA_FORMAT -- value: Set bits 3(full range) and 1 0 on (+/- 16g-range) - i2c_writeReg(ADXL345_ADDRESS, 0x2C, 0x09); // register: BW_RATE -- value: rate=50hz, bw=20hz - acc_1G = 256; -} - -void ACC_getADC() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz, ADXL435 is ok with this speed - i2c_getSixRawADC(ADXL345_ADDRESS, 0x32); - - ACC_ORIENTATION(-((rawADC[3] << 8) | rawADC[2]), ((rawADC[1] << 8) | rawADC[0]), ((rawADC[5] << 8) | rawADC[4])); - ACC_Common(); -} -#endif - -// ************************************************************************************************************ -// contribution initially from opie11 (rc-groups) -// adaptation from C2po (may 2011) -// contribution from ziss_dm (June 2011) -// contribution from ToLuSe (Jully 2011) -// contribution from Alex (December 2011) -// I2C Accelerometer BMA180 -// ************************************************************************************************************ -// I2C adress: 0x80 (8bit) 0x40 (7bit) (SDO connection to VCC) -// I2C adress: 0x82 (8bit) 0x41 (7bit) (SDO connection to VDDIO) -// Resolution: 14bit -// -// Control registers: -// -// 0x20 bw_tcs: | bw<3:0> | tcs<3:0> | -// | 150Hz | xxxxxxxx | -// 0x30 tco_z: | tco_z<5:0> | mode_config<1:0> | -// | xxxxxxxxxx | 00 | -// 0x35 offset_lsb1: | offset_x<3:0> | range<2:0> | smp_skip | -// | xxxxxxxxxxxxx | 8G: 101 | xxxxxxxx | -// ************************************************************************************************************ -#if defined(BMA180) -void ACC_init() -{ - delay(10); - //default range 2G: 1G = 4096 unit. - i2c_writeReg(BMA180_ADDRESS, 0x0D, 1 << 4); // register: ctrl_reg0 -- value: set bit ee_w to 1 to enable writing - delay(5); - uint8_t control = i2c_readReg(BMA180_ADDRESS, 0x20); - control = control & 0x0F; // save tcs register - control = control | (0x01 << 4); // register: bw_tcs reg: bits 4-7 to set bw -- value: set low pass filter to 20Hz - i2c_writeReg(BMA180_ADDRESS, 0x20, control); - delay(5); - control = i2c_readReg(BMA180_ADDRESS, 0x30); - control = control & 0xFC; // save tco_z register - control = control | 0x00; // set mode_config to 0 - i2c_writeReg(BMA180_ADDRESS, 0x30, control); - delay(5); - control = i2c_readReg(BMA180_ADDRESS, 0x35); - control = control & 0xF1; // save offset_x and smp_skip register - control = control | (0x05 << 1); // set range to 8G - i2c_writeReg(BMA180_ADDRESS, 0x35, control); - delay(5); - acc_1G = 255; -} - -void ACC_getADC() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; // Optional line. Sensor is good for it in the spec. - i2c_getSixRawADC(BMA180_ADDRESS, 0x02); - //usefull info is on the 14 bits [2-15] bits /4 => [0-13] bits /4 => 12 bit resolution - ACC_ORIENTATION(-((rawADC[1] << 8) | rawADC[0]) / 16, -((rawADC[3] << 8) | rawADC[2]) / 16, ((rawADC[5] << 8) | rawADC[4]) / 16); - ACC_Common(); -} -#endif - -// ************************************************************************************************************ -// contribution from Point65 and mgros (rc-groups) -// contribution from ziss_dm (June 2011) -// contribution from ToLuSe (Jully 2011) -// I2C Accelerometer BMA020 -// ************************************************************************************************************ -// I2C adress: 0x70 (8bit) -// Resolution: 10bit -// Control registers: -// -// Datasheet: After power on reset or soft reset it is recommended to set the SPI4-bit to the correct value. -// 0x80 = SPI four-wire = Default setting -// | 0x15: | SPI4 | enable_adv_INT | new_data_INT | latch_INT | shadow_dis | wake_up_pause<1:0> | wake_up | -// | | 1 | 0 | 0 | 0 | 0 | 00 | 0 | -// -// | 0x14: | reserved <2:0> | range <1:0> | bandwith <2:0> | -// | | !!Calibration!! | 2g | 25Hz | -// -// ************************************************************************************************************ -#if defined(BMA020) -void ACC_init() -{ - i2c_writeReg(0x70, 0x15, 0x80); // set SPI4 bit - uint8_t control = i2c_readReg(0x70, 0x14); - control = control & 0xE0; // save bits 7,6,5 - control = control | (0x02 << 3); // Range 8G (10) - control = control | 0x00; // Bandwidth 25 Hz 000 - i2c_writeReg(0x70, 0x14, control); - acc_1G = 63; -} - -void ACC_getADC() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; - i2c_getSixRawADC(0x70, 0x02); - ACC_ORIENTATION(((rawADC[1] << 8) | rawADC[0]) / 64, ((rawADC[3] << 8) | rawADC[2]) / 64, ((rawADC[5] << 8) | rawADC[4]) / 64); - ACC_Common(); -} -#endif - -// ************************************************************************************************************ -// standalone I2C Nunchuk -// ************************************************************************************************************ -#if defined(NUNCHACK) -void ACC_init() -{ - i2c_writeReg(0xA4, 0xF0, 0x55); - i2c_writeReg(0xA4, 0xFB, 0x00); - delay(250); - acc_1G = 200; -} - -void ACC_getADC() -{ - TWBR = ((16000000L / I2C_SPEED) - 16) / 2; // change the I2C clock rate. !! you must check if the nunchuk is ok with this freq - i2c_getSixRawADC(0xA4, 0x00); - - ACC_ORIENTATION(((rawADC[3] << 2) + ((rawADC[5] >> 4) & 0x2)), -((rawADC[2] << 2) + ((rawADC[5] >> 3) & 0x2)), (((rawADC[4] & 0xFE) << 2) + ((rawADC[5] >> 5) & 0x6))); - ACC_Common(); -} -#endif - -// ************************************************************************ -// LIS3LV02 I2C Accelerometer -//contribution from adver (http://multiwii.com/forum/viewtopic.php?f=8&t=451) -// ************************************************************************ -#if defined(LIS3LV02) -#define LIS3A 0x3A // I2C adress: 0x3A (8bit) - -void i2c_ACC_init() -{ - i2c_writeReg(LIS3A, 0x20, 0xD7); // CTRL_REG1 1101 0111 Pwr on, 160Hz - i2c_writeReg(LIS3A, 0x21, 0x50); // CTRL_REG2 0100 0000 Littl endian, 12 Bit, Boot - acc_1G = 256; -} - -void i2c_ACC_getADC() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz - i2c_getSixRawADC(LIS3A, 0x28 + 0x80); - ACC_ORIENTATION((rawADC[3] << 8 | rawADC[2]) / 4, -(rawADC[1] << 8 | rawADC[0]) / 4, -(rawADC[5] << 8 | rawADC[4]) / 4); - ACC_Common(); -} -#endif - -// ************************************************************************************************************ -// I2C Accelerometer LSM303DLx -// contribution from wektorx (http://www.multiwii.com/forum/viewtopic.php?f=8&t=863) -// ************************************************************************************************************ -#if defined(LSM303DLx_ACC) -void ACC_init() -{ - delay(10); - i2c_writeReg(0x30, 0x20, 0x27); - i2c_writeReg(0x30, 0x23, 0x30); - i2c_writeReg(0x30, 0x21, 0x00); - - acc_1G = 256; -} - -void ACC_getADC() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; - i2c_getSixRawADC(0x30, 0xA8); - - ACC_ORIENTATION(-((rawADC[3] << 8) | rawADC[2]) / 16, ((rawADC[1] << 8) | rawADC[0]) / 16, ((rawADC[5] << 8) | rawADC[4]) / 16); - ACC_Common(); -} -#endif - -// ************************************************************************************************************ -// ADC ACC -// ************************************************************************************************************ -#if defined(ADCACC) -void ACC_init() -{ - pinMode(A1, INPUT); - pinMode(A2, INPUT); - pinMode(A3, INPUT); - acc_1G = 75; -} - -void ACC_getADC() -{ - ACC_ORIENTATION(-analogRead(A1), -analogRead(A2), analogRead(A3)); - ACC_Common(); -} -#endif - -// ************************************************************************************************************ -// contribution from Ciskje -// I2C Gyroscope L3G4200D -// ************************************************************************************************************ -#if defined(L3G4200D) -void Gyro_init() -{ - delay(100); - i2c_writeReg(0XD2 + 0, 0x20, 0x8F); // CTRL_REG1 400Hz ODR, 20hz filter, run! - delay(5); - i2c_writeReg(0XD2 + 0, 0x24, 0x02); // CTRL_REG5 low pass filter enable -} - -void Gyro_getADC() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz - i2c_getSixRawADC(0XD2, 0x80 | 0x28); - - GYRO_ORIENTATION(((rawADC[1] << 8) | rawADC[0]) / 20, ((rawADC[3] << 8) | rawADC[2]) / 20, -((rawADC[5] << 8) | rawADC[4]) / 20); - GYRO_Common(); -} -#endif - -// ************************************************************************************************************ -// I2C Gyroscope ITG3200 -// ************************************************************************************************************ -// I2C adress: 0xD2 (8bit) 0x69 (7bit) -// I2C adress: 0xD0 (8bit) 0x68 (7bit) -// principle: -// 1) VIO is connected to VDD -// 2) I2C adress is set to 0x69 (AD0 PIN connected to VDD) -// or 2) I2C adress is set to 0x68 (AD0 PIN connected to GND) -// 3) sample rate = 1000Hz ( 1kHz/(div+1) ) -// ************************************************************************************************************ -#if defined(ITG3200) -void Gyro_init() -{ - delay(100); - i2c_writeReg(ITG3200_ADDRESS, 0x3E, 0x80); //register: Power Management -- value: reset device -// delay(5); -// i2c_writeReg(ITG3200_ADDRESS, 0x15, ITG3200_SMPLRT_DIV); //register: Sample Rate Divider -- default value = 0: OK - delay(5); - i2c_writeReg(ITG3200_ADDRESS, 0x16, 0x18 + ITG3200_DLPF_CFG); //register: DLPF_CFG - low pass filter configuration - delay(5); - i2c_writeReg(ITG3200_ADDRESS, 0x3E, 0x03); //register: Power Management -- value: PLL with Z Gyro reference - delay(100); -} - -void Gyro_getADC() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz - i2c_getSixRawADC(ITG3200_ADDRESS, 0X1D); - GYRO_ORIENTATION(+(((rawADC[2] << 8) | rawADC[3]) / 4), // range: +/- 8192; +/- 2000 deg/sec - -(((rawADC[0] << 8) | rawADC[1]) / 4), -(((rawADC[4] << 8) | rawADC[5]) / 4)); - GYRO_Common(); -} -#endif - - -// ************************************************************************************************************ -// I2C Compass common function -// ************************************************************************************************************ -#if MAG -static float magCal[3] = { 1.0, 1.0, 1.0 }; // gain for each axis, populated at sensor init -static uint8_t magInit = 0; - -void Mag_getADC() -{ - static uint32_t t, tCal = 0; - static int16_t magZeroTempMin[3]; - static int16_t magZeroTempMax[3]; - uint8_t axis; - if (currentTime < t) - return; //each read is spaced by 100ms - t = currentTime + 100000; - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz - Device_Mag_getADC(); - if (calibratingM == 1) { - tCal = t; - for (axis = 0; axis < 3; axis++) { - magZero[axis] = 0; - magZeroTempMin[axis] = 0; - magZeroTempMax[axis] = 0; - } - calibratingM = 0; - } - magADC[ROLL] = magADC[ROLL] * magCal[ROLL]; - magADC[PITCH] = magADC[PITCH] * magCal[PITCH]; - magADC[YAW] = magADC[YAW] * magCal[YAW]; - if (magInit) { // we apply offset only once mag calibration is done - magADC[ROLL] -= magZero[ROLL]; - magADC[PITCH] -= magZero[PITCH]; - magADC[YAW] -= magZero[YAW]; - } - - if (tCal != 0) { - if ((t - tCal) < 30000000) { // 30s: you have 30s to turn the multi in all directions - LEDPIN_TOGGLE; - for (axis = 0; axis < 3; axis++) { - if (magADC[axis] < magZeroTempMin[axis]) - magZeroTempMin[axis] = magADC[axis]; - if (magADC[axis] > magZeroTempMax[axis]) - magZeroTempMax[axis] = magADC[axis]; - } - } else { - tCal = 0; - for (axis = 0; axis < 3; axis++) - magZero[axis] = (magZeroTempMin[axis] + magZeroTempMax[axis]) / 2; - writeParams(); - } - } -} -#endif - -// ************************************************************************************************************ -// I2C Compass HMC5843 & HMC5883 -// ************************************************************************************************************ -// I2C adress: 0x3C (8bit) 0x1E (7bit) -// ************************************************************************************************************ -#if defined(HMC5843) || defined(HMC5883) -#define MAG_ADDRESS 0x3C -#define MAG_DATA_REGISTER 0x03 - -void Mag_init() -{ - delay(100); - // force positiveBias - i2c_writeReg(MAG_ADDRESS, 0x00, 0x71); //Configuration Register A -- 0 11 100 01 num samples: 8 ; output rate: 15Hz ; positive bias - delay(50); - // set gains for calibration - i2c_writeReg(MAG_ADDRESS, 0x01, 0x60); //Configuration Register B -- 011 00000 configuration gain 2.5Ga - i2c_writeReg(MAG_ADDRESS, 0x02, 0x01); //Mode register -- 000000 01 single Conversion Mode - - // read values from the compass - self test operation - // by placing the mode register into single-measurement mode (0x01), two data acquisition cycles will be made on each magnetic vector. - // The first acquisition values will be subtracted from the second acquisition, and the net measurement will be placed into the data output registers - delay(100); - getADC(); - delay(10); - magCal[ROLL] = 1000.0 / magADC[ROLL]; - magCal[PITCH] = 1000.0 / magADC[PITCH]; - magCal[YAW] = -1000.0 / magADC[YAW]; - - // leave test mode - i2c_writeReg(MAG_ADDRESS, 0x00, 0x70); //Configuration Register A -- 0 11 100 00 num samples: 8 ; output rate: 15Hz ; normal measurement mode - i2c_writeReg(MAG_ADDRESS, 0x01, 0x20); //Configuration Register B -- 001 00000 configuration gain 1.3Ga - i2c_writeReg(MAG_ADDRESS, 0x02, 0x00); //Mode register -- 000000 00 continuous Conversion Mode - - magInit = 1; -} - -void getADC() -{ - i2c_getSixRawADC(MAG_ADDRESS, MAG_DATA_REGISTER); -#if defined(HMC5843) - MAG_ORIENTATION(((rawADC[0] << 8) | rawADC[1]), ((rawADC[2] << 8) | rawADC[3]), -((rawADC[4] << 8) | rawADC[5])); -#endif -#if defined (HMC5883) - MAG_ORIENTATION(((rawADC[4] << 8) | rawADC[5]), -((rawADC[0] << 8) | rawADC[1]), -((rawADC[2] << 8) | rawADC[3])); -#endif -} - -#if not defined(MPU6050_EN_I2C_BYPASS) -void Device_Mag_getADC() -{ - getADC(); -} -#endif -#endif - -// ************************************************************************************************************ -// I2C Compass AK8975 (Contribution by EOSBandi) -// ************************************************************************************************************ -// I2C adress: 0x18 (8bit) 0x0C (7bit) -// ************************************************************************************************************ -#if defined(AK8975) -#define MAG_ADDRESS 0x18 -#define MAG_DATA_REGISTER 0x03 - -void Mag_init() -{ - delay(100); - i2c_writeReg(MAG_ADDRESS, 0x0a, 0x01); //Start the first conversion - delay(100); - magInit = 1; -} - -#if not defined(MPU6050_EN_I2C_BYPASS) -void Device_Mag_getADC() -{ - i2c_getSixRawADC(MAG_ADDRESS, MAG_DATA_REGISTER); - MAG_ORIENTATION(((rawADC[3] << 8) | rawADC[2]), ((rawADC[1] << 8) | rawADC[0]), -((rawADC[5] << 8) | rawADC[4])); - //Start another meassurement - i2c_writeReg(MAG_ADDRESS, 0x0a, 0x01); -} -#endif -#endif - -// ************************************************************************************************************ -// I2C Gyroscope and Accelerometer MPU6050 -// ************************************************************************************************************ -#if defined(MPU6050) - -void Gyro_init() -{ - TWBR = ((16000000L / 400000L) - 16) / 2; // change the I2C clock rate to 400kHz - i2c_writeReg(MPU6050_ADDRESS, 0x6B, 0x80); //PWR_MGMT_1 -- DEVICE_RESET 1 - delay(5); - i2c_writeReg(MPU6050_ADDRESS, 0x19, 0x00); //SMPLRT_DIV -- SMPLRT_DIV = 0 Sample Rate = Gyroscope Output Rate / (1 + SMPLRT_DIV) - i2c_writeReg(MPU6050_ADDRESS, 0x1A, MPU6050_DLPF_CFG); //CONFIG -- EXT_SYNC_SET 0 (disable input pin for data sync) ; default DLPF_CFG = 0 => ACC bandwidth = 260Hz GYRO bandwidth = 256Hz) - i2c_writeReg(MPU6050_ADDRESS, 0x6B, 0x03); //PWR_MGMT_1 -- SLEEP 0; CYCLE 0; TEMP_DIS 0; CLKSEL 3 (PLL with Z Gyro reference) - i2c_writeReg(MPU6050_ADDRESS, 0x1B, 0x18); //GYRO_CONFIG -- FS_SEL = 3: Full scale set to 2000 deg/sec - // enable I2C bypass for AUX I2C -#if defined(MAG) - i2c_writeReg(MPU6050_ADDRESS, 0x6A, 0x00); //USER_CTRL -- DMP_EN=0 ; FIFO_EN=0 ; I2C_MST_EN=0 (I2C bypass mode) ; I2C_IF_DIS=0 ; FIFO_RESET=0 ; I2C_MST_RESET=0 ; SIG_COND_RESET=0 - i2c_writeReg(MPU6050_ADDRESS, 0x37, 0x02); //INT_PIN_CFG -- INT_LEVEL=0 ; INT_OPEN=0 ; LATCH_INT_EN=0 ; INT_RD_CLEAR=0 ; FSYNC_INT_LEVEL=0 ; FSYNC_INT_EN=0 ; I2C_BYPASS_EN=1 ; CLKOUT_EN=0 -#endif -} - -void Gyro_getADC() -{ - i2c_getSixRawADC(MPU6050_ADDRESS, 0x43); - GYRO_ORIENTATION(+(((rawADC[2] << 8) | rawADC[3]) / 4), // range: +/- 8192; +/- 2000 deg/sec - -(((rawADC[0] << 8) | rawADC[1]) / 4), -(((rawADC[4] << 8) | rawADC[5]) / 4)); - GYRO_Common(); -} - -void ACC_init() -{ - i2c_writeReg(MPU6050_ADDRESS, 0x1C, 0x10); //ACCEL_CONFIG -- AFS_SEL=2 (Full Scale = +/-8G) ; ACCELL_HPF=0 //note something is wrong in the spec. - //note: something seems to be wrong in the spec here. With AFS=2 1G = 4096 but according to my measurement: 1G=2048 (and 2048/8 = 256) - //confirmed here: http://www.multiwii.com/forum/viewtopic.php?f=8&t=1080&start=10#p7480 - acc_1G = 255; - -#if defined(MPU6050_EN_I2C_BYPASS) - //at this stage, the MAG is configured via the original MAG init function in I2C bypass mode - //now we configure MPU as a I2C Master device to handle the MAG via the I2C AUX port (done here for HMC5883) - i2c_writeReg(MPU6050_ADDRESS, 0x6A, 0 b00100000); //USER_CTRL -- DMP_EN=0 ; FIFO_EN=0 ; I2C_MST_EN=1 (I2C master mode) ; I2C_IF_DIS=0 ; FIFO_RESET=0 ; I2C_MST_RESET=0 ; SIG_COND_RESET=0 - i2c_writeReg(MPU6050_ADDRESS, 0x37, 0x00); //INT_PIN_CFG -- INT_LEVEL=0 ; INT_OPEN=0 ; LATCH_INT_EN=0 ; INT_RD_CLEAR=0 ; FSYNC_INT_LEVEL=0 ; FSYNC_INT_EN=0 ; I2C_BYPASS_EN=0 ; CLKOUT_EN=0 - i2c_writeReg(MPU6050_ADDRESS, 0x24, 0x0D); //I2C_MST_CTRL -- MULT_MST_EN=0 ; WAIT_FOR_ES=0 ; SLV_3_FIFO_EN=0 ; I2C_MST_P_NSR=0 ; I2C_MST_CLK=13 (I2C slave speed bus = 400kHz) - i2c_writeReg(MPU6050_ADDRESS, 0x25, 0x80 | (MAG_ADDRESS >> 1)); //I2C_SLV0_ADDR -- I2C_SLV4_RW=1 (read operation) ; I2C_SLV4_ADDR=MAG_ADDRESS - i2c_writeReg(MPU6050_ADDRESS, 0x26, MAG_DATA_REGISTER); //I2C_SLV0_REG -- 6 data bytes of MAG are stored in 6 registers. First register address is MAG_DATA_REGISTER - i2c_writeReg(MPU6050_ADDRESS, 0x27, 0x86); //I2C_SLV0_CTRL -- I2C_SLV0_EN=1 ; I2C_SLV0_BYTE_SW=0 ; I2C_SLV0_REG_DIS=0 ; I2C_SLV0_GRP=0 ; I2C_SLV0_LEN=3 (3x2 bytes) -#endif -} - -void ACC_getADC() -{ - i2c_getSixRawADC(MPU6050_ADDRESS, 0x3B); - ACC_ORIENTATION(-((rawADC[0] << 8) | rawADC[1]) / 8, -((rawADC[2] << 8) | rawADC[3]) / 8, ((rawADC[4] << 8) | rawADC[5]) / 8); - ACC_Common(); -} - -//The MAG acquisition function must be replaced because we now talk to the MPU device -#if defined(MPU6050_EN_I2C_BYPASS) -void Device_Mag_getADC() -{ - i2c_getSixRawADC(MPU6050_ADDRESS, 0x49); //0x49 is the first memory room for EXT_SENS_DATA -#if defined(HMC5843) - MAG_ORIENTATION(((rawADC[0] << 8) | rawADC[1]), ((rawADC[2] << 8) | rawADC[3]), -((rawADC[4] << 8) | rawADC[5])); -#endif -#if defined (HMC5883) - MAG_ORIENTATION(((rawADC[4] << 8) | rawADC[5]), -((rawADC[0] << 8) | rawADC[1]), -((rawADC[2] << 8) | rawADC[3])); -#endif -#if defined (AK8975) - MAG_ORIENTATION(((rawADC[3] << 8) | rawADC[2]), ((rawADC[1] << 8) | rawADC[0]), -((rawADC[5] << 8) | rawADC[4])); -#endif -} -#endif -#endif - -#if !GYRO -// ************************************************************************************************************ -// I2C Wii Motion Plus + optional Nunchuk -// ************************************************************************************************************ -// I2C adress 1: 0xA6 (8bit) 0x53 (7bit) -// I2C adress 2: 0xA4 (8bit) 0x52 (7bit) -// ************************************************************************************************************ -void WMP_init() -{ - delay(250); - i2c_writeReg(0xA6, 0xF0, 0x55); // Initialize Extension - delay(250); - i2c_writeReg(0xA6, 0xFE, 0x05); // Activate Nunchuck pass-through mode - delay(250); - - // We need to set acc_1G for the Nunchuk beforehand; It's used in WMP_getRawADC() and ACC_Common() - // If a different accelerometer is used, it will be overwritten by its ACC_init() later. - acc_1G = 200; - acc_25deg = acc_1G * 0.423; - uint8_t numberAccRead = 0; - // Read from WMP 100 times, this should return alternating WMP and Nunchuk data - for (uint8_t i = 0; i < 100; i++) { - delay(4); - if (WMP_getRawADC() == 0) - numberAccRead++; // Count number of times we read from the Nunchuk extension - } - // If we got at least 25 Nunchuck reads, we assume the Nunchuk is present - if (numberAccRead > 25) - nunchuk = 1; - delay(10); -} - -uint8_t WMP_getRawADC() -{ - uint8_t axis; - TWBR = ((16000000L / I2C_SPEED) - 16) / 2; // change the I2C clock rate - i2c_getSixRawADC(0xA4, 0x00); - - if (micros() < (neutralizeTime + NEUTRALIZE_DELAY)) { //we neutralize data in case of blocking+hard reset state - for (axis = 0; axis < 3; axis++) { - gyroADC[axis] = 0; - accADC[axis] = 0; - } - accADC[YAW] = acc_1G; - return 1; - } - // Wii Motion Plus Data - if ((rawADC[5] & 0x03) == 0x02) { - // Assemble 14bit data - gyroADC[ROLL] = -(((rawADC[5] >> 2) << 8) | rawADC[2]); //range: +/- 8192 - gyroADC[PITCH] = -(((rawADC[4] >> 2) << 8) | rawADC[1]); - gyroADC[YAW] = -(((rawADC[3] >> 2) << 8) | rawADC[0]); - GYRO_Common(); - // Check if slow bit is set and normalize to fast mode range - gyroADC[ROLL] = (rawADC[3] & 0x01) ? gyroADC[ROLL] / 5 : gyroADC[ROLL]; //the ratio 1/5 is not exactly the IDG600 or ISZ650 specification - gyroADC[PITCH] = (rawADC[4] & 0x02) >> 1 ? gyroADC[PITCH] / 5 : gyroADC[PITCH]; //we detect here the slow of fast mode WMP gyros values (see wiibrew for more details) - gyroADC[YAW] = (rawADC[3] & 0x02) >> 1 ? gyroADC[YAW] / 5 : gyroADC[YAW]; // this step must be done after zero compensation - return 1; - } else if ((rawADC[5] & 0x03) == 0x00) { // Nunchuk Data - ACC_ORIENTATION(((rawADC[3] << 2) | ((rawADC[5] >> 4) & 0x02)), -((rawADC[2] << 2) | ((rawADC[5] >> 3) & 0x02)), (((rawADC[4] >> 1) << 3) | ((rawADC[5] >> 5) & 0x06))); - ACC_Common(); - return 0; - } else - return 2; -} -#endif - -void initSensors() -{ - delay(200); - POWERPIN_ON; - delay(100); - i2c_init(); - delay(100); - if (GYRO) - Gyro_init(); - else - WMP_init(); - if (BARO) - Baro_init(); - if (MAG) - Mag_init(); - if (ACC) { - ACC_init(); - acc_25deg = acc_1G * 0.423; - } -} diff --git a/mw-svn/Serial.cpp b/mw-svn/Serial.cpp deleted file mode 100755 index f389f5b0a..000000000 --- a/mw-svn/Serial.cpp +++ /dev/null @@ -1,486 +0,0 @@ -// ******************************************************* -// Interrupt driven UART transmitter - using a ring buffer -// ******************************************************* -static uint8_t head, tail; -static uint8_t buf[256]; // 256 is choosen to avoid modulo operations on 8 bits pointers -void serialize16(int16_t a) -{ - buf[head++] = a; - buf[head++] = a >> 8 & 0xff; -} - -void serialize8(uint8_t a) -{ - buf[head++] = a; -} - -ISR_UART { - UDR0 = buf[tail++]; // Transmit next byte in the ring - if (tail == head) // Check if all data is transmitted - UCSR0B &= ~(1 << UDRIE0); // Disable transmitter UDRE interrupt -} - -void UartSendData() -{ // Data transmission acivated when the ring is not empty - UCSR0B |= (1 << UDRIE0); // Enable transmitter UDRE interrupt -} - -void serialCom() -{ - int16_t a; - uint8_t i; - - if (SerialAvailable(0)) { - switch (SerialRead(0)) { -#ifdef BTSERIAL - case 'K': //receive RC data from Bluetooth Serial adapter as a remote - rcData[THROTTLE] = (SerialRead(0) * 4) + 1000; - rcData[ROLL] = (SerialRead(0) * 4) + 1000; - rcData[PITCH] = (SerialRead(0) * 4) + 1000; - rcData[YAW] = (SerialRead(0) * 4) + 1000; - rcData[AUX1] = (SerialRead(0) * 4) + 1000; - break; -#endif -#ifdef LCD_TELEMETRY - case 'A': // button A press - case '1': - if (telemetry == 1) - telemetry = 0; - else { - telemetry = 1; - LCDclear(); - } - break; - case 'B': // button B press - case '2': - if (telemetry == 2) - telemetry = 0; - else { - telemetry = 2; - LCDclear(); - } - break; - case 'C': // button C press - case '3': - if (telemetry == 3) - telemetry = 0; - else { - telemetry = 3; - LCDclear(); -#if defined(LOG_VALUES) && defined(DEBUG) - cycleTimeMax = 0; // reset min/max on transition on->off - cycleTimeMin = 65535; -#endif - } - break; - case 'D': // button D press - case '4': - if (telemetry == 4) - telemetry = 0; - else { - telemetry = 4; - LCDclear(); - } - break; - case '5': - if (telemetry == 5) - telemetry = 0; - else { - telemetry = 5; - LCDclear(); - } - break; - case '6': - if (telemetry == 6) - telemetry = 0; - else { - telemetry = 6; - LCDclear(); - } - break; - case '7': - if (telemetry == 7) - telemetry = 0; - else { - telemetry = 7; - LCDclear(); - } - break; -#if defined(LOG_VALUES) && defined(DEBUG) - case 'R': - //Reset logvalues - if (telemetry == 'R') - telemetry = 0; - else { - telemetry = 'R'; - LCDclear(); - } - break; -#endif -#ifdef DEBUG - case 'F': - { - if (telemetry == 'F') - telemetry = 0; - else { - telemetry = 'F'; - LCDclear(); - } - break; - } -#endif - case 'a': // button A release - case 'b': // button B release - case 'c': // button C release - case 'd': // button D release - break; -#endif - case 'M': // Multiwii @ arduino to GUI all data - serialize8('M'); - serialize8(VERSION); // MultiWii Firmware version - for (i = 0; i < 3; i++) - serialize16(accSmooth[i]); - for (i = 0; i < 3; i++) - serialize16(gyroData[i]); - for (i = 0; i < 3; i++) - serialize16(magADC[i]); - serialize16(EstAlt); - serialize16(heading); // compass - for (i = 0; i < 8; i++) - serialize16(servo[i]); - for (i = 0; i < 8; i++) - serialize16(motor[i]); - for (i = 0; i < 8; i++) - serialize16(rcData[i]); - serialize8(nunchuk | ACC << 1 | BARO << 2 | MAG << 3 | GPSPRESENT << 4); - serialize8(accMode | baroMode << 1 | magMode << 2 | (GPSModeHome | GPSModeHold) << 3); -#if defined(LOG_VALUES) - serialize16(cycleTimeMax); - cycleTimeMax = 0; -#else - serialize16(cycleTime); -#endif - for (i = 0; i < 2; i++) - serialize16(angle[i]); - serialize8(MULTITYPE); - for (i = 0; i < PIDITEMS; i++) { - serialize8(P8[i]); - serialize8(I8[i]); - serialize8(D8[i]); - } - serialize8(rcRate8); - serialize8(rcExpo8); - serialize8(rollPitchRate); - serialize8(yawRate); - serialize8(dynThrPID); - for (i = 0; i < CHECKBOXITEMS; i++) { - serialize8(activate1[i]); - serialize8(activate2[i]); - } - serialize16(GPS_distanceToHome); - serialize16(GPS_directionToHome); - serialize8(GPS_numSat); - serialize8(GPS_fix); - serialize8(GPS_update); - serialize16(intPowerMeterSum); - serialize16(intPowerTrigger1); - serialize8(vbat); - serialize16(BaroAlt); // 4 variables are here for general monitoring purpose - serialize16(i2c_errors_count); // debug2 - serialize16(debug3); // debug3 - serialize16(debug4); // debug4 - serialize8('M'); - UartSendData(); - break; - case 'O': // arduino to OSD data - contribution from MIS - serialize8('O'); - for (i = 0; i < 3; i++) - serialize16(accSmooth[i]); - for (i = 0; i < 3; i++) - serialize16(gyroData[i]); - serialize16(EstAlt * 10.0f); - serialize16(heading); // compass - 16 bytes - for (i = 0; i < 2; i++) - serialize16(angle[i]); //20 - for (i = 0; i < 6; i++) - serialize16(motor[i]); //32 - for (i = 0; i < 6; i++) { - serialize16(rcData[i]); - } //44 - serialize8(nunchuk | ACC << 1 | BARO << 2 | MAG << 3); - serialize8(accMode | baroMode << 1 | magMode << 2); - serialize8(vbat); // Vbatt 47 - serialize8(VERSION); // MultiWii Firmware version - serialize8('O'); //49 - UartSendData(); - break; - case 'W': //GUI write params to eeprom @ arduino - while (SerialAvailable(0) < (7 + 3 * PIDITEMS + 2 * CHECKBOXITEMS)) { - } - for (i = 0; i < PIDITEMS; i++) { - P8[i] = SerialRead(0); - I8[i] = SerialRead(0); - D8[i] = SerialRead(0); - } - rcRate8 = SerialRead(0); - rcExpo8 = SerialRead(0); //2 - rollPitchRate = SerialRead(0); - yawRate = SerialRead(0); //4 - dynThrPID = SerialRead(0); //5 - for (i = 0; i < CHECKBOXITEMS; i++) { - activate1[i] = SerialRead(0); - activate2[i] = SerialRead(0); - } -#if defined(POWERMETER) - powerTrigger1 = (SerialRead(0) + 256 * SerialRead(0)) / PLEVELSCALE; // we rely on writeParams() to compute corresponding pAlarm value -#else - SerialRead(0); - SerialRead(0); //7 so we unload the two bytes -#endif - writeParams(); - break; - case 'S': //GUI to arduino ACC calibration request - calibratingA = 400; - break; - case 'E': //GUI to arduino MAG calibration request - calibratingM = 1; - break; - } - } -} - -#define SERIAL_RX_BUFFER_SIZE 64 - -#if defined(PROMINI) -uint8_t serialBufferRX[SERIAL_RX_BUFFER_SIZE][1]; -volatile uint8_t serialHeadRX[1], serialTailRX[1]; -#endif -#if defined(MEGA) -uint8_t serialBufferRX[SERIAL_RX_BUFFER_SIZE][4]; -volatile uint8_t serialHeadRX[4], serialTailRX[4]; -#endif - -//#if defined(PROMINI) -//uint8_t serialBufferRX0[SERIAL_RX_BUFFER_SIZE]; -//volatile uint8_t serialHeadRX0,serialTailRX0; -//#endif -//#if defined(MEGA) -//uint8_t serialBufferRX1[SERIAL_RX_BUFFER_SIZE]; -//volatile uint8_t serialHeadRX1,serialTailRX1; -//uint8_t serialBufferRX2[SERIAL_RX_BUFFER_SIZE]; -//volatile uint8_t serialHeadRX2,serialTailRX2; -//uint8_t serialBufferRX3[SERIAL_RX_BUFFER_SIZE]; -//volatile uint8_t serialHeadRX3,serialTailRX3; -//#endif - -void SerialOpen(uint8_t port, uint32_t baud) -{ - uint8_t h = ((F_CPU / 4 / baud - 1) / 2) >> 8; - uint8_t l = ((F_CPU / 4 / baud - 1) / 2); - switch (port) { - case 0: - UCSR0A = (1 << U2X0); - UBRR0H = h; - UBRR0L = l; - UCSR0B |= (1 << RXEN0) | (1 << TXEN0) | (1 << RXCIE0); - break; -#if defined(MEGA) - case 1: - UCSR1A = (1 << U2X1); - UBRR1H = h; - UBRR1L = l; - UCSR1B |= (1 << RXEN1) | (1 << TXEN1) | (1 << RXCIE1); - break; - case 2: - UCSR2A = (1 << U2X2); - UBRR2H = h; - UBRR2L = l; - UCSR2B |= (1 << RXEN2) | (1 << TXEN2) | (1 << RXCIE2); - break; - case 3: - UCSR3A = (1 << U2X3); - UBRR3H = h; - UBRR3L = l; - UCSR3B |= (1 << RXEN3) | (1 << TXEN3) | (1 << RXCIE3); - break; -#endif - } -} - -void SerialEnd(uint8_t port) -{ - switch (port) { - case 0: - UCSR0B &= ~((1 << RXEN0) | (1 << TXEN0) | (1 << RXCIE0) | (1 << UDRIE0)); - break; -#if defined(MEGA) - case 1: - UCSR1B &= ~((1 << RXEN1) | (1 << TXEN1) | (1 << RXCIE1)); - break; - case 2: - UCSR2B &= ~((1 << RXEN2) | (1 << TXEN2) | (1 << RXCIE2)); - break; - case 3: - UCSR3B &= ~((1 << RXEN3) | (1 << TXEN3) | (1 << RXCIE3)); - break; -#endif - } -} - -#if defined(PROMINI) && !(defined(SPEKTRUM)) -SIGNAL(USART_RX_vect) -{ - uint8_t d = UDR0; - uint8_t i = (serialHeadRX[0] + 1) % SERIAL_RX_BUFFER_SIZE; - if (i != serialTailRX[0]) { - serialBufferRX[serialHeadRX[0]][0] = d; - serialHeadRX[0] = i; - } -} -#endif -#if defined(MEGA) -SIGNAL(USART0_RX_vect) -{ - uint8_t d = UDR0; - uint8_t i = (serialHeadRX[0] + 1) % SERIAL_RX_BUFFER_SIZE; - if (i != serialTailRX[0]) { - serialBufferRX[serialHeadRX[0]][0] = d; - serialHeadRX[0] = i; - } -} - -#if !(defined(SPEKTRUM)) -SIGNAL(USART1_RX_vect) -{ - uint8_t d = UDR1; - uint8_t i = (serialHeadRX[1] + 1) % SERIAL_RX_BUFFER_SIZE; - if (i != serialTailRX[1]) { - serialBufferRX[serialHeadRX[1]][1] = d; - serialHeadRX[1] = i; - } -} -#endif -SIGNAL(USART2_RX_vect) -{ - uint8_t d = UDR2; - uint8_t i = (serialHeadRX[2] + 1) % SERIAL_RX_BUFFER_SIZE; - if (i != serialTailRX[2]) { - serialBufferRX[serialHeadRX[2]][2] = d; - serialHeadRX[2] = i; - } -} - -SIGNAL(USART3_RX_vect) -{ - uint8_t d = UDR3; - uint8_t i = (serialHeadRX[3] + 1) % SERIAL_RX_BUFFER_SIZE; - if (i != serialTailRX[3]) { - serialBufferRX[serialHeadRX[3]][3] = d; - serialHeadRX[3] = i; - } -} -#endif - -//#if defined(PROMINI) && !(defined(SPEKTRUM)) -//SIGNAL(USART_RX_vect){ -// uint8_t d = UDR0; -// uint8_t i = (serialHeadRX0 + 1) % SERIAL_RX_BUFFER_SIZE; -// if (i != serialTailRX0) {serialBufferRX0[serialHeadRX0] = d; serialHeadRX0 = i;} -//} -//#endif -//#if defined(MEGA) -//SIGNAL(USART0_RX_vect){ -// uint8_t d = UDR0; -// uint8_t i = (serialHeadRX0 + 1) % SERIAL_RX_BUFFER_SIZE; -// if (i != serialTailRX0) {serialBufferRX0[serialHeadRX0] = d; serialHeadRX0 = i;} -//} -//#if !(defined(SPEKTRUM)) -//SIGNAL(USART1_RX_vect){ -// uint8_t d = UDR1; -// uint8_t i = (serialHeadRX1 + 1) % SERIAL_RX_BUFFER_SIZE; -// if (i != serialTailRX1) {serialBufferRX1[serialHeadRX1] = d; serialHeadRX1 = i;} -//} -//#endif -//SIGNAL(USART2_RX_vect){ -// uint8_t d = UDR2; -// uint8_t i = (serialHeadRX2 + 1) % SERIAL_RX_BUFFER_SIZE; -// if (i != serialTailRX2) {serialBufferRX2[serialHeadRX2] = d; serialHeadRX2 = i;} -//} -//SIGNAL(USART3_RX_vect){ -// uint8_t d = UDR3; -// uint8_t i = (serialHeadRX3 + 1) % SERIAL_RX_BUFFER_SIZE; -// if (i != serialTailRX3) {serialBufferRX3[serialHeadRX3] = d; serialHeadRX3 = i;} -//} -//#endif - -uint8_t SerialRead(uint8_t port) -{ - uint8_t c = serialBufferRX[serialTailRX[port]][port]; - if ((serialHeadRX[port] != serialTailRX[port])) - serialTailRX[port] = (serialTailRX[port] + 1) % SERIAL_RX_BUFFER_SIZE; - return c; -} - -//void SerialRead(uint8_t port,uint8_t c){ -// switch (port) { -// case 0: -// uint8_t c = serialBufferRX0[serialTailRX0]; -// if ((serialHeadRX0 != serialTailRX0)) serialTailRX0 = (serialTailRX0 + 1) % SERIAL_RX_BUFFER_SIZE; -// break; -// #if defined(MEGA) -// case 1: -// uint8_t c = serialBufferRX1[serialTailRX1]; -// if ((serialHeadRX1 != serialTailRX1)) serialTailRX1 = (serialTailRX1 + 1) % SERIAL_RX_BUFFER_SIZE; -// break; -// case 2: -// uint8_t c = serialBufferRX2[serialTailRX2]; -// if ((serialHeadRX2 != serialTailRX2)) serialTailRX2 = (serialTailRX2 + 1) % SERIAL_RX_BUFFER_SIZE; -// break; -// case 3: -// uint8_t c = serialBufferRX3[serialTailRX3]; -// if ((serialHeadRX3 != serialTailRX3)) serialTailRX3 = (serialTailRX3 + 1) % SERIAL_RX_BUFFER_SIZE; -// break; -// #endif -// } -// return c; -//} - -uint8_t SerialAvailable(uint8_t port) -{ - return (SERIAL_RX_BUFFER_SIZE + serialHeadRX[port] - serialTailRX[port]) % SERIAL_RX_BUFFER_SIZE; -} - -//void SerialAvailable(uint8_t port,uint8_t c){ -// switch (port) { -// case 0: return (SERIAL_RX_BUFFER_SIZE + serialHeadRX0 - serialTailRX0) % SERIAL_RX_BUFFER_SIZE; -// #if defined(MEGA) -// case 1: return (SERIAL_RX_BUFFER_SIZE + serialHeadRX1 - serialTailRX1) % SERIAL_RX_BUFFER_SIZE; -// case 2: return (SERIAL_RX_BUFFER_SIZE + serialHeadRX2 - serialTailRX2) % SERIAL_RX_BUFFER_SIZE; -// case 3: return (SERIAL_RX_BUFFER_SIZE + serialHeadRX3 - serialTailRX3) % SERIAL_RX_BUFFER_SIZE; -// #endif -// } -//} - -void SerialWrite(uint8_t port, uint8_t c) -{ - switch (port) { - case 0: - serialize8(c); - UartSendData(); - break; // Serial0 TX is driven via a buffer and a background intterupt -#if defined(MEGA) - case 1: - while (!(UCSR1A & (1 << UDRE1))); - UDR1 = c; - break; // Serial1 Serial2 and Serial3 TX are not driven via interrupts - case 2: - while (!(UCSR2A & (1 << UDRE2))); - UDR2 = c; - break; - case 3: - while (!(UCSR3A & (1 << UDRE3))); - UDR3 = c; - break; -#endif - } -} diff --git a/mw-svn/config.h b/mw-svn/config.h deleted file mode 100755 index 1acc22942..000000000 --- a/mw-svn/config.h +++ /dev/null @@ -1,427 +0,0 @@ -/*******************************/ -/****CONFIGURABLE PARAMETERS****/ -/*******************************/ - -/* Set the minimum throttle command sent to the ESC (Electronic Speed Controller) - This is the minimum value that allow motors to run at a idle speed */ -//#define MINTHROTTLE 1300 // for Turnigy Plush ESCs 10A -//#define MINTHROTTLE 1120 // for Super Simple ESCs 10A -//#define MINTHROTTLE 1220 -#define MINTHROTTLE 1150 - -/* The type of multicopter */ -//#define GIMBAL -//#define BI -//#define TRI -//#define QUADP -#define QUADX -//#define Y4 -//#define Y6 -//#define HEX6 -//#define HEX6X -//#define OCTOX8 -//#define OCTOFLATP -//#define OCTOFLATX -//#define FLYING_WING //experimental - -#define YAW_DIRECTION 1 // if you want to reverse the yaw correction direction -//#define YAW_DIRECTION -1 - -#define I2C_SPEED 100000L //100kHz normal mode, this value must be used for a genuine WMP -//#define I2C_SPEED 400000L //400kHz fast mode, it works only with some WMP clones - -//enable internal I2C pull ups -#define INTERNAL_I2C_PULLUPS - - -//****** advanced users settings ************* -/* I2C DFRobot LED RING communication */ -//#define LED_RING - -/* This option should be uncommented if ACC Z is accurate enough when motors are running*/ -/* should now be ok with BMA020 and BMA180 ACC */ -#define TRUSTED_ACCZ - -/* This will activate the ACC-Inflight calibration if unchecked */ -//#define InflightAccCalibration - -/* PIN A0 and A1 instead of PIN D5 & D6 for 6 motors config and promini config - This mod allow the use of a standard receiver on a pro mini - (no need to use a PPM sum receiver) -*/ -//#define A0_A1_PIN_HEX - -/* possibility to use PIN8 or PIN12 as the AUX2 RC input - it deactivates in this case the POWER PIN (pin 12) or the BUZZER PIN (pin 8) -*/ -//#define RCAUXPIN8 -//#define RCAUXPIN12 - -/* This option is here if you want to use the old level code from the verison 1.7 - It's just to have some feedback. This will be removed in the future */ -//#define STAB_OLD_17 - -/* GPS - only available on MEGA boards (this might be possible on 328 based boards in the future) - if enabled, define here the Arduino Serial port number and the UART speed - note: only the RX PIN is used, the GPS is not configured by multiwii - the GPS must be configured to output NMEA sentences (which is generally the default conf for most GPS devices) -*/ -//#define GPS -#define GPS_SERIAL 2 // should be 2 for flyduino v2. It's the serial port number on arduino MEGA -#define GPS_BAUD 115200 -//#define GPS_BAUD 9600 - -/* Pseudo-derivative conrtroller for level mode (experimental) - Additional information: http://www.multiwii.com/forum/viewtopic.php?f=8&t=503 */ -//#define LEVEL_PDF - -/* introduce a deadband around the stick center - Must be greater than zero, comment if you dont want a deadband on roll, pitch and yaw */ -//#define DEADBAND 6 - -/* if you use a specific sensor board: - please submit any correction to this list. - Note from Alex: I only own some boards - for other boards, I'm not sure, the info was gathered via rc forums, be cautious */ -//#define FFIMUv1 // first 9DOF+baro board from Jussi, with HMC5843 <- confirmed by Alex -//#define FFIMUv2 // second version of 9DOF+baro board from Jussi, with HMC5883 <- confirmed by Alex -//#define FREEIMUv1 // v0.1 & v0.2 & v0.3 version of 9DOF board from Fabio -//#define FREEIMUv03 // FreeIMU v0.3 and v0.3.1 -//#define FREEIMUv035 // FreeIMU v0.3.5 no baro -//#define FREEIMUv035_MS // FreeIMU v0.3.5_MS <- confirmed by Alex -//#define FREEIMUv035_BMP // FreeIMU v0.3.5_BMP -//#define FREEIMUv04 // FreeIMU v0.4 with MPU6050, HMC5883L, MS561101BA <- confirmed by Alex -//#define PIPO // 9DOF board from erazz -//#define QUADRINO // full FC board 9DOF+baro board from witespy with BMP085 baro <- confirmed by Alex -//#define QUADRINO_ZOOM // full FC board 9DOF+baro board from witespy second edition <- confirmed by Alex -//#define ALLINONE // full FC board or standalone 9DOF+baro board from CSG_EU -//#define AEROQUADSHIELDv2 -//#define ATAVRSBIN1 // Atmel 9DOF (Contribution by EOSBandi). requires 3.3V power. -//#define SIRIUS // Sirius Navigator IMU <- confirmed by Alex -//#define SIRIUS600 // Sirius Navigator IMU using the WMP for the gyro -//#define MINIWII // Jussi's MiniWii Flight Controller -//#define CITRUSv1_0 // CITRUSv1 from qcrc.ca -//#define DROTEK_IMU10DOF - - -//if you use independent sensors -//leave it commented it you already checked a specific board above -/* I2C gyroscope */ -//#define ITG3200 -//#define L3G4200D - -/* I2C accelerometer */ -//#define ADXL345 -//#define BMA020 -//#define BMA180 -//#define NUNCHACK // if you want to use the nunckuk as a standalone I2C ACC without WMP -//#define LIS3LV02 -//#define LSM303DLx_ACC - -/* I2C barometer */ -//#define BMP085 -//#define MS561101BA - -/* I2C magnetometer */ -//#define HMC5843 -//#define HMC5883 -//#define AK8975 - -/* ADC accelerometer */ // for 5DOF from sparkfun, uses analog PIN A1/A2/A3 -//#define ADCACC - -/* ITG3200 & ITG3205 Low pass filter setting. In case you cannot eliminate all vibrations to the Gyro, you can try - to decrease the LPF frequency, only one step per try. As soon as twitching gone, stick with that setting. - It will not help on feedback wobbles, so change only when copter is randomly twiching and all dampening and - balancing options ran out. Uncomment only one option! - IMPORTANT! Change low pass filter setting changes PID behaviour, so retune your PID's after changing LPF.*/ -//#define ITG3200_LPF_256HZ // This is the default setting, no need to uncomment, just for reference -//#define ITG3200_LPF_188HZ -//#define ITG3200_LPF_98HZ -//#define ITG3200_LPF_42HZ -//#define ITG3200_LPF_20HZ -//#define ITG3200_LPF_10HZ // Use this only in extreme cases, rather change motors and/or props - -/* MPU6050 Low pass filter setting. In case you cannot eliminate all vibrations to the Gyro, you can try - to decrease the LPF frequency, only one step per try. As soon as twitching gone, stick with that setting. - It will not help on feedback wobbles, so change only when copter is randomly twiching and all dampening and - balancing options ran out. Uncomment only one option! - IMPORTANT! Change low pass filter setting changes PID behaviour, so retune your PID's after changing LPF.*/ -//#define MPU6050_LPF_256HZ // This is the default setting, no need to uncomment, just for reference -//#define MPU6050_LPF_188HZ -//#define MPU6050_LPF_98HZ -//#define MPU6050_LPF_42HZ -//#define MPU6050_LPF_20HZ -//#define MPU6050_LPF_10HZ // Use this only in extreme cases, rather change motors and/or props - -/* The following lines apply only for specific receiver with only one PPM sum signal, on digital PIN 2 - IF YOUR RECEIVER IS NOT CONCERNED, DON'T UNCOMMENT ANYTHING. Note this is mandatory for a Y6 setup on a promini - Select the right line depending on your radio brand. Feel free to modify the order in your PPM order is different */ -//#define SERIAL_SUM_PPM PITCH,YAW,THROTTLE,ROLL,AUX1,AUX2,AUX3,AUX4 //For Graupner/Spektrum -//#define SERIAL_SUM_PPM ROLL,PITCH,THROTTLE,YAW,AUX1,AUX2,AUX3,AUX4 //For Robe/Hitec/Futaba -//#define SERIAL_SUM_PPM PITCH,ROLL,THROTTLE,YAW,AUX1,AUX2,AUX3,AUX4 //For some Hitec/Sanwa/Others - -/* The following lines apply only for Spektrum Satellite Receiver - Spektrum Satellites are 3V devices. DO NOT connect to 5V! - For MEGA boards, attach sat grey wire to RX1, pin 19. Sat black wire to ground. Sat orange wire to Mega board's 3.3V (or any other 3V to 3.3V source). - For PROMINI, attach sat grey to RX0. Attach sat black to ground. - There is no 3.3V source on a pro mini; you can either use a different 3V source, or attach orange to 5V with a 3V regulator in-line (such as http://search.digikey.com/scripts/DkSearch/dksus.dll?Detail&name=MCP1700-3002E/TO-ND) - If you use an inline-regulator, a standard 3-pin servo connector can connect to ground, +5V, and RX0; solder the correct wires (and the 3V regulator!) to a Spektrum baseRX-to-Sat cable that has been cut in half. - NOTE: Because there is only one serial port on the Pro Mini, using a Spektrum Satellite implies you CANNOT use the PC based configuration tool. Further, you cannot use on-aircraft serial LCD as the baud rates are incompatible. You can configure by one of two methods: - 1) Use an on-aircraft i2c LCD (such as Eagle Tree or LCD03) for setting gains, reading sensors, etc. - 2) Available now: Comment out the Spektrum definition, upload, plug in PC, configure; uncomment the Spektrum definition, upload, plug in RX, and fly. Repeat as required to configure. - (Contribution by Danal) */ -//#define SPEKTRUM 1024 -//#define SPEKTRUM 2048 - - -/* EXPERIMENTAL !! - contribution from Captain IxI and Zaggo - cf http://www.multiwii.com/forum/viewtopic.php?f=7&t=289 - The following line apply only for Futaba S-Bus Receiver on MEGA boards at RX1 only (Serial 1). - You have to invert the S-Bus-Serial Signal e.g. with a Hex-Inverter like IC SN74 LS 04 */ -//#define SBUS - -/* Failsave settings - added by MIS - Failsafe check pulse on THROTTLE channel. If the pulse is OFF (on only THROTTLE or on all channels) the failsafe procedure is initiated. - After FAILSAVE_DELAY time of pulse absence, the level mode is on (if ACC or nunchuk is avaliable), PITCH, ROLL and YAW is centered - and THROTTLE is set to FAILSAVE_THR0TTLE value. You must set this value to descending about 1m/s or so for best results. - This value is depended from your configuration, AUW and some other params. - Next, afrer FAILSAVE_OFF_DELAY the copter is disarmed, and motors is stopped. - If RC pulse coming back before reached FAILSAVE_OFF_DELAY time, after the small quard time the RC control is returned to normal. - If you use serial sum PPM, the sum converter must completly turn off the PPM SUM pusles for this FailSafe functionality.*/ -#define FAILSAFE // Alex: comment this line if you want to deactivate the failsafe function -#define FAILSAVE_DELAY 10 // Guard time for failsafe activation after signal lost. 1 step = 0.1sec - 1sec in example -#define FAILSAVE_OFF_DELAY 200 // Time for Landing before motors stop in 0.1sec. 1 step = 0.1sec - 20sec in example -#define FAILSAVE_THR0TTLE (MINTHROTTLE + 200) // Throttle level used for landing - may be relative to MINTHROTTLE - as in this case - -/* EXPERIMENTAL !! - contribution from Luis Correia - see http://www.multiwii.com/forum/viewtopic.php?f=18&t=828 - It uses a Bluetooth Serial module as the input for controlling the device via an Android application - As with the SPEKTRUM option, is not possible to use the configuration tool on a mini or promini. */ -//#define BTSERIAL - -/* The following lines apply only for a pitch/roll tilt stabilization system - On promini board, it is not compatible with config with 6 motors or more - Uncomment the first line to activate it */ -//#define SERVO_TILT -#define TILT_PITCH_MIN 1020 //servo travel min, don't set it below 1020 -#define TILT_PITCH_MAX 2000 //servo travel max, max value=2000 -#define TILT_PITCH_MIDDLE 1500 //servo neutral value -#define TILT_PITCH_PROP 10 //servo proportional (tied to angle) ; can be negative to invert movement -#define TILT_ROLL_MIN 1020 -#define TILT_ROLL_MAX 2000 -#define TILT_ROLL_MIDDLE 1500 -#define TILT_ROLL_PROP 10 - -/* interleaving delay in micro seconds between 2 readings WMP/NK in a WMP+NK config - if the ACC calibration time is very long (20 or 30s), try to increase this delay up to 4000 - it is relevent only for a conf with NK */ -#define INTERLEAVING_DELAY 3000 - -/* for V BAT monitoring - after the resistor divisor we should get [0V;5V]->[0;1023] on analog V_BATPIN - with R1=33k and R2=51k - vbat = [0;1023]*16/VBATSCALE */ -#define VBAT // comment this line to suppress the vbat code -#define VBATSCALE 131 // change this value if readed Battery voltage is different than real voltage -#define VBATLEVEL1_3S 107 // 10,7V -#define VBATLEVEL2_3S 103 // 10,3V -#define VBATLEVEL3_3S 99 // 9.9V -#define NO_VBAT 16 // Avoid beeping without any battery - -/* when there is an error on I2C bus, we neutralize the values during a short time. expressed in microseconds - it is relevent only for a conf with at least a WMP */ -#define NEUTRALIZE_DELAY 100000 - -/* this is the value for the ESCs when they are not armed - in some cases, this value must be lowered down to 900 for some specific ESCs */ -#define MINCOMMAND 1000 - -/* this is the maximum value for the ESCs at full power - this value can be increased up to 2000 */ -#define MAXTHROTTLE 1850 - -/* This is the speed of the serial interface. 115200 kbit/s is the best option for a USB connection.*/ -#define SERIAL_COM_SPEED 115200 - -/* In order to save space, it's possibile to desactivate the LCD configuration functions - comment this line only if you don't plan to used a LCD */ -#define LCD_CONF -/* to include setting the aux switches for AUX1 and AUX2 via LCD */ -//#define LCD_CONF_AUX_12 -/* to include setting the aux switches for AUX1, AUX2, AUX3 and AUX4 via LCD */ -//#define LCD_CONF_AUX_1234 -/* Use this to trigger LCD configuration without a TX - only for debugging - do NOT fly with this activated */ -//#define LCD_CONF_DEBUG - -/* choice of LCD attached for configuration and telemetry, see notes below */ -#define LCD_SERIAL3W // Alex' initial variant with 3 wires, using rx-pin for transmission @9600 baud fixed -/* serial (wired or wireless via BT etc.) */ -//#define LCD_TEXTSTAR // Cat's Whisker LCD_TEXTSTAR Module CW-LCD-02 (Which has 4 input keys for selecting menus) -//#define LCD_VT100 // vt100 compatible terminal emulation (blueterm, putty, etc.) -/* i2c devices */ -//#define LCD_ETPP // Eagle Tree Power Panel LCD, which is i2c (not serial) -//#define LCD_LCD03 // LCD03, which is i2c - -/* keys to navigate the LCD menu (preset to LCD_TEXTSTAR key-depress codes)*/ -#define LCD_MENU_PREV 'a' -#define LCD_MENU_NEXT 'c' -#define LCD_VALUE_UP 'd' -#define LCD_VALUE_DOWN 'b' - -/* To use an LCD03 for configuration: - http://www.robot-electronics.co.uk/htm/Lcd03tech.htm - Remove the jumper on its back to set i2c control. - VCC to +5V VCC (pin1 from top) - SDA - Pin A4 Mini Pro - Pin 20 Mega (pin2 from top) - SCL - Pin A5 Mini Pro - Pin 21 Mega (pin3 from top) - GND to Ground (pin4 from top) - (by Th0rsten) */ - -/* To use an Eagle Tree Power Panel LCD for configuration: - White wire to Ground - Red wire to +5V VCC (or to the WMP power pin, if you prefer to reset everything on the bus when WMP resets) - Yellow wire to SDA - Pin A4 Mini Pro - Pin 20 Mega - Brown wire to SCL - Pin A5 Mini Pro - Pin 21 Mega - (Contribution by Danal) */ - -/* Cat's whisker LCD_TEXTSTAR LCD - Pleae note this display needs a full 4 wire connection to (+5V, Gnd, RXD, TXD ) - Configure display as follows: 115K baud, and TTL levels for RXD and TXD, terminal mode - NO rx / tx line reconfiguration, use natural pins */ - - -/* motors will not spin when the throttle command is in low position - this is an alternative method to stop immediately the motors */ -//#define MOTOR_STOP - -/* some radios have not a neutral point centered on 1500. can be changed here */ -#define MIDRC 1500 - -/* experimental - camera trigger function : activated via Rc Options in the GUI, servo output=A2 on promini */ -//#define CAMTRIG -#define CAM_SERVO_HIGH 2000 // the position of HIGH state servo -#define CAM_SERVO_LOW 1020 // the position of LOW state servo -#define CAM_TIME_HIGH 1000 // the duration of HIGH state servo expressed in ms -#define CAM_TIME_LOW 1000 // the duration of LOW state servo expressed in ms - -/* you can change the tricopter servo travel here */ -#define TRI_YAW_CONSTRAINT_MIN 1020 -#define TRI_YAW_CONSTRAINT_MAX 2000 -#define TRI_YAW_MIDDLE 1500 // tail servo center pos. - use this for initial trim; later trim midpoint via LCD - -/* Flying Wing: you can change change servo orientation and servo min/max values here */ -/* valid for all flight modes, even passThrough mode */ -/* need to setup servo directions here; no need to swap servos amongst channels at rx */ -#define PITCH_DIRECTION_L 1 // left servo - pitch orientation -#define PITCH_DIRECTION_R -1 // right servo - pitch orientation (opposite sign to PITCH_DIRECTION_L, if servos are mounted in mirrored orientation) -#define ROLL_DIRECTION_L 1 // left servo - roll orientation -#define ROLL_DIRECTION_R 1 // right servo - roll orientation (same sign as ROLL_DIRECTION_L, if servos are mounted in mirrored orientation) -#define WING_LEFT_MID 1500 // left servo center pos. - use this for initial trim; later trim midpoint via LCD -#define WING_RIGHT_MID 1500 // right servo center pos. - use this for initial trim; later trim midpoint via LCD -#define WING_LEFT_MIN 1020 // limit servo travel range must be inside [1020;2000] -#define WING_LEFT_MAX 2000 // limit servo travel range must be inside [1020;2000] -#define WING_RIGHT_MIN 1020 // limit servo travel range must be inside [1020;2000] -#define WING_RIGHT_MAX 2000 // limit servo travel range must be inside [1020;2000] - -/* enable monitoring of the power consumption from battery (think of mAh) */ -/* allows to set alarm value in GUI or via LCD */ -/* Two options: */ -/* 1 - soft: - (good results +-5% for plush and mystery ESCs @ 2S and 3S, not good with SuperSimple ESC */ -/* 00. relies on your combo of battery type (Voltage, cpacity), ESC, ESC settings, motors, props and multiwii cycle time */ -/* 01. set POWERMETER soft. Uses PLEVELSCALE = 50, PLEVELDIV = PLEVELDIVSOFT = 5000 */ -/* 0. output is a value that linearily scales to power (mAh) */ -/* 1. get voltage reading right first */ -/* 2. start with freshly charged battery */ -/* 3. go fly your typical flight (routine and duration) */ -/* 4. at end connect to GUI or LCD and read the power value; write it down (example 4711)*/ -/* 5. charge battery, write down amount of energy needed (example 722 mAh) */ -/* 6. compute alarm value for desired power threshold (example 750 mAh : alarm = 4711 / 722 * 750) */ -/* 7. set alarm value in GUI or LCD */ -/* 8. enjoy your new battery alarm - possibly repeat steps 2 .. 7 */ -/* 9. if you want the numbers to represent your mAh value, you must change PLEVELDIV */ -/* 2 - hard: - (uses hardware sensor, after configuration gives reasonable results */ -/* 00. uses analog pin 2 to read voltage output from sensor. */ -/* 01. set POWERMETER hard. Uses PLEVELSCALE = 50 */ -/* 02. install low path filter for 25 Hz to sensor input */ -/* 03. check your average cycle time. If not close to 3ms, then you must change PLEVELDIV accordingly */ -/* 1. compute PLEVELDIV for your sensor (see below for insturctions) */ -/* 2. set PLEVELDIVSOFT to 5000 ( to use LOG_VALUES for individual motor comparison) */ -/* 3. attach, set PSENSORNULL and PINT2mA */ -/* 4. configure, compile, upload, set alarm value in GUI or LCD */ -/* 3. enjoy true readings of mAh consumed */ -/* set POWERMETER to "soft" (1) or "hard" (2) depending on sensor you want to utilize */ -//#define POWERMETER_SOFT -//#define POWERMETER_HARD -/* the sum of all powermeters ranges from [0:60000 e4] theoretically. */ -/* the alarm level from eeprom is out of [0:255], so we multipy alarm level with PLEVELSCALE and with 1e4 before comparing */ -/* PLEVELSCALE is the step size you can use to set alarm */ -#define PLEVELSCALE 50 // if you change this value for other granularity, you must search for comments in code to change accordingly -/* larger PLEVELDIV will get you smaller value for power (mAh equivalent) */ -#define PLEVELDIV 5000 // default for soft - if you lower PLEVELDIV, beware of overrun in uint32 pMeter -#define PLEVELDIVSOFT PLEVELDIV // for soft always equal to PLEVELDIV; for hard set to 5000 -//#define PLEVELDIV 1361L // to convert the sum into mAh divide by this value -/* amploc 25A sensor has 37mV/A */ -/* arduino analog resolution is 4.9mV per unit; units from [0..1023] */ -/* sampling rate 20ms, approx 19977 micro seconds */ -/* PLEVELDIV = 37 / 4.9 * 10e6 / 18000 * 3600 / 1000 = 1361L */ -/* set to analogRead() value for zero current */ -#define PSENSORNULL 510 // for I=0A my sensor gives 1/2 Vss; that is approx 2.49Volt -#define PINT2mA 13 // for telemtry display: one integer step on arduino analog translates to mA (example 4.9 / 37 * 100 - - - -/* to monitor system values (battery level, loop time etc. with LCD enable this */ -/* note: for now you must send single characters 'A', 'B', 'C', 'D' to request 4 different pages */ -/* Buttons toggle request for page on/off */ -/* The active page on the LCD does get updated automatically */ -/* Easy to use with Terminal application or display like LCD - uses the 4 buttons are preconfigured to send 'A', 'B', 'C', 'D' */ -//#define LCD_TELEMETRY -/* to enable automatic hopping between a choice of telemetry pages uncomment this. */ -/* This may be useful if your LCD has no buttons or the sending is broken */ -/* hopping is activated and deactivated in unarmed mode with throttle=low & roll=left & pitch=forward */ -/* set it to the sequence of telemetry pages you want to see */ -//#define LCD_TELEMETRY_AUTO "12345267" // pages 1 to 7 in ascending order -//#define LCD_TELEMETRY_AUTO "2122324252627" // strong emphasis on page 2 -/* Use this to trigger telemetry without a TX - only for debugging - do NOT fly with this activated */ -//#define LCD_TELEMETRY_DEBUG //This form rolls between all screens, LCD_TELEMETRY_AUTO must also be defined. -//#define LCD_TELEMETRY_DEBUG 6 //This form stays on the screen specified. - -/* on telemetry page B it gives a bar graph which shows how much voltage battery has left. Range from 0 to 12 Volt is not very informative */ -/* so we try do define a meaningful part. For a 3S battery we define full=12,6V and calculate how much it is above first warning level */ -/* Example: 12.6V - VBATLEVEL1_3S (for me = 126 - 102 = 24) */ -#define VBATREF 24 - -/* to log values like max loop time and others to come */ -/* logging values are visible via LCD config */ -/* set to 2, if you want powerconsumption on a per motor basis (this uses the big array and is a memory hog, if POWERMETER <> PM_SOFT) */ -//#define LOG_VALUES 1 - -/* to add debugging code */ -/* not needed and not recommended for normal operation */ -/* will add extra code that may slow down the main loop or make copter non-flyable */ -//#define DEBUG - -//****** end of advanced users settings ************* - -//if you want to change to orientation of individual sensor -//#define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = Y; accADC[PITCH] = -X; accADC[YAW] = Z;} -//#define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = -Y; gyroADC[PITCH] = X; gyroADC[YAW] = Z;} -//#define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = X; magADC[PITCH] = Y; magADC[YAW] = Z;} - - -/* frequenies for rare cyclic actions in the main loop, depend on cycle time! */ -/* time base is main loop cycle time - a value of 6 means to trigger the action every 6th run through the main loop */ -/* example: with cycle time of approx 3ms, do action every 6*3ms=18ms */ -/* value must be [1; 65535] */ -#define LCD_TELEMETRY_FREQ 23 // to send telemetry data over serial 23 <=> 60ms <=> 16Hz (only sending interlaced, so 8Hz update rate) -#define LCD_TELEMETRY_AUTO_FREQ 667 // to step to next telemetry page 667 <=> 2s -#define PSENSORFREQ 6 // to read hardware powermeter sensor 6 <=> 18ms -#define VBATFREQ PSENSORFREQ // to read battery voltage - keep equal to PSENSORFREQ unless you know what you are doing -/**************************************/ -/****END OF CONFIGURABLE PARAMETERS****/ -/**************************************/ diff --git a/mw-svn/def.h b/mw-svn/def.h deleted file mode 100755 index cce350d74..000000000 --- a/mw-svn/def.h +++ /dev/null @@ -1,484 +0,0 @@ -#if defined(__AVR_ATmega168__) || defined(__AVR_ATmega328P__) - #define PROMINI -#endif -#if defined(__AVR_ATmega1280__) || defined(__AVR_ATmega1281__) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega2561__) - #define MEGA -#endif - -#if defined(PROMINI) - #define LEDPIN_PINMODE pinMode (13, OUTPUT); - #define LEDPIN_TOGGLE PINB |= 1<<5; //switch LEDPIN state (digital PIN 13) - #define LEDPIN_OFF PORTB &= ~(1<<5); - #define LEDPIN_ON PORTB |= (1<<5); - #define BUZZERPIN_PINMODE pinMode (8, OUTPUT); - #define BUZZERPIN_ON PORTB |= 1; - #define BUZZERPIN_OFF PORTB &= ~1; - #define POWERPIN_PINMODE pinMode (12, OUTPUT); - #define POWERPIN_ON PORTB |= 1<<4; - #define POWERPIN_OFF PORTB &= ~(1<<4); //switch OFF WMP, digital PIN 12 - #define I2C_PULLUPS_ENABLE PORTC |= 1<<4; PORTC |= 1<<5; // PIN A4&A5 (SDA&SCL) - #define I2C_PULLUPS_DISABLE PORTC &= ~(1<<4); PORTC &= ~(1<<5); - #define PINMODE_LCD pinMode(0, OUTPUT); - #define LCDPIN_OFF PORTD &= ~1; - #define LCDPIN_ON PORTD |= 1; - #define STABLEPIN_PINMODE ; - #define STABLEPIN_ON ; - #define STABLEPIN_OFF ; - #define DIGITAL_SERVO_TRI_PINMODE pinMode(3,OUTPUT); //also right servo for BI COPTER - #define DIGITAL_SERVO_TRI_HIGH PORTD |= 1<<3; - #define DIGITAL_SERVO_TRI_LOW PORTD &= ~(1<<3); - #define DIGITAL_TILT_PITCH_PINMODE pinMode(A0,OUTPUT); - #define DIGITAL_TILT_PITCH_HIGH PORTC |= 1<<0; - #define DIGITAL_TILT_PITCH_LOW PORTC &= ~(1<<0); - #define DIGITAL_TILT_ROLL_PINMODE pinMode(A1,OUTPUT); - #define DIGITAL_TILT_ROLL_HIGH PORTC |= 1<<1; - #define DIGITAL_TILT_ROLL_LOW PORTC &= ~(1<<1); - #define DIGITAL_BI_LEFT_PINMODE pinMode(11,OUTPUT); - #define DIGITAL_BI_LEFT_HIGH PORTB |= 1<<3; - #define DIGITAL_BI_LEFT_LOW PORTB &= ~(1<<3); - #define PPM_PIN_INTERRUPT attachInterrupt(0, rxInt, RISING); //PIN 0 - #define SPEK_SERIAL_VECT USART_RX_vect - #define SPEK_DATA_REG UDR0 -// #define MOTOR_ORDER 9,10,11,3,6,5 //for a quad+: rear,right,left,front - #define DIGITAL_CAM_PINMODE pinMode(A2,OUTPUT); - #define DIGITAL_CAM_HIGH PORTC |= 1<<2; - #define DIGITAL_CAM_LOW PORTC &= ~(1<<2); - //RX PIN assignment inside the port //for PORTD - #define THROTTLEPIN 2 - #define ROLLPIN 4 - #define PITCHPIN 5 - #define YAWPIN 6 - #define AUX1PIN 7 - #define AUX2PIN 0 // optional PIN 8 or PIN 12 - #define AUX3PIN 1 // unused - #define AUX4PIN 3 // unused - #define ISR_UART ISR(USART_UDRE_vect) - #define V_BATPIN A3 // Analog PIN 3 - #define PSENSORPIN A2 // Analog PIN 2 - - //motor order changes because of possible octo - #define MOTOR_ORDER 9,10,11,3,6,5,A2,12 //for a quad+: rear,right,left,front - - // TILT_PITCH - #define SERVO_1_PINMODE pinMode(A0,OUTPUT); - #define SERVO_1_PIN_HIGH PORTC |= 1<<0; - #define SERVO_1_PIN_LOW PORTC &= ~(1<<0); - - // TILT_ROLL - #define SERVO_2_PINMODE pinMode(A1,OUTPUT); - #define SERVO_2_PIN_HIGH PORTC |= 1<<1; - #define SERVO_2_PIN_LOW PORTC &= ~(1<<1); - - // CAM TRIG - #define SERVO_3_PINMODE pinMode(A2,OUTPUT); - #define SERVO_3_PIN_HIGH PORTC |= 1<<2; - #define SERVO_3_PIN_LOW PORTC &= ~(1<<2); - - // new - #define SERVO_4_PINMODE pinMode(12,OUTPUT); - #define SERVO_4_PIN_HIGH PORTB |= 1<<4; - #define SERVO_4_PIN_LOW PORTB &= ~(1<<4); - - // BI LEFT - #define SERVO_5_PINMODE pinMode(3,OUTPUT); - #define SERVO_5_PIN_HIGH PORTD|= 1<<3; - #define SERVO_5_PIN_LOW PORTD &= ~(1<<3); - - // TRI REAR - #define SERVO_6_PINMODE pinMode(11,OUTPUT); - #define SERVO_6_PIN_HIGH PORTB |= 1<<3; - #define SERVO_6_PIN_LOW PORTB &= ~(1<<3); - - // new motor pin 10 - #define SERVO_7_PINMODE pinMode(10,OUTPUT); - #define SERVO_7_PIN_HIGH PORTB |= 1<<2; - #define SERVO_7_PIN_LOW PORTB &= ~(1<<2); - - //new motor pin 9 - #define SERVO_8_PINMODE pinMode(9,OUTPUT); - #define SERVO_8_PIN_HIGH PORTB |= 1<<1; - #define SERVO_8_PIN_LOW PORTB &= ~(1<<1); - -#endif -#if defined(MEGA) - #define LEDPIN_PINMODE pinMode (13, OUTPUT);pinMode (30, OUTPUT); - #define LEDPIN_TOGGLE PINB |= (1<<7); PINC |= (1<<7); - #define LEDPIN_ON PORTB |= (1<<7); PORTC |= (1<<7); - #define LEDPIN_OFF PORTB &= ~(1<<7);PORTC &= ~(1<<7); - #define BUZZERPIN_PINMODE pinMode (32, OUTPUT); - #define BUZZERPIN_ON PORTC |= 1<<5; - #define BUZZERPIN_OFF PORTC &= ~(1<<5); - #define POWERPIN_PINMODE pinMode (37, OUTPUT); - #define POWERPIN_ON PORTC |= 1<<0; - #define POWERPIN_OFF PORTC &= ~(1<<0); - #define I2C_PULLUPS_ENABLE PORTD |= 1<<0; PORTD |= 1<<1; // PIN 20&21 (SDA&SCL) - #define I2C_PULLUPS_DISABLE PORTD &= ~(1<<0); PORTD &= ~(1<<1); - #define PINMODE_LCD pinMode(0, OUTPUT); - #define LCDPIN_OFF PORTE &= ~1; //switch OFF digital PIN 0 - #define LCDPIN_ON PORTE |= 1; //switch OFF digital PIN 0 - #define STABLEPIN_PINMODE pinMode (31, OUTPUT); - #define STABLEPIN_ON PORTC |= 1<<6; - #define STABLEPIN_OFF PORTC &= ~(1<<6); - #define DIGITAL_SERVO_TRI_PINMODE pinMode(2,OUTPUT); //PIN 2 //also right servo for BI COPTER - #define DIGITAL_SERVO_TRI_HIGH PORTE |= 1<<4; - #define DIGITAL_SERVO_TRI_LOW PORTE &= ~(1<<4); - #define DIGITAL_TILT_PITCH_PINMODE pinMode(34,OUTPUT);pinMode(44,OUTPUT); // 34 + 44 - #define DIGITAL_TILT_PITCH_HIGH PORTC |= 1<<3;PORTL |= 1<<5; - #define DIGITAL_TILT_PITCH_LOW PORTC &= ~(1<<3);PORTL &= ~(1<<5); - #define DIGITAL_TILT_ROLL_PINMODE pinMode(35,OUTPUT);pinMode(45,OUTPUT); // 35 + 45 - #define DIGITAL_TILT_ROLL_HIGH PORTC |= 1<<2;PORTL |= 1<<4; - #define DIGITAL_TILT_ROLL_LOW PORTC &= ~(1<<2);PORTL &= ~(1<<4); - #define DIGITAL_BI_LEFT_PINMODE pinMode(6,OUTPUT); - #define DIGITAL_BI_LEFT_HIGH PORTH |= 1<<3; - #define DIGITAL_BI_LEFT_LOW PORTH &= ~(1<<3); - #define PPM_PIN_INTERRUPT attachInterrupt(4, rxInt, RISING); //PIN 19, also used for Spektrum satellite option - #define SPEK_SERIAL_VECT USART1_RX_vect - #define SPEK_DATA_REG UDR1 - #define DIGITAL_CAM_PINMODE pinMode(33,OUTPUT); pinMode(46,OUTPUT); // 33 + 46 - #define DIGITAL_CAM_HIGH PORTC |= 1<<4;PORTL |= 1<<3; - #define DIGITAL_CAM_LOW PORTC &= ~(1<<4);PORTL &= ~(1<<3); - //RX PIN assignment inside the port //for PORTK - #define THROTTLEPIN 0 //PIN 62 = PIN A8 - #define ROLLPIN 1 //PIN 63 = PIN A9 - #define PITCHPIN 2 //PIN 64 = PIN A10 - #define YAWPIN 3 //PIN 65 = PIN A11 - #define AUX1PIN 4 //PIN 66 = PIN A12 - #define AUX2PIN 5 //PIN 67 = PIN A13 - #define AUX3PIN 6 //PIN 68 = PIN A14 - #define AUX4PIN 7 //PIN 69 = PIN A15 - #define ISR_UART ISR(USART0_UDRE_vect) - #define V_BATPIN A0 // Analog PIN 0 - #define PSENSORPIN A2 // Analog PIN 2 - - #define MOTOR_ORDER 3,5,6,2,7,8,9,10 //for a quad+: rear,right,left,front //+ for y6: 7:under right 8:under left - - // TILT_PITCH - #define SERVO_1_PINMODE pinMode(34,OUTPUT);pinMode(44,OUTPUT); - #define SERVO_1_PIN_HIGH PORTC |= 1<<3;PORTL |= 1<<5; - #define SERVO_1_PIN_LOW PORTC &= ~(1<<3);PORTL &= ~(1<<5); - - // TILT_ROLL - #define SERVO_2_PINMODE pinMode(35,OUTPUT);pinMode(45,OUTPUT); - #define SERVO_2_PIN_HIGH PORTC |= 1<<2;PORTL |= 1<<4; - #define SERVO_2_PIN_LOW PORTC &= ~(1<<2);PORTL &= ~(1<<4); - - // CAM TRIG - #define SERVO_3_PINMODE pinMode(33,OUTPUT); pinMode(46,OUTPUT); - #define SERVO_3_PIN_HIGH PORTC |= 1<<4;PORTL |= 1<<3; - #define SERVO_3_PIN_LOW PORTC &= ~(1<<4);PORTL &= ~(1<<3); - - // new ? - #define SERVO_4_PINMODE pinMode (37, OUTPUT); - #define SERVO_4_PIN_HIGH PORTC |= 1<<0; - #define SERVO_4_PIN_LOW PORTC &= ~(1<<0); - - // BI LEFT - #define SERVO_5_PINMODE pinMode(6,OUTPUT); - #define SERVO_5_PIN_HIGH PORTH |= 1<<3; - #define SERVO_5_PIN_LOW PORTH &= ~(1<<3); - - // TRI REAR - #define SERVO_6_PINMODE pinMode(2,OUTPUT); - #define SERVO_6_PIN_HIGH PORTE |= 1<<4; - #define SERVO_6_PIN_LOW PORTE &= ~(1<<4); - - //new motor pin 5 - #define SERVO_7_PINMODE pinMode(5,OUTPUT); - #define SERVO_7_PIN_HIGH PORTE |= 1<<3; - #define SERVO_7_PIN_LOW PORTE &= ~(1<<3); - - //new motor pin 3 - #define SERVO_8_PINMODE pinMode(3,OUTPUT); - #define SERVO_8_PIN_HIGH PORTE |= 1<<5; - #define SERVO_8_PIN_LOW PORTE &= ~(1<<5); -#endif - - -//please submit any correction to this list. -#if defined(FFIMUv1) - #define ITG3200 - #define BMA180 - #define BMP085 - #define HMC5843 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = X; magADC[PITCH] = Y; magADC[YAW] = Z;} - #define BMA180_ADDRESS 0x80 - #define ITG3200_ADDRESS 0XD0 -#endif - -#if defined(FFIMUv2) - #define ITG3200 - #define BMA180 - #define BMP085 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = X; magADC[PITCH] = Y; magADC[YAW] = Z;} - #define BMA180_ADDRESS 0x80 - #define ITG3200_ADDRESS 0XD0 -#endif - -#if defined(FREEIMUv1) - #define ITG3200 - #define ADXL345 - #define HMC5843 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = -Y; accADC[PITCH] = X; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = X; magADC[PITCH] = Y; magADC[YAW] = Z;} - #define ADXL345_ADDRESS 0xA6 - #undef INTERNAL_I2C_PULLUPS -#endif - -#if defined(FREEIMUv03) - #define ITG3200 - #define ADXL345 // this is actually an ADXL346 but that's just the same as ADXL345 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = -Y; accADC[PITCH] = X; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define ADXL345_ADDRESS 0xA6 - #undef INTERNAL_I2C_PULLUPS -#endif - -#if defined(FREEIMUv035) || defined(FREEIMUv035_MS) || defined(FREEIMUv035_BMP) - #define ITG3200 - #define BMA180 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #undef INTERNAL_I2C_PULLUPS - #if defined(FREEIMUv035_MS) - #define MS561101BA - #elif defined(FREEIMUv035_BMP) - #define BMP085 - #endif -#endif - -#if defined(FREEIMUv04) - #define MPU6050 - #define HMC5883 - #define MS561101BA - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define MPU6050_EN_I2C_BYPASS // MAG connected to the AUX I2C bus of MPU6050 - #undef INTERNAL_I2C_PULLUPS -#endif - -#if defined(PIPO) - #define L3G4200D - #define ADXL345 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = -Y; accADC[PITCH] = X; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = X; magADC[PITCH] = Y; magADC[YAW] = Z;} - #define ADXL345_ADDRESS 0xA6 -#endif - -#if defined(QUADRINO) - #define ITG3200 - #define BMA180 - #define BMP085 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define BMA180_ADDRESS 0x80 - #define ITG3200_ADDRESS 0XD0 -#endif - -#if defined(QUADRINO_ZOOM) - #define ITG3200 - #define BMA180 - #define BMP085 // note, can be also #define MS561101BA on some versions - //#define MS561101BA - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define BMA180_ADDRESS 0x80 - #define ITG3200_ADDRESS 0XD0 - #define STABLEPIN_PINMODE pinMode (A2, OUTPUT); - #define STABLEPIN_ON PORTC |= (1<<2); - #define STABLEPIN_OFF PORTC &= ~(1<<2); -#endif - -#if defined(ALLINONE) - #define ITG3200 - #define BMA180 - #define BMP085 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} -#endif - -#if defined(AEROQUADSHIELDv2) // to confirm - #define ITG3200 - #define BMA180 - #define BMP085 - #define HMC5843 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = -Y; accADC[PITCH] = X; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = -Y; gyroADC[PITCH] = X; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define ITG3200_ADDRESS 0XD2 -#endif - -#if defined(ATAVRSBIN1) - #define ITG3200 - #define BMA020 //Actually it's a BMA150, but this is a drop in replacement for the discountinued BMA020 - #define AK8975 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = Y; accADC[PITCH] = -X; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = -Y; gyroADC[PITCH] = X; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -X; magADC[PITCH] = -Y; magADC[YAW] = -Z;} -#endif - -#if defined(SIRIUS) - #define ITG3200 - #define BMA180 - #define BMP085 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define BMA180_ADDRESS 0x80 - #define ITG3200_ADDRESS 0XD0 -#endif - -#if defined(SIRIUS600) - #define BMA180 - #define BMP085 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define BMA180_ADDRESS 0x80 -#endif - -#if defined(MINIWII) - #define ITG3200 - #define BMA180 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = -Y; accADC[YAW] = -Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = -X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} -#endif - -#if defined(CITRUSv1_0) - #define ITG3200 - #define ADXL345 - #define BMP085 - #define HMC5883 - #define ACC_ORIENTATION(Y, X, Z) {accADC[ROLL] = -X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(Y, X, Z) {magADC[ROLL] = Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define ADXL345_ADDRESS 0xA6 - #define ITG3200_ADDRESS 0XD0 -#endif - -#if defined(DROTEK_IMU10DOF) - #define ITG3200 - #define BMA180 - #define BMP085 - #define HMC5883 - #define ACC_ORIENTATION(X, Y, Z) {accADC[ROLL] = X; accADC[PITCH] = Y; accADC[YAW] = Z;} - #define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = X; gyroADC[PITCH] = Y; gyroADC[YAW] = Z;} - #define MAG_ORIENTATION(X, Y, Z) {magADC[ROLL] = -Y; magADC[PITCH] = X; magADC[YAW] = Z;} - #define ITG3200_ADDRESS 0XD2 -#endif - -#if defined(ADXL345) || defined(BMA020) || defined(BMA180) || defined(NUNCHACK) || defined(ADCACC) || defined(LSM303DLx_ACC) || defined(MPU6050) - #define ACC 1 -#else - #define ACC 0 -#endif - -#if defined(HMC5883) || defined(HMC5843) || defined(AK8975) - #define MAG 1 -#else - #define MAG 0 -#endif - -#if defined(ITG3200) || defined(L3G4200D) || defined(MPU6050) - #define GYRO 1 -#else - #define GYRO 0 -#endif - -#if defined(BMP085) || defined(MS561101BA) - #define BARO 1 -#else - #define BARO 0 -#endif - -#if defined(GPS) - #define GPSPRESENT 1 -#else - #define GPSPRESENT 0 -#endif - - -#if defined(RCAUXPIN8) - #define BUZZERPIN_PINMODE ; - #define BUZZERPIN_ON ; - #define BUZZERPIN_OFF ; - #define RCAUXPIN -#endif -#if defined(RCAUXPIN12) - #define POWERPIN_PINMODE ; - #define POWERPIN_ON ; - #define POWERPIN_OFF ; - #define RCAUXPIN -#endif - - -#if defined(TRI) - #define MULTITYPE 1 -#elif defined(QUADP) - #define MULTITYPE 2 -#elif defined(QUADX) - #define MULTITYPE 3 -#elif defined(BI) - #define MULTITYPE 4 -#elif defined(GIMBAL) - #define MULTITYPE 5 -#elif defined(Y6) - #define MULTITYPE 6 -#elif defined(HEX6) - #define MULTITYPE 7 -#elif defined(FLYING_WING) - #define MULTITYPE 8 -#elif defined(Y4) - #define MULTITYPE 9 -#elif defined(HEX6X) - #define MULTITYPE 10 -#elif defined(OCTOX8) - #define MULTITYPE 11 -#elif defined(OCTOFLATP) - #define MULTITYPE 11 //the GUI is the same for all 8 motor configs -#elif defined(OCTOFLATX) - #define MULTITYPE 11 //the GUI is the same for all 8 motor configs -#endif - -#if defined(POWERMETER_HARD) || defined(POWERMETER_SOFT) - #define POWERMETER -#endif - -/**************************/ -/* Error Checking Section */ -/**************************/ - -#if (defined(LCD_CONF) || defined(LCD_TELEMETRY)) && !(defined(LCD_SERIAL3W) || defined(LCD_TEXTSTAR) || defined(LCD_VT100) || defined(LCD_ETPP) || defined(LCD_LCD03)) - #error "LCD_CONF or LCD_TELEMETRY defined, and choice of LCD not defined. Uncomment one of LCD_SERIAL3W or LCD_TEXTSTAR or LCD_VT100 or LCD_ETPP or LCD_LCD03" -#endif - - -#if defined(POWERMETER) && !(defined(VBAT)) - #error "to use powermeter, you must also define and configure VBAT" -#endif - -#if defined(LCD_TELEMETRY_AUTO) && !(defined(LCD_TELEMETRY)) - #error "to use automatic telemetry, you MUST also define and configure LCD_TELEMETRY" -#endif - - - diff --git a/startup_stm32f10x_md.s b/src/baseflight_startups/startup_stm32f10x_md.s similarity index 100% rename from startup_stm32f10x_md.s rename to src/baseflight_startups/startup_stm32f10x_md.s diff --git a/startup_stm32f10x_md_gcc.s b/src/baseflight_startups/startup_stm32f10x_md_gcc.s similarity index 100% rename from startup_stm32f10x_md_gcc.s rename to src/baseflight_startups/startup_stm32f10x_md_gcc.s diff --git a/board.h b/src/board.h similarity index 100% rename from board.h rename to src/board.h diff --git a/cli.c b/src/cli.c similarity index 100% rename from cli.c rename to src/cli.c diff --git a/config.c b/src/config.c similarity index 100% rename from config.c rename to src/config.c diff --git a/drv_adc.c b/src/drv_adc.c similarity index 100% rename from drv_adc.c rename to src/drv_adc.c diff --git a/drv_adc.h b/src/drv_adc.h similarity index 100% rename from drv_adc.h rename to src/drv_adc.h diff --git a/drv_adxl345.c b/src/drv_adxl345.c similarity index 100% rename from drv_adxl345.c rename to src/drv_adxl345.c diff --git a/drv_adxl345.h b/src/drv_adxl345.h similarity index 100% rename from drv_adxl345.h rename to src/drv_adxl345.h diff --git a/drv_bmp085.c b/src/drv_bmp085.c similarity index 100% rename from drv_bmp085.c rename to src/drv_bmp085.c diff --git a/drv_bmp085.h b/src/drv_bmp085.h similarity index 100% rename from drv_bmp085.h rename to src/drv_bmp085.h diff --git a/drv_hmc5883l.c b/src/drv_hmc5883l.c similarity index 100% rename from drv_hmc5883l.c rename to src/drv_hmc5883l.c diff --git a/drv_hmc5883l.h b/src/drv_hmc5883l.h similarity index 100% rename from drv_hmc5883l.h rename to src/drv_hmc5883l.h diff --git a/drv_i2c.c b/src/drv_i2c.c similarity index 100% rename from drv_i2c.c rename to src/drv_i2c.c diff --git a/drv_i2c.h b/src/drv_i2c.h similarity index 100% rename from drv_i2c.h rename to src/drv_i2c.h diff --git a/drv_mpu3050.c b/src/drv_mpu3050.c similarity index 100% rename from drv_mpu3050.c rename to src/drv_mpu3050.c diff --git a/drv_mpu3050.h b/src/drv_mpu3050.h similarity index 100% rename from drv_mpu3050.h rename to src/drv_mpu3050.h diff --git a/drv_pwm.c b/src/drv_pwm.c similarity index 100% rename from drv_pwm.c rename to src/drv_pwm.c diff --git a/drv_pwm.h b/src/drv_pwm.h similarity index 100% rename from drv_pwm.h rename to src/drv_pwm.h diff --git a/drv_system.c b/src/drv_system.c similarity index 100% rename from drv_system.c rename to src/drv_system.c diff --git a/drv_system.h b/src/drv_system.h similarity index 100% rename from drv_system.h rename to src/drv_system.h diff --git a/drv_uart.c b/src/drv_uart.c similarity index 100% rename from drv_uart.c rename to src/drv_uart.c diff --git a/drv_uart.h b/src/drv_uart.h similarity index 100% rename from drv_uart.h rename to src/drv_uart.h diff --git a/imu.c b/src/imu.c similarity index 100% rename from imu.c rename to src/imu.c diff --git a/main.c b/src/main.c similarity index 100% rename from main.c rename to src/main.c diff --git a/mixer.c b/src/mixer.c similarity index 100% rename from mixer.c rename to src/mixer.c diff --git a/mw.c b/src/mw.c similarity index 100% rename from mw.c rename to src/mw.c diff --git a/mw.h b/src/mw.h similarity index 100% rename from mw.h rename to src/mw.h diff --git a/sensors.c b/src/sensors.c similarity index 100% rename from sensors.c rename to src/sensors.c diff --git a/serial.c b/src/serial.c similarity index 100% rename from serial.c rename to src/serial.c diff --git a/stm32_flash.ld b/stm32_flash.ld new file mode 100644 index 000000000..0bab13229 --- /dev/null +++ b/stm32_flash.ld @@ -0,0 +1,150 @@ +/* +***************************************************************************** +** +** File : stm32_flash.ld +** +** Abstract : Linker script for STM32F103C8 Device with +** 64KByte FLASH, 20KByte RAM +** +***************************************************************************** +*/ + +/* Entry Point */ +ENTRY(Reset_Handler) + +/* Highest address of the user mode stack */ +_estack = 0x20005000; /* end of 10K RAM */ + +/* Generate a link error if heap and stack don't fit into RAM */ +_Min_Heap_Size = 0; /* required amount of heap */ +_Min_Stack_Size = 0x400; /* required amount of stack */ + +/* Specify the memory areas */ +MEMORY +{ + FLASH (rx) : ORIGIN = 0x08000000, LENGTH = 64K + RAM (xrw) : ORIGIN = 0x20000000, LENGTH = 20K + MEMORY_B1 (rx) : ORIGIN = 0x60000000, LENGTH = 0K +} + +/* Define output sections */ +SECTIONS +{ + /* The startup code goes first into FLASH */ + .isr_vector : + { + . = ALIGN(4); + KEEP(*(.isr_vector)) /* Startup code */ + . = ALIGN(4); + } >FLASH + + /* The program code and other data goes into FLASH */ + .text : + { + . = ALIGN(4); + *(.text) /* .text sections (code) */ + *(.text*) /* .text* sections (code) */ + *(.rodata) /* .rodata sections (constants, strings, etc.) */ + *(.rodata*) /* .rodata* sections (constants, strings, etc.) */ + *(.glue_7) /* glue arm to thumb code */ + *(.glue_7t) /* glue thumb to arm code */ + *(.eh_frame) + + KEEP (*(.init)) + KEEP (*(.fini)) + + . = ALIGN(4); + _etext = .; /* define a global symbols at end of code */ + } >FLASH + + + .ARM.extab : { *(.ARM.extab* .gnu.linkonce.armextab.*) } >FLASH + .ARM : { + __exidx_start = .; + *(.ARM.exidx*) + __exidx_end = .; + } >FLASH + + .preinit_array : + { + PROVIDE_HIDDEN (__preinit_array_start = .); + KEEP (*(.preinit_array*)) + PROVIDE_HIDDEN (__preinit_array_end = .); + } >FLASH + .init_array : + { + PROVIDE_HIDDEN (__init_array_start = .); + KEEP (*(SORT(.init_array.*))) + KEEP (*(.init_array*)) + PROVIDE_HIDDEN (__init_array_end = .); + } >FLASH + .fini_array : + { + PROVIDE_HIDDEN (__fini_array_start = .); + KEEP (*(.fini_array*)) + KEEP (*(SORT(.fini_array.*))) + PROVIDE_HIDDEN (__fini_array_end = .); + } >FLASH + + /* used by the startup to initialize data */ + _sidata = .; + + /* Initialized data sections goes into RAM, load LMA copy after code */ + .data : + { + . = ALIGN(4); + _sdata = .; /* create a global symbol at data start */ + *(.data) /* .data sections */ + *(.data*) /* .data* sections */ + + . = ALIGN(4); + _edata = .; /* define a global symbol at data end */ + } >RAM AT> FLASH + + /* Uninitialized data section */ + . = ALIGN(4); + .bss : + { + /* This is used by the startup in order to initialize the .bss secion */ + _sbss = .; /* define a global symbol at bss start */ + __bss_start__ = _sbss; + *(.bss) + *(.bss*) + *(COMMON) + + . = ALIGN(4); + _ebss = .; /* define a global symbol at bss end */ + __bss_end__ = _ebss; + } >RAM + + /* User_heap_stack section, used to check that there is enough RAM left */ + ._user_heap_stack : + { + . = ALIGN(4); + PROVIDE ( end = . ); + PROVIDE ( _end = . ); + . = . + _Min_Heap_Size; + . = . + _Min_Stack_Size; + . = ALIGN(4); + } >RAM + + /* MEMORY_bank1 section, code must be located here explicitly */ + /* Example: extern int foo(void) __attribute__ ((section (".mb1text"))); */ + .memory_b1_text : + { + *(.mb1text) /* .mb1text sections (code) */ + *(.mb1text*) /* .mb1text* sections (code) */ + *(.mb1rodata) /* read-only data (constants) */ + *(.mb1rodata*) + } >MEMORY_B1 + + /* Remove information from the standard libraries */ + /DISCARD/ : + { + libc.a ( * ) + libm.a ( * ) + libgcc.a ( * ) + } + + .ARM.attributes 0 : { *(.ARM.attributes) } +}