Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/GCC/c.bat =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/GCC/c.bat (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/GCC/c.bat (working copy) @@ -0,0 +1,3 @@ +cls +make clean +make \ No newline at end of file Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/GCC/makefile =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/GCC/makefile (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/GCC/makefile (working copy) @@ -0,0 +1,236 @@ + +ifeq ($(OS),Windows_NT) +DIR = C:/gcc-arm-none-eabi-7-2018-q2-update-win32 +else +DIR = /usr/gcc-arm-none-eabi-7-2018-q2-update +endif + +ARCH = $(DIR)/bin/arm-none-eabi +GCC = $(ARCH)-gcc +LD = $(ARCH)-ld +AS = $(ARCH)-as +OBJCOPY = $(ARCH)-objcopy +OBJDUMP = "$(ARCH)-objdump" +LIB_PATH = ../../../../../Librarier +USER_PATH = ../../user + + +all : output/out.hex + + +CORE_OBJS = $(LIB_PATH)/startup/flash_start_gcc \ + $(LIB_PATH)/core/system \ + $(LIB_PATH)/core/bt_code \ + $(LIB_PATH)/core/misc \ + $(LIB_PATH)/sdk/yc_gpio \ + $(LIB_PATH)/sdk/yc_uart \ + $(LIB_PATH)/sdk/yc_lpm \ + $(LIB_PATH)/sdk/yc_sysctrl \ + $(LIB_PATH)/sdk/yc_bt \ + $(LIB_PATH)/sdk/yc_systick \ + $(LIB_PATH)/sdk/yc_ipc \ + $(LIB_PATH)/sdk/yc_otp \ + $(LIB_PATH)/sdk/yc_timer + + +USER_OBJS = $(USER_PATH)/main + + +OBJS = $(CORE_OBJS) $(USER_OBJS) + +INC_DIR = -I $(LIB_PATH)/core \ + -I $(LIB_PATH)/sdk + + +CFLAG = -mthumb -mcpu=cortex-m0 -c -g -Os $(INC_DIR) $(DEF) -fno-toplevel-reorder -ffunction-sections -fdata-sections +LDFLAG = -T output/ld.script -Map=output/memmap $(LIB_PATH)/sdk/libyc_qspi.a -lc -lm -lgcc -L "$(DIR)/lib/gcc/arm-none-eabi/7.3.1/thumb/v6-m" -L "$(DIR)/arm-none-eabi/lib/thumb/v6-m" + +define ldscript = +/* Linker script to configure memory regions. + * Need modifying for a specific board. + * FLASH.ORIGIN: starting address of flash + * FLASH.LENGTH: length of flash + * RAM.ORIGIN: starting address of RAM bank 0 + * RAM.LENGTH: length of RAM bank 0 + */ +MEMORY +{ + FLASH (rx) : ORIGIN = 0x1000000, LENGTH = 0x80000 /* 512K */ + RAM (rwx) : ORIGIN = 0x20000, LENGTH = 0x10000 /* 64K */ +} + +/* Linker script to place sections and symbol values. Should be used together + * with other linker script that defines memory regions FLASH and RAM. + * It references following symbols, which must be defined in code: + * Reset_Handler : Entry of reset handler + * + * It defines following symbols, which code can use without definition: + * __exidx_start + * __exidx_end + * __copy_table_start__ + * __copy_table_end__ + * __zero_table_start__ + * __zero_table_end__ + * __etext + * __data_start__ + * __preinit_array_start + * __preinit_array_end + * __init_array_start + * __init_array_end + * __fini_array_start + * __fini_array_end + * __data_end__ + * __bss_start__ + * __bss_end__ + * __end__ + * end + * __HeapLimit + * __StackLimit + * __StackTop + * __stack + */ +ENTRY(Reset_Handler) + +SECTIONS +{ + .text : + { + *flash_start*.o + *(.text*) + + KEEP(*(.init)) + KEEP(*(.fini)) + + /* .ctors */ + *crtbegin.o(.ctors) + *crtbegin?.o(.ctors) + *(EXCLUDE_FILE(*crtend?.o *crtend.o) .ctors) + *(SORT(.ctors.*)) + *(.ctors) + + /* .dtors */ + *crtbegin.o(.dtors) + *crtbegin?.o(.dtors) + *(EXCLUDE_FILE(*crtend?.o *crtend.o) .dtors) + *(SORT(.dtors.*)) + *(.dtors) + + *(.rodata*) + + KEEP(*(.eh_frame*)) + } > FLASH + + + + .ARM.extab : + { + *(.ARM.extab* .gnu.linkonce.armextab.*) + } > FLASH + + + .ARM.exidx : + { + *(.ARM.exidx* .gnu.linkonce.armexidx.*) + } > FLASH + + . = ALIGN(4); + __exidx_start = .; + + __etext = .; + + .data : AT (__etext) + { + __data_start__ = .; + *(vtable) + *(.data*) + + . = ALIGN(4); + /* preinit data */ + PROVIDE_HIDDEN (__preinit_array_start = .); + KEEP(*(.preinit_array)) + PROVIDE_HIDDEN (__preinit_array_end = .); + + . = ALIGN(4); + /* init data */ + PROVIDE_HIDDEN (__init_array_start = .); + KEEP(*(SORT(.init_array.*))) + KEEP(*(.init_array)) + PROVIDE_HIDDEN (__init_array_end = .); + + + . = ALIGN(4); + /* finit data */ + PROVIDE_HIDDEN (__fini_array_start = .); + KEEP(*(SORT(.fini_array.*))) + KEEP(*(.fini_array)) + PROVIDE_HIDDEN (__fini_array_end = .); + + KEEP(*(.jcr*)) + . = ALIGN(4); + /* All data end */ + __data_end__ = .; + + } > RAM + + .bss : + { + . = ALIGN(4); + __bss_start__ = .; + *(.bss*) + *(COMMON) + . = ALIGN(4); + __bss_end__ = .; + } > RAM + + .heap (COPY): + { + __end__ = .; + PROVIDE(end = .); + *(.heap*) + __HeapLimit = .; + } > RAM + + /* .stack_dummy section doesn't contains any symbols. It is only + * used for linker to calculate size of stack sections, and assign + * values to stack symbols later */ + .stack_dummy (COPY): + { + *(.stack*) + } > RAM + + /* Set stack top to end of RAM, and stack limit move down by + * size of stack_dummy section */ + __StackTop = ORIGIN(RAM) + LENGTH(RAM); + __StackLimit = __StackTop - SIZEOF(.stack_dummy); + PROVIDE(__stack = __StackTop); + + /* Check if data + heap + stack exceeds RAM limit */ + ASSERT(__StackLimit >= __HeapLimit, "region RAM overflowed with stack") +} +endef + + +output/out.hex : output/out + $(OBJCOPY) $^ -O ihex $@ + + +output/out : $(addprefix output/, $(addsuffix .o, $(OBJS))) + $(file >output/ld.script, $(ldscript)) + $(LD) $(addprefix output/obj/,$(addsuffix .o, $(notdir $(OBJS)))) -o $@ $(LDFLAG) + $(OBJDUMP) -S $@ > output/disasm + +output/%.o : %.c + $(GCC) $< $(CFLAG) -o output/obj/$(notdir $@) + +output/%.o : %.s + $(AS) $^ -mthumb -mcpu=cortex-m0 -o output/obj/$(notdir $@) + + +clean : +ifeq ($(OS),Windows_NT) + del /Q output\*.* + del /Q output\obj\*.* +else + rm -rf output/* + rm -rf output/obj/* +endif Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/Objects/YC3121_keil.sct =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/Objects/YC3121_keil.sct (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/Objects/YC3121_keil.sct (working copy) @@ -0,0 +1,55 @@ +; ************************************************************* +; *** Scatter-Loading Description File generated by uVision *** +; ************************************************************* + +LR_IROM1 0x00000000 0x0001fff { ; load region size_region + ER_IROM1 0x00000000 0x00001fff { ; load address = execution address + startup.o (RESET, +First) + startup.o (|.text|,+RO) +; *(InRoot$$Sections) + } + ;ER_IROM2 0x4000 { + ;rom_main.o (+RO) + ;} + + ;ER_IROM3 0x100000 { + ;*(InRoot$$Sections) + ;} + + ;ER_IROM4 0x100400 { + ;flash_start.o (+RO) + ;.ANY (+RO) + ;} + + ;RW_IRAM1 0x000d0000 0x0010000 { ; RW data + ;.ANY (+RW +ZI) + ;} + +; ARM_LIB_STACK 0xE0000 EMPTY -0x10000{} +} + +;LR_IROM2 0x4000 0x4000{ +; ER_IROM2 0x4000 { +; rom_main.o (+RO) +; } +;} + +LR_IROM3 0x1000200 0x200{ + ER_IROM3 0x1000200 { + flash_start.o (|.flash_start|,+RO) + } +} + +LR_IROM4 0x1000400 0x1000000{ + ER_IROM4 0x1000400 { +; flash_start.o (|.flash_start|,+RO) + *(InRoot$$Sections) + .ANY (+RO) + } + + + RW_IRAM2 0x00020000 0x010000 { ; RW data + .ANY (+RW +ZI) + } +} + Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/YC3121_Keil.uvoptx =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/YC3121_Keil.uvoptx (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/YC3121_Keil.uvoptx (working copy) @@ -0,0 +1,426 @@ + + + + 1.0 + +
### uVision Project, (C) Keil Software
+ + + *.c + *.s*; *.src; *.a* + *.obj; *.o + *.lib + *.txt; *.h; *.inc + *.plm + *.cpp + 0 + + + + 0 + 0 + + + + YC3121 + 0x4 + ARM-ADS + + 12000000 + + 1 + 1 + 0 + 1 + 0 + + + 1 + 65535 + 0 + 0 + 0 + + + 79 + 66 + 8 + .\Listings\ + + + 1 + 1 + 1 + 0 + 1 + 1 + 0 + 1 + 0 + 0 + 0 + 0 + + + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 0 + 0 + + + 1 + 0 + 1 + + 7 + + 0 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 0 + 1 + 1 + 1 + 1 + 0 + 0 + 1 + 0 + 0 + 4 + + + + + + + + + + ..\..\..\..\..\ConfigFiles\MDK\flash.ini + Segger\JL2CM3.dll + + + + 0 + DLGUARM + d + + + 0 + PWSTATINFO + 200,50,700 + + + 0 + ARMRTXEVENTFLAGS + -L70 -Z18 -C0 -M0 -T1 + + + 0 + DLGTARM + (1010=-1,-1,-1,-1,0)(1007=-1,-1,-1,-1,0)(1008=-1,-1,-1,-1,0) + + + 0 + ARMDBGFLAGS + + + + 0 + JL2CM3 + -U4294967295 -O78 -S2 -ZTIFSpeedSel5000 -A0 -C0 -JU1 -JI127.0.0.1 -JP0 -RST0 -N00("ARM CoreSight SW-DP") -D00(0BB11477) -L00(0) -TO18 -TC10000000 -TP21 -TDS8007 -TDT0 -TDC1F -TIEFFFFFFFF -TIP8 -TB1 -TFE0 -FO31 -FD20000 -FCA000 -FN1 -FF0YC3121 -FS01000200 -FL01000000 + + + 0 + UL2CM3 + UL2CM3(-S0 -C0 -P0 -FD20000000 -FC1000) + + + + + 0 + + + 0 + 0 + 1 + 0 + 0 + 0 + 0 + 1 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + + + + 0 + 0 + 0 + + + + + + + + + + + + + core + 1 + 0 + 0 + 0 + + 1 + 1 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\core\misc.c + misc.c + 0 + 0 + + + 1 + 2 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\core\system.c + system.c + 0 + 0 + + + 1 + 3 + 1 + 0 + 0 + 0 + ..\..\user\bt_code.c + bt_code.c + 0 + 0 + + + + + main + 1 + 0 + 0 + 0 + + 2 + 4 + 1 + 0 + 0 + 0 + ..\..\user\main.c + main.c + 0 + 0 + + + + + sdk + 1 + 0 + 0 + 0 + + 3 + 5 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_bt.c + yc_bt.c + 0 + 0 + + + 3 + 6 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_gpio.c + yc_gpio.c + 0 + 0 + + + 3 + 7 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_uart.c + yc_uart.c + 0 + 0 + + + 3 + 8 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_ipc.c + yc_ipc.c + 0 + 0 + + + 3 + 9 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_otp.c + yc_otp.c + 0 + 0 + + + 3 + 10 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_lpm.c + yc_lpm.c + 0 + 0 + + + 3 + 11 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_sysctrl.c + yc_sysctrl.c + 0 + 0 + + + 3 + 12 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_timer.c + yc_timer.c + 0 + 0 + + + 3 + 13 + 4 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_qspi.lib + yc_qspi.lib + 0 + 0 + + + 3 + 14 + 1 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\sdk\yc_systick.c + yc_systick.c + 0 + 0 + + + + + startup + 1 + 0 + 0 + 0 + + 4 + 15 + 2 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\startup\flash_start.s + flash_start.s + 0 + 0 + + + 4 + 16 + 2 + 0 + 0 + 0 + ..\..\..\..\..\Librarier\startup\startup.s + startup.s + 0 + 0 + + + + Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/YC3121_Keil.uvprojx =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/YC3121_Keil.uvprojx (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/prj/MDK/YC3121_Keil.uvprojx (working copy) @@ -0,0 +1,492 @@ + + + + 2.1 + +
### uVision Project, (C) Keil Software
+ + + + YC3121 + 0x4 + ARM-ADS + 5060750::V5.06 update 6 (build 750)::ARMCC + 0 + + + ARMCM0 + ARM + ARM.CMSIS.5.5.1 + http://www.keil.com/pack/ + IRAM(0x20000000,0x00020000) IROM(0x00000000,0x00040000) CPUTYPE("Cortex-M0") CLOCK(12000000) ESEL ELITTLE + + + UL2CM3(-S0 -C0 -P0 -FD20000000 -FC1000) + 0 + $$Device:ARMCM0$Device\ARM\ARMCM0\Include\ARMCM0.h + + + + + + + + + + $$Device:ARMCM0$Device\ARM\SVD\ARMCM0.svd + 0 + 0 + + + + + + + 0 + 0 + 0 + 0 + 1 + + .\Objects\ + YC3121_Keil + 1 + 0 + 1 + 1 + 1 + .\Listings\ + 1 + 0 + 1 + + 0 + 0 + + + 0 + 0 + 0 + 0 + + + 0 + 0 + + + 0 + 0 + 0 + 0 + + + 1 + 0 + fromelf.exe --text -a -c --output=@L_asm.txt "!L" + + 0 + 0 + 0 + 0 + + 0 + + + + 0 + 0 + 0 + 0 + 0 + 1 + 0 + 0 + 0 + 0 + 3 + + + 1 + + + SARMCM3.DLL + + DARMCM1.DLL + -pCM0 + SARMCM3.DLL + + TARMCM1.DLL + -pCM0 + + + + 1 + 0 + 0 + 0 + 16 + + + + + 1 + 0 + 1 + 1 + 1 + 4100 + + 0 + Segger\JL2CM3.dll + "" () + + + + + 0 + + + + 0 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 0 + 1 + 1 + 0 + 1 + 1 + 0 + 0 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 1 + 0 + 0 + "Cortex-M0" + + 0 + 0 + 0 + 1 + 1 + 0 + 0 + 0 + 0 + 0 + 0 + 8 + 1 + 1 + 0 + 0 + 3 + 3 + 0 + 0 + 0 + 0 + 0 + 1 + 0 + 0 + 0 + 0 + 1 + 0 + 0 + 0 + 0 + 1 + 0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x20000000 + 0x20000 + + + 1 + 0x0 + 0x40000 + + + 0 + 0x0 + 0x0 + + + 1 + 0x0 + 0x0 + + + 1 + 0x0 + 0x0 + + + 1 + 0x0 + 0x0 + + + 1 + 0x1000000 + 0x80000 + + + 1 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x0 + 0x0 + + + 0 + 0x20000 + 0x10000 + + + 0 + 0x0 + 0x0 + + + + + + 1 + 1 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 1 + 0 + 0 + 1 + 0 + 0 + 1 + 1 + 1 + 1 + 0 + 0 + 0 + + + __USEKEILCOMPILE__ + + ..\..\..\..\..\Librarier\core;..\..\..\..\..\Librarier\sdk;..\..\user + + + + 1 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + 0 + + + + + + + + + 0 + 0 + 0 + 0 + 1 + 0 + 0x00000000 + 0xd0000 + + .\Objects\YC3121_keil.sct + + + + + + + + + + + core + + + misc.c + 1 + ..\..\..\..\..\Librarier\core\misc.c + + + system.c + 1 + ..\..\..\..\..\Librarier\core\system.c + + + bt_code.c + 1 + ..\..\user\bt_code.c + + + + + main + + + main.c + 1 + ..\..\user\main.c + + + + + sdk + + + yc_bt.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_bt.c + + + yc_gpio.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_gpio.c + + + yc_uart.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_uart.c + + + yc_ipc.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_ipc.c + + + yc_otp.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_otp.c + + + yc_lpm.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_lpm.c + + + yc_sysctrl.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_sysctrl.c + + + yc_timer.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_timer.c + + + yc_qspi.lib + 4 + ..\..\..\..\..\Librarier\sdk\yc_qspi.lib + + + yc_systick.c + 1 + ..\..\..\..\..\Librarier\sdk\yc_systick.c + + + + + startup + + + flash_start.s + 2 + ..\..\..\..\..\Librarier\startup\flash_start.s + + + startup.s + 2 + ..\..\..\..\..\Librarier\startup\startup.s + + + + + + + + + + + + + + Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/bt_code.c =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/bt_code.c (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/bt_code.c (working copy) @@ -0,0 +1,576 @@ +const unsigned char bt_code[] = { +0x00,0x02,0xaa,0x55,0xb2,0x1f,0xc2,0x84,0x00,0x1a,0xc0,0x00,0x00,0x37,0xc0,0x08, +0x87,0xe7,0xc0,0x00,0x80,0x6c,0xc0,0x42,0x80,0x73,0xc0,0x44,0x80,0x94,0xc0,0x4a, +0x00,0x5a,0xc0,0x51,0x00,0x9d,0xc0,0x51,0x80,0x65,0xc0,0x56,0x00,0xa4,0xc0,0x5c, +0x00,0xa5,0xc0,0x5d,0x81,0x41,0xc0,0x5e,0x01,0xd4,0xc0,0x75,0x81,0xf8,0xc0,0x02, +0x83,0xdb,0xc0,0x16,0x03,0xf5,0xc0,0x17,0x03,0xfa,0xc0,0x37,0x84,0x02,0xc0,0x53, +0x04,0x13,0xc0,0x53,0x84,0x34,0xc0,0x55,0x84,0x5b,0xc0,0x1d,0x83,0xfd,0xc0,0x5f, +0x84,0x99,0xc0,0x13,0x04,0x7f,0xc0,0x14,0x04,0x8c,0x20,0x20,0x4a,0x8b,0xc0,0x01, +0x82,0x02,0xc0,0x02,0x82,0x0e,0xc0,0x03,0x02,0x17,0xc0,0x03,0x82,0x1c,0xc0,0x04, +0x02,0x25,0xc0,0x05,0x82,0x36,0xc0,0x09,0x82,0x46,0xc0,0x0a,0x02,0xcb,0xc0,0x0e, +0x02,0xde,0xc0,0x0f,0x03,0x07,0xc0,0x0f,0x83,0x35,0xc0,0x10,0x83,0x69,0xc0,0x18, +0x03,0x7a,0xc0,0x19,0x03,0x7e,0xc0,0x1d,0x03,0x91,0xc0,0x1f,0x03,0x9c,0xc0,0x20, +0x83,0xae,0xc0,0x24,0x83,0xb4,0xc0,0x29,0x03,0xbd,0xc0,0x2a,0x83,0xca,0xc0,0x46, +0x83,0x1c,0xc0,0x4c,0x83,0xd7,0xc0,0x35,0x07,0x90,0xc0,0x3d,0x07,0x75,0xc0,0x28, +0x84,0xb0,0xc0,0x2a,0x04,0xbe,0xc0,0x2c,0x04,0x9e,0xc0,0x31,0x84,0x9c,0x20,0x20, +0x4a,0x8b,0x6f,0xec,0x4b,0xf2,0x67,0xec,0x00,0xa1,0x1c,0xe2,0x7e,0x00,0x20,0x3a, +0x00,0x44,0x20,0x40,0x00,0x3d,0x20,0x20,0x40,0x02,0x70,0x40,0x91,0x00,0x20,0x40, +0x00,0x40,0x20,0x20,0x67,0xbc,0x6f,0xe2,0x89,0x73,0x79,0x20,0x7e,0x06,0x67,0xe2, +0x89,0x73,0x20,0x60,0x00,0x00,0x6f,0xe2,0x81,0x26,0xc2,0x80,0x00,0x4b,0x6f,0xec, +0x00,0xa1,0x68,0x4c,0x81,0x0e,0x98,0x41,0x7e,0x00,0x24,0x5a,0x00,0x3d,0x20,0x20, +0x40,0x02,0x20,0x40,0x00,0x4d,0x20,0x20,0x40,0x02,0x58,0xff,0xff,0xff,0x68,0x46, +0x81,0x0e,0x98,0x42,0xfe,0x00,0x68,0x46,0x00,0xa1,0x98,0x41,0x7e,0x00,0x24,0x3a, +0x00,0x3d,0x58,0xff,0xff,0xff,0x68,0x46,0x81,0x11,0x98,0x42,0xfe,0x00,0x68,0x46, +0x00,0xa4,0x98,0x41,0x7e,0x00,0x24,0x3a,0x00,0x3d,0x20,0x60,0x00,0x00,0x18,0x42, +0x7e,0x00,0x20,0x40,0x7d,0x2b,0x1c,0x30,0x7e,0x00,0x79,0x20,0x7e,0x2c,0x20,0x40, +0x7d,0x14,0x79,0x3f,0xfe,0x2c,0x20,0x40,0x4a,0x76,0x20,0x40,0x7d,0x14,0x20,0x74, +0x00,0x00,0x20,0x40,0x00,0x69,0x20,0x20,0x4a,0x2f,0x1b,0x42,0x7e,0x00,0x20,0x40, +0x00,0x68,0x20,0x20,0x4a,0xe9,0x20,0x40,0x7d,0x14,0x98,0x00,0x0c,0x00,0x79,0x3f, +0x8c,0x10,0x20,0x20,0x7d,0x1f,0x70,0x45,0x3d,0x00,0x20,0x40,0x68,0xc4,0x20,0x40, +0x60,0xd7,0x20,0x40,0x00,0x71,0x20,0x20,0x40,0x0a,0x20,0x75,0x80,0x00,0x20,0x20, +0x7b,0x9a,0x20,0x30,0x80,0x83,0x70,0x89,0x55,0xd4,0x20,0x00,0x00,0x04,0x70,0x89, +0x55,0xd2,0x20,0x00,0x00,0x04,0x70,0x89,0x55,0xd1,0x20,0x00,0x00,0x04,0x6f,0xe2, +0x41,0xdf,0xc0,0x00,0x00,0x81,0xc0,0x00,0x80,0x91,0xc0,0x01,0x00,0x81,0xc0,0x01, +0x80,0x91,0xc0,0x02,0x00,0x91,0xc0,0x10,0x00,0x91,0x70,0x89,0x55,0xd0,0x70,0x89, +0x56,0xe0,0x18,0x00,0x2a,0x08,0x18,0x00,0x2a,0x00,0x78,0x50,0xfc,0x00,0x78,0x50, +0x7c,0x00,0x78,0x2f,0x7c,0x00,0x70,0x89,0x02,0x00,0x70,0x89,0x01,0x00,0x70,0x89, +0x00,0x00,0x70,0x89,0x03,0x00,0x70,0x89,0x04,0x70,0x6f,0xe2,0x89,0x06,0x79,0x20, +0x7e,0x00,0x67,0xe2,0x89,0x06,0x20,0x60,0x00,0x00,0x70,0x89,0x55,0xd0,0x70,0x89, +0x56,0xc0,0x20,0x20,0x00,0x83,0x60,0x42,0x00,0x17,0x20,0x40,0x49,0x2a,0x20,0x40, +0x49,0x80,0x58,0x00,0x05,0x00,0x20,0x40,0x4a,0x8e,0x6f,0xe2,0x89,0x06,0x79,0x20, +0x7e,0x00,0x67,0xe2,0x89,0x06,0x20,0x20,0x49,0x37,0x70,0x89,0x06,0x7c,0x20,0x75, +0x80,0x00,0x58,0x00,0x00,0x00,0x67,0xe4,0x41,0xdd,0x1c,0x43,0x7e,0x00,0x67,0xe8, +0x40,0x94,0x20,0x60,0x00,0x00,0x20,0x20,0x4b,0x7f,0x58,0x00,0x00,0xb4,0x67,0xe4, +0x41,0xf6,0x58,0x00,0x01,0x0a,0x67,0xe4,0x41,0xfe,0x58,0x00,0x01,0x1f,0x67,0xe4, +0x41,0xfa,0x58,0x00,0x01,0x32,0x67,0xe4,0x41,0xea,0x58,0x00,0x01,0x3e,0x67,0xe4, +0x41,0xf2,0x20,0x40,0x4d,0xaf,0x20,0x40,0x4d,0xbc,0x20,0x40,0x4c,0x2a,0x20,0x40, +0x50,0x4d,0x20,0x20,0x04,0xe9,0x1a,0x62,0x7e,0x00,0xc0,0x00,0x80,0xc3,0xc0,0x04, +0x80,0xd4,0xc0,0x01,0x00,0xc7,0xc0,0x02,0x80,0xd9,0xc0,0x02,0x00,0xdb,0xc0,0x09, +0x80,0xdb,0xc0,0x0c,0x00,0xff,0xc0,0x30,0x00,0xdf,0xc0,0x2c,0x80,0xe1,0xc0,0x2c, +0x00,0xe8,0xc0,0x0a,0x00,0xea,0xc0,0x0a,0x80,0xfb,0xc0,0x1e,0x80,0xfe,0x20,0x20, +0x4d,0xdf,0x70,0x4c,0xf3,0x00,0x20,0x40,0x4d,0x6b,0x20,0x40,0x4d,0x62,0x20,0x20, +0x4e,0x2c,0x20,0x40,0x04,0xe9,0x70,0x4a,0xd0,0x00,0x20,0x40,0x4d,0xd7,0x6f,0xe2, +0x46,0x37,0x24,0x5a,0x50,0x8c,0x20,0x40,0x00,0xf7,0x6f,0xe4,0x46,0x52,0xc3,0x02, +0x00,0xd2,0x79,0x3f,0xfe,0x04,0x67,0xe4,0x46,0x52,0x20,0x20,0x50,0x26,0x70,0x4c, +0xf3,0x14,0x20,0x60,0x00,0x00,0x6f,0xe2,0x4a,0xcf,0x24,0x5a,0x00,0xd7,0x20,0x60, +0x00,0x00,0x70,0x4a,0xd0,0x06,0x20,0x60,0x00,0x00,0x20,0x40,0x4d,0xd7,0x20,0x20, +0x00,0xf3,0x20,0x40,0x00,0xf7,0x20,0x20,0x00,0xdd,0x70,0x0a,0xff,0xb1,0x20,0x20, +0x50,0x4e,0x70,0x0a,0xff,0xb2,0x20,0x20,0x50,0x4e,0x70,0x0a,0xff,0xb3,0x6f,0xe2, +0x4c,0xbb,0x20,0x40,0x50,0xa5,0x6f,0x22,0x4c,0xbb,0xd8,0x60,0x4c,0xbc,0x20,0x40, +0x50,0x16,0x20,0x20,0x67,0xb9,0x70,0x0a,0xff,0xb4,0x20,0x20,0x50,0x4e,0x20,0x40, +0x03,0x73,0x20,0x40,0x00,0xef,0x6f,0xe2,0x46,0x6e,0x67,0xe2,0x41,0x73,0x20,0x20, +0x50,0x24,0x6f,0xe2,0x46,0x6c,0x2f,0xef,0xfe,0x01,0x20,0x40,0xcd,0x73,0x20,0x60, +0x00,0x00,0x6f,0xe2,0x46,0x6c,0x2f,0xef,0xfe,0x00,0x20,0x40,0xcd,0x6b,0x20,0x60, +0x00,0x00,0x6f,0xe2,0x46,0x6c,0x2f,0xef,0xfe,0x00,0x20,0x40,0xcd,0x69,0x20,0x60, +0x00,0x00,0x20,0x40,0x5b,0xf6,0x20,0x40,0x4e,0x95,0x20,0x20,0x50,0x28,0x20,0x60, +0x00,0x00,0x70,0x0a,0xff,0xb0,0x58,0x00,0x00,0x1c,0x20,0x40,0x50,0xa5,0x6f,0xec, +0x40,0xa0,0xe7,0xec,0x00,0x0a,0x6f,0xec,0x00,0x40,0xe7,0xec,0x00,0x0a,0xd8,0xc0, +0x41,0xbf,0xdf,0x20,0x00,0x10,0x20,0x40,0x67,0xd4,0x20,0x20,0x67,0xb9,0x20,0x40, +0x01,0x19,0x20,0x40,0x01,0x11,0x20,0x40,0x01,0x0e,0x20,0x20,0x50,0xc3,0xda,0x60, +0x4c,0xf3,0xda,0x40,0x4d,0x5c,0x20,0x20,0x4d,0x04,0x6f,0xe2,0x4a,0xd0,0x20,0x7a, +0x00,0x00,0x1f,0xe0,0xff,0xff,0x67,0xe2,0x4a,0xd0,0x24,0x7a,0x00,0x00,0x6f,0xe4, +0x46,0x52,0xc2,0x80,0x4d,0x64,0x20,0x60,0x00,0x00,0x6f,0xe8,0x4b,0xee,0x20,0x7a, +0x00,0x00,0x1f,0xe0,0xff,0xff,0x67,0xe8,0x4b,0xee,0x24,0x7a,0x00,0x00,0x20,0x20, +0x00,0x3d,0x20,0x40,0x04,0x63,0x20,0x74,0x00,0x00,0x1a,0x22,0x7e,0x00,0x67,0xe4, +0x46,0x71,0x20,0x40,0x01,0x2c,0x67,0xe2,0x46,0x70,0x68,0x44,0x04,0x74,0x60,0x44, +0x46,0x73,0x20,0x40,0x5b,0x6c,0x24,0x3a,0x4a,0x8b,0x6f,0xe2,0x04,0x9e,0xc0,0x81, +0x50,0x42,0x20,0x20,0x50,0x42,0x6f,0xe2,0x4b,0xed,0x24,0x3a,0x01,0x30,0x1f,0x22, +0x7e,0x00,0x20,0x60,0x00,0x00,0x1a,0x42,0x7e,0x00,0x20,0x60,0x00,0x00,0x20,0x40, +0x02,0x99,0x24,0x34,0x01,0x3b,0x6f,0xe2,0x4f,0xef,0xc0,0x00,0x81,0x3b,0x6f,0xe2, +0x44,0x96,0xc0,0x80,0x01,0x39,0x20,0x20,0x4d,0x4d,0xc0,0x7f,0xcd,0x4d,0x20,0x20, +0x01,0x3b,0x20,0x40,0x00,0x40,0x20,0x40,0x67,0xbc,0x20,0x20,0x4d,0x4b,0x20,0x40, +0x01,0x40,0x20,0x20,0x50,0xd3,0x20,0x20,0x4d,0xc7,0x6f,0xe2,0x0a,0xff,0xc0,0x13, +0x81,0xb9,0xc0,0x06,0x01,0x68,0xc0,0x3b,0x01,0x71,0xc0,0x3b,0x81,0x77,0xc0,0x3c, +0x01,0x7c,0xc0,0x0a,0x81,0xb6,0xc0,0x20,0x01,0xba,0xc0,0x7f,0x81,0x65,0xc0,0x3c, +0x81,0xc7,0xc0,0x58,0x81,0xca,0xc0,0x01,0x01,0x4e,0x20,0x20,0x4e,0x5c,0x6f,0xe2, +0x0b,0x00,0xc0,0x80,0xd0,0x1c,0x1a,0x22,0x06,0x00,0x20,0x40,0x50,0x1f,0xe8,0x42, +0x00,0x03,0x60,0x42,0x46,0x6f,0x6f,0xe2,0x46,0x6c,0x2f,0xef,0xfe,0x00,0x24,0x20, +0x81,0x5c,0x6f,0xe4,0x46,0x52,0xc2,0x80,0x01,0x5c,0x68,0x42,0x46,0x6f,0x18,0x41, +0x7e,0x03,0x67,0xe2,0x40,0x93,0x6f,0xe2,0x46,0x6c,0x2f,0xef,0xfe,0x01,0x24,0x60, +0x80,0x00,0x6f,0xe4,0x46,0x52,0xc3,0x84,0x80,0x00,0x68,0x42,0x46,0x6f,0x28,0x4f, +0xfe,0x02,0x20,0x20,0xcd,0x75,0x20,0x20,0x4d,0x73,0xef,0xe2,0x00,0x03,0x67,0xe2, +0x40,0x91,0x20,0x60,0x00,0x00,0x1a,0x22,0x06,0x00,0xef,0xe2,0x00,0x03,0xc0,0x00, +0x4f,0x1c,0xc0,0x00,0xcf,0x1f,0xc0,0x01,0x4f,0x25,0xc0,0x01,0x81,0x6f,0x20,0x20, +0x50,0x1c,0x58,0x00,0x00,0x01,0x20,0x20,0x4f,0x20,0xd8,0x40,0x00,0x0c,0x20,0x40, +0x5b,0x4d,0x18,0xc0,0x8b,0xfe,0x58,0x00,0x00,0x00,0xe7,0xe4,0x00,0x05,0x20,0x20, +0x50,0x1f,0x20,0x40,0x01,0x80,0x20,0x40,0x01,0x9d,0x58,0x00,0x00,0x00,0xe7,0xe4, +0x00,0x05,0x20,0x20,0x01,0xaf,0xef,0xe2,0x00,0x03,0x20,0x40,0x01,0x84,0x20,0x40, +0x01,0x8b,0x20,0x20,0x01,0xaf,0x20,0x40,0x01,0xa1,0x58,0x28,0x00,0x02,0xe7,0xe6, +0x00,0x05,0x20,0x60,0x00,0x00,0x67,0xe2,0x0a,0x96,0x20,0x40,0x01,0xa1,0x59,0x28, +0x03,0x02,0xe7,0xe8,0x00,0x05,0x6f,0xe2,0x0a,0x96,0xe7,0xe6,0x00,0x05,0x20,0x60, +0x00,0x00,0x20,0x40,0x01,0xa1,0x20,0x40,0x01,0x9d,0x20,0x40,0x01,0x9d,0x58,0x00, +0x00,0x00,0xe7,0xe4,0x00,0x05,0x18,0x40,0x85,0xff,0x20,0x40,0x5b,0x4d,0x18,0xc0, +0x8c,0x04,0xef,0xe2,0x00,0x06,0xc2,0x82,0x01,0x98,0xc2,0x82,0x81,0x98,0x18,0x40, +0x84,0x01,0x20,0x60,0x00,0x00,0x20,0x40,0x01,0xa1,0x5a,0x29,0x02,0x02,0xe7,0xf0, +0x00,0x05,0x18,0x40,0x85,0xff,0x20,0x60,0x00,0x00,0xef,0xe2,0x00,0x03,0x1f,0xe2, +0x72,0x00,0xe7,0xe2,0x00,0x05,0x20,0x20,0x67,0xed,0x20,0x40,0x01,0xa4,0xe0,0x44, +0x00,0x05,0x20,0x60,0x00,0x00,0x6f,0xe4,0x44,0x8e,0x98,0x00,0x0c,0x00,0xef,0xe4, +0x00,0x06,0x20,0x7a,0x00,0x00,0x1f,0xe0,0x84,0x01,0xef,0xe2,0x00,0x06,0x98,0xc0, +0x8c,0x00,0xef,0xe2,0x00,0x06,0x98,0xc0,0x8c,0x00,0x18,0xc2,0x0a,0x00,0x20,0x20, +0x01,0xa6,0x60,0x44,0x0a,0x9e,0x70,0x0a,0xff,0x29,0x58,0x00,0x00,0x02,0x20,0x40, +0x50,0xa5,0x68,0x44,0x0a,0x9e,0xe0,0x44,0x00,0x0a,0x20,0x20,0x67,0xb9,0xef,0xe6, +0x00,0x03,0x67,0xe6,0x40,0xaa,0x20,0x20,0x50,0x1f,0x20,0x20,0x4d,0x85,0xef,0xe2, +0x00,0x03,0x68,0x48,0x41,0x79,0x79,0x3a,0x04,0x10,0x79,0x3a,0x04,0x18,0x60,0x48, +0x41,0x79,0x68,0x42,0x41,0x57,0x79,0x3a,0x04,0x00,0x60,0x42,0x41,0x57,0xef,0xec, +0x00,0x03,0x67,0xec,0x00,0xa1,0x67,0xec,0x4b,0xf2,0x20,0x40,0x4b,0xe3,0x20,0x20, +0x50,0x1f,0xef,0xe8,0x00,0x03,0x67,0xe8,0x4b,0xee,0x20,0x20,0x50,0x1f,0xef,0xec, +0x00,0x03,0x67,0xec,0x40,0xa0,0xef,0xec,0x00,0x03,0x67,0xec,0x41,0xd1,0xd8,0xa0, +0x41,0xbf,0xdf,0x20,0x00,0x10,0x20,0x40,0x67,0xed,0x20,0x40,0x68,0xbe,0x20,0x40, +0x4d,0x5c,0x20,0x20,0x50,0x1f,0x6f,0xe2,0x46,0x79,0xc2,0x81,0x82,0xab,0x6f,0xe2, +0x46,0x79,0xc3,0x83,0x80,0x00,0x6f,0xe4,0x44,0x78,0x20,0x40,0x7d,0xb5,0x1f,0xe2, +0x04,0x00,0x18,0x40,0xff,0xfd,0xd8,0x40,0x00,0xc8,0x20,0x40,0x7d,0xb5,0x68,0x42, +0x46,0x7a,0x20,0x40,0x7d,0xb5,0x1f,0xe2,0x22,0x00,0x18,0x42,0x7e,0x00,0x9a,0x26, +0x7e,0x00,0x67,0xe2,0x46,0x7a,0x68,0x44,0x46,0x7b,0x18,0x40,0x85,0xff,0x20,0x40, +0x5b,0x4d,0x20,0x3a,0x01,0xf4,0xe8,0x48,0x00,0x06,0x59,0x28,0x03,0x02,0x98,0x46, +0x7c,0x00,0x24,0x22,0x81,0xf4,0xef,0xe2,0x00,0x06,0xc2,0x82,0x81,0xf0,0xc2,0x82, +0x4f,0x01,0x20,0x20,0x01,0xf4,0x20,0x40,0x03,0x75,0x68,0x44,0x46,0x7b,0x20,0x40, +0x5e,0x4d,0x20,0x20,0x4f,0x03,0x70,0x46,0x7a,0x00,0x70,0x0b,0x01,0x01,0x20,0x40, +0x50,0xe0,0x20,0x20,0x50,0x1c,0x6f,0xe2,0x4b,0xed,0x24,0x3a,0x57,0x09,0x20,0x40, +0x57,0x09,0x70,0x4a,0xdb,0x01,0x70,0x4a,0xdc,0x00,0x58,0x00,0x00,0x00,0x67,0xf0, +0x4a,0xd1,0x58,0x00,0x00,0x1b,0x67,0xe4,0x4a,0xd9,0x20,0x60,0x00,0x00,0x20,0x40, +0x49,0xba,0x78,0x23,0xfc,0x00,0x78,0x24,0xfc,0x00,0x09,0x80,0x00,0x08,0x19,0x89, +0x7e,0x00,0x67,0xe2,0x02,0xd5,0x09,0x80,0x00,0x08,0x19,0x89,0x7e,0x00,0xe7,0xe2, +0x00,0x05,0x1f,0xe2,0x72,0x00,0x20,0x3a,0x58,0x8b,0x20,0x20,0x58,0x87,0x20,0x40, +0x58,0xa3,0x20,0x40,0x49,0x15,0x68,0x42,0x00,0x17,0x20,0x40,0x49,0x1c,0x20,0x00, +0x05,0xdc,0x20,0x40,0x49,0x21,0x78,0x28,0x7c,0x00,0xd9,0x60,0x15,0x7c,0x20,0x20, +0x58,0x69,0x20,0x40,0x57,0xaf,0x20,0x40,0x02,0x1a,0x20,0x20,0x58,0xa7,0x20,0x36, +0x80,0x99,0x20,0x20,0x57,0xbe,0x6f,0xe2,0x4b,0xed,0x24,0x3a,0x58,0xb3,0x6f,0xe2, +0x4a,0xdb,0x08,0x00,0x86,0x08,0xef,0xe2,0x00,0x06,0x1f,0xe2,0x72,0x00,0x08,0x00, +0x86,0x08,0x20,0x22,0xd8,0xbc,0x20,0x20,0x58,0xb9,0x6f,0xe2,0x4b,0xed,0x24,0x3a, +0x58,0xc4,0x6f,0xe2,0x44,0x56,0xc0,0x00,0xd8,0xd3,0x6f,0xe2,0x44,0x57,0x1f,0xf2, +0x7e,0x00,0x1f,0xeb,0xfe,0x00,0x67,0xe2,0x4a,0xdb,0x68,0x42,0x43,0x41,0x18,0x40, +0xfe,0x06,0x67,0xe2,0x4a,0xdc,0x6f,0xec,0x44,0x72,0x67,0xec,0x4a,0xdd,0x18,0x42, +0x72,0x00,0xd8,0xc0,0x43,0x42,0x20,0x40,0x7c,0xcf,0x20,0x20,0x58,0xde,0x6f,0xe2, +0x4b,0xed,0x24,0x3a,0x58,0xf7,0xd8,0x40,0x00,0x04,0x6f,0xe2,0x44,0x57,0x7d,0x3a, +0x04,0x06,0x60,0x42,0x4a,0xdb,0x68,0x42,0x43,0x61,0x18,0x40,0xfe,0x06,0x67,0xe2, +0x4a,0xdc,0x6f,0xec,0x44,0x72,0x67,0xec,0x4a,0xdd,0xd8,0xc0,0x43,0x62,0x18,0x42, +0x72,0x00,0x20,0x40,0x7c,0xcf,0x20,0x40,0x58,0xa1,0x20,0x20,0x5a,0xe2,0x20,0x40, +0x5a,0xc9,0x20,0x40,0x59,0x9a,0x6f,0xe2,0x02,0xd5,0x2f,0xef,0xfe,0x04,0x79,0x20, +0x80,0x2a,0x1f,0xe3,0x7e,0x00,0x98,0x42,0xfe,0x00,0x2f,0xef,0xfe,0x02,0x79,0x20, +0x80,0x0f,0xc6,0x07,0x80,0x00,0x6f,0xe2,0x02,0xd6,0x20,0x3a,0x02,0x58,0x6f,0xe2, +0x04,0x3b,0xc3,0x02,0x02,0x58,0x20,0x40,0x73,0x42,0x20,0x40,0x72,0xb2,0x7d,0x3a, +0x00,0x0f,0x24,0x7a,0x00,0x00,0x68,0x42,0x04,0x52,0x79,0x40,0x04,0x02,0x60,0x42, +0x04,0x52,0x6f,0xe2,0x4b,0xed,0x24,0x7a,0x00,0x00,0x20,0x20,0x02,0x5e,0x6f,0xe2, +0x02,0xd6,0x20,0x7a,0x00,0x00,0x6f,0xe2,0x02,0xd5,0x2f,0xe0,0x06,0x01,0x20,0x20, +0x82,0x86,0x2f,0xe0,0x06,0x02,0x20,0x20,0x82,0x66,0x20,0x60,0x00,0x00,0x6f,0xe4, +0x02,0xd9,0xc1,0x82,0x00,0x00,0xef,0xe6,0x00,0x06,0x67,0xe6,0x04,0x73,0x79,0x20, +0x00,0x0f,0xc0,0x09,0x02,0x7a,0xc0,0x29,0x02,0x7c,0xc0,0x0b,0x02,0x73,0xc0,0x0c, +0x5e,0x3b,0xc0,0x01,0x03,0x77,0xc0,0x0f,0x03,0x73,0x79,0x3f,0x80,0x0f,0x20,0x60, +0x00,0x00,0x58,0x00,0x0b,0x1e,0x67,0xe4,0x4a,0xd5,0x20,0x40,0x02,0x7f,0x1f,0x20, +0xf3,0xfe,0xda,0x20,0x02,0xe0,0x20,0x40,0x5a,0xbe,0x20,0x20,0x02,0x9f,0x20,0x40, +0x02,0x7c,0x20,0x20,0x02,0x96,0x20,0x40,0x02,0x7f,0xda,0x20,0x02,0xde,0x20,0x20, +0x5a,0xbe,0x6f,0xe2,0x02,0xd6,0x1f,0xe0,0xf3,0xf9,0x1f,0xe0,0xff,0xfc,0x67,0xe4, +0x4a,0xd1,0xe8,0x44,0x00,0x06,0x60,0x44,0x4a,0xd3,0x20,0x60,0x00,0x00,0x79,0x20, +0x00,0x0f,0x20,0x40,0x02,0x8e,0x6f,0xe2,0x04,0x73,0xc0,0x09,0x02,0x96,0xc0,0x0b, +0x02,0x95,0xc1,0x29,0x00,0x00,0x79,0x3f,0x80,0x0f,0x20,0x60,0x00,0x00,0x6f,0xe2, +0x02,0xd6,0x68,0x44,0x4a,0xd1,0x98,0x40,0x84,0x00,0x60,0x44,0x4a,0xd1,0x1f,0xe2, +0x72,0x00,0xda,0x20,0x02,0xd7,0x20,0x20,0x5a,0xbe,0x20,0x20,0x02,0x9f,0x20,0x40, +0x02,0x99,0x24,0x74,0x00,0x00,0x20,0x20,0x04,0x75,0x20,0x40,0x7d,0xc1,0x6f,0xe4, +0x4a,0xd3,0x68,0x44,0x4a,0xd1,0x98,0x46,0x7c,0x00,0x24,0x62,0x80,0x00,0x20,0x20, +0x7d,0xbf,0x6f,0xe4,0x4a,0xd5,0x1f,0xe2,0x0a,0x00,0x6f,0xe2,0x02,0xd6,0x1f,0xe2, +0x72,0x00,0x20,0x40,0x7c,0xdc,0x18,0xa2,0x7e,0x00,0x67,0xe4,0x4a,0xd5,0x20,0x40, +0x02,0x99,0x24,0x74,0x00,0x00,0xd8,0xe0,0x00,0x03,0x20,0x40,0x50,0xe6,0x20,0x20, +0x02,0xab,0x20,0x40,0x5c,0x74,0x24,0x7a,0x00,0x00,0x70,0x0b,0x22,0x17,0x58,0x00, +0x0b,0x1e,0x67,0xe4,0x4a,0xd7,0x68,0x44,0x0b,0x1e,0x18,0x40,0x84,0x04,0x58,0x00, +0x00,0xf9,0x20,0x40,0x7d,0xb5,0x1f,0xe0,0xa5,0xfc,0x18,0x00,0x02,0x02,0x1f,0xe2, +0x22,0x00,0x20,0x40,0x5c,0x32,0x6f,0xe4,0x4a,0xd7,0x1f,0xe2,0x0c,0x00,0x1a,0x22, +0x72,0x00,0x20,0x40,0x7c,0xcf,0x18,0xc2,0x7e,0x00,0x67,0xe4,0x4a,0xd7,0x6f,0xe4, +0x0b,0x1e,0x9a,0x46,0x7e,0x00,0x67,0xe4,0x0b,0x1e,0x20,0x3a,0x02,0xc7,0xd8,0x40, +0x00,0xf9,0x20,0x40,0x7d,0xb5,0x1f,0xe2,0x24,0x00,0x18,0x00,0x02,0x01,0x20,0x20, +0x02,0xb6,0x58,0x00,0x00,0x00,0x67,0xe4,0x4a,0xd5,0xd8,0xe0,0x00,0x03,0x20,0x20, +0x50,0xe2,0x6f,0xe2,0x4b,0xed,0x24,0x3a,0x59,0x9b,0x68,0x42,0x04,0x52,0x28,0x4c, +0x00,0x05,0x20,0x60,0x80,0x00,0x6f,0xe2,0x02,0xd5,0x1f,0xe3,0xfe,0x00,0x98,0x42, +0xfe,0x00,0xc4,0x01,0x80,0x00,0x79,0x3f,0x84,0x05,0x79,0x40,0x04,0x03,0x60,0x42, +0x04,0x52,0x28,0x40,0x06,0x03,0x24,0x60,0x80,0x00,0x6f,0xe2,0x4a,0xdd,0xc0,0x02, +0xd9,0xac,0x6f,0xe2,0x44,0x97,0xc0,0x01,0x59,0xb0,0x20,0x60,0x00,0x00,0x6f,0xe2, +0x4b,0xed,0x24,0x3a,0x59,0xf9,0x6f,0xe2,0x04,0x52,0xc3,0x82,0x80,0x00,0x20,0x40, +0x5a,0x1c,0x20,0x40,0x5c,0x53,0x20,0x3a,0x5a,0x3e,0xef,0xe2,0x00,0x06,0xe8,0x42, +0x00,0x06,0x18,0x42,0x22,0x00,0x9a,0x26,0x7e,0x00,0x20,0x40,0x03,0x03,0x20,0x40, +0x7d,0xb5,0x1f,0xe2,0x04,0x00,0xef,0xe2,0x00,0x06,0x1f,0xe2,0x02,0x00,0x1a,0x22, +0x7e,0x00,0x98,0xc0,0x8c,0x00,0xd8,0xa0,0x4a,0xdd,0x18,0x42,0x72,0x00,0x20,0x40, +0x7c,0xcf,0x20,0x40,0x5a,0x2e,0x20,0x40,0x5a,0x40,0x20,0x40,0x5c,0x53,0xef,0xe2, +0x00,0x06,0x1f,0xe2,0x22,0x00,0x18,0xc2,0x26,0x00,0xe8,0x42,0x00,0x06,0x18,0x42, +0x24,0x00,0x9a,0x46,0x7e,0x00,0x20,0x40,0x03,0x03,0x20,0x40,0x7d,0xb5,0x9a,0x40, +0xfe,0x00,0xe7,0xe2,0x00,0x13,0x9a,0x26,0x7c,0x00,0x24,0x62,0x80,0x00,0x20,0x20, +0x5c,0x76,0x18,0xc2,0x0a,0x00,0x68,0x44,0x4a,0xd9,0x18,0xa2,0x0c,0x00,0x20,0x60, +0x00,0x00,0x6f,0xe2,0x4b,0xed,0x24,0x3a,0x5a,0x41,0x60,0x42,0x4a,0xdc,0x68,0x42, +0x04,0x52,0x79,0x20,0x04,0x05,0x18,0x41,0x7e,0xfc,0x98,0x21,0xfe,0x00,0x67,0xe2, +0x04,0x52,0x1f,0xe1,0x7e,0x1f,0x28,0x0f,0xfe,0x29,0x79,0x20,0xfe,0x04,0x67,0xe2, +0x4a,0xdb,0x6f,0xe2,0x4a,0xdb,0x28,0x20,0x06,0x01,0x24,0x20,0x83,0x18,0x6f,0xe2, +0x4a,0xdc,0x20,0x7a,0x00,0x00,0x6f,0xe2,0x04,0x3b,0xc4,0x02,0x00,0x00,0x20,0x40, +0x73,0x42,0x20,0x20,0x72,0x99,0x6f,0xe2,0x4b,0xed,0x24,0x3a,0x72,0x9a,0xda,0x60, +0x4a,0xdb,0x68,0x4a,0x43,0xd5,0x20,0x40,0x72,0x77,0x18,0x00,0x70,0x08,0x98,0x00, +0x5e,0x00,0x18,0x00,0x22,0x00,0x20,0x40,0x72,0x63,0x20,0x40,0x72,0xe8,0xda,0x60, +0x4a,0xdd,0x6f,0xe2,0x4a,0xdc,0x1f,0xe0,0xa5,0xff,0x9a,0x60,0x8a,0x00,0x18,0x00, +0x70,0x0c,0x1d,0xe2,0x7e,0x00,0xe7,0xe8,0x00,0x05,0x20,0x40,0x72,0x8e,0x6f,0xe2, +0x4a,0xdc,0x1f,0xe0,0xfe,0x04,0x67,0xe2,0x4a,0xdc,0x68,0x4a,0x43,0xd5,0x18,0x40, +0x84,0x01,0x60,0x4a,0x43,0xd5,0x20,0x60,0x00,0x00,0xc6,0x07,0x80,0x00,0x20,0x40, +0x5c,0x70,0x24,0x7a,0x00,0x00,0x6f,0xe2,0x02,0xd5,0x1f,0xe1,0x7e,0x03,0x67,0xe2, +0x44,0xde,0xef,0xe2,0x00,0x06,0x67,0xe2,0x44,0xdd,0x20,0x7a,0x00,0x00,0x18,0xc2, +0x7e,0x00,0x67,0xe4,0x44,0xdf,0x6f,0xe2,0x44,0xde,0xc0,0x01,0x83,0x47,0x20,0x40, +0x5a,0x76,0xd8,0xe0,0x00,0x03,0x24,0x34,0x4b,0xec,0x20,0x40,0x4b,0xf0,0x20,0x20, +0x5a,0x6b,0x6f,0xe2,0x4b,0xed,0x24,0x3a,0x60,0x44,0x6f,0xe2,0x02,0xd7,0xc0,0x04, +0x03,0x4d,0xc0,0x0a,0x03,0x5a,0x20,0x20,0x60,0x45,0xda,0x20,0x00,0x09,0xda,0x40, +0x00,0x09,0x20,0x40,0x5c,0x22,0x58,0x00,0x00,0x21,0xe7,0xf0,0x00,0x05,0x20,0x40, +0x03,0x54,0x20,0x60,0x00,0x00,0x6f,0xe2,0x02,0xd8,0x1f,0xe1,0x7e,0x20,0x20,0x3a, +0x03,0x58,0x20,0x60,0x00,0x00,0x70,0x4b,0xed,0x01,0x20,0x60,0x00,0x00,0xef,0xe4, +0x00,0x06,0x67,0xe4,0x4a,0xd9,0x20,0x20,0x03,0x5d,0xda,0x20,0x00,0x09,0xda,0x40, +0x00,0x15,0x20,0x40,0x5c,0x22,0x58,0x00,0x00,0xfb,0xe7,0xe4,0x00,0x05,0x58,0x00, +0x08,0x48,0xe7,0xe4,0x00,0x05,0x58,0x00,0x00,0xfb,0xe7,0xe4,0x00,0x05,0x58,0x00, +0x08,0x48,0xe7,0xe4,0x00,0x05,0x20,0x60,0x00,0x00,0xef,0xe4,0x00,0x06,0xc0,0x02, +0x03,0x6e,0xc0,0x03,0x5e,0xd4,0xc0,0x02,0xde,0x96,0x20,0x60,0x00,0x00,0xef,0xe6, +0x00,0x06,0x67,0xe6,0x04,0x73,0xc0,0x05,0x04,0x66,0xc0,0x09,0x04,0x71,0x20,0x20, +0x5c,0x8d,0xd8,0xe0,0x00,0x07,0x20,0x20,0x50,0xe2,0xd8,0xe0,0x00,0x07,0x20,0x20, +0x50,0xe6,0x20,0x40,0x5c,0xa9,0x67,0xe4,0x44,0x78,0x20,0x20,0x5c,0xa2,0x20,0x40, +0x5b,0x86,0xda,0x60,0x43,0x81,0xda,0x20,0x43,0x62,0x20,0x20,0x5b,0xa5,0x6f,0xe2, +0x4b,0xed,0x24,0x3a,0x5b,0xd5,0x78,0x55,0xfc,0x00,0x20,0x37,0x03,0x83,0x24,0x36, +0xdb,0xe6,0x20,0x40,0x4b,0xa0,0x6f,0xe4,0x40,0xc1,0x67,0xe4,0x04,0x49,0x24,0x36, +0xcb,0xb3,0xc5,0x07,0xcb,0xb3,0x6f,0xe2,0x44,0xdd,0x24,0x3a,0x4b,0xb3,0x6f,0xe2, +0x4a,0xdc,0x24,0x3a,0x4b,0xb3,0x6f,0xe2,0x44,0xbb,0xc2,0x82,0xcb,0xb3,0x6f,0xe2, +0x04,0x3b,0xc2,0x82,0xcb,0xb3,0x20,0x20,0x4b,0x95,0x6f,0xe2,0x00,0x7d,0xc0,0x08, +0x03,0x95,0xc0,0x0b,0x83,0x9b,0x20,0x20,0x60,0xfe,0x68,0x42,0x05,0x4e,0x18,0x46, +0x7c,0x06,0x20,0x21,0x03,0x99,0x20,0x20,0x62,0x06,0x70,0x00,0x7e,0x24,0x20,0x20, +0x61,0x34,0x20,0x20,0x62,0xb8,0x78,0x54,0x7c,0x00,0x20,0x40,0x66,0xa3,0x6f,0xe2, +0x00,0x48,0x20,0x7a,0x00,0x00,0xc2,0x83,0x83,0xa2,0x20,0x20,0x63,0xf2,0xc0,0x42, +0x03,0xa5,0xc0,0x41,0x83,0xa8,0x20,0x20,0x64,0x21,0x20,0x40,0x03,0xab,0x6f,0xe2, +0x00,0x48,0x20,0x20,0x64,0x7b,0x20,0x40,0x03,0xab,0x6f,0xe2,0x00,0x48,0x20,0x20, +0x64,0xef,0x6f,0xe2,0x46,0x2c,0x20,0x3a,0x65,0x0d,0x20,0x20,0x65,0x06,0x6f,0xe2, +0x40,0x9e,0x79,0x3f,0xfe,0x03,0x67,0xe2,0x40,0x9e,0x58,0x00,0x00,0x01,0x67,0xe4, +0x04,0xca,0x20,0x60,0x00,0x00,0x19,0x42,0x7e,0x00,0x67,0xe4,0x4f,0xf6,0x70,0x40, +0x91,0x00,0x20,0x40,0x00,0x40,0x6f,0xe2,0x80,0x43,0xc3,0x83,0x80,0x00,0x79,0x20, +0x7e,0x07,0x67,0xe2,0x80,0x43,0x20,0x60,0x00,0x00,0x6f,0xe2,0x04,0xf9,0xc0,0x77, +0x83,0xc0,0x20,0x20,0x69,0x57,0x6f,0xe4,0x04,0xfd,0x1f,0xe2,0x0c,0x00,0x20,0x40, +0x69,0x84,0x6f,0xe2,0x04,0xff,0xc0,0x38,0x03,0xc6,0x20,0x20,0x69,0x60,0x70,0x0a, +0x95,0x08,0x20,0x40,0x7b,0xab,0x20,0x40,0x69,0x72,0x20,0x20,0x69,0xba,0x6f,0xe2, +0x04,0xf9,0xc0,0x77,0x83,0xcd,0x20,0x20,0x6a,0x15,0x6f,0xe4,0x04,0xfd,0x1f,0xe2, +0x0c,0x00,0x20,0x40,0x69,0x84,0x6f,0xe2,0x04,0xff,0xc0,0x38,0x03,0xd3,0x20,0x20, +0x6a,0x1d,0x70,0x0a,0x95,0x08,0x20,0x40,0x7b,0xab,0x20,0x40,0x69,0x72,0x20,0x20, +0x6a,0x43,0x6f,0xe2,0x44,0x90,0x20,0x3a,0x5e,0xd0,0x20,0x40,0x74,0x38,0x20,0x20, +0x79,0x32,0x20,0x40,0x42,0x5a,0x24,0x22,0x83,0xe3,0x20,0x40,0x42,0x06,0x1a,0x20, +0x8c,0x01,0xef,0xe2,0x00,0x06,0xc2,0x80,0x57,0x3a,0xc2,0x80,0xc1,0x62,0x20,0x20, +0x43,0xcb,0x20,0x40,0x03,0xe5,0x20,0x20,0x40,0x2c,0xdf,0x20,0x00,0x02,0x68,0x42, +0x00,0x15,0x18,0x40,0x84,0x01,0x28,0x41,0xfe,0x02,0x24,0x20,0x83,0xeb,0xd8,0x40, +0x00,0x00,0x60,0x42,0x00,0x15,0x18,0x4f,0xfe,0x50,0xda,0x20,0x4b,0xf8,0x9a,0x20, +0xa2,0x00,0xef,0xe2,0x00,0x11,0xc2,0x80,0x83,0xf3,0xc3,0x80,0x00,0x00,0xc3,0x81, +0x80,0x00,0xc2,0x00,0x03,0xe7,0x20,0x60,0x00,0x00,0xda,0x60,0x03,0xf7,0x20,0x20, +0x42,0x39,0xc2,0x80,0x42,0x62,0x18,0x00,0x7c,0x00,0x20,0x60,0x00,0x00,0xda,0x20, +0x4b,0xf8,0xdf,0x20,0x00,0x02,0x20,0x20,0x42,0x60,0x6f,0xe2,0x00,0x30,0x79,0x3f, +0xfe,0x03,0x67,0xe2,0x00,0x30,0x70,0x46,0x51,0x00,0x20,0x20,0x43,0xc5,0x78,0x48, +0x7c,0x00,0x18,0x42,0x36,0x00,0x20,0x40,0x04,0x0a,0x78,0x54,0x7c,0x00,0x24,0x62, +0x80,0x00,0x18,0x00,0x36,0x00,0x78,0x34,0x7c,0x00,0x20,0x60,0x00,0x00,0xda,0x60, +0x04,0x0c,0x20,0x20,0x42,0x5d,0x1f,0xe2,0x04,0x00,0x1a,0x20,0x8c,0x01,0xef,0xe2, +0x00,0x06,0x1a,0x22,0x0c,0x00,0xc2,0x80,0x42,0x62,0x18,0x42,0x7e,0x00,0x20,0x20, +0x42,0xc2,0x58,0x00,0x00,0x00,0x1c,0xe2,0x7c,0x00,0x20,0x22,0x84,0x1d,0x6f,0xe2, +0x81,0x24,0x68,0x42,0x81,0x25,0x98,0x46,0x7c,0x00,0x20,0x21,0x04,0x1b,0x18,0x42, +0x7e,0x00,0x9c,0xe6,0x7e,0x00,0x1f,0xe0,0xfe,0x01,0x1f,0xe0,0xfe,0x08,0x37,0xd9, +0x82,0x00,0x9e,0x20,0xfe,0x00,0x68,0x48,0x41,0x5c,0x98,0x40,0xfe,0x00,0x68,0x46, +0x41,0x70,0x98,0x4f,0xfe,0x00,0x1f,0xec,0xfe,0x00,0x1f,0xf1,0xfe,0x00,0x1f,0xe0, +0xfe,0x6e,0xd8,0x40,0x0e,0xa6,0x98,0x46,0xfc,0x00,0x20,0x40,0x7d,0x61,0x18,0x07, +0xfe,0x00,0x1f,0xf0,0x7e,0x00,0x18,0x07,0x04,0x00,0x98,0x41,0xfe,0x00,0x68,0x4c, +0x41,0x64,0x20,0x40,0x7d,0x07,0x18,0x42,0x32,0x00,0x6f,0xec,0x4c,0x00,0x20,0x40, +0x48,0x50,0x20,0x60,0x00,0x00,0x20,0x40,0x4a,0xd8,0x6f,0xe6,0x41,0x70,0x20,0x7a, +0x00,0x00,0x6f,0xe2,0x40,0x91,0x20,0x7a,0x00,0x00,0x6f,0xe2,0x46,0x2c,0x20,0x3a, +0x04,0x3d,0x6f,0xe2,0x45,0x83,0x20,0x7a,0x00,0x00,0x6f,0xe2,0x44,0x92,0x24,0x7a, +0x00,0x00,0x20,0x40,0x4b,0xf4,0x24,0x7a,0x00,0x00,0x6f,0xe2,0x4b,0xf8,0x2f,0xe0, +0x0e,0x03,0x24,0x20,0xcb,0x72,0x6f,0xe4,0x4b,0xfa,0x20,0x7a,0x00,0x00,0x20,0x75, +0x80,0x00,0x68,0x42,0x00,0xa0,0x6f,0xe4,0x4b,0xfa,0x98,0x4f,0xfe,0x00,0x18,0x51, +0x84,0x00,0x18,0x4b,0x04,0x00,0x98,0x46,0x7e,0x00,0x68,0x48,0x4b,0xfc,0x98,0x40, +0xfe,0x00,0x68,0x42,0x41,0x56,0x98,0x46,0x7e,0x00,0x1f,0xf0,0x60,0x00,0x6f,0xe4, +0x4c,0x06,0x1f,0xe3,0x7e,0x00,0x20,0x40,0x7d,0x2b,0x1e,0x02,0x7e,0x00,0x20,0x40, +0x7d,0x14,0x1b,0x42,0x04,0x00,0x20,0x40,0x00,0x68,0x20,0x74,0x00,0x00,0x20,0x20, +0x4b,0x68,0x6f,0xe2,0x4b,0xf8,0x20,0x20,0x4b,0x74,0x20,0x40,0x7d,0xc1,0x6f,0xe2, +0x44,0x98,0xc1,0x00,0x00,0x00,0x6f,0xe2,0x4b,0xf8,0xc3,0x82,0x00,0x00,0x20,0x20, +0x7d,0xbf,0x6f,0xe2,0x46,0x79,0xc2,0x81,0x04,0x5d,0x20,0x20,0x7d,0xc1,0x68,0x44, +0x04,0x74,0x6f,0xe2,0x44,0xbb,0xc2,0x81,0x84,0x6a,0x20,0x20,0x5d,0x9f,0x6f,0xe4, +0x44,0xcc,0x98,0x46,0x7c,0x00,0x24,0x22,0xdd,0x9f,0x20,0x40,0x04,0x5d,0x24,0x34, +0x5d,0x9f,0x70,0x04,0x76,0x05,0x20,0x20,0x5e,0x57,0x18,0xc2,0x22,0x00,0x6f,0xe4, +0x44,0xce,0x1f,0xe0,0xa5,0xfd,0x20,0x40,0x5a,0xbe,0x6f,0xe2,0x44,0xbb,0xc3,0x02, +0x5e,0x1d,0x68,0x44,0x04,0x74,0x6f,0xe4,0x44,0xcc,0x98,0x46,0x7c,0x00,0x24,0x22, +0xde,0x1d,0x20,0x40,0x04,0x5d,0x24,0x34,0x5e,0x1d,0x70,0x04,0x76,0x05,0x20,0x20, +0x5e,0x57,0x20,0x40,0x41,0xc5,0x24,0x74,0x00,0x00,0x78,0x54,0x7c,0x00,0x70,0x00, +0x11,0x20,0x79,0x3f,0x80,0x0b,0x79,0x3f,0x80,0x2c,0x20,0x40,0x4a,0x4e,0x20,0x40, +0x42,0xe2,0xc5,0x05,0x84,0x8c,0x20,0x40,0x44,0x51,0x24,0x3a,0x04,0x85,0xc5,0x16, +0x04,0x95,0x20,0x20,0x41,0xe8,0x20,0x40,0x4a,0x4c,0xd8,0x20,0x00,0x10,0x20,0x40, +0x42,0xd8,0x79,0x20,0x00,0x2c,0x79,0x3f,0x80,0x0b,0x6f,0xe2,0x00,0x77,0x98,0x00, +0x08,0x00,0x70,0x00,0x11,0x02,0x20,0x20,0x04,0x85,0x6f,0xe8,0x01,0x63,0x1f,0xe0, +0xfe,0x08,0x67,0xe8,0x01,0x63,0x20,0x20,0x41,0xf4,0x20,0x40,0x51,0x4a,0x70,0x02, +0x81,0x17,0x20,0x60,0x00,0x00,0x20,0x40,0x04,0xf3,0x20,0x20,0x6b,0x6e,0x58,0x00, +0x15,0xef,0xe7,0xe4,0x00,0x05,0x58,0x00,0x11,0x83,0xe7,0xe4,0x00,0x05,0x18,0x42, +0x7e,0x00,0xe7,0xe2,0x00,0x05,0x58,0x00,0x00,0xf0,0xe7,0xe6,0x00,0x05,0x6f,0xe4, +0x45,0x3e,0xe7,0xe4,0x00,0x05,0x58,0x00,0x00,0x00,0xe7,0xe2,0x00,0x05,0x6f,0xe2, +0x45,0x40,0xe7,0xe2,0x00,0x05,0x20,0x40,0x68,0xf0,0xe7,0xe2,0x00,0x05,0x70,0x45, +0x3b,0x10,0x20,0x60,0x00,0x00,0x6f,0xe2,0x46,0x51,0xc0,0x00,0x69,0x4f,0x6f,0xe4, +0x02,0x60,0x1f,0xe2,0x0c,0x00,0x20,0x40,0x69,0x79,0x6f,0xe2,0x04,0xf8,0xc0,0x00, +0x6a,0x13,0x20,0x20,0x04,0xb8,0x6f,0xe2,0x04,0xf9,0xc0,0x77,0x84,0xca,0xc0,0x7f, +0x84,0xc2,0xc0,0x29,0x84,0xbd,0x20,0x20,0x6a,0x4e,0x20,0x20,0x6a,0x05,0x6f,0xe2, +0x04,0xf9,0xc0,0x77,0x84,0xca,0xc0,0x7f,0x84,0xc2,0x20,0x20,0x69,0xdc,0x6f,0xe4, +0x04,0xfd,0x1f,0xe2,0x0c,0x00,0x1f,0xe0,0xfe,0x01,0x67,0xe4,0x04,0xfd,0xef,0xe2, +0x00,0x06,0x68,0x42,0x45,0x3a,0x98,0x40,0xfe,0x00,0x67,0xe2,0x45,0x3a,0x20,0x40, +0x6b,0x01,0x6f,0xe4,0x04,0xfd,0x67,0xe4,0x4c,0xae,0x68,0xe2,0x04,0xfb,0x20,0x20, +0x04,0xcf,0x18,0xe2,0x7e,0x00,0x20,0x62,0x80,0x00,0x68,0x44,0x4c,0xae,0x18,0x42, +0x0c,0x00,0x20,0x40,0x04,0xdd,0x24,0x74,0x00,0x00,0x18,0xc2,0x7e,0x00,0x67,0xe4, +0x4c,0xb0,0x20,0x40,0x04,0xdd,0x24,0x74,0x00,0x00,0x18,0xc2,0x7e,0x00,0x67,0xe4, +0x4c,0xae,0x20,0x40,0x05,0x6f,0x20,0x20,0x04,0xcf,0x78,0x54,0x7c,0x00,0x18,0xe2, +0x7e,0x00,0x1f,0xe0,0xff,0xfe,0x24,0x61,0x00,0x00,0x18,0xe0,0x8f,0xff,0xef,0xe2, +0x00,0x06,0xc0,0x86,0x84,0xde,0x18,0xe0,0x8f,0xff,0xef,0xe2,0x00,0x06,0xc0,0x85, +0x04,0xde,0x78,0x34,0x7c,0x00,0x20,0x60,0x00,0x00,0x70,0x4c,0x98,0x00,0x70,0x4c, +0x99,0x00,0x70,0x4c,0x9a,0x00,0x70,0x4c,0xad,0x0a,0x70,0x4c,0xab,0x0a,0x70,0x4c, +0xba,0x00,0x58,0x00,0x4c,0xab,0xd8,0xa0,0x4c,0x98,0x98,0xa6,0x72,0x00,0x20,0x20, +0x7c,0xaf,0x20,0x40,0x56,0x4e,0x24,0x7a,0x00,0x00,0x6f,0xe2,0x4c,0x98,0xc0,0x05, +0x05,0x24,0xc1,0x05,0x80,0x00,0xc0,0x06,0x05,0x2f,0xc1,0x06,0x80,0x00,0xc0,0x07, +0x05,0x3a,0xc1,0x07,0x80,0x00,0xc0,0x00,0x05,0x08,0xc0,0x00,0x85,0x15,0xc1,0x01, +0x00,0x00,0xc0,0x01,0x85,0x45,0xc1,0x02,0x00,0x00,0xc0,0x02,0x85,0x50,0xc1,0x03, +0x00,0x00,0xc0,0x03,0x85,0x59,0xc1,0x04,0x00,0x00,0xc0,0x04,0x85,0x07,0x20,0x60, +0x00,0x00,0x20,0x60,0x00,0x00,0x6f,0xe2,0x42,0x26,0xc0,0x77,0x85,0x0c,0xc0,0x7f, +0x85,0x0c,0x20,0x60,0x00,0x00,0x70,0x4c,0x98,0x01,0x20,0x60,0x00,0x00,0x67,0xe4, +0x46,0x6a,0x58,0x00,0x4c,0xd5,0x67,0xe4,0x4c,0xb2,0x1f,0xe2,0x0a,0x00,0x58,0x2b, +0x54,0x41,0xe7,0xe6,0x00,0x05,0x20,0x60,0x00,0x00,0x6f,0xe2,0x45,0x3a,0x20,0x7a, +0x00,0x00,0x20,0x40,0x07,0x4b,0x70,0x4c,0x98,0x02,0x58,0x00,0x00,0x0a,0x20,0x40, +0x05,0x0e,0x58,0x53,0x52,0x42,0xe7,0xe6,0x00,0x05,0x58,0x00,0x3d,0x46,0xe7,0xe4, +0x00,0x05,0x6f,0xe2,0x4c,0xb4,0xe7,0xe2,0x00,0x05,0x58,0x00,0x00,0x0d,0xe7,0xe2, +0x00,0x05,0x20,0x20,0x07,0x4d,0x20,0x40,0x07,0x4b,0x70,0x4c,0x98,0x0b,0x58,0x00, +0x00,0x0a,0x20,0x40,0x05,0x0e,0x58,0x00,0x48,0x43,0xe7,0xe4,0x00,0x05,0x58,0x3d, +0x44,0x4c,0xe7,0xe6,0x00,0x05,0x58,0x00,0x0d,0x3f,0xe7,0xe4,0x00,0x05,0x20,0x20, +0x07,0x4d,0x20,0x40,0x07,0x4b,0x70,0x4c,0x98,0x0d,0x58,0x00,0x00,0x0a,0x20,0x40, +0x05,0x0e,0x58,0x00,0x4c,0x43,0xe7,0xe4,0x00,0x05,0x58,0x3d,0x50,0x49,0xe7,0xe6, +0x00,0x05,0x58,0x00,0x0d,0x31,0xe7,0xe4,0x00,0x05,0x20,0x20,0x07,0x4d,0x20,0x40, +0x07,0x4b,0x70,0x4c,0x98,0x0f,0x58,0x00,0x00,0x0a,0x20,0x40,0x05,0x0e,0x58,0x00, +0x43,0x43,0xe7,0xe4,0x00,0x05,0x58,0x3d,0x41,0x57,0xe7,0xe6,0x00,0x05,0x58,0x00, +0x0d,0x31,0xe7,0xe4,0x00,0x05,0x20,0x20,0x07,0x4d,0x20,0x40,0x07,0x4b,0x70,0x4c, +0x98,0x04,0x58,0x00,0x00,0x0a,0x20,0x40,0x05,0x0e,0x58,0x4e,0x49,0x43,0xe7,0xe6, +0x00,0x05,0x58,0x3f,0x3d,0x44,0xe7,0xe6,0x00,0x05,0x58,0x00,0x00,0x0d,0xe7,0xe2, +0x00,0x05,0x20,0x20,0x07,0x4d,0x20,0x40,0x07,0x4b,0x70,0x4c,0x98,0x06,0x58,0x00, +0x00,0x09,0x20,0x40,0x05,0x0e,0x58,0x4e,0x49,0x43,0xe7,0xe6,0x00,0x05,0x58,0x0d, +0x3f,0x44,0xe7,0xe6,0x00,0x05,0x20,0x20,0x07,0x4d,0x20,0x40,0x07,0x4b,0x70,0x4c, +0x98,0x08,0x58,0x00,0x00,0x10,0x20,0x40,0x05,0x0e,0x58,0x45,0x4d,0x43,0xe7,0xe6, +0x00,0x05,0x58,0x33,0x3d,0x52,0xe7,0xe6,0x00,0x05,0x58,0x2c,0x30,0x2c,0xe7,0xe6, +0x00,0x05,0x58,0x31,0x2c,0x30,0xe7,0xe6,0x00,0x05,0x58,0x00,0x00,0x0d,0xe7,0xe2, +0x00,0x05,0x20,0x20,0x07,0x4d,0x58,0x00,0x00,0x08,0x20,0x40,0x05,0x0e,0x58,0x43, +0x4c,0x43,0xe7,0xe6,0x00,0x05,0x58,0x00,0x0d,0x43,0xe7,0xe4,0x00,0x05,0x20,0x20, +0x07,0x4d,0x78,0x54,0x7c,0x00,0x20,0x40,0x05,0x8b,0x20,0x74,0x00,0x00,0x20,0x40, +0x05,0xb5,0x20,0x74,0x00,0x00,0x60,0xe4,0x0a,0x9e,0x20,0x40,0x07,0x4b,0x68,0xe4, +0x0a,0x9e,0x20,0x40,0x06,0xc8,0x20,0x74,0x00,0x00,0x20,0x40,0x05,0xcf,0x20,0x74, +0x00,0x00,0x20,0x40,0x05,0xc3,0x20,0x74,0x00,0x00,0x20,0x40,0x06,0x35,0x20,0x74, +0x00,0x00,0x20,0x40,0x06,0xd8,0x20,0x74,0x00,0x00,0x20,0x40,0x06,0xe6,0x20,0x74, +0x00,0x00,0x20,0x40,0x07,0x07,0x20,0x74,0x00,0x00,0x20,0x40,0x06,0xf9,0x20,0x74, +0x00,0x00,0x20,0x40,0x07,0x26,0x20,0x74,0x00,0x00,0x6f,0xe4,0x4c,0xb8,0x20,0x20, +0x7d,0x77,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa7, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa5,0x80,0x00,0x78,0x34,0x7c,0x00,0x20,0x40, +0x05,0x9c,0x6f,0xe2,0x4c,0x98,0xc0,0x04,0x05,0xac,0xc0,0x05,0x85,0xae,0xc0,0x06, +0x85,0xb0,0xc0,0x07,0x85,0xb2,0xc0,0x01,0x05,0xa6,0xc0,0x02,0x05,0xa8,0xc0,0x03, +0x05,0xaa,0x20,0x60,0x00,0x00,0x6f,0xe2,0x4c,0x9a,0xc0,0x00,0x85,0xa2,0xc0,0x01, +0x05,0xa2,0xc0,0x01,0x85,0xa4,0xc0,0x02,0x05,0xa2,0x20,0x60,0x00,0x00,0x70,0x4c, +0x9a,0x00,0x20,0x60,0x00,0x00,0x70,0x4c,0x9a,0x00,0x20,0x60,0x00,0x00,0x70,0x4c, +0x98,0x03,0x20,0x60,0x00,0x00,0x70,0x4c,0x98,0x05,0x20,0x60,0x00,0x00,0x70,0x4c, +0x98,0x07,0x20,0x60,0x00,0x00,0x70,0x4c,0x98,0x0a,0x20,0x60,0x00,0x00,0x70,0x4c, +0x98,0x0c,0x20,0x60,0x00,0x00,0x70,0x4c,0x98,0x0e,0x20,0x60,0x00,0x00,0x70,0x4c, +0x98,0x09,0x70,0x0a,0x95,0x60,0x20,0x20,0x7b,0xab,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2, +0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa2,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa9, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa9,0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa7, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa9,0x00,0x00,0x78,0x34,0x7c,0x00,0x20,0x20, +0x05,0x9c,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa9, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa4,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa7, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa3,0x80,0x00,0x78,0x34,0x7c,0x00,0x20,0x60, +0x00,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0x95, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa4, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa2,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xab, +0x00,0x00,0x78,0x34,0x7c,0x00,0x20,0x40,0x07,0x37,0x1a,0x20,0xa2,0x02,0x58,0x00, +0x4c,0x9d,0x98,0x40,0x84,0x00,0x18,0x40,0x85,0xff,0xef,0xe2,0x00,0x02,0xd8,0x40, +0x4c,0xa4,0x98,0x40,0xfe,0x00,0x67,0xe4,0x4c,0xb0,0x1a,0x22,0x0c,0x00,0x20,0x40, +0x07,0x47,0x20,0x40,0x07,0x37,0x6f,0xe4,0x4c,0xb0,0xe0,0x42,0x00,0x3f,0x58,0x00, +0x00,0x01,0x20,0x40,0x05,0xef,0xc0,0x00,0x05,0xf3,0xc0,0x00,0x86,0x15,0x20,0x60, +0x00,0x00,0xd8,0xc0,0x4c,0xa4,0x98,0xc0,0x8c,0x00,0xef,0xe2,0x00,0x06,0x20,0x60, +0x00,0x00,0x58,0x00,0x00,0x02,0x20,0x40,0x05,0xef,0xc0,0x00,0x86,0x01,0xc0,0x01, +0x06,0x11,0xc0,0x01,0x86,0x11,0x6f,0xe2,0x4c,0x99,0xc1,0x00,0x00,0x00,0x70,0x4c, +0x99,0x00,0x6f,0xe2,0x4c,0xba,0x1f,0xe6,0x7c,0x01,0x20,0x42,0x85,0xff,0x20,0x20, +0x06,0x2f,0x70,0x0a,0x95,0x58,0x20,0x20,0x7b,0xab,0x20,0x40,0x05,0x68,0x6f,0xe2, +0x4c,0x99,0xc1,0x00,0x80,0x00,0x70,0x4c,0x99,0x01,0x70,0x0a,0x95,0x5a,0x20,0x20, +0x7b,0xab,0x70,0x0a,0x95,0x5b,0x20,0x20,0x7b,0xab,0x70,0x0a,0x95,0x5c,0x20,0x20, +0x7b,0xab,0x70,0x0a,0x95,0x5d,0x20,0x20,0x7b,0xab,0x70,0x0a,0x95,0x5e,0x20,0x20, +0x7b,0xab,0x70,0x0a,0x95,0x5f,0x20,0x20,0x7b,0xab,0x6f,0xe2,0x4c,0x99,0xc1,0x01, +0x00,0x00,0x70,0x4c,0x99,0x02,0x20,0x20,0x06,0x07,0x58,0x00,0x00,0x03,0x20,0x40, +0x05,0xef,0xc0,0x00,0x06,0x24,0x6f,0xe2,0x4c,0x99,0xc1,0x03,0x00,0x00,0x70,0x4c, +0x99,0x06,0x20,0x20,0x06,0x0f,0x6f,0xe2,0x4c,0x99,0xc1,0x02,0x00,0x00,0x70,0x4c, +0x99,0x04,0x20,0x20,0x06,0x0b,0x6f,0xe2,0x4c,0x99,0xc1,0x02,0x80,0x00,0x70,0x4c, +0x99,0x05,0x20,0x20,0x06,0x0d,0x58,0x00,0x00,0x02,0x20,0x40,0x05,0xef,0xc0,0x00, +0x86,0x1c,0xc0,0x01,0x06,0x20,0xc0,0x01,0x86,0x20,0x6f,0xe2,0x4c,0x99,0xc1,0x01, +0x80,0x00,0x70,0x4c,0x99,0x03,0x20,0x40,0x06,0x09,0x70,0x4c,0xba,0x02,0x20,0x60, +0x00,0x00,0x70,0x4c,0xba,0x00,0x20,0x60,0x00,0x00,0x70,0x0a,0x95,0x59,0x20,0x40, +0x7b,0xab,0x70,0x4c,0xba,0x01,0x20,0x60,0x00,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2, +0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0x95,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa4,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa7, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa2,0x00,0x00,0x78,0x34,0x7c,0x00,0x18,0xc0, +0x8c,0x02,0xef,0xe2,0x00,0x06,0xc0,0x14,0x06,0x61,0x20,0x20,0x06,0x46,0x18,0x00, +0x72,0x07,0x60,0xc4,0x4c,0xb0,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0x20,0x40, +0x07,0x37,0x1a,0x20,0xa2,0x02,0x1a,0x22,0x0c,0x00,0x20,0x40,0x07,0x47,0x18,0xc2, +0x7e,0x00,0x67,0xe4,0x4c,0xb0,0x18,0x42,0x22,0x00,0x1f,0x22,0x04,0x00,0x18,0x46, +0x04,0x07,0x20,0x40,0x06,0x5a,0xd8,0x40,0x4c,0xa4,0x98,0x40,0x84,0x00,0x1a,0x22, +0x7e,0x00,0xe7,0xe2,0x00,0x02,0xc2,0x00,0x06,0x48,0x20,0x20,0x05,0xea,0x58,0x00, +0x4c,0x9d,0x98,0x40,0x84,0x00,0xef,0xe2,0x00,0x02,0x20,0x60,0x00,0x00,0xef,0xe2, +0x00,0x06,0xc1,0x11,0x00,0x00,0x20,0x20,0x06,0x5e,0x18,0x00,0x72,0x07,0x20,0x40, +0x06,0x5e,0x60,0xc4,0x4c,0xb0,0x20,0x40,0x06,0x70,0x20,0x36,0x06,0x6d,0x20,0x40, +0x06,0x8e,0x20,0x36,0x06,0x6d,0x20,0x40,0x06,0xba,0x20,0x36,0x06,0x6d,0x20,0x40, +0x06,0xac,0x20,0x36,0x06,0x6d,0x20,0x40,0x06,0x7e,0x20,0x40,0x06,0x5e,0xc2,0x00, +0x06,0x62,0x20,0x60,0x00,0x00,0x78,0x56,0x7c,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2, +0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb9,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb2, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb9,0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xbb, +0x00,0x00,0x78,0x36,0x7c,0x00,0x18,0x00,0x22,0x00,0x20,0x20,0x06,0xa5,0x78,0x56, +0x7c,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb1, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb0,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xba, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xba,0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb1, +0x80,0x00,0x78,0x36,0x7c,0x00,0x18,0x00,0x22,0x06,0x20,0x20,0x06,0xa5,0x78,0x56, +0x7c,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb1, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb0,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb6, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb6,0x00,0x00,0xef,0xe2,0x00,0x06,0x78,0x36, +0x7c,0x00,0xc0,0x34,0x06,0xa4,0xc0,0x11,0x06,0xa1,0xc0,0x39,0x86,0x9f,0x20,0x60, +0x00,0x00,0x18,0x00,0x22,0x02,0x20,0x20,0x06,0xa5,0x18,0xc0,0x8d,0xff,0x18,0x00, +0x22,0x01,0x20,0x20,0x06,0xa5,0x18,0x00,0x22,0x03,0x1f,0x22,0x7e,0x00,0x1f,0xe6, +0x7e,0x07,0xd8,0x40,0x4c,0x9d,0x98,0x40,0x84,0x00,0x1a,0x22,0x7e,0x00,0xe7,0xe2, +0x00,0x02,0x20,0x60,0x00,0x00,0x78,0x56,0x7c,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2, +0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb9,0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb7, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb0,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb6, +0x80,0x00,0x78,0x36,0x7c,0x00,0x18,0x00,0x22,0x05,0x20,0x20,0x06,0xa5,0x78,0x56, +0x7c,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb9, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb4,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb3, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xb7,0x00,0x00,0x78,0x36,0x7c,0x00,0x18,0x00, +0x22,0x04,0x20,0x20,0x06,0xa5,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2, +0x00,0x06,0xc1,0x95,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1,0x00,0x00,0xef,0xe2, +0x00,0x06,0xc1,0xa9,0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa9,0x80,0x00,0xef,0xe2, +0x00,0x06,0xc1,0xa3,0x00,0x00,0x78,0x34,0x7c,0x00,0x20,0x40,0x07,0x37,0x60,0x44, +0x4c,0x9b,0x20,0x60,0x00,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2, +0x00,0x06,0xc1,0x95,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1,0x80,0x00,0xef,0xe2, +0x00,0x06,0xc1,0xa4,0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa6,0x00,0x00,0xef,0xe2, +0x00,0x06,0xc1,0xa2,0x00,0x00,0x78,0x34,0x7c,0x00,0x20,0x60,0x00,0x00,0x6f,0xe4, +0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0x95,0x80,0x00,0xef,0xe2, +0x00,0x06,0xc1,0xab,0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa3,0x80,0x00,0xef,0xe2, +0x00,0x06,0x78,0x34,0x7c,0x00,0xc0,0x26,0x86,0xf6,0xc0,0x29,0x86,0xf3,0x20,0x60, +0x00,0x00,0x20,0x40,0x07,0x37,0x60,0x42,0x4c,0xab,0x20,0x60,0x00,0x00,0x20,0x40, +0x07,0x37,0x60,0x42,0x4c,0xad,0x20,0x60,0x00,0x00,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2, +0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0x95,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xab, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa0,0x80,0x00,0x78,0x34,0x7c,0x00,0x20,0x20, +0x07,0x18,0x6f,0xe4,0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0x95, +0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa6, +0x00,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa4,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa8, +0x00,0x00,0x78,0x34,0x7c,0x00,0x20,0x40,0x07,0x18,0x6f,0xe2,0x4c,0xba,0xc1,0x80, +0x00,0x00,0x20,0x20,0x06,0x31,0xef,0xe2,0x00,0x06,0xc0,0x91,0x07,0x18,0x18,0x00, +0x22,0x00,0x18,0x00,0x24,0x30,0xd8,0xa0,0x4c,0xbc,0xef,0xe2,0x00,0x06,0xc0,0x11, +0x07,0x23,0x1a,0x20,0xa2,0x01,0x9a,0x46,0x7e,0x00,0xe7,0xe2,0x00,0x05,0x20,0x20, +0x07,0x1d,0x1a,0x22,0x7e,0x00,0x67,0xe2,0x4c,0xbb,0x20,0x60,0x00,0x00,0x6f,0xe4, +0x4c,0xb0,0x1f,0xe2,0x0c,0x00,0xef,0xe2,0x00,0x06,0xc1,0x95,0x80,0x00,0xef,0xe2, +0x00,0x06,0xc1,0xa1,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa6,0x00,0x00,0xef,0xe2, +0x00,0x06,0xc1,0xa1,0x80,0x00,0xef,0xe2,0x00,0x06,0xc1,0xa1,0x80,0x00,0x78,0x34, +0x7c,0x00,0x20,0x40,0x07,0x18,0x6f,0xe2,0x4c,0xba,0xc1,0x80,0x00,0x00,0x20,0x20, +0x06,0x31,0x20,0x40,0x07,0x47,0x18,0xc0,0x8d,0xfe,0x18,0xc2,0x22,0x00,0x18,0x00, +0x24,0x01,0x18,0x00,0x04,0x00,0xef,0xe2,0x00,0x11,0x1a,0x20,0xa3,0xff,0xc1,0x1e, +0x80,0x00,0xc1,0x1d,0x00,0x00,0xc1,0x16,0x00,0x00,0xc0,0x10,0x07,0x3c,0x1f,0xe0, +0xff,0xd0,0x9a,0x4f,0xfe,0x00,0x98,0x40,0x84,0x00,0x1a,0x4f,0xa4,0x0a,0x20,0x20, +0x07,0x3c,0xef,0xe2,0x00,0x06,0xc1,0x06,0x80,0x00,0xc1,0x16,0x00,0x00,0x20,0x20, +0x07,0x47,0x20,0x40,0x69,0x33,0x20,0x20,0x6a,0xe9,0x6f,0xe2,0x45,0x3a,0x20,0x7a, +0x00,0x00,0x1f,0xe0,0xff,0xff,0x67,0xe2,0x45,0x3a,0x6f,0xe2,0x45,0x37,0x67,0xe2, +0x05,0x0b,0x58,0x00,0x00,0xef,0x67,0xe2,0x05,0x0a,0x20,0x40,0x69,0x33,0x6f,0xe4, +0x46,0x6a,0x1f,0xe0,0xfe,0x04,0x1f,0xe2,0x22,0x00,0x20,0x40,0x07,0x6e,0x6f,0xe2, +0x05,0x09,0xe7,0xe2,0x00,0x05,0x6f,0xe2,0x05,0x0a,0xe7,0xe2,0x00,0x05,0x20,0x40, +0x07,0x69,0x6f,0xe4,0x46,0x6a,0x1f,0xe2,0x72,0x00,0x6f,0xe4,0x4c,0xb2,0x1f,0xe2, +0x0c,0x00,0x20,0x40,0x7c,0xdc,0x6f,0xe2,0x05,0x0b,0xe7,0xe2,0x00,0x05,0x58,0x00, +0x00,0x00,0x67,0xe4,0x46,0x6a,0x20,0x60,0x00,0x00,0x6f,0xe4,0x46,0x6a,0x1f,0xe3, +0xfe,0x00,0x79,0x20,0x7e,0x00,0xe7,0xe2,0x00,0x05,0x20,0x60,0x00,0x00,0x20,0x40, +0x56,0xac,0x20,0x40,0x56,0xba,0x1a,0x22,0x7e,0x00,0xe7,0xe4,0x00,0x05,0x6f,0xe4, +0x42,0x1c,0xe7,0xe4,0x00,0x05,0x20,0x60,0x00,0x00,0x18,0xc2,0x04,0x00,0xdf,0x20, +0x00,0x04,0xd8,0xa0,0x05,0x26,0x20,0x40,0x7c,0xa1,0x18,0x42,0x0c,0x00,0x1a,0x42, +0x7e,0x00,0xc0,0x01,0x87,0x7e,0xc0,0x02,0x87,0x88,0x20,0x20,0x6c,0xe3,0xef,0xe4, +0x00,0x06,0xef,0xe4,0x00,0x06,0x1f,0xf0,0xfe,0x00,0xc0,0x80,0xca,0x8b,0xef,0xe8, +0x00,0x06,0x67,0xe8,0x05,0x20,0x6f,0xe2,0x42,0x22,0x79,0x20,0x7e,0x06,0x67,0xe2, +0x42,0x22,0x20,0x60,0x00,0x00,0x6f,0xe2,0x42,0x22,0x79,0x20,0x7e,0x07,0x67,0xe2, +0x42,0x22,0x18,0x42,0x0c,0x00,0xef,0xe4,0x00,0x06,0x20,0x40,0x6f,0xc1,0x67,0xe2, +0x45,0x36,0x20,0x60,0x00,0x00,0x6f,0xe2,0x02,0x83,0x20,0x7a,0x00,0x00,0xc0,0x02, +0x07,0x98,0xc0,0x1e,0x87,0x9c,0xc0,0x1f,0x07,0xa1,0xc0,0x1f,0x87,0xa7,0xc0,0x20, +0x07,0xaa,0x20,0x20,0x6b,0xbd,0x6f,0xe2,0x42,0x22,0xc1,0x9f,0x80,0x00,0x70,0x02, +0x83,0x3d,0x20,0x20,0x6b,0xba,0x70,0x02,0x83,0x3e,0xda,0x20,0x00,0x0d,0x58,0x00, +0x1f,0x11,0x67,0xe4,0x05,0x4b,0x20,0x20,0x07,0xae,0x6f,0xe2,0x42,0x22,0xc4,0x03, +0x00,0x00,0x6f,0xe8,0x05,0x20,0x20,0x3a,0x4d,0x64,0x70,0x02,0x83,0x3f,0x20,0x20, +0x6b,0xba,0x70,0x02,0x83,0x40,0xda,0x20,0x00,0x13,0x20,0x20,0x07,0xc3,0x6f,0xe2, +0x42,0x22,0xc4,0x03,0x80,0x00,0x70,0x02,0x83,0x3b,0x20,0x20,0x6c,0x3a,0x20,0x40, +0x07,0xdc,0x58,0x00,0x00,0x02,0xe7,0xe2,0x00,0x05,0x6f,0xe4,0x05,0x1a,0x1f,0xf0, +0xfe,0x00,0xe7,0xe4,0x00,0x05,0x1a,0x20,0xa3,0xfb,0x1a,0x30,0xa2,0x00,0x1a,0x22, +0x7e,0x00,0xe7,0xe4,0x00,0x05,0x58,0x00,0x03,0x35,0xe7,0xe4,0x00,0x05,0x58,0x00, +0x00,0x19,0xe7,0xe2,0x00,0x05,0x6f,0xe4,0x05,0x4b,0xe7,0xe4,0x00,0x05,0x58,0x00, +0x00,0x08,0xe7,0xe4,0x00,0x05,0x58,0x00,0x00,0x00,0xe7,0xe2,0x00,0x05,0x20,0x60, +0x00,0x00,0x20,0x40,0x07,0xdc,0x58,0x00,0x00,0x04,0xe7,0xe2,0x00,0x05,0x6f,0xe4, +0x05,0x1a,0x1f,0xf0,0xfe,0x00,0xe7,0xe4,0x00,0x05,0x1a,0x20,0xa3,0xfb,0x1a,0x30, +0xa2,0x00,0x1a,0x22,0x7e,0x00,0xe7,0xe4,0x00,0x05,0x6f,0xe8,0x05,0x20,0xe7,0xe8, +0x00,0x05,0x58,0x00,0x2c,0x01,0xe7,0xe4,0x00,0x05,0x58,0x00,0x05,0x35,0xe7,0xe4, +0x00,0x05,0x58,0x00,0x00,0x0a,0xe7,0xe2,0x00,0x05,0x58,0x00,0x00,0x00,0xe7,0xe4, +0x00,0x05,0x5f,0xff,0xff,0xff,0xe7,0xe4,0x00,0x05,0x58,0x00,0x00,0x00,0xe7,0xe2, +0x00,0x05,0x20,0x60,0x00,0x00,0x6f,0xe4,0x05,0x1a,0x1f,0xe0,0xfe,0x01,0x67,0xe4, +0x05,0x1a,0x20,0x40,0x7c,0x60,0x20,0x40,0x56,0x9f,0x20,0x40,0x7c,0x70,0x20,0x40, +0x56,0xa8,0xe2,0x24,0x00,0x3f,0x6f,0xe4,0x42,0x1a,0xe7,0xe4,0x00,0x05,0x20,0x60, +0x00,0x00,0x68,0x44,0x40,0xb7,0x18,0x00,0x0e,0x28,0x20,0x40,0x47,0x18,0x20,0x34, +0x41,0x10,0x20,0x20,0x40,0xec,0xaf,0x6d,0xaa,0x55,0x40,0x00,0x00,0x40,0x23,0x00, +0x02,0x00,0x40,0x51,0x00,0x08,0x00,0x00,0x00,0x00,0x00,0x80,0x00,0x00,0x20,0x02, +0x10,0x00,0xcc,0x18,0x00,0x99,0x00,0x00,0x00,0x00,0x00,0x08,0x00,0x00,0xe8,0x09, +0x18,0xd0,0x02,0x00,0x05,0x44,0x02,0x02,0x36,0x01,0x08,0x04,0x00,0x04,0x00,0x20, +0x00,0x02,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xaa,0x55, +0x01,0x00,0x06,0x42,0x17,0xaa,0x55,0x01,0x00,0x93,0x40,0x00,0xaa,0x55,0x01,0x00, +0x6d,0x46,0x28,0xaa,0x55,0x04,0x00,0x3d,0x45,0x00,0xc8,0x00,0x07,0xaa,0x55,0x03, +0x00,0x2d,0x46,0x03,0x00,0x04,0xaa,0x55,0x01,0x00,0x2c,0x46,0x01,0xaa,0x55,0x06, +0x00,0x57,0x46,0x04,0x30,0x30,0x30,0x30,0x30,0xaa,0x55,0x01,0x00,0x54,0x46,0x48, +0xaa,0x55,0x06,0x00,0xa0,0x40,0xa7,0x2a,0x2a,0x21,0x10,0x55,0xaa,0x55,0x0d,0x00, +0xe7,0x44,0x0c,0x33,0x31,0x32,0x31,0x20,0x62,0x74,0x20,0x64,0x65,0x6d,0x6f,0xaa, +0x55,0x03,0x00,0xe4,0x41,0x20,0x00,0x01,0xaa,0x55,0x01,0x00,0xe8,0x41,0x00,0xaa, +0x55,0x01,0x00,0x2c,0x45,0x0a,0xaa,0x55,0x03,0x00,0xaa,0x40,0x08,0x04,0x24,0xaa, +0x55,0x01,0x00,0x5b,0x41,0x00,0xaa,0x55,0x08,0x00,0x98,0x40,0xff,0xfb,0x8f,0xf8, +0x8b,0x85,0x59,0x83,0xaa,0x55,0x01,0x00,0xd1,0x40,0x01,0xaa,0x55,0x0a,0x00,0x49, +0x45,0x04,0x03,0x00,0x12,0x00,0x01,0x01,0x00,0x1e,0x11,0xaa,0x55,0x01,0x00,0x5f, +0x45,0x00,0xaa,0x55,0x02,0x00,0x47,0x45,0x83,0x46,0xaa,0x55,0x86,0x00,0x83,0x46, +0x03,0x11,0x1e,0x00,0x03,0x01,0x00,0x00,0x01,0x00,0x00,0x36,0x00,0x37,0x09,0x00, +0x00,0x0a,0x00,0x01,0x00,0x00,0x09,0x00,0x01,0x35,0x06,0x19,0x11,0x1e,0x19,0x12, +0x03,0x09,0x00,0x04,0x35,0x0c,0x35,0x03,0x19,0x01,0x00,0x35,0x05,0x19,0x00,0x03, +0x08,0x01,0x09,0x00,0x09,0x35,0x08,0x35,0x06,0x19,0x11,0x1e,0x09,0x01,0x05,0x09, +0x03,0x11,0x09,0x00,0x1f,0x03,0x12,0x00,0x10,0x02,0x00,0x01,0x00,0x01,0x00,0x02, +0x36,0x00,0x33,0x09,0x00,0x00,0x0a,0x00,0x01,0x00,0x02,0x09,0x00,0x01,0x35,0x03, +0x19,0x12,0x00,0x09,0x02,0x00,0x09,0x01,0x03,0x09,0x02,0x01,0x09,0x0e,0x05,0x09, +0x02,0x02,0x09,0x12,0x34,0x09,0x02,0x03,0x09,0x01,0x01,0x09,0x02,0x04,0x28,0x01, +0x09,0x02,0x05,0x09,0x00,0x01,0xaa,0x55,0x01,0x00,0xb4,0x4c,0x34,0xaa,0x55,0x01, +0x00,0x6e,0x46,0x05,0xaa,0x55,0x04,0x00,0x75,0x46,0x2d,0x00,0x2f,0x00,0xaa,0x55, +0x07,0x00,0x25,0x44,0x02,0x03,0x00,0x05,0x10,0x02,0x03,0xaa,0x55,0x08,0x00,0x68, +0x44,0x08,0x00,0x10,0x00,0x00,0x00,0x2c,0x01,0xaa,0x55,0x02,0x00,0xcc,0x44,0x31, +0x00,0xaa,0x55,0x01,0x00,0x78,0x44,0xf0,0xaa,0x55,0x01,0x00,0x7a,0x44,0x17,0xaa, +0x55,0x01,0x00,0x90,0x44,0x00,0xaa,0x55,0x01,0x00,0x5f,0x44,0x07,0xaa,0x55,0x01, +0x00,0x98,0x44,0x00,0xaa,0x55,0x01,0x00,0x40,0x43,0x00,0xaa,0x55,0x02,0x00,0x54, +0x44,0x40,0x00,0xaa,0x55,0x06,0x00,0x72,0x44,0x21,0x22,0x01,0x33,0x02,0x3a,0xaa, +0x55,0x0e,0x00,0x81,0x43,0x0d,0x33,0x31,0x32,0x31,0x20,0x62,0x6c,0x65,0x20,0x64, +0x65,0x6d,0x6f,0xaa,0x55,0x04,0x00,0x41,0x43,0x1f,0x02,0x01,0x02,0xaa,0x55,0x10, +0x00,0x61,0x43,0x1f,0x0e,0x09,0x33,0x31,0x32,0x31,0x20,0x62,0x6c,0x65,0x20,0x64, +0x65,0x6d,0x6f,0xaa,0x55,0x02,0x00,0x8e,0x44,0xaf,0x47,0xaa,0x55,0xcd,0x00,0xaf, +0x47,0x01,0x00,0x02,0x00,0x28,0x02,0x01,0x18,0x02,0x00,0x02,0x03,0x28,0x01,0x20, +0x03,0x00,0x02,0x05,0x2a,0x01,0x00,0x04,0x00,0x02,0x02,0x29,0x02,0x01,0x00,0x05, +0x00,0x02,0x00,0x28,0x02,0x00,0x18,0x06,0x00,0x02,0x03,0x28,0x01,0x02,0x07,0x00, +0x02,0x00,0x2a,0x1e,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20, +0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20,0x20, +0x20,0x20,0x08,0x00,0x02,0x03,0x28,0x01,0x02,0x09,0x00,0x02,0x01,0x2a,0x02,0x00, +0x00,0x0a,0x00,0x02,0x03,0x28,0x01,0x02,0x0b,0x00,0x02,0x04,0x2a,0x08,0x10,0x00, +0x20,0x00,0x05,0x00,0x2c,0x01,0x0c,0x00,0x02,0x00,0x28,0x10,0x55,0xe4,0x05,0xd2, +0xaf,0x9f,0xa9,0x8f,0xe5,0x4a,0x7d,0xfe,0x43,0x53,0x53,0x49,0x0d,0x00,0x02,0x03, +0x28,0x01,0x10,0x0e,0x00,0x10,0x16,0x96,0x24,0x47,0xc6,0x23,0x61,0xba,0xd9,0x4b, +0x4d,0x1e,0x43,0x53,0x53,0x49,0x01,0x00,0x0f,0x00,0x02,0x02,0x29,0x02,0x00,0x00, +0x10,0x00,0x02,0x03,0x28,0x01,0x0c,0x11,0x00,0x10,0xb3,0x9b,0x72,0x34,0xbe,0xec, +0xd4,0xa8,0xf4,0x43,0x41,0x88,0x43,0x53,0x53,0x49,0x01,0x00,0x00,0x00,0xaa,0x55, +0x01,0x00,0x92,0x40,0x0a,0xaa,0x55,0x03,0x00,0x14,0x42,0x25,0x4a,0x00,0xaa,0x55, +0x10,0x00,0xf0,0x4f,0x00,0x1c,0xff,0x1f,0x00,0x1c,0x00,0x1c,0x00,0x4d,0xe0,0x4f, +0x00,0x4d,0x00,0x4d,0xaa,0x55,0x02,0x00,0x68,0x46,0x00,0x0b,0xaa,0x55,0x01,0x00, +0x6c,0x46,0x03,0xaa,0x55,0x01,0x00,0x6f,0x46,0x07,0xaa,0x55,0x01,0x00,0x79,0x46, +0x00,0xaa,0x55,0x01,0x00,0xcf,0x4a,0x00,0xaa,0x55,0x01,0x00,0x91,0x40,0x00,0xaa, +0x55,0x03,0x00,0x54,0x41,0x00,0x01,0x08,0xaa,0x55,0x01,0x00,0x74,0x41,0x02,0xaa, +0x55,0x07,0x00,0x76,0x41,0x0f,0x84,0xf0,0x0a,0x0b,0xb2,0x32,0xaa,0x55,0x02,0x00, +0x57,0x41,0x8b,0x0b,0xaa,0x55,0x08,0x00,0xa1,0x00,0x00,0x00,0x00,0x00,0x00,0x00, +0x00,0x00,0xaa,0x55,0x02,0x00,0xbd,0x40,0x02,0x24,0xaa,0x55,0x08,0x00,0xad,0x40, +0x40,0x00,0x00,0x02,0x32,0x00,0x00,0x02,0xaa,0x55,0x02,0x00,0xbb,0x40,0x20,0x00, +0xaa,0x55,0x02,0x00,0xb7,0x40,0x20,0x00,0xaa,0x55,0x02,0x00,0xb5,0x40,0x00,0x00, +0xaa,0x55,0x02,0x00,0xb9,0x40,0x00,0x20,0xaa,0x55,0x04,0x00,0xbf,0x40,0x80,0x04, +0x00,0x10,0xaa,0x55,0x05,0x00,0xe2,0x44,0x08,0x0e,0x05,0x04,0x00,0xaa,0x55,0x02, +0x00,0x02,0x42,0x30,0x1f,0xaa,0x55,0x01,0x00,0x10,0x42,0x20,0xaa,0x55,0x01,0x00, +0xe0,0x41,0x01,0xaa,0x55,0x0f,0x00,0xde,0x4b,0x4b,0xba,0x55,0xd0,0x56,0xe0,0x57, +0x88,0x58,0x6c,0x59,0x10,0x07,0xff,0xff,0xaa,0x55,0x02,0x00,0xc3,0x40,0xde,0x4b, +0x55,0xaa,0xaa,0x55,0x3c,0xd0,0xe0,0x71 +}; Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/main.h =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/main.h (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/main.h (working copy) @@ -0,0 +1,55 @@ +#ifndef __YC_MAIN_H__ +#define __YC_MAIN_H__ + +#include "type.h" + +#define BT_NUM 5 // ¶àͨµÀ +#define BTADDR_LEN 6 +#define LINK_KEY_LEN 16 + +#define NVRAM_INV 0xFF +#define NVRAM_DNO 0xDADADADA + +#define IFLASH_NVRAM_ADDR (0x1000000 + ((512 - 4) * 1024)) +#define IFLASH_USER_INFO_ADDR (0x1000000 + ((512 - 8) * 1024)) +#define USER_INFO_PAGA (4*1024) //4k + +/** + * @brief À¶ÑÀ°ó¶¨ĐÅÏ¢ + * + */ +typedef struct +{ + uint8_t btaddr[BTADDR_LEN]; + uint8_t hostbtaddr[BTADDR_LEN]; + uint8_t link_key[LINK_KEY_LEN]; +} bt_bond_info_t; + +/** + * @brief BT nvram data typedef + * + */ +typedef struct +{ + bt_bond_info_t bt_bond_info[BT_NUM]; + uint32_t nvflag; + uint32_t nvid; + uint32_t inv_flag; +} nvram_t; + + +typedef struct +{ + uint8_t bt_index; +} user_info_t; + + + + + + + + + + +#endif Index: ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/main.c =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/main.c (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_HFP_BLE_DEMO/user/main.c (working copy) @@ -0,0 +1,783 @@ +/** + ****************************************************************************** + * @file 3121Demo\ModuleDemo\BlueTooth\BT&BLE\user\main.c + * @author Yichip Application Team + * @version V1.0.0 + * @date 18-Feb-2020 + * @brief BT&BLE test program. + ****************************************************************************** + * @attention + * + * COPYRIGHT 2019 Yichip Microelectronics + * + * The purpose of this firmware is to provide guidance to customers engaged in + * programming work to guide them smoothly to product development, + * so as to save their time. + * + * Therefore, Yichip microelectronics shall not be responsible for any direct, + * indirect or consequential damages caused by any content of this gu jiang + * and/or contained in this code used by the customer in its products. + * + ****************************************************************************** + */ + +/* Includes ------------------------------------------------------------------*/ +#include "yc3121.h" +#include "yc_gpio.h" +#include "yc_uart.h" +#include "yc_bt.h" +#include "yc_systick.h" +#include "yc_qspi.h" +#include "yc_ipc.h" +#include "board_config.h" +#include "main.h" + + + +/* Private typedef -----------------------------------------------------------*/ +/* Private define ------------------------------------------------------------*/ +#define IPC_UART UART0 +#define UART_TO_IPC_BAUDRATE 921600 +//#define UART_TO_IPC + +/* Private macro -------------------------------------------------------------*/ +/* Private variables ---------------------------------------------------------*/ +/* Private function prototypes -----------------------------------------------*/ +void UART_Configuration(void); + + +nvram_t nvram_data; + +user_info_t user_info; + + + +// byte0ï¼ uuid length +//byte1-16: uuid +// 49535343-FE78-4AE5-8FA9-9FAFD205E455 +uint8_t ble_service_uuid_lsps[] = {0x10,0x55,0xe4,0x05,0xd2,0xaf,0x9f,0xa9,0x8f,0xe5,0x4a,0x7d,0xfe,0x43,0x53,0x53,0x49}; + +/* +byte0: characterisitic +byte1:characterisitic uuid length +byte2-17:characterisitic uuid +byte18:write/read payload length +byte19-20:write/read payload +*/ +//49535343-1E4D-4BD9-BA61-23C647249616 +uint8_t ble_Characteristic_uuid_lsps_tx[] = {0x10,0x10,0x16,0x96,0x24,0x47,0xc6,0x23,0x61,0xba,0xd9,0x4b,0x4d,0x1e,0x43,0x53,0x53,0x49,0x01,0x00}; +//49535343-8841-43F4-A8D4-ECBE34729BB3 +uint8_t ble_Characteristic_uuid_lsps_rx[] = {0x0c,0x10,0xb3,0x9b,0x72,0x34,0xbe,0xec,0xd4,0xa8,0xf4,0x43,0x41,0x88,0x43,0x53,0x53,0x49,0x01,0x00}; +//49535343-aca3-481c-91ec-d85e28a60318 +uint8_t ble_Characteristic_uuid_flow_ctrl[] = {0x18,0x10,0x18,0x03,0xa6,0x28,0x5e,0xd8,0xec,0x91,0x1c,0x48,0xa3,0xac,0x43,0x53,0x53,0x49,0x01,0x00}; + + + +//#define NVRAM_LEN 170//Nvram 长度170bytes,æ¯ç»„Nvram长度为34bytes,最å¤å¯å­˜å‚¨5组é…å¯¹ä¿¡æ¯ + +uint16_t ble_send_handle=0x2a; +uint8_t bt_cod[3] = {0x24,0x04,0x04}; +//uint8_t NvramData[NVRAM_LEN]={0}; +uint8_t LinkKeyData[16]={0}; + +uint8_t check_bond_info_valid(uint8_t indx); +void bt_start_reconnect(uint8_t btindex); + +uint8_t app_get_nvram_data(nvram_t* nvramdat); +uint8_t app_save_nvram(nvram_t* nvram_data, uint8_t* nvram, uint8_t btindex); + +void Uart_PrintArray(const char *str,uint8_t *dataBuf,uint8_t dataLen); +uint8_t BT_Get_Rssi(void); + +//write flash +uint8_t ReserveNV(uint8_t* nvram); +extern tick SystickCount; +#ifdef UART_TO_IPC +HCI_TypeDef HCI_Tx; +HCI_TypeDef HCI_Rx; +uint8_t ipc_tx_buf[256]; +uint8_t ipc_rx_buf[256]; +#endif + +void BT_IRQHandler() +{ + while(IPC_have_data()) + { + #ifdef UART_TO_IPC + if(TRUE==IPC_ReadBtData(&HCI_Rx)) + { + UART_SendBuf(IPC_UART,(uint8_t*)&HCI_Rx,3); + UART_SendBuf(IPC_UART,HCI_Rx.p_data,HCI_Rx.DataLen); + } + #else + BT_ParseBTData(); + #endif + } + + BT_CONFIG &= (~(1<=TICK_MAX_VALUE) SystickCount=0; +} + + + +static uint8_t hex_lookup[16] = { '0', '1', '2', '3', '4', '5', '6', '7','8','9', 'a', 'b', 'c', 'd', 'e', 'f' }; +static void array2hex(uint8_t* in, int inlen, uint8_t* out) +{ + int i; + for (i = 0; i < inlen; ++i) + { + out[2 * i] = hex_lookup[in[inlen-1-i] >> 4]; + out[2 * i + 1] = hex_lookup[in[inlen-1-i] & 0x0f]; + } +} + +void genBleAdvData(uint8_t *ble_name,int ble_name_len,uint8_t *ble_mac,uint8_t *ble_adv_data) +{ + int index=0; + //property + ble_adv_data[index++]=0x02; + ble_adv_data[index++]=0x01; + ble_adv_data[index++]=0x02; + //name + ble_adv_data[index++]=(ble_name_len+1); + ble_adv_data[index++]=0x09;//name flag + for(int i=0;i BT_NUM) + { + user_info.bt_index = 0; + } + user_info.bt_index = 0; + memcpy(nvram_data.bt_bond_info[user_info.bt_index].btaddr, bt_addr, BT_ADDR_LEN); + + if(BT_SetBtAddr(bt_addr) == TRUE) + MyPrintf("SetBtAddr_suc\n"); + else + MyPrintf("SetBtAddr_fail\n"); + + + bt_start_reconnect(user_info.bt_index); + + if(BT_SetVisibility(0x01,0x01,0x01) == TRUE) //设置å¯å‘ç° + MyPrintf("BT_SetVisibility success\n"); + else + MyPrintf("BT_SetVisibility failed\n"); + + while (1) + { + //uart cmd to ipc + #ifdef UART_TO_IPC + if(UART_IsRXFIFONotEmpty(IPC_UART)) + { + HCI_Tx.type = UART_ReceiveData(IPC_UART); + while(!UART_IsRXFIFONotEmpty(IPC_UART)); + HCI_Tx.opcode = UART_ReceiveData(IPC_UART); + while(!UART_IsRXFIFONotEmpty(IPC_UART)); + HCI_Tx.DataLen = UART_ReceiveData(IPC_UART); + i=0; + while(i0) + { + MyPrintf("received %d bytes bt data:\n",BtDataLen); + for(int i=0;i0) + { + MyPrintf("received %d bytes ble data[handle:%02x %02x]:\n",BleDataLen-2,bleData[0],bleData[1]); + for(int i=0;i<(BleDataLen-2);i++) MyPrintf("%02x ",bleData[2+i]); + MyPrintf("\n"); + + //add handle + bleData[0]=(ble_send_handle&0xff); + bleData[1]=((ble_send_handle>>8)&0xff); + BT_SendBleData(bleData,BleDataLen); + MyPrintf("send %d bytes ble data[%02x %02x]:\n",BleDataLen-2,bleData[0],bleData[1]); + for(int i=0;i<(BleDataLen-2);i++) MyPrintf("%02x ",bleData[2+i]); + MyPrintf("\n"); + } + else MyPrintf("read ble data error\r\n"); + } + break; + + case BT_CONNECTED: + MyPrintf("bt connected\n"); + break; + + case BT_DISCONNECTED: + MyPrintf("bt disconnected\n"); + if (check_bond_info_valid(user_info.bt_index)) + { + bt_start_reconnect(user_info.bt_index); + } + break; + + case BT_RECONNECT_FAIL: + MyPrintf("bt reconnect fail\n"); + break; + + case HFP_CONNECT: + MyPrintf("hfp connected\n"); + break; + + case HFP_STOP_DIALING: + MyPrintf("hfp stop dialing\n"); + break; + + case HFP_START_DIALING: + { + MyPrintf("hfp start dialing\n"); + uint8_t PhoneNum[11]; + uint8_t PhoneNumLen=0; + PhoneNumLen=BT_ReadBTData(PhoneNum); + + MyPrintf("hfp receive %dbytes phone num:",PhoneNumLen); + for(uint8_t i=0; i < PhoneNumLen; i++) + { + if(PhoneNum[i] > 9) + { + MyPrintf("hfp phone error handle\r\n"); + } + MyPrintf("%d",PhoneNum[i]); + } + MyPrintf("\n"); + } + break; + + case BLE_CONNECTED: + MyPrintf("ble connected\n"); + break; + + case BLE_DISCONNECTED: + MyPrintf("ble disconnected\n"); + break; + + case BT_ENC_INFO: + { + MyPrintf("ble enc info:\n"); + uint8_t BtEncInfo[MAX_BLUETOOTH_DATA_LEN]; + int BtEncInfoLen = 0; + BtEncInfoLen = BT_ReadBTData(BtEncInfo); + + if (BtEncInfoLen > 0) + { + for(int i=0;i0) + { + MyPrintf("receive %dbytes Nvramdata:",NvramDataLen); + for(int i=0;i0) + { + MyPrintf("receive %dbytes CONFIRM_GKEY:",GkeyDataLen); + for(int i=0;i0) + { + MyPrintf("receive %dbytes paring data:",PairingDataLen); + for(int i=0;i0) + { + MyPrintf("datalen:%d\r\n",unknownDataLen); + for(int i=0;invflag = NVRAM_DNO; + nvram_data->nvid = btindex; + memcpy(&nvram_data->bt_bond_info[btindex], nvram, sizeof(bt_bond_info_t)); + MyPrintf("new nvram data,updata to flash\r\n"); + qspi_flash_sectorerase(IFLASH_NVRAM_ADDR); + return qspi_flash_write(IFLASH_NVRAM_ADDR, (uint8_t*)nvram_data, sizeof(nvram_t)); +} + + +#define USER_PAGA (100) +/** + * @brief ä¿å­˜ç”¨æˆ·ä¿¡æ¯ + * + * @return æ‰§è¡Œç»“æœ + */ +uint8_t app_save_user_info(void) +{ + + qspi_flash_sectorerase(IFLASH_USER_INFO_ADDR); + + return qspi_flash_write(IFLASH_USER_INFO_ADDR, (uint8_t*)&user_info, sizeof(user_info_t)); +} + +/** + * @brief 读å–ç”¨æˆ·ä¿¡æ¯ + * + * @param useinfo ç”¨æˆ·ä¿¡æ¯ + * @return + */ +uint8_t app_read_user_info(user_info_t* useinfo) +{ + return qspi_flash_read(IFLASH_USER_INFO_ADDR, (uint8_t*)useinfo, sizeof(user_info_t)); +} + + +void Uart_PrintArray(const char *str,uint8_t *dataBuf,uint8_t dataLen) +{ + for (uint8_t i = 0; i < strlen(str); i++) + MyPrintf("%c", (uint8_t)str[i]); + MyPrintf(":"); + for (uint8_t i = 0; i < dataLen; i++) + MyPrintf(" %02x", dataBuf[i]); + MyPrintf("\r\n"); +} + + + +uint8_t Get_Rssi(void) +{ + return *(volatile byte*)0xc0018; +} + +uint16_t Get_Ui_State_Map(void) +{ + return ((*(volatile byte*)0xc4652) || (*(volatile byte*)0xc4653 << 8)); +} + +uint8_t BT_Get_Rssi(void) +{ + if(Get_Ui_State_Map() & 0x0001) + { + MyPrintf("classic rssi:%d\r\n",Get_Rssi()); + return Get_Rssi(); + } + else + { + MyPrintf("classic connection link not found\r\n"); + return -1; + } +} + + + + + + + + + + +/************************ (C) COPYRIGHT Yichip Microelectronics *****END OF FILE****/ + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/do.bat =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/do.bat (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/do.bat (working copy) @@ -0,0 +1,78 @@ +cls +@echo off + +setlocal enabledelayedexpansion +for /f %%f in ('dir /b /o program\*.prog') do @if not %%f==bt.prog if not %%f==patch.prog if not %%f==sim.prog set progs=!progs! program\%%f +type program\bt.prog %progs% > output\bt_program23.meta +for /f %%f in ('dir /b /o format\*.format') do @if not %%f==bt.format if not %%f==command.format set fmts=!fmts! format\%%f +type format\bt.format %fmts% format\command.format > output\bt_format.meta +perl util/mergepatch.pl output/bt_program23.meta +perl util/memalloc.pl output/bt_format.meta + +cd output +osiuasm bt_program23 -O-W + +copy ..\sched\bt_config.dat+ ..\sched\ble_config.dat+ ..\sched\DM_module.dat + ..\sched\109x.dat ..\output\sched.rom + +Creat_patch_Module +if "%1" equ "eep" ( + goto genromrevc +)else ( + goto downloadram +) + +:genromrevc +echo off +@echo Start to generate EEPROM code +geneep -n + + +:gen_eep_end +cd .. +echo ********************************** +echo EEPROM Generated. +echo Use command "e fp" to download EEPROM. +echo ********************************** +goto end + + + +:genrom +@rem echo on +perl ..\util\rom2mif.pl romcode +del ..\..\%FPGA_PATH%\romcode.mif +copy .\romcode.mif ..\..\%FPGA_PATH%\romcode.mif +perl ..\util\gen_patch_h.pl >%YC_PATCH_FILE% +copy .\%YC_PATCH_FILE% ..\..\%MV_PATCH%\%YC_PATCH_FILE% +copy .\%YC_PATCH_FILE% D:\work\yichip\mv_proj\src\inc\%YC_PATCH_FILE% +cd ..\..\%FPGA_PATH% +quartus_cdb btspi -c btspi --update_mif +quartus_asm --read_settings_files=off --write_settings_files=off btspi -c btspi +quartus_pgm -c USB-Blaster[USB-0] -m jtag -o "p;.\output\btspi.sof" +@echo bitstream_compression=on >1 +@echo memory_map_file=on >> 1 +quartus_cpf -c -o 1 -s EP3C55 -d EPCS16 output\btspi.sof output\btspi.jic +@rem quartus_pgm -c USB-Blaster[USB-0] -m jtag -o "pi;.\output\btspi.jic" +@del 1 +goto end + + + +:downloadram +echo on +@echo Start to download ram code +e ku +e hu +e su sched.rom +@echo ********************************** +@echo RAM CODE has been downloaded. +@echo The Device is %device_option%. +@echo ********************************** +cd .. + + +:end +echo create bt_code.c file +perl .\util\rom2h.pl <.\output\eeprom.dat> .\output\bt_code.c +copy .\output\bt_code.c ..\..\BT_HFP_BLE_DEMO\user + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/app.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/app.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/app.format (working copy) @@ -0,0 +1,278 @@ + +memalloc( + +/* load code */ +1 mem_ucode_status +2 mem_otp_ucode_flag +1 mem_spid_tbuf /* spid buf: 03 addr[23:16] addr[15:8] addr[7:0] */ +0 mem_iicd_tbuf /* iicd buf: iic_adr addr[15:8] addr[7:0] iic_adr */ +1 mem_addr_hi +1 mem_addr_mi +1 mem_addr_lo +1 mem_iicd_addr +4 mem_spid_rbuf +2 mem_ucode_buf +2 mem_ucode_len +2 mem_sched_addr +2 mem_ucode_ptr +16 mem_ucode_keybuf +18 mem_check_plap_temp + + +1 mem_reconnect_flag +1 mem_switch_fail_master_count +1 mem_app_evt_timer_count + +) + +xmemalloc( +1 mem_app_handshake_flag +2 mem_sniff_param_interval +2 mem_sniff_param_attempt +2 mem_sniff_param_timeout + +/*App Callback Functons*/ +2 mem_cb_check_wakelock +2 mem_cb_before_hibernate +2 mem_cb_before_lpm +2 mem_cb_le_process +2 mem_cb_bt_process +2 mem_cb_idle_process +2 mem_cb_bb_event_process +2 mem_cb_discovry_timeout +2 mem_cb_att_write +2 mem_cb_ble_transmit +2 mem_cb_event_timer +2 mem_cb_bt_set_mult + + + + +2 mem_eeprom_base + +1 mem_unsniff2sniff_timer_count +//lpm mode +1 mem_wake_up_delay_timer + +1 mem_app_connection_options + +// +2 mem_app_disconn_reason +2 mem_app_disconn_reason_flag +4 mem_lpm_delay_after_sniff +1 mem_xrecord_mode + +1 mem_eeprom_block_size +1 mem_spi_init_clk +1 mem_spi_init_delay_time +1 mem_spi_ncs_gpio + +2 mem_nv_data_ptr +1 mem_nv_data_number + + +ifdef SPI_SIMULATE +//spi gpio config +0 mem_spi_simulate_struct +1 mem_spi_simulate_cs_gpio +1 mem_spi_simulate_sclk_gpio +1 mem_spi_simulate_mosi_gpio +1 mem_spi_simulate_miso_gpio +1 mem_spi_simulate_motion_gpio +//spi slave read byte +50 mem_spi_simulate_read_byte_slave +1 mem_spi_simulate_read_byte_slave_temp +1 mem_spi_simulate_read_length_slave +1 mem_spi_simulate_read_length_slave_temp +//spi slave write byte +50 mem_spi_simulate_write_byte_slave +1 mem_spi_simulate_write_byte_slave_temp +1 mem_spi_simulate_write_byte_slave_temp_temp +1 mem_spi_simulate_write_length_slave +1 mem_spi_simulate_write_length_slave_temp +endif + +) +//adc read +( +0 ADC_CONFIG_VINLPM +1 ADC_CONFIG_HVIN +2 ADC_CONFIG_GPIO +) + + +( +0 QUEUE_OFFSET_EACH_SIZE +1 QUEUE_OFFSET_LENGTH +2 QUEUE_OFFSET_CURR_NUM +3 QUEUE_OFFSET_READ_PTR +4 QUEUE_OFFSET_WRITE_PTR +5 QUEUE_OFFSET_ELE_INIT_ADDR +) +( +//Flash Register +0x05 FLASH_READ_SATUS + +// Flash Status Register +0x00 FLASH_STATUS_WIP +0X01 FLASH_STATUS_WEL +0X02 FLASH_STATUS_BP0 +0X03 FLASH_STATUS_BP1 + +//Flash Write Sm +0X00 FLASH_SM_NO_BUYS +0X01 FLASH_SM_START +0X02 FLASH_SM_ERASE_SECTOR +0X03 FLASH_SM_WAIT_ERASE_SECTOR +0X04 FLASH_SM_WRITE_DATA +0X05 FLASH_SM_WAIT_WRITE_DATA + + +//Flash Command +0x02 FLASH_COMMAND_WRITE_DATA +0x03 FLASH_COMMAND_READ_DATA +0x20 FLASH_COMMAND_SECTOR_ERASE +) + +0x0000 otp_ucode_flag +0x07f0 otp_ucode_aeskey + +/* adc data addr and flag */ +( +0x07e0 OTP_CHIP_FUNCTIONS +0x07e2 otp_adc_io_0_5V_addr +0x07e4 otp_adc_hvin_1V_addr +0x07e6 otp_adc_vinlpm_2V_addr +0x07e8 otp_adc_io_1V_addr +0x07ea otp_adc_hvin_5V_addr +0x07ec otp_adc_vinlpm_3V_addr +0x07ee otp_adc_flag_addr +0xaa55 OTP_ADC_FLAG +) + +/* data stored in eeprom */ +( +0 eeprom_nv_ram + +195 eeprom_module_init_flag//2 + +) + +/*mem_app_handshake_flag*/ +( +0 APP_HANDSHAKE_NULL +1 APP_HANDSHAKE_DONE + +) +/*mem_device_option*/ +( +1 dvc_op_hci +4 dvc_op_dongle +5 dvc_op_spp +6 dvc_op_ukey +7 dvc_op_ir + +9 dvc_op_shutter +10 dvc_op_module +11 dvc_op_ble_mouse +12 dvc_op_ble_kb +13 dvc_op_ble_prcp +14 dvc_op_car +15 dvc_op_AntiLost +16 dvc_op_remote_car +255 dvc_op_test +//device option hight 4 +6 dvc_op_mouse +7 dvc_op_keyboard +//device option low 2 +( +0 MODE_3_MOUSE +1 MODE_4_MOUSE +) +) + +( +3 twspi_sclk +4 twspi_sdio +) + +( +4 pan_clk_bit +5 pan_dat_bit +6 pan_mov_bit +) + +( +7 otp_uflag_aes +6 otp_uflag_skip_eep +5 otp_uflag_skip_flash +4 otp_uflag_hci +) + +/* ir command */ +( +1 ircmd_record +2 ircmd_play +3 ircmd_write_pulse +4 ircmd_write_seq +5 ircmd_write_next + +8 ircmd_test_play +9 ircmd_test_rec + +10 ircmd_report_pulse +11 ircmd_report_seq +12 ircmd_report_raw + +20 ircmd_screen_on +21 ircmd_screen_off +) + +( +7 gpio_active_bit +) +( +2 HID_HANDSHAKE_TIMEOUT + +) + +( +1 APP_FLAG_RECONNECT +) +( +5 LPM_WAKE_UP_DELAY_TIMER +) + + +//mem_app_disconn_reason +//mem_app_disconn_reason_flag +//bit map +( +2 APP_DISC_RSN_SIZE +) +( +0 APP_DISC_BY_BUTTON +1 APP_DISC_AFTER_PAIRING +2 APP_DISC_AFTER_RECONN +3 APP_DISC_AFTER_SNIFF +4 APP_DISC_AFTER_SETUP_DONE +5 APP_DISC_AFTER_HANDSHAKE +6 APP_DISC_BT +7 APP_DISC_BLE +8 APP_DISC_L2CAP_REFUSED +9 APP_DISC_SWITCH_FAIL +) +//eeprom init flag +( + 0xaa55 EEPROM_INIT_FLAG +) + +( +1 KEY_CONF_STRUCT_LEN +0 KEY_PIN_OFFSET +) + +( +12000000 PWM_12MHZ +) + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/app_module.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/app_module.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/app_module.format (working copy) @@ -0,0 +1,413 @@ + + +bmemalloc( + 0 mem_module_prepare_write_request_packet + 2 mem_module_prepare_write_request_PDU_length + 2 mem_module_prepare_write_request_Channel_ID + 1 mem_module_prepare_write_request_opcode + 2 mem_module_prepare_write_request_handle + 600 mem_temp_prepare_write_request_Data +) +omemalloc( + 2 mem_soft_version_num + + 2 mem_current_packet_length + 1 mem_module_state + + 1 mem_module_spp_lpm_mult + 1 mem_module_le_lpm_mult + 1 mem_module_bluetooth_stauts_by_command + + //ble + 1 mem_module_le_rx_data_len + 2 mem_module_le_rx_data_address + 2 mem_module_le_rx_data_handle + //ble write handle + 2 mem_module_data_write_handle + 2 mem_module_data_write_handle2 + //flag + 1 mem_module_flag + + 1 mem_module_hci_notify_len + 2 mem_module_hci_notify_handle + 2 mem_module_hci_nofiy_addr + + 4 mem_last_transmite_clock + + 300 mem_module_uuid_list + 0 mem_module_uuid_list_end + 630 mem_module_le_att_list + 0 mem_module_le_att_list_end + 0 mem_module_nv_data + 34 mem_module_nv_data0 + 34 mem_module_nv_data1 + 34 mem_module_nv_data2 + 34 mem_module_nv_data3 + 34 mem_module_nv_data4 + 1 mem_rfcomm_lmp_dis_flag + 1 mem_module_rfcomm_disconnect_count + + 2 mem_le_buff_len + 2 mem_le_buff_len_all + 2 mem_module_prepare_write_request_contw + 2 mem_module_prepare_write_request_contr + + 2 mem_module_master_rx_max + + 1 mem_le_txheader_temp + 1 mem_le_txlen_temp + 2 mem_le_txpayload_temp + 2 mem_le_txcid_temp + 1 mem_le_l2cap_temp + 1 mem_le_l2cap_response_temp + 251 mem_le_txbdy_temp + 15 mem_rf_init + 1 mem_ble_dle_enable +// 1 mem_wakeup_gpio +// 1 mem_wake_by_m0 + + 4 mem_mcu_set_bt_wake_timer + 6 mem_gpio_wakeup_backup + + // Be aware of memory boundaries + + 160 mem_context_new + + + //hfp start + 0 mem_xmem_hf_state_start + 1 mem_hf_state + 1 mem_hf_call_state + 1 mem_hf_command + 2 mem_agoption + 7 mem_AG_indicator_map + 7 mem_AG_indicator + 0 mem_xmem_hf_state_end + + //hfp volume ctr + 1 mem_hf_vlm_speaker + 1 mem_music_vlm_speaker + 1 mem_hf_vlm_mic + + 2 mem_at_payload_ptr + 2 mem_at_command_ptr + 2 mem_at_rfcomm_data_ptr + + //init this value in user.dat + 3 mem_UI_HF_brsf_feature + + 1 mem_codec_type + + //hfp callback + 2 mem_cb_hfp_result_code + + 1 mem_telephone_dialing_state + 1 mem_phone_num_len + 25 mem_phone_number + 30 mem_at_command_data + //hfp end + + 1 mem_module_rfcomm_reconnect_count + + 0 mem_module_params_end +) +(//mem_ble_dle_enable +0x00 DLE_ENABLE +0x01 DLE_DISABLE +) +( +249 LE_BASEBAND_MAX_BUFFER +) + +( +0x4FEF IPC_HOLD_BT + +0x4FF0 IPC_BT2M0_START_ADDR +0x4FF2 IPC_BT2M0_END_ADDR +0x4FF4 IPC_BT2M0_READ_PTR +0x4FF6 IPC_BT2M0_WRITE_PTR + +0x4FF8 IPC_M02BT_START_ADDR +0x4FFA IPC_M02BT_END_ADDR +0x4FFC IPC_M02BT_READ_PTR +0x4FFE IPC_M02BT_WRITE_PTR +) + +(//mem_module_flag +//bit0~bit3 config module function +0 MODULE_FLAG_UART_FLOW_CONTROL +1 MODULE_FLAG_BLE_SEND_MTU23 +2 MODULE_FLAG_BLE_DATA_ENCRYPT + +//bit3~bit7 module states change +3 MODULE_RECEIVE_COMPLETE_PREPARE_WRITE_REQ +4 MODULE_FLAG_BLE_DATA_FINISH +5 MOUDLE_TASK_UNSNIFF +6 MOUDLE_TASK_SNIFF +7 MODULE_RECV_CONFIRM +) + +( +34 NV_DATA_LEN +-1 DECREASED_ONE +) + + + +( + 10 FLAG_MODULE_READ_VDD_COUNT +) + +( + 110 DM_REFCOM_BUFF_LEN + 230 NL_RFCOMM_BUFF_LEN +) +( + 0x200 UART_AIR_CONTROL_THRESHOLD +) + +( +0x01 HCI_DISCARD_PACKET +0x00 HCI_NOT_DISCARD_PACKET +) + + + +(//Command +0x00 HCI_CMD_SET_BT_ADDR_REQ +0x01 HCI_CMD_SET_LE_ADDR_REQ +0x02 HCI_CMD_SET_VISIBILITY_REQ +0x03 HCI_CMD_SET_BT_NAME_REQ +0x04 HCI_CMD_SET_LE_NAME_REQ +0x05 HCI_CMD_SPP_DATA_REQ +0x09 HCI_CMD_LE_DATA_REQ +0x0b HCI_CMD_STATUS_IRQ +0x0c HCI_CMD_SET_PAIRING_REQ +0x0d HCI_CMD_SET_PINCODE_REQ +0x0e HCI_CMD_SET_UARTCONTROL_REQ +0x0f HCI_CMD_SET_UART_BAUD_REQ +0x10 HCI_CMD_VERSION_REQ +0x11 HCI_CMD_BT_DISCONNECT +0x12 HCI_CMD_BLE_DISCONNECT +0x13 HCI_CMD_DELETE_DEVICE +0x14 HCI_CMD_CREATE_CONNECT +0x15 HCI_CMD_SET_COD +0x26 HCI_CMD_SET_NVRAM_REQ +0x27 HCI_CMD_SLEEP +0x28 HCI_CMD_CONFIRM_GKEY +0x29 HCI_CMD_SET_CREDIT_GIVEN +0x2a HCI_CMD_AUTO_ADV_SCAN +0x2b HCI_CMD_POWER_REQ +0x2c HCI_CMD_POWER_SET +0x30 HCI_CMD_PASSKEY_ENTRY +0x31 HCI_CMD_SET_GPIO +0x32 HCI_CMD_READ_GPIO +0x33 HCI_CMD_LE_SET_PAIRING +0x34 HCI_CMD_LE_SET_ADV_DATA +0x35 HCI_CMD_LE_SET_SCAN_DATA +0x36 HCI_CMD_LE_SEND_CONN_UPDATE_REQ +0x37 HCI_CMD_LE_SET_ADV_PARM +0x38 HCI_CMD_LE_START_PAIRING +0x40 HCI_CMD_SET_WAKE_GPIO +0x42 HCI_CMD_SET_TX_POWER +0x43 HCI_CMD_BOOT_VERSION_REQ +0x48 HCI_CMD_LE_CONFIRM_GKEY +0x49 HCI_CMD_REJECT_JUSTWORK +0x51 HCI_CMD_RESET_CHIP_REQ +0x61 HCI_CMD_LE_SET_FIXED_PASSKEY + +0x76 HCI_CMD_DELETE_CUSTOMIZE_SERVICE +0x77 HCI_CMD_ADD_SERVICE_UUID +0x78 HCI_CMD_ADD_CHARACTERISTIC_UUID +0x79 HCI_CMD_MCU_SET_BT_WAKE_TIMER + + + +0xb1 HCI_CMD_CREAT_BT_RECONNECT + + +0xee HCI_TEST_CMD_REBACK +0xff HCI_TEST_CMD_CLOSE_LPM +) + +(//event +0x00 HCI_EVENT_SPP_CONN_REP +0x01 HCI_EVENT_HID_CONN_REP +0x02 HCI_EVENT_LE_CONN_REP +0x03 HCI_EVENT_SPP_DIS_REP +0x04 HCI_EVENT_HID_DIS_REP +0x05 HCI_EVENT_LE_DIS_REP +0x06 HCI_EVENT_CMD_RES +0x07 HCI_EVENT_SPP_DATA_REP +0x08 HCI_EVENT_LE_DATA_REP +0x09 HCI_EVENT_STANDBY_REP +0x0a HCI_EVENT_STATUS_RES +0x0b HCI_EVENT_FINISH_PACK_NUM +0X0C HCI_EVENT_SNIFF_MD_CHANGE +0x0D HCI_EVENT_NVRAM_REP +0x0e HCI_EVENT_GKEY +0x0F HCI_EVENT_INVALID_PACKET +0x10 HCI_EVENT_GET_PASSKEY +0x11 HCI_EVENT_LE_TK +0x12 HCI_EVENT_REMOTE_MTU +0x14 HCI_EVENT_LE_PAIRING_STATE +0X15 HCI_EVENT_LE_ENCRYPTION_STATE +0x17 HCI_EVENT_LE_CONNECTION_UPDATE +0x1d HCI_EVENT_LE_GKEY +0x29 HCI_EVENT_UUID_HANDLE + + +0xb0 HCI_EVENT_BT_ENC_INFO +0xb1 HCI_EVENT_BT_RECONNECT_FAIL +0xb2 HCI_EVENT_HFP_CONNECTED +0xb3 HCI_EVENT_HFP_START_DIALING +0xb4 HCI_EVENT_HFP_STOP_DIALING + + +) + + +(//command HCI_CMD_SET_GPIO +//byte 0 +0x00 HCI_CMD_CONFIG_GPIO_INPUT +0x01 HCI_CMD_CONFIG_GPIO_OUTPUT +//byte 1 input state +0x00 GPIO_INPUT_PULLUP +0x01 GPIO_INPUT_PULLDOWN +0x02 GPIO_INPUT_HIGH_IMPEDANCE +) + + + +( +0x7e0 OTP_ADDR_RF_PARAM_FIX +//struct of RF_PARAM_FIX +// uint8 //length = param_pair_count * 2 +// uint16 //param-pair-1 +// uint16 //param-pair-2 +// uint16 //param-pair-3 +// uint16 //param-pair-4 +// uint16 //param-pair-5 +// uint16 //param-pair-6 +// uint16 //param-pair-7 +) + +( +0 PAIRING_PINCODE +1 PAIRING_JUSTWORK +2 PAIRING_PASSKEY +3 PAIRING_CONFIRM +) + + +( +0x0001 FLAG_BT_PAIRING_SUCCESS +0x0101 FLAG_BT_PAIRING_FAIL +0x0080 FLAG_BLE_PAIRING_SUCCESS +0x0180 FLAG_BLE_PAIRING_FAIL +) + + +( +1 FLAG_EVENT_START_ENC +0 FLAG_EVENT_PAUSE_ENC +) + +( + 0 MOUDLE_STATE_BT_BIT + 1 MOUDLE_STATE_BLE_BIT +) + + + + + + +( +0 DAC_ENABLE +1 DAC_MRAM_SEL +2 DAC_CONTINUOUS_MODE +3 DAC_MUTU +4 DAC_INIT_FILTER +5 DAC_SDM +6 DAC_INVERT_WAVE +7 DAC_BYPASS_DAC +) + +( +15 HFP_SPEAKER_MAX_VLM +15 HFP_MIC_MAX_VLM +10 HFP_DEFAULT_SPEAKER +10 HFP_DEFAULT_MIC_VLM +) + +( +0 HFP_CIEVIND_SERVICE +1 HFP_CIEVIND_CALL +2 HFP_CIEVIND_CALLSETTUP +3 HFP_CIEVIND_CALLHELD +4 HFP_CIEVIND_SIGNAL +5 HFP_CIEVIND_ROAM +6 HFP_CIEVIND_BATTCHA +) + + +( +0 HFP_NONO +1 HFP_INCOMMING +2 HFP_OUTGOING +3 HFP_CALLACTIVE +4 HFP_CALLIMG +5 HFP_CALLOGG +6 HFP_CALMULTY +) + +( +0 CIEV_CALLST_NO +1 CIEV_CALLST_IMG +2 CIEV_CALLST_OUG +3 CIEV_CALLST_RE_ALTD +) + +( +0 CIEV_CALL_NO +1 CIEV_CALL_ACT +) + +( +0 CIEV_HELD_NO +1 CIEV_HELD_IN_HOLD +2 CIEV_HELD_ALL +) + +( +0 HFP_NO_KEY +1 HFP_TAP_KEY +2 HFP_DOUBLE_KEY +3 HFP_TRIPLE_KEY +4 HFP_KEY_PRESS +5 HFP_KEY_PRESS_RELEASE +6 HFP_KEY_LONG_PRESS +) + +( +2 CODEC_AIR_MODE +2 SCO_ATTEMPT_COUNT +) + + +( +0 HF_CMD_IDLE +1 HF_WAIT_ACCEPT_CALL_OK +2 HF_WAIT_HANGUP_OK +3 HF_WAIT_VGS_OK +4 HF_WAIT_VGM_OK +) + +( + 0 HFP_DIALING_STATE_NO + 1 HFP_DIALING_STATE_START + 2 HFP_DIALING_STATE_STOP +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/bt.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/bt.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/bt.format (working copy) @@ -0,0 +1,1051 @@ + + width = 32 + const length = 12000 + + /* ========= memory ============== */ +memalloc( +/* 00-0f most frequently used area */ +1 mem_le_adv_transmit +1 mem_le_adv_waitcnt +1 mem_le_adv_rcv +1 mem_le_req_rcv +1 mem_le_scanrsp_rcv +1 mem_le_conn_rcv + +1 mem_inquiryscan_waitcnt +1 mem_inquiryscan_rcvcnt +1 mem_pagescan_waitcnt +1 mem_pagescan_rcvcnt +1 mem_pagescan_rcvfhscnt +1 mem_slave_rcvcnt +1 mem_page_transmit +1 mem_page_rcv +1 mem_page_rcv_fhs +1 mem_master_rcvcnt + +/* 10-1f debug area */ +1 mem_fhs_wait_counter +1 mem_newconnto_counter +1 mem_inquiry_transmit +1 mem_inquiry_rcv +1 mem_fw_ver +1 mem_current_context +1 mem_le_ch_mapped +1 mem_last_freq +1 mem_rssi +1 mem_rx_type +2 mem_rx_hec_err +2 mem_rx_crc_err +2 mem_context_ptr +8 mem_display +8 mem_bcd + + /* context swappable area */ +1 mem_state +1 mem_mode +2 mem_tsniff +4 mem_sniff_anchor +6 mem_clk_offset +2 mem_rx_window +3 mem_plap +1 mem_puap +2 mem_pnap +1 mem_conn_handle +1 mem_arq +1 mem_lmp_to_send +1 mem_lmi_opcode +1 mem_lmo_reason +1 mem_op +1 mem_state_map +4 mem_supervision_timer +2 mem_supervision_to +1 mem_name_offset +1 mem_key_size +1 mem_conn_sm +12 mem_aco +16 mem_kc +1 mem_conn_timer +1 mem_sniff_attempt +1 mem_sniff_timeout +2 mem_dsniff +1 mem_amaddr +1 mem_lmo_opcode1 +1 mem_lmi_opcode1 +1 mem_lmo_reason1 +1 mem_lmo_tid1 +1 mem_lmo_opcode2 +1 mem_lmi_opcode2 +1 mem_lmo_reason2 +1 mem_lmo_tid2 + +3 mem_hci_version +2 mem_acl_pktlen +1 mem_sco_pktlen +2 mem_acl_pktcnt +2 mem_sco_pktcnt + +1 mem_current_sniff_attempt +1 mem_current_sniff_timeout +1 mem_sniff_timeout_temp +1 mem_nfreq_index_inq +1 mem_nfreq_index_page +1 mem_ninqy_index +1 mem_fhs_misc + + + +/* lpo related */ +4 mem_subsniff_instant +1 mem_subsniff_rate +2 mem_subsniff_tcmax +1 mem_subsniff_tsniff +1 mem_lpm_adjust +6 mem_sync_clke +1 mem_lpm_current_mult +6 mem_gpio_wakeup + +/* sco & esco */ +1 mem_air_mode +1 mem_sco_asso_handle +2 mem_sco_handle +1 mem_esco_desco +1 mem_esco_type +1 mem_neogotiation_state +1 mem_saved_amaddr +1 mem_esco_arq +1 mem_esco_saved_arq +30 mem_sco_obuf +30 mem_sco_ibuf +1 mem_sco_poll + + + +//page +1 mem_npage_index +1 mem_page_mode +4 mem_page_clk + + +/* test related */ +2 mem_tst_pktcnt_sync +2 mem_tst_pktcnt_hec +2 mem_tst_pktcnt_crc +2 mem_tst_pktcnt_dmh +3 mem_tmp_buffer_head +80 mem_tmp_buffer + + +1 mem_tester_emulate +0 mem_temp_payload +1 test_mode_scenario +1 test_mode_hopping_mode +1 test_mode_tx_freq +1 test_mode_rx_freq +1 test_mode_power_mode +1 test_mode_poll_period +1 test_mode_packet_type +2 test_mode_data_length +1 mem_test_mode_old_debug_config +1 mem_tester_cnt + + +/*temp mem*/ +1 mem_temp_am_addr +1 mem_temp_arq + +// +2 mem_len +4 mem_clkn_bt +4 mem_clke_bt +4 mem_dpll_clkn +1 mem_connection_options + +1 mem_nameres_cnt +2 mem_txptr +2 mem_slot_offset + +//extm +1 extm_fhs_misc +1 extm_newconn_am_addr +3 extm_class +3 extm_lap +1 extm_uap +3 extm_nap + + +//debug +1 mem_debug_config +1 mem_lch_code +1 mem_fhs_am_addr +2 mem_dpll_error +1 mem_select_list_item +0 mem_temp_reconn_record +1 mem_record_bt_mode +6 mem_temp_lap +2 mem_list_item_ptr + +100 mem_eir +) + + +xmemalloc( +/* patch enable 0x4000-0x403f */ + +1 mem_patch00 +1 mem_patch01 +1 mem_patch02 +1 mem_patch03 +1 mem_patch04 +1 mem_patch05 +1 mem_patch06 +1 mem_patch07 +1 mem_patch08 +1 mem_patch09 +1 mem_patch0a +1 mem_patch0b +1 mem_patch0c +1 mem_patch0d +1 mem_patch0e +1 mem_patch0f +1 mem_patch10 +1 mem_patch11 +1 mem_patch12 +1 mem_patch13 +1 mem_patch14 +1 mem_patch15 +1 mem_patch16 +1 mem_patch17 +1 mem_patch18 +1 mem_patch19 +1 mem_patch1a +1 mem_patch1b +1 mem_patch1c +1 mem_patch1d +1 mem_patch1e +1 mem_patch1f +1 mem_patch20 +1 mem_patch21 +1 mem_patch22 +1 mem_patch23 +1 mem_patch24 +1 mem_patch25 +1 mem_patch26 +1 mem_patch27 +1 mem_patch28 +1 mem_patch29 +1 mem_patch2a +1 mem_patch2b +1 mem_patch2c +1 mem_patch2d +1 mem_patch2e +1 mem_patch2f +1 mem_patch30 +1 mem_patch31 +1 mem_patch32 +1 mem_patch33 +1 mem_patch34 +1 mem_patch35 +1 mem_patch36 +1 mem_patch37 +1 mem_patch38 +1 mem_patch39 +1 mem_patch3a +1 mem_patch3b +1 mem_patch3c +1 mem_patch3d +1 mem_patch3e +1 mem_patch3f + + /* 3 device contexts */ +80 mem_context +1 mem_current_amaddr +1 mem_lpm_mode +1 mem_device_option +1 mem_scan_mode +4 mem_last_clkn + + /* parameters */ +8 mem_features +3 mem_lap +1 mem_uap +2 mem_nap +1 mem_npage +3 mem_glap +3 mem_class +2 mem_iscan_window +2 mem_iscan_interval +2 mem_pscan_window +2 mem_pscan_interval +2 mem_page_interval +2 mem_page_window +2 mem_page_to +2 mem_inq_window +1 mem_fcomp_mul +1 mem_fcomp_div +2 mem_rx_window_init +2 mem_rx_window_sniff +2 mem_rf_init_ptr + + /* connection related */ +1 mem_last_type +1 mem_last_type_esco +1 mem_last_type_saved +2 mem_retransmission_cnt +4 mem_next_btclk + +1 mem_rf_rccal +1 mem_handle_num +1 mem_max_slot +1 mem_eir_enable + +/* AFH related */ +4 mem_afh_instant +2 mem_afh_error_total +1 mem_afh_cfg +1 mem_afh_new_mod +5 mem_afh_map_lo +5 mem_afh_map_hi +1 mem_afh_used +2 mem_afh_index +11 mem_afh_map_new +80 mem_afh_map +4 mem_afh_timer +10 mem_afh_classify_channel_map + + + /* lpm related */ +2 mem_chip_functions +2 mem_lpm_wake_lock +2 mem_lpm_interval +1 mem_lpm_overhead +1 mem_lpm_hibernate_switch +1 mem_lpm_doze_switch +1 mem_esco_addr +1 mem_sniff_unint_lost +1 mem_ptt +4 mem_sleep_counter //should be 0x41fc in REVC +4 mem_sleep_counter_all +6 mem_sleep_clkn +3 mem_sniff_rcv +3 mem_sniff_lost +3 mem_clks_per_lpo + +1 mem_lpm_mult +1 mem_lpm_mult_timeout +1 mem_lpm_mult_cnt + +/* 8139-813b lpm_ctrl[31:12] */ +3 mem_lpm_config + +1 mem_lpm_xtalcnt +1 mem_lpm_buckcnt +1 mem_lpm_ldocnt +1 mem_lpm_isogate +1 mem_lpm_isogate_final +16 mem_saved_gpio // should be 0x421e in REVC +3 mem_saved_gsel +8 mem_saved_mark +1 mem_saved_spidctrl +2 mem_patch_ptr +2 mem_patch_len + +32 mem_timers + +/*LINK KEY*/ +1 mem_link_key_exists +16 mem_link_key + + +/* HCI */ +1 mem_hci_cmd +1 mem_hci_conn_handle +3 mem_hci_plap +1 mem_hci_puap +2 mem_hci_pnap + +/*Peripherals*/ +1 mem_uartd_rxitems_got_data +1 mem_uartd_rxitems_threshold +2 mem_uartd_rx_timeout + +1 mem_loadcode_times + +1 mem_tx_lch +2 mem_tx_len + +1 mem_tx_power + +1 mem_context_number + +1 mem_250k_freq_enable + +ifdef DEBUG_RF_INIT +1 mem_rf_init_data +endif +) + +(//bluetooth tx power +0 TX_POWER_0DB +1 TX_POWER_3DB +2 TX_POWER_5DB +3 TX_POWER_f3DB +4 TX_POWER_f5DB + +0x20 TX_POWER_PAIR +) + + +ifdef RAM_VERSION +0x4b17 rom_lpm_sleep +0x4b1d rom_lpm_enter_sleep +0x4b16 rom_lpm_write_ctrl +0x6b1a rom_otpd_read_data +0x6ada rom_otp_write +else +0x3b17 rom_lpm_sleep +0x59e0 rom_save_ucode + +0x4219 rom_mem_lpm_xtalcnt +0x423b rom_mem_patch_ptr +0x423d rom_mem_patch_len + +0x5b1a rom_otpd_read_data +0x5ada rom_otp_write +endif + /* context */ +( +0x01 coffset_mode +0x02 coffset_tsniff +0x04 coffset_sniff_anchor +0x08 coffset_clk_offset +0x0e coffset_rx_window +0x10 coffset_plap +0x16 coffset_conn_handle +0x17 coffset_arq + /* 3.0 only */ +0x18 coffset_lmp_to_send +0x1b coffset_op +0x1c coffset_state_map + /* le only */ +0x18 coffset_le_ch +0x19 coffset_le_hop +0x1a coffset_le_event_cnt + +80 context_size +1 context_num +2 context_num_new +) + +( +0 lpm_flag_wake +1 lpm_flag_loadcode +) + +/* ========= parameters ============== */ +( +0x0050 param_newconn_arq +0x0007 param_esco_addr +0x0010 param_conn_handle +0x01f0 param_conn_handle_comp +0x0020 param_newconnto +0x0008 param_pagerespto +0x0a00 param_snooze_setup_orig +0x5353 param_snooze_ahead_orig +0x00ff param_ninquiry +0x2000 param_page_to +0x0005 param_max_slot +0x0010 param_sco_poll + +/* 6Mhz clock setting */ +ifdef CLK6M +0x0721 param_tx_setup +0x06e8 param_rx_setup +0x04e8 param_rx_setup_earlier +0x0300 param_rf_setup +0x01d8 param_clke_cal +0x0500 param_conn_access +0x0400 param_conn_access_wider +200 param_pll_setup +else +/* 12Mhz clock setting */ +0x0e43 param_tx_setup +0x09d0 param_rx_setup_earlier +0x0600 param_rf_setup +0x03bb param_clke_cal +0x0600 param_conn_access +0x0800 param_conn_access_wider +ifdef FPGA +0x0500 param_pll_setup // 120 is minimum +else +0x0500 param_pll_setup // 120 is minimum +endif +0x0500 param_rx_ahead + +0x0d00 param_rx_setup // 114us before sync +2000 param_dpll_start_delay + +110 param_lpm_fix +10 param_lpo_extra +200 param_lpm_adjmax + +ifdef SIM +20 param_hibernate_clks +3 param_chgpump_delay +else +-1 param_hibernate_clks +3000 param_chgpump_delay +endif + +3 param_featrue_ssp +0x0101 param_lmpext_ssp_enable +339 param_acl_pktlen +30 param_sco_pktlen +1 param_acl_pktcnt /*buffer acl pkt cnt*/ +7 param_sco_pktcnt + + +0x8fffff param_features0 +0x9d83fe param_features1 // not support afh +0x8359 param_features2 +0x000033 param_unap +0x001177 param_lap +0x9e8b33 param_glap +0x002540 param_class//0x180208 //0x002580//402500//240404 +0x12e904 param_hci_version +0x000a04 param_lmp_version//0x0a04 +0x000a06 param_lmp_version0 +0x12e9 param_lmp_subversion +0x0012 param_tisw +0x0012 param_tpsw +0x1000 param_tisi +0x0800 param_tpsi +0x0020 param_page_window +0x0020 param_inq_window +0x1c80 param_supervision_to +39 param_fcomp_div +2 param_fcomp_mul +6 param_name_len +0x535442 param_name +0x344950 param_name1 + + +) + +/* ======= packet types ========= */ +( +0x0 type_null +0x1 type_poll +0x2 type_fhs +0x3 type_dm1 +0x4 type_dh1 +0x5 type_hv1 +0x6 type_hv2 +0x7 type_hv3 +0x8 type_3dh1 +0x9 type_aux1 +0xa type_dm3 +0xb type_dh3 +0xe type_dm5 +0xf type_dh5 +0x10 type_id +0x11 type_shutdown +0x13 type_lmp +) + +/* ========== flag[6] =============== */ +( +0 always /* always 1 */ +1 true /* set/rstn by verify,compare,icompare (true) */ +2 positive /* set/rstn by all alu operations (opcode = 0x03,0x13,0x0f,0x1f), if alu output >= 0 */ +3 timeout /* read only, the timeout from timers */ +5 zero /* set/rstn by all alu operations (opcode = 0x03,0x13,0x0f,0x1f), if alu output == 0 */ +6 crc_failed /* level, cleared by hop_start */ +7 enable_white /* outside mux decide whether to load bt_clk or response_X */ +8 enable_parity /* level */ +9 enable_crc /* level */ +10 enable_hec /* level */ +11 decode_fec1 /* level */ +12 decode_fec2 /* level */ +13 decode_fec0 /* level */ +14 encrypt /* level */ +15 crc16 /* for caculate ccitt crc16 */ +16 swfine /* =0 stop_watch count based on oneslot =1 on 1 clock */ +17 bt_trig +20 rqst_freq /* pulse, to start calculating frequency */ +21 recalc /* pulse, to recalculate the fhs_parity */ +22 init_encrypt /* pulse, issued to initialize encrption */ +23 mhalfbnd /* half slot boundary of clke_rt, or when clke_bt[0] toggles */ +24 sync /* sync found as a result of correlation,set/rstn by correlate opcode */ +25 user10 /* user10 */ +26 kc_p_activate /* pulse to recalc the kc_p */ +27 encode_fec1 /* level */ +28 encode_fec2 /* level */ +29 encode_fec0 /* level */ +30 packet_end /* pulse */ +32 is_tx /* level */ +33 is_rx /* level */ +34 halfslot /* pulse, read only, when clkn_bt[0] toggles */ +35 oneslot /* pulse, read only, when clkn_bt[1] toggles */ +36 mslotbnd /* pulse, read only, when clke_bt[1] toggles */ +37 expire /* level, read only, when selected clock source exceed timeup value */ +38 meet /* level, read only, when selected clock source meet timeup value */ +39 tx_clear /* level, read only, indicate tx pipe is cleared */ +40 user /* user0 */ +41 master /* user1 */ +42 slave2 /* user2 */ +43 wake /* user3 */ +44 user2 /* user4 */ +45 match /* user5 */ +46 attempt /* user6 */ +47 user3 /* user7 */ +48 clknt /* user8 */ +49 user7 /* user9 */ +50 synchronize /* synchronize lpo and regular version of the clock */ +51 lpo_edge /* read only, 3 clocks after risling edge of lpo clock */ +52 blank /* C0 only, means pdata == 0 */ +53 modone /* set divide operation is done */ +54 le /* bluetooth 4.0 LE enable */ +55 aes_ready /* set when aes is ok */ +63 never /* read only, always 0 */ +) + +default flag = always + +/* ========== reg[6] =============== */ +( +0 mark /* for keeping strobes, more permanent */ +1 type /* save and verify during rx */ /* rw */ +2 temp /* general purpose register, 64 bits */ +3 contru /* contr uart */ +4 am_addr /* verify during rx, read and send during tx */ /* ro */ +5 contw /* last mem_addr during write */ +6 contr /* last mem_addr during read */ +7 queue /* the index of qset*,qisolate* commands, ie, if queue = 3, qset/qisolate operate on bit3 */ +8 debug /* can be wired out for observation */ +9 access /* the 72 bit access word */ +10 contwu /* contw uart */ +11 timeup /* when does certain counter expire */ +12 pwindow /* bit 71-61 of pdata; because on rx, bits shifts in from 71 down */ +13 fhs_parity /* re-gernated based on bt_adr( {nap,uap,lap} ) when recalc flag is pulsed */ +14 white_init /* init value of the whitening */ +15 crc24_init /* init crc24 lfsr, 24 bits */ +16 contrub /* uartb read ptr */ +17 rega /* general purpose register, 32 bits */ +18 regb /* general purpose register, 32 bits */ +19 regc /* general purpose register, 17 bits */ +20 regab /* concat of {rega,regb}, thus 64 bits */ +21 radio_ctrl /* radio i/f direct i/o ctrl, check following "radio_ctrl" section */ +22 addhi /* ahb bus address [24:16] */ +23 freq_index /* 7 bit read only */ +24 regd /* regext[1] */ +25 clkn /* {clkn_bt, clkn_rt} */ +26 clke /* {clke_bt, clke_rt} */ +27 stop_watch +28 fhs_misc /* SR, SP, pscan mode */ +29 fhs_class /* class field in fhs */ +30 fhs0 /* read only, bit 0-71 of fhs word */ +31 fhs1 /* read only, bit 72-142 of fhs word */ +32 bt_adr /* r/w, the bt_addr to access gen and freq hopping, contain only lap and uap */ +33 bt_clk /* r/w, the bt_clk for freq hopping */ +34 clkn_bt /* read only, native bluetooth clock, free running 3.2KHz or controlled by RTHALFSLOT register */ +35 clkn_rt /* read only, native realtime clock, free running 12MHz, count from 0-3749, or controlled by RTHALFSLOT register */ +36 freq_mode +/* wire even_train = freq_mode[4]; // odd even train */ +/* wire conn_mode = 3; // connection */ +/* wire iqpgscan_mode = 2; // slave in inquiry and page (not response) */ +/* wire iqpgresp_mode = 1; // slave in inquriy and page (response only) */ +/* wire inqypage_mode = 0; // master in inquiry and page(response or not response) */ +37 xin /* x parameter, read only */ +38 N_tx_slot /* the N factor in equations for Xi,Xp,Xprm,Xprs */ +39 auxcnt +40 clke_bt /* r/w, external bluetooth clock , free running 3.2KHz or controlled by RTHALFSLOT register */ +41 clke_rt /* r/w, external realtime clock, , free running 12MHz, count from 0-3749, or controlled by RTHALFSLOT register */ +42 branch_addr /* last branch address */ +44 lap +45 uap +46 nap +47 regext /* r/w extended 12x32bit registers, indexed by regext_index */ +48 alarm /* r/w, lpo wake up time, this is also how lpo and current clock keep sync */ +49 lpo_time /* read only, this is the value to be copied back to clkn/clke after wakeup */ +50 kc_ls /* secret key, 71: 0 */ +51 kc_ms /* secret key, 127:72 */ +52 g1l /* encryption length */ +53 mask3ff /* for mask 0x3ff operation */ +54 aes_ctrl /* bit[0] init, bit[2:1] mode, bit[3] big endian, bit[4] load data, bit[5] load key */ +55 rege /* regext[3],regext[2] */ +56 regext_index /* index of regext */ +57 loopcnt +58 stack /* current return address */ +59 stack_ptr /* stack depth */ +60 max_stack /* maximum stack ptr */ +61 pc /* direct goto */ +62 null /* to nowhere */ +63 pdata /* the shift register */ +) +default reg = pdata + +/* regext_index */ +( +0 regidx_data +4 regidx_key +8 regidx_xor +12 regidx_result +) + +/* aes_ctrl */ +( +0x01 aes_cbc +0x02 aes_cfb +0x04 aes_192 +0x08 aes_256 +0x10 aes_big_endian +0x20 aes_initialize +0x40 aes_load +0x80 aes_zero +) + +/* ========== radio_ctrl========= */ +( +0 TXGFSK +1 PSK +2 PSK3M +3 RESET +) +/* assign BPWR = radio_ctrl[0]; */ +/* assign PARAMP = radio_ctrl[1]; */ +/* assign XTALPU = radio_ctrl[2]; */ +/* assign SYNTHPU = radio_ctrl[3]; */ +/* assign TXPU = radio_ctrl[4]; */ +/* assign RXPU = radio_ctrl[5]; */ +/* assign SLCTRL = radio_ctrl[6]; */ +/* assign XTALSEL_MUX_SEL = radio_ctrl[7] */ + + +/* =========== destination[4] ============== */ +( +0 bucket +1 rxf +2 back +3 mod +) +default dest = bucket + +/* =========== source[4] ============= */ +( +1 txf +3 demod +) +default source = 0 + + +/* ============== mark ============= *//*0 - 47 */ +( + +0 mark_fhs_eir +1 mark_rxbuf_inuse +2 mark_tx_l2cap +3 mark_switch_initiated +4 mark_accept_switch +5 mark_loopback +7 mark_esco +8 mark_esco_rxok +9 mark_context +10 mark_am_addr_broadcast +11 mark_fhs_already_good +12 mark_page_trainb +13 mark_lpm_mult_enable +14 mark_usb_flag +15 mark_old_packet +16 mark_longpacket +17 mark_testmode +18 mark_ar2 +19 mark_h5tx_rp +20 mark_h5tx_crc +21 mark_h5tx_retransmit +22 mark_h5rx_pstart +23 mark_h5_sync +24 mark_h5_reinit +28 mark_inquiry_on +29 mark_inquiry_state +30 mark_inquiry_trainb +31 mark_periodical_diac +32 mark_all_diac +33 mark_slave_in_rand_accepted +34 mark_reconn_recieve_switch +35 mark_isstr +36 mark_loadcode +37 mark_ext_patch +38 mark_24g +39 mark_24g_conext +40 mark_eeprom_size +// REVAB:max 35, REVC:max 63 +41 mark_ble_tx_md +42 mark_ble_rx_md +43 mark_otp_encrypt +44 mark_role_switch_receive_fhs +) + +( +1 reload_type_otp +2 reload_type_spi +3 reload_type_iic +) + + +/* ============== soft timers ============== */ +( +0 le_adv_interval_timer +1 inquiry_length_timer +2 le_scan_interval_timer +3 page_length_timer +4 iscan_interval_timer +5 pscan_interval_timer +6 switch_wait_timer +7 enpt_delay_timer +8 page_interval_timer +9 key_scan_timer +10 smp_pairing_timer +11 ui_led_blink //led timer ¿ÉÀ©Ơ¹ +12 ui_led_blink1 +13 ui_led_blink2 + +) + +( +1 hci_cmd_inquiry +2 hci_cmd_inquiry_cancel +3 hci_cmd_remote_name_req +4 hci_cmd_remote_feature_req +5 hci_cmd_create_conn +6 hci_cmd_disconn +7 hci_cmd_accept_conn +8 hci_cmd_reject_conn +9 hci_cmd_pair +10 hci_cmd_nopair +11 hci_cmd_linkkey +12 hci_cmd_nokey +13 hci_cmd_auth +14 hci_cmd_stopencrypt +15 hci_cmd_startencrypt +16 hci_cmd_setup_sco +17 hci_cmd_disconn_sco +18 hci_cmd_in_sniff +19 hci_cmd_exit_sniff +20 hci_cmd_remote_version_req +21 hci_cmd_remote_ext_features_req +22 hci_cmd_io_cap +23 hci_cmd_role_discovery +24 hci_cmd_role_switch +25 hci_cmd_accept_with_switch +26 hci_cmd_detach +27 hci_cmd_le_create_conn +28 hci_cmd_accept_sco_conn +80 hci_cmd_wait_remote_feature +81 hci_cmd_wait_remote_ext_feature +82 hci_cmd_wait_remote_name +) + + + +/* ============== debug ============= */ +( +0 debug_neg_skew +1 debug_bitbucket +2 debug_dont_clear_got_tx +3 debug_scatter_enabled +4 debug_tx_fixed_freq +5 debug_rx_fixed_freq +6 debug_tx_pattern +) + +/* ============== tester_emulator ============= */ +( +0 tester_fixed_flow +1 tester_fixed_flow_polarity +2 tester_change +3 tester_exit +4 tester_pattern_test +5 tester_whitening_change +6 tester_fixed_freq +7 tester_no_whitening +) + +/* ============== mode ==========*/ +( +0 mode_le +1 mode_master +2 afh_enable +3 afh_change +4 send_sco_when_slave +5 first_seqnx +) + +/* ============== state_map ==========*/ +( +0 smap_lmptidinit +1 smap_lmptid +2 smap_encryption +3 smap_name_res +4 smap_name_req +5 smap_edr +6 smap_rxlmp +7 smap_rxl2cap +) +( +0 state_inconn +1 state_insniff +2 state_insco +3 state_inpage +4 state_conn_comp +5 state_init_seq +6 state_combkey +7 state_linkkey +) +( +0 op_send_sres +1 op_auth_req +2 op_inrand_req +3 op_disconn +4 op_stop_enc +5 op_start_enc +6 op_txl2cap +7 op_pkt_comp +) + + +/* ============== arq [3] ================ */ +( +0 flow +1 arqn +2 seqn +3 wack +4 flowx /* out */ /* not really in memory */ +5 arqnx /* out */ +6 seqnx /* out */ +7 bcast1 /* first broadcast received */ +) + +/* arq {flow,arqn,seqn}, read/write */ +/* [0] flow r/w acl full status of the other, store during rx, checked during tx */ +/* [1] arqn r/w ack of the other during rx (ack tx fifo), */ +/* [2] seqn r/w seqn of the other, check during rx */ +/* arqx {flowx,arqnx,seqnx} */ +/* [0] flowx r/o flow back to the other, 1 alow send, 0 not to send, read only tx */ +/* [1] arqnx r/w ack to the other, set by rx, send back on tx */ +/* [2] seqnx r/w toggled by arqn, to be send during tx */ + +( +0 llid0 +1 llid1 +2 nesn +3 sn +4 md +5 wak +) + +/* AFH flags */ +( +0 AFH_CFG_ON +1 AFH_CFG_TIMER +2 send_lmp_set_afh +3 AFH_CFG_REPORT_MODE +4 AFH_CFG_MASTER_SENT_REQ +) + +/* LLID CODE */ +( +1 LLID_L2CAP_CONT +2 LLID_L2CAP_START +3 LLID_LMP +) + +/* ============== master_state ==========*/ +( +0 master_in_idle +1 master_in_inquiry +2 master_in_page +10 master_in_becoming_slave +15 master_in_conn +) +( +0 newrev_feature_bettx +1 newrev_feature_betplltx +2 newrev_feature_skip_retransmit +3 newrev_feature_init_radio_after_sleep +4 newrev_feature_no_lpolog +) +/*************mem_pincode_state****************/ +( +0 pincode_state_ilde +1 pincode_state_wait_pincode +2 pincode_state_pincode_ready +) + + +// lpm_write +( +1 lpmreg_sel_ctrl +2 lpmreg_sel_ctrl2 +4 lpmreg_sel_gpiolow +8 lpmreg_sel_gpiohigh +16 lpmreg_sel_counter +) + +//scan_mode +( +0 inq_scan_mode +1 page_scan_mode +2 page_inq_enable +) +//mem_neogotiation_state +( + 0 default_neogotiation_state + 1 prarm_neogotiation +) + +//mem_lpm_wake_lock +( +0 wake_lock_ble_rx +1 wake_lock_ble_tx +2 wake_lock_m0_single + +3 wake_lock_ble_rx_patch +4 wake_lock_ble_tx_patch + +5 wake_lock_ipc_bt2m0 +6 wake_lock_ipc_m02bt +7 wake_lock_button +8 wake_lock_cmd +9 wake_lock_app +10 wake_lock_lmp_tx +11 wake_lock_lmp_rx +12 wake_lock_l2cap_tx +13 wake_lock_l2cap_rx +14 wake_lock_ipc_c512bt +15 wake_lock_ipc_bt2c51 + +) + +( +0 bt_disabled +1 ble_disabled +2 module_disable + +) + +( +0x33 REC_3_MODE +0x34 REC_4_MODE +0x35 REC_4_MODE_STATIC_ADDRESS +0x36 REC_4_MODE_RANDOM_RESOLVABLE_PRIVATE_ADDRESS +0x37 REC_4_MODE_RANDOM_NON_RESOLVABLE_PRIVATE_ADDRESS +) + + +//sniff UART_TX UART_RX +( +6 UART_WAKEUP_TX +7 UART_WAKEUP_RX +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/command.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/command.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/command.format (working copy) @@ -0,0 +1,1407 @@ + +/* Parse Command: +TX: take bits from tx fifo, jam it into shift and a destination (rf,bucket) +RX: take bits from demod, jam it into shift and a destination (acl,sco,bucket) */ + +/* Inject Command: +TX: 0 into shift, send tail of shift into a destination (rf,bucket) +RX: 0 into shift, send tail of shift into a destination (acl,sco,bucket) */ + +format + ! 15 romdat + % d0 + % d1 + % d2 + % d3 + [8] d0 + [8] d1 + [8] d2 + [8] d3 +end + +format + ! 15 enable /* set flag to 1 */ + % flag + [5] opcode + [6] 1 + [6] flag + [6] null + [9] 0 +end + /* High 5 bytes of channel map */ +format + ! 15 pulse /* set flag to 1 */ + % flag + [5] opcode + [6] 1 + [6] flag + [6] null + [9] 0 +end + +format + ! 15 disable /* set flag to 0 */ + % flag + [5] opcode + [6] 2 + [6] flag + [6] null + [9] 0 +end + +format + ! 15 set0 /* set selected bit of reg to 0 */ + % immediate + % reg + [5] opcode + [6] 9 + [6] never + [6] reg + [9] immediate +end + +format + ! 15 set1 /* set selected bit of reg to 1 */ + % immediate + % reg + [5] opcode + [6] 9 /* alu op demux */ + [6] always + [6] reg + [9] immediate +end + +format + ! 15 setflag /* set selected bit of the reg to the polarity of the flag */ + % flag + % immediate + % reg + [5] opcode + [6] 9 + [6] flag + [6] reg + [9] immediate +end + +format + ! 15 nsetflag /* set the selected bit of the reg to the opposite polarity of the flag */ + % flag + % immediate + % reg + [5] opcode + [6] 0x29 + [6] flag + [6] reg + [9] immediate +end + +format + ! 15 setflip /* invert the selected bit of the reg */ + % immediate + % reg + [5] opcode + [6] 10 /* this is alu op */ + [6] always + [6] reg + [9] immediate +end + +format + ! 0x1f qset1 /* demux the lowest 4 bit of queue and OR it with regr into regw */ + % reg /* in short, set the bit in reg indexed by queue to 1 */ + [5] opcode + [6] 9 + [6] always + [6] reg + [9] 0 +end + +format + ! 0x1f qset0 /* demux the lowest 4 bit of queue and AND it with regr into regw */ + % reg /* in short, set the bit in reg indexed by queue to 0 */ + [5] opcode + [6] 9 + [6] never + [6] reg + [9] 0 +end + +format + ! 0x1f qsetflag /* set the bit in reg index by queue to same as flag */ + % flag + % reg + [5] opcode + [6] 9 + [6] flag + [6] reg + [9] 0 +end + +format + ! 0x1f nqsetflag /* set the bit in the reg index by queue to opposite of flag */ + % flag + % reg + [5] opcode + [6] 0x29 + [6] flag + [6] reg + [9] 0 +end + +format + ! 0x1f qsetflip /* flip the bit in reg index by queue */ + % reg + [5] opcode + [6] 10 + [6] always + [6] reg + [9] 0 +end + +format + ! 1 parse /* take bits out of source (sco_tx,tx_buffer,rx-elas) into pdata and dest (sco_rx,rx_fifo,tx-elas) */ + % source + % dest + % immediate + [5] opcode + [4] source /* voice, data, demod */ + [2] 0 + [6] 0 + [2] 0 /* parse or inject */ + [4] dest /* acl, sco, mod, bucket */ + [9] immediate /* number of bits to parse off */ +end + +format + ! 1 inject /* shift data from pdata into destination (tx-elas,rx_fifo,sco_rx) */ + % destination + % immediate + [5] opcode + [4] 0 + [2] 0 + [6] 1 + [2] 0 + [4] destination /* acl,sco,mod,bucket */ + [9] immediate /* number of bits to be injected */ +end + +format + ! 1 iinject + % destination + % regr + [5] opcode + [6] regr /* contain the number of bits to inject */ + [6] 3 + [2] 0 + [4] destination /* acl,sco,mod,bucket */ + [9] 0 +end + +format + ! 1 stuff /* automatic parse, stuff_counter decrement on every bit until hits zero */ + % source + % destination + [5] opcode + [4] source + [2] 0 + [6] 2 + [2] 0 + [4] destination + [9] 0 +end + +format /* force immediate value into registers */ + ! 3 force + % immediate + % regw + [5] opcode + [6] 0 + [6] 0 /* alu operation force */ + [6] regw /* destination register */ + [9] immediate +end + +format /* force whatever is on shift_reg to regsiters */ + ! 0x13 iforce + % regw + [5] opcode + [6] 0 + [6] 0 /* alu operation force */ + [6] regw /* destination register */ + [9] 0 +end + +format /* force immediate value into registers */ + ! 3 increase + % immediate + % reg + [5] opcode + [6] reg + [6] 1 /* alu operation add */ + [6] reg + [9] immediate +end + +format + ! 3 pincrease + % immediate + [5] opcode + [6] -1 /* pdata */ + [6] 1 /* alu add */ + [6] -1 /* back to pdata */ + [9] immediate +end + +format /* force immediate value into registers */ + ! 3 and_into + % immediate + % reg + [5] opcode + [6] reg + [6] 2 /* alu operation and into */ + [6] reg + [9] immediate +end + +format + ! 3 and + % regr + % immediate + % regw + [5] opcode + [6] regr + [6] 2 /* alu operation and into */ + [6] regw + [9] immediate +end + +format + ! 0x13 iand /* pdata & regr -> regw */ + % regr + % regw + [5] opcode + [6] regr + [6] 2 /* alu operation and into */ + [6] regw + [9] 0 +end + + +format /* and whatever is in shiftreg with reg */ + ! 0x13 iand_into + % reg + [5] opcode + [6] reg + [6] 2 /* alu operation and into */ + [6] reg + [9] 0 +end + +format + ! 3 or_into + % immediate + % reg + [5] opcode + [6] reg + [6] 3 /* alu operation or into */ + [6] reg + [9] immediate +end + +format + ! 3 or + % regr + % immediate + % regw + [5] opcode + [6] regr + [6] 3 /* alu operation or into */ + [6] regw + [9] immediate +end + +format + ! 0x13 ior + % regr + % regw + [5] opcode + [6] regr + [6] 3 /* alu operation or into */ + [6] regw + [9] 0 +end + +format + ! 0x13 ior_into + % reg + [5] opcode + [6] reg + [6] 3 /* alu operation or into */ + [6] reg + [9] 0 +end + +format + ! 3 skip_to /* jump to location stored in reg */ + % reg + [5] opcode + [6] reg + [6] 4 /* alu operation copy */ + [6] rom_addr + [9] 0 +end + +format + ! 3 copy + % regr + % regw + [5] opcode + [6] regr + [6] 4 /* alu operation copy */ + [6] regw + [9] 0 +end + +format + ! 3 deposit /* copy the register content thru alu to shift register, not prealigned like preload */ + % reg + [5] opcode + [6] reg + [6] 4 /* alu operation copy */ + [6] -1 /* pdata */ + [9] 0 +end + +format + ! 3 icopy /* copy the shift register lsb content directly to register, not aligned */ + % regw + [5] opcode + [6] -1 /* pdata */ + [6] 4 /* alu copy */ + [6] regw + [9] 0 +end + +format + ! 3 add + % regr + % immediate + % regw + [5] opcode + [6] regr + [6] 1 + [6] regw + [9] immediate +end + +format + ! 0x13 iadd /* regr + pdata -> regw */ + % regr + % regw + [5] opcode + [6] regr + [6] 1 + [6] regw + [9] 0 +end + +format + ! 3 sub /* immediate - regr -> regw */ + % regr + % immediate + % regw + [5] opcode + [6] regr + [6] 12 + [6] regw + [9] immediate +end + +format + ! 0x13 isub /* pdata - regr -> regw */ + % regr + % regw + [5] opcode + [6] regr + [6] 12 + [6] regw + [9] 0 +end + + +format + ! 3 flip + % immediate + % reg + [5] opcode + [6] reg + [6] 5 + [6] reg + [9] immediate +end + +format + ! 0x13 iflip /* use shift register as immediate to do xor */ + % regr + % regw + [5] opcode + [6] regr + [6] 5 + [6] regw + [9] 0 +end + +format + ! 3 xor + % regr + % immediate + % regw + [5] opcode + [6] regr + [6] 5 + [6] regw + [9] immediate +end + +format + ! 3 xor_into + % immediate + % reg + [5] opcode + [6] reg + [6] 5 + [6] reg + [9] immediate +end + +format + ! 0x13 ixor /* pdata xor regr and store result in regw */ + % regr + % regw + [5] opcode + [6] regr + [6] 5 + [6] regw + [9] 0 +end + +format + ! 3 invert + % regr + % regw + [5] opcode + [6] regr + [6] 8 + [6] regw + [9] 0 +end + +format + ! 3 pinvert /* invert pdata into itself */ + [5] opcode + [6] -1 + [6] 8 + [6] -1 + [9] 0 +end + +format + ! 3 div /* regr div immediate div */ + % reg + % immediate + [5] opcode + [6] reg + [6] 13 /* generate diven pulse to div */ + [6] null + [9] immediate +end + +format + ! 0x13 idiv /* pdata div regr data ready at most after 41 nops */ + % reg + [5] opcode + [6] reg + [6] 13 /* generate diven pulse to div */ + [6] null + [9] 0 +end + +format + ! 3 remainder /* harvest div remainder */ + % regw + [5] opcode + [6] 0 + [6] 14 + [6] regw + [9] 0 +end + +format + ! 3 quotient /* harvest div quotient */ + % regw + [5] opcode + [6] 0 + [6] 15 + [6] regw + [9] 0 +end + +format + ! 3 rshift + % regr + % regw + [5] opcode + [6] regr + [6] 6 + [6] regw + [9] 0 +end + +format + ! 3 rshift2 + % regr + % regw + [5] opcode + [6] regr + [6] 22 + [6] regw + [9] 0 +end + +format + ! 3 rshift3 + % regr + % regw + [5] opcode + [6] regr + [6] 18 + [6] regw + [9] 0 +end + +format + ! 3 rshift4 + % regr + % regw + [5] opcode + [6] regr + [6] 35 + [6] regw + [9] 0 +end + +format + ! 3 rshift8 + % regr + % regw + [5] opcode + [6] regr + [6] 25 + [6] regw + [9] 0 +end + +format + ! 3 rshift16 + % regr + % regw + [5] opcode + [6] regr + [6] 34 + [6] regw + [9] 0 +end + +format + ! 3 rshift32 + % regr + % regw + [5] opcode + [6] regr + [6] 30 + [6] regw + [9] 0 +end + +format + ! 3 lshift + % regr + % regw + [5] opcode + [6] regr + [6] 7 + [6] regw + [9] 0 +end + +format + ! 3 lshift2 + % regr + % regw + [5] opcode + [6] regr + [6] 23 + [6] regw + [9] 0 +end + +format + ! 3 lshift8 + % regr + % regw + [5] opcode + [6] regr + [6] 26 + [6] regw + [9] 0 +end + + +format + ! 3 lshift3 + % regr + % regw + [5] opcode + [6] regr + [6] 19 + [6] regw + [9] 0 +end + +format + ! 3 lshift4 + % regr + % regw + [5] opcode + [6] regr + [6] 36 + [6] regw + [9] 0 +end + + +format + ! 3 lshift16 + % regr + % regw + [5] opcode + [6] regr + [6] 32 + [6] regw + [9] 0 +end + +format + ! 3 random /* random number into regw */ + % reg + [5] opcode + [6] 0 + [6] 20 + [6] reg + [9] 0 +end + +format /* bit reverse within a byte */ + ! 3 reverse + % reg + % regw + [5] opcode + [6] reg + [6] 27 + [6] regw + [9] 0 +end + +format + ! 3 priority /* priority encode reg into regw, lsb is the top priority, ie, priority(8'b00010000) = 4 */ + % reg + % regw + [5] opcode + [6] reg + [6] 21 + [6] regw + [9] 0 +end + +format + ! 7 setsect /* set a section of pdata */ + % section /* 0 sets 17:0 of pdata with set_data, 1 sets 35:18, 2 sets 53:36, 3 sets 71:54 */ + % set_data + [5] opcode + [7] 0 + [2] section + [18] set_data +end + +format + ! 10 preload /* load stuff into pdata according to fhs format, check us.v */ + % reg + [5] opcode + [6] reg + [6] 0 + [6] -1 + [9] 0 +end + +format /* load register with pdata content, according to fhs format, check us.v */ + ! 10 ialigned /* all bits are in position */ + % regw + [5] opcode + [6] -1 + [6] 0 + [6] regw + [9] 0 +end + +format /* load register to another according to fhs format */ + ! 10 aligned + % regr + % regw + [5] opcode + [6] regr + [6] 0 + [6] regw + [9] 0 +end + +format + ! 4 branch + % addr + % flag + [5] opcode + [6] 1 + [6] flag + [15] addr +end + +format + ! 4 call + % addr + % flag + [5] opcode + [6] 2 + [6] flag + [15] addr +end + +format + ! 4 rtn + % flag + [5] opcode + [6] 3 + [6] flag + [15] 0 +end + +format + ! 0x0c storer /* write reg to memory, address from immediate then mem_ptr */ + % reg + % num_bytes + % addr + [5] opcode + [6] reg + [4] num_bytes + [17] addr +end + +format + ! 0x0c store /* write pdata to memory, address from immediate then mem_ptr */ + % num_bytes + % addr + [5] opcode + [6] 63 + [4] num_bytes + [17] addr +end + +format + ! 0x0c storet /* write temp to memory, address from immediate then mem_ptr */ + % num_bytes + % addr + [5] opcode + [6] 2 + [4] num_bytes + [17] addr +end + + +format + ! 0x1c istorer /* write regr to memory, address from regaddr */ + % regr + % num_bytes + % regaddr + [5] opcode + [6] regr + [4] num_bytes + [11] 0 + [6] regaddr +end + +format + ! 0x1c istore /* write pdata to memory, address from regaddr */ + % num_bytes + % regaddr + [5] opcode + [6] 63 + [4] num_bytes + [11] 0 + [6] regaddr +end + +format + ! 0x1c istoret /* write temp to memory, address from regaddr */ + % num_bytes + % regaddr + [5] opcode + [6] 2 + [4] num_bytes + [11] 0 + [6] regaddr +end + + +format + ! 0x0d fetchr /* read reg from memory, address from immediate then mem_ptr */ + % reg + % num_bytes + % addr + [5] opcode + [6] reg + [4] num_bytes + [17] addr +end + +format + ! 0x0d fetch /* read pdata from memory, address from immediate then mem_ptr */ + % num_bytes + % addr + [5] opcode + [6] 63 + [4] num_bytes + [17] addr +end + +format + ! 0x0d fetcht /* read temp from memory, address from immediate then mem_ptr */ + % num_bytes + % addr + [5] opcode + [6] 2 + [4] num_bytes + [17] addr +end + +format + ! 0x1d ifetchr /* read regr from memory, address from regaddr */ + % regr + % num_bytes + % regaddr + [5] opcode + [6] regr + [4] num_bytes + [11] 0 + [6] regaddr +end + +format + ! 0x1d ifetch /* read pdata from memory, address from regaddr */ + % num_bytes + % regaddr + [5] opcode + [6] 63 + [4] num_bytes + [11] 0 + [6] regaddr +end + +format + ! 0x1d ifetcht /* read temp from memory, address from regaddr */ + % num_bytes + % regaddr + [5] opcode + [6] 2 + [4] num_bytes + [11] 0 + [6] regaddr +end + + +format + ! 0x0c hstoret /* write to corereg, data from temp, address from immediate won't increment */ + % num_bytes + % addr + [5] opcode + [6] 2 /* memory */ + [4] num_bytes + [1] 0 + [1] 1 + [15] addr +end + +format + ! 0x0d hfetcht /* read from corereg, data into temp, address from immediate won't increment */ + % num_bytes + % addr + [5] opcode + [6] 2 /* memory */ + [4] num_bytes + [1] 0 + [1] 1 + [15] addr +end + +format + ! 0x0c hstore /* write to memory, data from pdata, address from immediate then mem_ptr */ + % num_bytes + % addr + [5] opcode + [6] 63 /* memory */ + [4] num_bytes + [1] 0 + [1] 1 + [15] addr +end + +format + ! 0x0d hfetch /* read from memory, data into pdata, address from immediate then mem_ptr */ + % num_bytes + % addr + [5] opcode + [6] 63 /* memory */ + [4] num_bytes + [1] 0 + [1] 1 + [15] addr +end + + +format + ! 0x0d crc /* read from memory, count from loopcnt, put crc result into pdata */ + % addr + [5] opcode + [6] 0 + [4] 0 + [17] addr +end + +format + ! 0x1d icrc /* read from memory, address from reg, count from loopcnt, put crc result into pdata */ + % reg + [5] opcode + [6] reg /* hold address */ + [4] 0 + [17] 0 +end + +format + ! 0x0e jam + % immediate + % addr + [5] opcode + [2] 0 + [17] addr + [8] immediate +end + +format + ! 0x0e hjam + % immediate + % addr + [5] opcode + [3] 0 + [1] 1 /* msb */ + [15] addr + [8] immediate +end + + +format /* 0x242... */ + ! 4 nbranch + % addr + % flag + [5] opcode + [1] 1 + [5] 1 + [6] flag + [15] addr +end + +format + ! 4 ncall + % addr + % flag + [5] opcode + [1] 1 + [5] 2 + [6] flag + [15] addr +end + +format + ! 4 nrtn + % flag + [5] opcode + [1] 1 + [5] 3 + [6] flag + [15] 0 +end + +format + ! 4 nop + % addr /* no-op for addr+2 clocks */ + [5] opcode + [6] 0 + [6] 0 /* always */ + [15] addr +end + +format + ! 4 clear_stack + [5] opcode + [6] 4 + [6] 0 /* always */ + [15] 0 +end + +format + ! 6 until + % reg + % flag + [5] opcode + [6] reg + [6] flag + [6] 1 + [9] 0 +end + +format + ! 6 correlate /* quit if 1. flag is true 2, regr time up 3, found sync,(cond_true) */ + % reg /* expire counter to check against */ + % flag + [5] opcode + [6] reg + [6] flag + [6] 2 /* correlate */ + [9] 0 +end + +format + ! 5 compare /* sets cond flag, if reg equals immediate */ + % immediate + % reg + % mask + [5] opcode + [6] reg + [3] 0 + [9] mask + [9] immediate +end + +format + ! 0x15 icompare /* sets cond flag, if reg equals pdata */ + % mask + % reg + [5] opcode + [6] reg + [3] 0 + [9] mask + [9] 0 +end + +format /* sets cond. flag, if reg equals LS half of shift reg with MS half of reg being mask */ + ! 5 iverify + % reg + [5] opcode + [6] reg + [3] 2 + [18] 0 +end + +format + ! 0x15 qisolate1 + % reg + [5] opcode + [6] reg + [3] 3 + [18] -1 +end + +format + ! 0x15 qisolate0 + % reg + [5] opcode + [6] reg + [3] 3 + [18] 0 +end + + /* REVAB bug: cannot access bit above 35 */ +format + ! 5 isolate1 + % addr + % reg + [5] opcode + [6] reg + [3] 3 + [9] -1 + [9] addr +end + +format + ! 5 isolate0 + % addr + % reg + [5] opcode + [6] reg + [3] 3 + [9] 0 + [9] addr +end + +format + ! 11 setarg + % immediate + [5] opcode + [27] immediate +end + +format + ! 0x1b arg + % immediate + % reg + [5] opcode + [6] reg + [21] immediate +end + + +format + ! 0 sleep + [5] opcode + [27] 0 +end + +format + ! 0 snooze + [5] opcode + [6] -1 + [21] 0 +end + +format + ! 0 revision + % rev_num + [5] opcode + [27] rev_num +end + +format + ! 0x18 loop /* branch when loopcnt is NOT zero, and decrease loopcnt */ + % addr + [5] opcode + [4] 4 + [8] 0 + [15] addr +end + +format + ! 0x18 beq /* branch when pdata is equal to immediate */ + % imme + % addr + [5] opcode + [4] 0 + [8] imme + [15] addr +end + +format + ! 0x18 bne /* branch when pdata is NOT equal to immediate */ + % imme + % addr + [5] opcode + [4] 1 + [8] imme + [15] addr +end + +format + ! 0x18 rtneq /* return when pdata is equal to immediate */ + % imme + [5] opcode + [4] 2 + [8] imme + [15] 0 +end + +format + ! 0x18 rtnne /* return when pdata is NOT equal to immediate */ + % imme + [5] opcode + [4] 3 + [8] imme + [15] 0 +end + +format + ! 0x18 bbit1 /* branch when pdata's imme bit is 1 */ + % imme + % addr + [5] opcode + [4] 5 + [8] imme + [15] addr +end + +format + ! 0x18 bbit0 /* branch when pdata's imme bit is 0 */ + % imme + % addr + [5] opcode + [4] 6 + [8] imme + [15] addr +end + +format + ! 0x18 rtnbit1 /* return when pdata's imme bit is 0 */ + % imme + [5] opcode + [4] 7 + [8] imme + [15] 0 +end + +format + ! 0x18 rtnbit0 /* return when pdata's imme bit is 0 */ + % imme + [5] opcode + [4] 8 + [8] imme + [15] 0 +end + +format + ! 8 bpatch + % imme + % addr + [5] opcode + [4] 9 + [8] imme + [15] addr +end + +format + ! 8 bpatchx + % imme + % addr + [5] opcode + [4] 14 + [8] imme + [15] addr +end + +format + ! 0x18 bmark1 /* branch when mark's imme bit is 1 */ + % imme + % addr + [5] opcode + [4] 10 + [8] imme + [15] addr +end + +format + ! 0x18 bmark0 /* branch when mark's imme bit is 0 */ + % imme + % addr + [5] opcode + [4] 11 + [8] imme + [15] addr +end + +format + ! 0x18 rtnmark1 /* return when mark's imme bit is 0 */ + % imme + [5] opcode + [4] 12 + [8] imme + [15] 0 +end + +format + ! 0x18 rtnmark0 /* return when mark's imme bit is 0 */ + % imme + [5] opcode + [4] 13 + [8] imme + [15] 0 +end + +format + ! 3 mul32 /* immediate mult regr */ + % regr + % immediate + % regw + [5] opcode + [6] regr + [6] 31 + [6] regw + [9] immediate +end + +format + ! 0x13 imul32 /* pdata mult regr 32x32=64bit */ + % regr + % regw + [5] opcode + [6] regr + [6] 31 + [6] regw + [9] 0 +end + +format + ! 3 product /* harvest mult product */ + % regw + [5] opcode + [6] 0 + [6] 17 + [6] regw + [9] 0 +end + +format + ! 3 byteswap + % regr + % regw + [5] opcode + [6] regr + [6] 33 + [6] regw + [9] 0 +end + +format + ! 3 shasx /* SHA256 Sx operation, immediate is Sx */ + % regr + % immediate + % regw + [5] opcode + [6] regr + [6] 28 + [6] regw + [9] immediate +end + + +format + ! 0x13 regexrot /* regext[0] <- regext[7], regext[1] <- regext[0], regext[2] <- regext[1] ... */ + [5] opcode + [6] 0 + [6] 29 + [6] null + [9] 0 +end + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/hci.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/hci.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/hci.format (working copy) @@ -0,0 +1,569 @@ + + +memalloc( +1 mem_h5rx_ackcnt +1 mem_check_err_acl_cont + +1 mem_rp_packets +2 mem_packet_type + +2 mem_hci_sniff_conn_handle +2 mem_hci_sniff_max_interval +2 mem_hci_sniff_min_interval +2 mem_hci_sniff_attempt +2 mem_hci_sniff_timeout +2 mem_voice_setting +1 mem_retransmission_effort +2 mem_sco_ptype +3 mem_extm_uap_restore + +2 mem_h5rx_rptr +1 mem_h5rx_ack +1 mem_h5tx_ack +2 mem_h5tx_rptr +2 mem_h5tx_wptr +2 mem_h5tx_free +1 mem_h5rx_tmp +1 mem_h5tx_seq + +2 mem_hci_acl_queue_wptr +2 mem_hci_acl_queue_rptr +2 mem_hci_acl_queue_end +1 mem_hci_acl_queue_wcnt +1 mem_hci_acl_cnt + +2 mem_hci_acl_tx_trigger_wptr //tx via uart + + +1 mem_hci_curr_len +2 mem_hci_curr_target +) + +xmemalloc( + +1 mem_hci_lt_rx_state +) + +15 hci_flag_rp +//mem_hci_options bit map +( +1 hci_option_h4 +2 hci_option_protocol2 +3 hci_option_protocol3 +4 hci_option_uart +5 hci_option_usb +6 hci_option_phy2 +7 hci_option_phy3 +) +// UART baud rate @6MHz +( +0 uart_ctrl_bit_enable +3 uart_ctrl_bit_slip_protocol + +) + +//bit map of core_uart_ctrl +( + +) +//bit map of core_uart_status +( +0 uart_status_tx_fifo_full +1 uart_status_tx_fifo_empty +2 uart_status_tx_busy +3 uart_status_rx_fifo_empty + +) +//HCI H4 LOG related +( +0x4850 mem_hci_log +8 hci_log_size +100 hci_log_cnt + +) +//HCI H4 Packet TYPE +( +0x01 HCI_H4_TYPE_CMD +0x02 HCI_H4_TYPE_ACL +0x04 HCI_H4_TYPE_EVENT + +) +// HCI command opcode group field values +( +0x01 HCI_OGF_LINK_CONTROL +0x02 HCI_OGF_LINK_POLICY +0x03 HCI_OGF_BASEBAND +0x04 HCI_OGF_INFO +0x05 HCI_OGF_STATUS +0x06 HCI_OGF_TEST +0x08 HCI_OGF_LOW_ENERGY +0x3e HCI_OGF_LOGO_TESTING +0x3f HCI_OGF_VENDOR_SPECIFIC +) + +// HCI link control opcode command field values, OGF=1 +( +0x01 HCI_INQUIRY +0x02 HCI_INQUIRY_CANCEL +0x03 HCI_PERIODIC_INQUIRY_MODE +0x04 HCI_EXIT_PERIODIC_INQUIRY_MODE +0x05 HCI_CREATE_CONNECTION +0x06 HCI_DISCONNECT +0x07 HCI_ADD_SCO_CONNECTION +0x08 HCI_CREATE_CONNECTION_CANCEL +0x09 HCI_ACCEPT_CONNECTION +0x0A HCI_REJECT_CONNECTION +0x0B HCI_LINK_KEY_REQUEST_REPLY +0x0C HCI_LINK_KEY_REQUEST_NEGATIVE_REPLY +0x0D HCI_PIN_CODE_REQUEST_REPLY +0x0E HCI_PIN_CODE_REQUEST_NEGATIVE_REPLY +0x0F HCI_CHANGE_CONNECTION_PACKET_TYPE +0x11 HCI_AUTHENTICATION_REQUESTED +0x13 HCI_SET_CONNECTION_ENCRYPTION +0x15 HCI_CHANGE_CONNECTION_LINK_KEY +0x17 HCI_MASTER_LINK_KEY +0x19 HCI_REMOTE_NAME_REQUEST +0x1A HCI_REMOTE_NAME_REQUEST_CANCEL +0x1B HCI_READ_REMOTE_SUPPORTED_FEATURES +0x1C HCI_READ_REMOTE_EXT_FEATURES +0x1D HCI_READ_REMOTE_VERSION_INFORMATION +0x1F HCI_READ_CLOCK_OFFSET +0x20 HCI_READ_LMP_HANDLE +0x28 HCI_SETUP_SCO_CONNECTION +0x29 HCI_ACCEPT_SCO_CONNECTION +0x2A HCI_REJECT_SCO_CONNECTION +0x2B HCI_IO_CAP_REQUEST_REPLY +0x2C HCI_USER_CONFIRMATION_REQUEST_REPLY +0x2D HCI_USER_CONFIRMATION_REQUEST_NEGATIVE_REPLY +0x2E HCI_USER_PASSKEY_REQUEST_REPLY +0x2F HCI_USER_PASSKEY_REQUEST_NEGATIVE_REPLY +0x30 HCI_REMOTE_OOB_DATA_REQUEST_REPLY +0x33 HCI_REMOTE_OOB_DATA_REQUEST_NEGATIVE_REPLY +0x34 HCI_IO_CAPABILITY_REQUEST_NEGATIVE_REPLY +0x35 HCI_CREATE_PHYSICAL_LINK +0x36 HCI_ACCEPT_PHYSICAL_LINK +0x37 HCI_DISCONNECT_PHYSICAL_LINK +0x38 HCI_CREATE_LOGICAL_LINK +0x39 HCI_ACCEPT_LOGICAL_LINK +0x3A HCI_DISCONNECT_LOGICAL_LINK +0x3B HCI_LOGICAL_LINK_CANCEL +0x3C HCI_FLOW_SPEC_MODIFY +0x3D HCI_ENHANCED_SETUP_SYNCHRONOUS_CONNECTION +0x3E HCI_ENHANCED_ACCEPT_SYNCHRONOUS_CONNECTION_REQUEST +0x3F HCI_TRUNCATED_PAGE +0x40 HCI_TRUNCATED_PAGE_CANCEL +0x41 HCI_SET_CONNECTIONLESS_SLAVE_BROADCAST +0x42 HCI_SET_CONNECTIONLESS_SLAVE_BROADCAST_RECEIVE +0x43 HCI_START_SYNCHRONIZATION_TRAIN +0x44 HCI_RECEIVE_SYNCHRONIZATION_TRAIN +0x45 HCI_REMOTE_OOB_EXTENDED_DATA_REQUEST_REPLY +) + + +// HCI link policy commands OCF value, OGF=2 +( +0x01 HCI_HOLD_MODE +0x03 HCI_SNIFF_MODE +0x04 HCI_EXIT_SNIFF_MODE +0x05 HCI_PARK_MODE +0x06 HCI_EXIT_PARK_MODE +0x07 HCI_QOS_SETUP +0x09 HCI_ROLE_DISCOVERY +0x0B HCI_SWITCH_ROLE +0x0C HCI_READ_LINK_POLICY_SETTINGS +0x0D HCI_WRITE_LINK_POLICY_SETTINGS +0x0e HCI_READ_DEFAULT_LINK_POLICY_SETTINGS +0x0f HCI_WRITE_DEFAULT_LINK_POLICY_SETTINGS +0x10 HCI_FLOW_SPECIFICATION +0x11 HCI_SNIFF_SUBRATING +) + +// HCI host controller and baseband commands OCF values, OGF=3 +( +0x01 HCI_SET_EVENT_MASK +0x03 HCI_RESET +0x05 HCI_SET_EVENT_FILTER +0x08 HCI_FLUSH +0x09 HCI_READ_PIN_TYPE +0x0A HCI_WRITE_PIN_TYPE +0x0B HCI_CREATE_NEW_UNIT_KEY +0x0D HCI_READ_STORED_LINK_KEY +0x11 HCI_WRITE_STORED_LINK_KEY +0x12 HCI_DELETE_STORED_LINK_KEY +0x13 HCI_WRITE_LOCAL_NAME +0x14 HCI_READ_LOCAL_NAME +0x15 HCI_READ_CONN_ACCEPT_TIMEOUT +0x16 HCI_WRITE_CONN_ACCEPT_TIMEOUT +0x17 HCI_READ_PAGE_TIMEOUT +0x18 HCI_WRITE_PAGE_TIMEOUT +0x19 HCI_READ_SCAN_ENABLE +0x1A HCI_WRITE_SCAN_ENABLE +0x1B HCI_READ_PAGE_SCAN_ACTIVITY +0x1C HCI_WRITE_PAGE_SCAN_ACTIVITY +0x1D HCI_READ_INQUIRY_SCAN_ACTIVITY +0x1E HCI_WRITE_INQUIRY_SCAN_ACTIVITY +0x1F HCI_READ_AUTHENTICATION_ENABLE +0x20 HCI_WRITE_AUTHENTICATION_ENABLE +0x21 HCI_READ_ENCRYPTION_MODE +0x22 HCI_WRITE_ENCRYPTION_MODE +0x23 HCI_READ_CLASS_OF_DEVICE +0x24 HCI_WRITE_CLASS_OF_DEVICE +0x25 HCI_READ_VOICE_SETTING +0x26 HCI_WRITE_VOICE_SETTING +0x27 HCI_READ_AUTOMATIC_FLUSH_TIMEOUT +0x28 HCI_WRITE_AUTOMATIC_FLUSH_TIMEOUT +0x29 HCI_READ_NUM_BROADCAST_RETRANSMISSIONS +0x2A HCI_WRITE_NUM_BROADCAST_RETRANSMISSIONS +0x2B HCI_READ_HOLD_MODE_ACTIVITY +0x2C HCI_WRITE_HOLD_MODE_ACTIVITY +0x2D HCI_READ_TRANSMIT_POWER_LEVEL +0x2E HCI_READ_SCO_FLOW_CONTROL_ENABLE +0x2F HCI_WRITE_SCO_FLOW_CONTROL_ENABLE +0x31 HCI_SET_CONTROLLER_TO_HOST_FLOW_CONTROL +0x33 HCI_HOST_BUFFER_SIZE +0x35 HCI_HOST_NUM_COMPLETED_PACKETS +0x36 HCI_READ_LINK_SUPERVISION_TIMEOUT +0x37 HCI_WRITE_LINK_SUPERVISION_TIMEOUT +0x38 HCI_READ_NUMBER_OF_SUPPORTED_IAC +0x39 HCI_READ_CURRENT_IAC_LAP +0x3A HCI_WRITE_CURRENT_IAC_LAP +0x3B HCI_READ_PAGE_SCAN_PERIOD_MODE +0x3C HCI_WRITE_PAGE_SCAN_PERIOD_MODE +0x3D HCI_READ_PAGE_SCAN_MODE +0x3E HCI_WRITE_PAGE_SCAN_MODE +0x3F HCI_SET_AFH_CHANNEL_CLASSIFICATION + + +0x42 HCI_READ_INQUIRY_SCAN_TYPE +0x43 HCI_WRITE_INQUIRY_SCAN_TYPE +0x44 HCI_READ_INQUIRY_MODE +0x45 HCI_WRITE_INQUIRY_MODE +0x46 HCI_READ_PAGE_SCAN_TYPE +0x47 HCI_WRITE_PAGE_SCAN_TYPE + +0x48 HCI_READ_AFH_CHANNEL_ACCESSMENT_MODE +0x49 HCI_WRITE_AFH_CHANNEL_ACCESSMENT_MODE +0x51 HCI_READ_EXTENDED_INQUIRY_RESPONSE +0x52 HCI_WRITE_EXTENDED_INQUIRY_RESPONSE +0x53 HCI_REFRESH_ENCRYPTION_KEY +0x55 HCI_READ_SIMPLE_PAIRING_MODE +0x56 HCI_WRITE_SIMPLE_PAIRING_MODE +0x57 HCI_READ_LOCAL_OOB_DATA +0x58 HCI_READ_INQUIRY_RESPONSE_TRANSMIT_POWER_LEVEL +0x59 HCI_WRITE_INQUIRY_TRANSMIT_POWER_LEVEL +0x60 HCI_SEND_KEYPRESS_NOTIFICATION +0x5A HCI_READ_DEFAULT_ERRONEOUS_DATA_REPORTING +0x5B HCI_WRITE_DEFAULT_ERRONEOUS_DATA_REPORTING +0x5F HCI_ENHANCED_FLUSH +0x61 HCI_READ_LOGICAL_LINK_ACCEPT_TIMEOUT +0x62 HCI_WRITE_LOGICAL_LINK_ACCEPT_TIMEOUT +0x63 HCI_SET_EVENT_MASK_PAGE_2 +0x64 HCI_READ_LOCATION_DATA +0x65 HCI_WRITE_LOCATION_DATA +0x66 HCI_READ_FLOW_CONTROL_MODE +0x67 HCI_WRITE_FLOW_CONTROL_MODE +0x68 HCI_READ_ENHANCE_TRANSMIT_POWER_LEVEL +0x69 HCI_READ_BEST_EFFORT_FLUSH_TIMEOUT +0x6A HCI_WRITE_BEST_EFFORT_FLUSH_TIMEOUT +0x6B HCI_SHORT_RANGE_MODE +0x6C HCI_READ_LE_HOST_SUPPORT +0x6D HCI_WRITE_LE_HOST_SUPPORT +0x6E HCI_SET_MWS_CHANNEL_PARAMETERS +0x6F HCI_SET_EXTERNAL_FRAME_CONFIGURATION +0x70 HCI_SET_MWS_SIGNALING +0x71 HCI_SET_MWS_TRANSPORT_LAYER +0x72 HCI_SET_MWS_SCAN_FREQUENCY_TABLE +0x73 HCI_SET_MWS_PATTERN_CONFIGURATION +0x74 HCI_SET_RESERVED_LT_ADDR +0x75 HCI_DELETE_RESERVED_LT_ADDR +0x76 HCI_SET_CONNECTIONLESS_SLAVE_BROADCAST_DATA +0x77 HCI_READ_SYNCHRONIZATION_TRAIN_PARAMETERS +0x78 HCI_WRITE_SYNCHRONIZATION_TRAIN_PARAMETERS +0x79 HCI_READ_SECURE_CONNECTIONS_HOST_SUPPORT +0x7A HCI_WRITE_SECURE_CONNECTIONS_HOST_SUPPORT +0x7B HCI_READ_AUTHENTICATED_PAYLOAD_TIMEOUT +0x7C HCI_WRITE_AUTHENTICATED_PAYLOAD_TIMEOUT +0x7D HCI_READ_LOCAL_OOB_EXTENDED_DATA +0x7E HCI_READ_EXTENDED_PAGE_TIMEOUT +0x7F HCI_WRITE_EXTENDED_PAGE_TIMEOUT +0x80 HCI_READ_EXTENDED_INQUIRY_LENGTH +0x81 HCI_WRITE_EXTENDED_INQUIRY_LENGTH +) + + +// HCI informational parameters OCF values, OGF=4 +( +0x01 HCI_READ_LOCAL_VERSION_INFORMATION +0x02 HCI_READ_LOCAL_SUPPORTED_COMMANDS +0x03 HCI_READ_LOCAL_SUPPORTED_FEATURES +0x04 HCI_READ_LOCAL_EXT_FEATURES +0x05 HCI_READ_BUFFER_SIZE +0x07 HCI_READ_COUNTRY_CODE +0x09 HCI_READ_BD_ADDR +0x0A HCI_REJECT_CONNECTION_REQUEST +0x0B HCI_READ_LOCAL_SUPPORTED_CODECS +) + +// HCI status parameters OCF values, OGF=5 +( +0x01 HCI_READ_FAILED_CONTACT_COUNTER +0x02 HCI_RESET_FAILED_CONTACT_COUNTER +0x03 HCI_GET_LINK_QUALITY +0x05 HCI_READ_RSSI +0x06 HCI_READ_AFH_CHANNEL_MAP +0x07 HCI_READ_BD_CLOCK +0x08 HCI_READ_ENCRYPTION_KEY_SIZE +0x09 HCI_READ_LOCAL_AMP_INFO +0x0A HCI_READ_LOCAL_AMP_ASSOC +0x0B HCI_WRITE_REMOTE_AMP_ASSOC +0x0C HCI_GET_MWS_TRANSPORT_LAYER_CONFIGURATION +0x0D HCI_SET_TRIGGERED_CLOCK_CAPTURE +) + +// HCI testing command OCF values, OGF=6 +( +0x01 HCI_READ_LOOPBACK_MODE +0x02 HCI_WRITE_LOOPBACK_MODE +0x03 HCI_ENABLE_DEVICE_UNDER_TEST_MODE +0x04 HCI_WRITE_SIMPLE_PAIRING_DEBUG_MODE +0x07 HCI_ENABLE_AMP_RECEIVER_REPORTS +0x08 HCI_AMP_TEST_END +0x09 HCI_AMP_TEST +0x0A HCI_WRITE_SECURE_CONNECTIONS_TEST_MODE +) + +// HCI vendor specific command OCF values -OGF=3F +( +0x01 HCI_WRITE_BD_ADDR +0x02 HCI_READ_INQUIRY_RESPONSE_TIMEOUT +0x03 HCI_WRITE_INQUIRY_RESPONSE_TIMEOUT +0x04 HCI_READ_PAGE_SCAN_REPETITION_MODE +0x05 HCI_WRITE_PAGE_SCAN_REPETITION_MODE +0x06 HCI_READ_PAGE_RESPONSE_TIMEOUT +0x07 HCI_WRITE_PAGE_RESPONSE_TIMEOUT +0x08 HCI_READ_NEW_CONNECTION_TIMEOUT +0x09 HCI_WRITE_NEW_CONNECTION_TIMEOUT +0x0a HCI_INITIALIZE_BASEBAND +0x0b HCI_WRITE_LOCAL_SUPPORTED_FEATURES +0x0c HCI_WRITE_PARK_PARAMETERS +0x0d HCI_READ_PARK_PARAMETERS +0x0e HCI_WRITE_QUALITY_OF_SERVICE +0x0f HCI_NOT_USED +0x10 HCI_MODIFY_BEACON_PARAMETERS +0x11 HCI_UNPARK_USING_PM_ADDR +0x12 HCI_WRITE_HOPPING_CHANNELS +0x13 HCI_SLEEP_FOREVER_MODE +0x14 HCI_WRITE_AUTO_PAGE_SCAN_ENABLE +0x15 HCI_READ_AUTO_PAGE_SCAN_ENABLE +0x16 HCI_SET_ENCRYPTION_KEY_SIZE +0x17 HCI_INVALIDATE_FLASH_AND_REBOOT +0x18 HCI_UPDATE_UART_BAUD_RATE +0x19 HCI_WRITE_GPIO_1_4_AS_OUTPUT +0x1A HCI_WRITE_GPIO_2_LED +0x1B HCI_SET_TESTMODE_TYPE +0x1C HCI_WRITE_SCO_PCM_INT_PARAM +0x1D HCI_READ_SCO_PCM_INT_PARAM +0x1E HCI_WRITE_PCM_DATA_FORMAT_PARAM +0x1F HCI_READ_PCM_DATA_FORMAT_PARAM +0x20 HCI_WRITE_COMFORT_NOISE_PARAM +0x21 HCI_READ_COMFORT_NOISE_PARAM +0x22 HCI_WRITE_SCO_TS +0x23 HCI_READ_SCO_TS +0x24 HCI_WRITE_PCM_LOOPBACK_MODE +0x25 HCI_READ_PCM_LOOPBACK_MODE +0x26 HCI_SET_TRANSMIT_POWER +0x27 HCI_SET_SLEEPMODE_PARAM +0x28 HCI_READ_SLEEPMODE_PARAM +0x29 HCI_SLEEPMODE_CMD +0x2A HCI_DELAY_PERIPHERAL_SCO_STARTUP +0x2B HCI_WRITE_RECEIVE_ONLY +0x2C HCI_WRITE_RATE_CONTROL +0x2D HCI_TX_UNMOD_CARRIER +0x2E HCI_DOWNLOAD_MINIDRIVER +0x2F HCI_CRYSTAL_PPM +0x30 HCI_SET_POWER_AMP_BIAS +0x31 HCI_SET_HAM_BEHAVIOR +0x32 HCI_SET_AFH_BEHAVIOR +0x33 HCI_READ_USER_DEFINED_NVRAM +0x34 HCI_ENABLE_RADIO +0x35 HCI_READ_DIAGNOSTIC_INFO +0x36 HCI_GET_HID_DEVICE_LIST +0x37 HCI_ADD_HID_DEVICE +0x38 HCI_READ_APP_FW_CONFIG_VERSION +0x39 HCI_DELETE_HID_DEVICE +0x3B HCI_ENABLE_USB_HID_EMULATION +// 0x3A available +// 0x3B available +0x3C HCI_SEND_LMPDU +0x3D HCI_AUTO_PAIR_REQ +0x3E HCI_READ_VS_EXTENSION +0x3F HCI_WRITE_VS_EXTENSION + +0x77 HCI_OPCODE_FC77 +0x79 HCI_OPCODE_FC79 +0xC4 HCI_DOWNLOAD_PATCH +0xCC HCI_OPCODE_FCCC + +0x00 HCI_VENDOR_CMD_RESET +0x01 HCI_VENDOR_CMD_CHIPID +0x02 HCI_VENDOR_CMD_BAUD +0x03 HCI_VENDOR_CMD_PATCH +0x04 HCI_VENDOR_CMD_PATCH_DONE +0x05 HCI_VENDOR_CMD_ECHO +0x06 HCI_VENDOR_CMD_BDADDR + +0x07 HCI_VENDOR_CMD_ENTER_LPM +0x08 HCI_VENDOR_CMD_COMMU_READY + +0x10 HCI_VENDOR_CMD_MEM +0x11 HCI_VENDOR_CMD_EEP + +0X12 HCI_VENDOR_CMD_PATCH_SEC_INIT +0X13 HCI_VENDOR_CMD_PATCH_SEC +) + +//HCI LE controller command OCF values, OGF=8 +( +0x01 HCI_LE_SET_EVENT_MASK +0x02 HCI_LE_READ_BUFFER_SIZE +0x03 HCI_LE_READ_LOCAL_SUPPORTED_FEATURES +0x05 HCI_LE_SET_RANDOM_ADDRESS +0x06 HCI_LE_SET_ADVERTISING_PARAMETERS +0x07 HCI_LE_READ_ADVERTISING_CHANNEL_TX_POWER +0x08 HCI_LE_SET_ADVERTISING_DATA +0x09 HCI_LE_SET_SCAN_RESPONSE_DATA +0x0A HCI_LE_SET_ADVERTISE_ENABLE +0x0B HCI_LE_SET_SCAN_PARAMETERS +0x0C HCI_LE_SET_SCAN_ENABLE +0x0D HCI_LE_CREATE_CONNECTION +0x0E HCI_LE_CREATE_CONNECTION_CANCEL +0x0F HCI_LE_READ_WHITE_LIST_SIZE +0x10 HCI_LE_CLEAR_WHITE_LIST +0x11 HCI_LE_ADD_DEVICE_TO_WHITE_LIST +0x12 HCI_LE_REMOVE_DEVICE_FROM_WHITE_LIST +0x13 HCI_LE_CONNECTION_UPDATE +0x14 HCI_LE_SET_HOST_CHANNEL_CLASSIFICATION +0x15 HCI_LE_READ_CHANNEL_MAP +0x16 HCI_LE_READ_REMOTE_USED_FEATURES +0x17 HCI_LE_ENCRYPT +0x18 HCI_LE_RAND +0x19 HCI_LE_START_ENCRYPTION +0x1A HCI_LE_LONG_TERM_KEY_REQUEST_REPLY +0x1B HCI_LE_LONG_TERM_KEY_REQUEST_NEGATIVE_REPLY +0x1C HCI_LE_READ_SUPPORTED_STATES +0x1D HCI_LE_RECEIVER_TEST +0x1E HCI_LE_TRANSMITTER_TEST +0x1F HCI_LE_TEST_END +0x20 HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_REPLY +0x21 HCI_LE_REMOTE_CONNECTION_PARAMETER_REQUEST_NEGATIVE_REPLY +) +// HCI event code +( +0x01 HCI_EVENT_INQUIRY_COMPLETE +0x02 HCI_EVENT_INQUIRY_RESULT +0x03 HCI_EVENT_CONNECTION_COMPLETE +0x04 HCI_EVENT_CONNECTION_REQUEST +0x05 HCI_EVENT_DISCONNECTION_COMPLETE +0x06 HCI_EVENT_AUTHENTICATION_COMPLETE +0x07 HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE +0x08 HCI_EVENT_ENCRYPTION_CHANGE_COMPLETE +0x09 HCI_EVENT_CHANGE_CONNECTION_LINK_KEY_COMPLETE +0x0A HCI_EVENT_MASTER_LINK_KEY_COMPLETE +0x0B HCI_EVENT_READ_REMOTE_FEATURES_COMPLETE +0x0C HCI_EVENT_READ_REMOTE_VERSION_INFORMATION_COMPLETE +0x0D HCI_EVENT_QOS_SETUP_COMPLETE +0x0E HCI_EVENT_COMMAND_COMPLETE +0x0F HCI_EVENT_COMMAND_STATUS +0x10 HCI_EVENT_HARDWARE_ERROR +0x11 HCI_EVENT_FLUSH_OCCURRED +0x12 HCI_EVENT_ROLE_CHANGE +0x13 HCI_EVENT_NUM_COMPLETED_PACKETS +0x14 HCI_EVENT_MODE_CHANGE +0x15 HCI_EVENT_RETURN_LINK_KEYS +0x16 HCI_EVENT_PIN_CODE_REQUEST +0x17 HCI_EVENT_LINK_KEY_REQUEST +0x18 HCI_EVENT_LINK_KEY_NOTIFICATION +0x19 HCI_EVENT_LOOPBACK_COMMAND +0x1A HCI_EVENT_DATA_BUFFER_OVERFLOW +0x1B HCI_EVENT_MAX_SLOTS_CHANGE +0x1C HCI_EVENT_READ_CLOCK_OFFSET_COMPLETE +0x1D HCI_EVENT_CONNECTION_PACKET_TYPE_CHANGED +0x1E HCI_EVENT_QOS_VIOLATION +0x1F HCI_EVENT_PAGE_SCAN_MODE_CHANGE +0x20 HCI_EVENT_PAGE_SCAN_REPETITION_MODE_CHANGE +0x21 HCI_EVENT_FLOW_SPECIFICATION_COMPLETE +0x22 HCI_EVENT_INQUIRY_RESULT_WITHRSSI +0x23 HCI_EVENT_READ_REMOTE_EXT_FEATURES_COMPLETE +0x2C HCI_EVENT_SCO_CONNECTION_COMPLETE +0x2D HCI_EVENT_SCO_CONNECTION_CHANGED +0x2E HCI_EVENT_SNIFF_SUBRATING +0x2F HCI_EVENT_EXT_INQUIRY_RESULT +0x30 HCI_EVENT_ENCRYPT_KEY_REFRESH_COMPLETE +0x31 HCI_EVENT_IO_CAP_REQ +0x32 HCI_EVENT_IO_CAP_RESPONSE +0x33 HCI_EVENT_USER_CONFIRMATION_REQUEST +0x34 HCI_EVENT_UESR_PASSKEY_REQUEST +0x35 HCI_EVENT_REMOTE_OOB_DATA_REQUEST +0x36 HCI_EVENT_SIMPLE_PAIRING_COMPLETE +0x38 HCI_EVENT_LINK_SUPERVISION_TIMEOUT_CHANGED +0x39 HCI_EVENT_ENHANCED_FLUSH_COMPLETE +0x3B HCI_EVENT_USER_PASSKEY_NOTIFICATION +0x3C HCI_EVENT_KEYPRESS_NOTIFICATION +0x3D HCI_EVENT_REMOTE_HOST_SUPPORTED_FEATURES_NOTIFICATION +0x3E HCI_EVENT_LE_META_EVENT +0x40 HCI_EVENT_PHYSICAL_LINK_COMPLETE +0x41 HCI_EVENT_CHANNEL_SELECTED +0x42 HCI_EVENT_DISCONNECTION_PHYSICAL_LINK_COMPLETE +0x43 HCI_EVENT_PHYSICAL_LINK_LOSS_EARLY_WARNING +0x44 HCI_EVENT_PHYSICAL_LINK_RECOVERY +0x45 HCI_EVENT_LOGICAL_LINK_COMPLETE +0x46 HCI_EVENT_DISCONNECTION_LOGICAL_LINK_COMPLETE +0x47 HCI_EVENT_FLOW_SPEC_MODIFY_COMPLETE +0x48 HCI_EVENT_NUMBER_OF_COMPLETED_DATA_BLOCKS +0x49 HCI_EVENT_AMP_START_TEST +0x4A HCI_EVENT_AMP_TEST_END +0x4B HCI_EVENT_AMP_RECEIVER_REPORT +0x4C HCI_EVENT_SHORT_RANGE_MODE_CHANGE_COMPLETE +0x4D HCI_EVENT_AMP_STATUS_CHANGE +0x4E HCI_EVENT_TRIGGERED_CLOCK_CAPTURE +0x4F HCI_EVENT_SYNCHRONIZATION_TRAIN_COMPLETE +0x50 HCI_EVENT_SYNCHRONIZATION_TRAIN_RECEIVED +0x51 HCI_EVENT_CONNECTIONLESS_SLAVE_BROADCAST_RECEIVE +0x52 HCI_EVENT_CONNECTIONLESS_SLAVE_BROADCAST_TIMEOUT +0x53 HCI_EVENT_TRUNCATED_PAGE_COMPLETE +0x54 HCI_EVENT_SLAVE_PAGE_RESPONSE_TIMEOUT +0x55 HCI_EVENT_CONNECTIONLESS_SLAVE_BROADCAST_CHANNEL_MAP_CHANGE +0x56 HCI_EVENT_INQUIRY_RESPONSE_NOTIFICATION +0x57 HCI_EVENT_AUTHENTICATED_PAYLOAD_TIMEOUT_EXPIRED + +0xFE HCI_EVENT_LOGO_TESTING +0xFF HCI_EVENT_VENDOR_SPECIFIC +) +( +0x01 HCI_VENDOR_EVENT_COMMU_READY +) +//HCI LE SUBEVENT CODE +( +0x01 HCI_LE_SUBEVENT_CONN_COMPLETE +0x02 HCI_LE_SUBEVENT_ADV_REPORT +0x03 HCI_LE_SUBEVENT_CONN_UPDATE_COMPLETE +0x04 HCI_LE_SUBEVENT_REMOTE_FEATURE_COMPLETE +0x05 HCI_LE_SUBEVENT_LTK_REQUEST +0x06 HCI_LE_SUBEVENT_REMOTE_CONN_PARAM_REQ +) + +( +0x00 HCI_LPM_OFF +0x01 HCI_LPM_ON +) + + +( +33 HOST_WAKE_TIME +) + +( +1 HCI_RX_WAKE +0 HCI_RX_READY +) + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/hid.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/hid.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/hid.format (working copy) @@ -0,0 +1,21 @@ + +( +/*HID TYPE*/ +0x01 HID_TYPE_CONTROL +0x04 HID_TYPE_GET_REPORT +0x05 HID_TYPE_SET_REPORT +0x07 HID_TYPE_SET_PROTOCOL +0x09 HID_TYPE_SET_IDLE +0x0a HID_TYPE_DATA +/*HID REPORT ID*/ +0x01 HID_REPORT_ID_KB + +0x00 HID_CONTROL_P_NOOPERATION +0x01 HID_CONTROL_P_HARDRESET +0x02 HID_CONTROL_P_SOFTRESET +0x03 HID_CONTROL_P_SUSPEND +0x04 HID_CONTROL_P_EXITSUSPEND +0x05 HID_CONTROL_P_VIRTUALCABLEUNPLUG +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/l2cap.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/l2cap.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/l2cap.format (working copy) @@ -0,0 +1,450 @@ + +memalloc( +0 mem_l2cap_mem_start +// L2CAP RX +2 mem_l2cap_rxbuff1_len +2 mem_l2cap_rxbuff2_len +2 mem_l2cap_rxbuff_new +1 mem_l2cap_rxbuff_inuse +2 mem_l2cap_payload_ptr +2 mem_l2cap_rx_pkt_length +2 mem_l2cap_rx_cid +1 mem_l2cap_rx_done + + + +// L2CAP TX Signal channel +2 mem_l2cap_signal_tx_buff_ptr +2 mem_l2cap_signal_tx_payload_ptr +2 mem_l2cap_signal_tx_length +// L2CAP TX SDP channel +2 mem_sdp_tx_buff_ptr +2 mem_sdp_tx_payload_ptr +2 mem_sdp_tx_pkt_length +// L2CAP TX RFCOMM channel +2 mem_rfcomm_tx_buff_ptr +2 mem_rfcomm_tx_payload_ptr +2 mem_rfcomm_tx_pkt_length + + + +//L2CAP Util + +2 memL2CAP_T1 + +1 mem_CONTROL_tasks +1 mem_send_config_req + + +1 mem_config_identifier +2 mem_config_req_dest_CID +1 mem_rfcomm_malloc_fail_flag + +//L2CAP STATE MACHINE +1 mem_message_to_uppersm +1 mem_upper_sm_remote_page +1 mem_upper_sm_reconn +1 mem_upper_sm_ss + + +64 mem_tx_malloc_log +0 mem_l2cap_mem_end + + +2 mem_scid +2 mem_cmd_length +2 mem_tt2 +2 mem_tt3 +2 mem_id +2 mem_psm + + +4 mem_l2cap_sdpres_delay_time +) + +xmemalloc( +0 mem_l2cap_xmem_start +//*******************L2CAP TX MULTI-PACKET*********************// +2 mem_l2cap_tx_multi_offset //0 means single packet + +//*******************CHANNEL ID*********************// +2 mem_sdp_remote_cid +2 mem_rfcomm_remote_cid +2 mem_hid_ctrl_remote_cid +2 mem_hid_int_remote_cid +//*******************CHANNEL STATE*********************// +1 mem_sdp_state +1 mem_rfcomm_state +1 mem_hid_control_state +1 mem_hid_interrupt_state +1 mem_spp_state +1 mem_ML2CAP_comm_id + +//*******************L2CAP malloc********************// +1 mem_used_map +0 mem_tx_fifo0 +1 mem_tx_fifo0_map +2 mem_tx_fifo0_ptr +0 mem_tx_fifo1 +1 mem_tx_fifo1_map +2 mem_tx_fifo1_ptr +0 mem_tx_fifo2 +1 mem_tx_fifo2_map +2 mem_tx_fifo2_ptr +0 mem_tx_fifo3 +1 mem_tx_fifo3_map +2 mem_tx_fifo3_ptr +0 mem_tx_fifo_end +256 mem_l2cap_lpm_txbuf +//*******************MISC*********************// +1 mem_l2cap_flow_ctrl_flag +1 mem_l2cap_pending_item +0 mem_l2cap_xmem_end + +) + +( +0 offset_lc_psm +1 offset_lc_state +2 offset_lc_local_cid +4 offset_lc_remote_cid +) + +//mem_l2cap_lpm_txbuf +( +256 l2cap_lpm_txbuf_len +) + +( +4 L2CAP_TX_FIFO_SIZE +8 L2CAP_TX_BUFF_CNT + +) +( +0x0002 L2CAP_SIG_EXT_FEATRUE +0x0003 L2CAP_SIG_FIX_FEATRUE +) + + +( +0 HS_IDLE +1 AG_INIT_CALL +2 HS_INIT_CALL +) +( +0 M_ACL_LINK_ABSENT +1 M_ACL_LINK_EXIST +) + +( +0 L2CAP_INUSE_BUFF1 +1 L2CAP_INUSE_BUFF2 +) +/* upper layer interface w/ lower layer */ +( +1 MAX_NUM_LINKS_ALLOWED +1 MAX_NUM_SCO_ALLOWED +1 ACL_LINK_PRESENT +0 ACL_LINK_ABSENT +) +( +1 L2CAP_RX_DONE +0 L2CAP_RX_CLEAR +) +/* Scheduler */ +( +0 L2CAP_DISCONNECT_INTERRUPT +1 RFCOMM_wants_service +2 L2CAP_sig_Tx_buff_full +3 RFCOMM_Tx_buff_full +4 SDP_Tx_buff_full +5 got_complete_L2CAP_pkt +6 L2CAP_init_Config_Req +7 L2CAP_DISCONNECT_CONTROL +) + +/* mem_CONTROL_tasks2 */ +( +0 UI_NEED_SERVICE +) +/* L2CAP logic channel identifiers (2 bytes) p.261 */ +( +0x0001 L2CAP_signal_channel +0x0050 L2CAP_SDP_channel +0x0051 L2CAP_RFCOMM_channel +0x0052 L2CAP_HID_Control_channel +0x0053 L2CAP_HID_Interrupt_channel +0x0077 L2CAP_AVDTP_signal_channel //------avdtp +0x0078 L2CAP_AVDTP_media_channel +0x0079 L2CAP_AVDTP_report_channel +0x0080 L2CAP_AVDTP_recovery_channel +0x00dd L2CAP_AVCTP_Control_channel +) +/* L2CAP signalling command codes (1 byte) p.284 */ +( +0x00 reserved +0x01 signal_cmd_reject +0x02 signal_connect_req +0x03 signal_connect_rsp +0x04 signal_config_req +0x05 signal_config_rsp +0x06 signal_disconnect_req +0x07 signal_disconnect_rsp +0x08 signal_echo_req +0x09 signal_echo_rsp +0x0a signal_info_req +0x0b signal_info_rsp +) +/* L2CAP signal_command_reject reason code (2 bytes), p.285 */ +( +0x0000 cmd_not_understood +0x0001 signalling_MTU_exceeded +0x0002 invalid_CID_in_req +) +/* L2CAP PSM values used in signal_connect_req (2 bytes), p.286 */ +( +0x0001 PSM_SDP +0x0003 PSM_RFCOMM +0x0005 PSM_TCS +0x0011 PSM_HID_control +0x0013 PSM_HID_interrupt +0x0017 PSM_AVCTP +0x0019 PSM_AVDTP +) +/* L2CAP connection response result code (2 bytes), p.288 */ +( +0x0000 L2CAP_connect_successful +0x0001 L2CAP_connect_pending +0x0002 L2CAP_connect_refused_PSM_unsupported +0x0003 L2CAP_connect_refused_security_block +0x0004 L2CAP_connect_refused_no_resources +) +/* L2CAP connection status values (2 bytes), p.288 */ +( +0x0000 L2CAP_no_info_available +0x0001 L2CAP_authentication_pending +0x0002 L2CAP_authorization_pending +) +/* L2CAP configuration response result code (2 bytes), p.292 */ +( +0x0000 L2CAP_config_success +0x0001 L2CAP_config_failure_bad_parameters +0x0002 L2CAP_config_failure_no_reason +0x0003 L2CAP_config_failure_unknown_options +) +/* L2CAP constant definitions */ +( +128 L2CAP_Rx_buff_size +48 L2CAP_signal_Tx_buff_size +128 SDP_Tx_buff_size +128 RFCOMM_Tx_buff_size +1 AM_ADDRESS +3 DM1TYPE +4 DH1TYPE +11 DH3TYPE +8 DVTYPE +0 channel_state_closed +1 channel_state_config +2 channel_state_open +0x0030 L2CAP_config_MTU_SDP +0xffff L2CAP_config_ftimeout_SDP +0x03e3 L2CAP_config_MTU_RFCOMM +0xffff L2CAP_config_ftimeout_RFCOMM +260 l2cap_max_pkt_len +) + +( +0 FAILURE +1 SUCCESS +2 IN_PROGRESS +) +( +0x00 IDLE +0x01 WAIT_4_BB_PAGE +0x02 WAIT_4_LMP_CONN +0x03 WAIT_4_SCO_CONN +0x04 WAIT_4_SCO_KILLED +) + +/*mem_master_mss*/ +( +0 STOP_ENC +1 SEND_SWITCH_REQ +) +( +0 HF_HS_READY +1 HF_AG_READY +) +/* mem_hf_state */ +( +0 HF_STATE_WAITING_RFCOMM_CONN +1 HF_STATE_HF_SEND_FEATURE +2 HF_STATE_WAITING_AG_FEATURE_OK +3 HF_STATE_HF_SEND_INDICATORS +4 HF_STATE_WAITING_AG_INDICATORS_OK +5 HF_STATE_HF_SEND_CURR_STATUS +6 HF_STATE_WAITING_AG_STATUS_OK +7 HF_STATE_HF_SEND_UPDATE_STATUS +8 HF_STATE_WAITING_AG_UPDATE_STATUS_OK +9 HF_STATE_CONNECTED +0x0a HF_STATE_HF_SEND_RECEIVE_INFO +0x0b HF_STATE_WAITING_AG_INFO +0x0c HF_STATE_HF_SEND_AT_CLIP +0x0d HF_STATE_WAITING_AT_CLIP +0x0e HF_STATE_HF_SEND_AT_CCWA +0x0f HF_STATE_WAITING_AT_CCWA +) +/*mem_hf_call_state*/ +( +0 HF_CALL_STATE_INACTIVE +1 HF_CALL_STATE_SETUP +2 HF_CALL_STATE_ACTIVE +) +/* mem_pairing_state bit definition */ +( +0 PAIR_INQUIRY_START +1 PAIR_INQUIRY_TIME_OUT +2 PAIR_INQUIRY_FAILED +3 PAIR_INQUIRY_SUCCESS +4 PAIR_READY_CONN +5 PAIR_WAIT_CANCEL_RESPONSE +6 PAIR_CONN_SUCCESS +7 PAIR_WAIT_DETACH +) + +/* mem_pairing_mode bit definition */ +( +0 FORCE_AUTHENTICATION +) +/* mem_hid_protecol_type */ +( +0 PROTECOL_BOOT /*default*/ +1 PROTECOL_REPORT +) + +/* mem_upper_sm_reconn */ +( +1 UPPERSM_SEND_SDP_CONN_REQ +2 UPPERSM_SEND_SDP_CFG_REQ +3 UPPERSM_SEND_SDP_HF_SS +4 UPPERSM_SEND_SDP_DISC_REQ +5 UPPERSM_SEND_RFCOMM_CONN_REQ +6 UPPERSM_SEND_RFCOMM_CFG_REQ +7 UPPERSM_SEND_SABM_CMD +8 UPPERSM_SEND_DISC +9 UPPERSM_SEND_WAIT +10 UPPERSM_SEND_HID_CONTROL_CONN_REQ +11 UPPERSM_SEND_HID_CONTROL_CFG_REQ +12 UPPERSM_SEND_HID_INTERRUPT_CONN_REQ +13 UPPERSM_SEND_HID_INTERRUPT_CFG_REQ +14 UPPERSM_SEND_SDP_HS_SS +15 UPPERSM_SEND_SDP_PBAP_SS +16 UPPERSM_SEND_SDP_AVTARG_SS +) +/* mem_upper_sm_remote_page */ +( +1 UPPERSM_RP_SEND_SDP_CONN_REQ +2 UPPERSM_RP_SEND_SDP_CFG_REQ +3 UPPERSM_RP_SEND_SDP_HF_SS +4 UPPERSM_RP_SEND_SDP_HS_SS +5 UPPERSM_RP_SEND_SDP_PBAP_SS +6 UPPERSM_RP_SEND_SDP_AVTARG_SS +7 UPPERSM_RP_SEND_SDP_DISC_REQ +8 UPPERSM_RP_SEND_AVCTP_CONN_REQ +9 UPPERSM_RP_SEND_AVCTP_CFG_REQ +) + +/* mem_ML2CAP_flag */ +( +0 MSCHEDULER_HID_CONTROL_CONN_DONE +1 MSCHEDULER_HID_INTERRUPT_CONN_DONE +2 MSCHEDULER_HID_CONTROL_CFG_REQ_DONE +3 MSCHEDULER_HID_CONTROL_CFG_RSP_DONE +4 MSCHEDULER_HID_INTERRUPT_CFG_REQ_DONE +5 MSCHEDULER_HID_INTERRUPT_CFG_RSP_DONE +6 MSCHEDULER_HID_CONTROL_DISC_DONE +7 MSCHEDULER_HID_INTERRUPT_DISC_DONE +) +/* ui event --add by lj*/ +( +0x00 UI_DATA_EVNET_NONE +0x01 UI_DATA_EVNET_HID +0x02 UI_DATA_EVNET_AVDTP_S +0x03 UI_DATA_EVNET_AVDTP_M +0x04 UI_DATA_EVNET_AVCTP +0x05 UI_DATA_EVNET_HS +0x06 UI_DATA_EVNET_HF +0x07 UI_DATA_EVNET_SPP +0x08 UI_DATA_EVNET_OBEX +) +/* ui ack --add by lj*/ +( +0x00 UI_DATA_TX_NONE +0x01 UI_DATA_TX_HID +0x02 UI_DATA_TX_AVDTP_S +0x03 UI_DATA_TX_AVDTP_M +0x04 UI_DATA_TX_AVCTP +0x05 UI_DATA_TX_HS +0x06 UI_DATA_TX_HF +0x07 UI_DATA_TX_SPP +0x08 UI_DATA_TX_OBEX +0x10 ACL_TX_L2CAP_SIGNAL +0x11 ACL_TX_SDP +0x12 ACL_TX_RFCOMM + +) + +( +0 L2CAP_SDP_interface_conn +1 L2CAP_SDP_interface_cfg +) + +( +0 L2CAP_CHANNEL_STATE_CONN_REQ +1 L2CAP_CHANNEL_STATE_CONN_RES +2 L2CAP_CHANNEL_STATE_SND_CFG_REQ +3 L2CAP_CHANNEL_STATE_SND_CFG_RES +4 L2CAP_CHANNEL_STATE_RCV_CFG_REQ +5 L2CAP_CHANNEL_STATE_RCV_CFG_RES +6 L2CAP_CHANNEL_STATE_RECV_SEARCH_RES +7 L2CAP_CHANNEL_STATE_RECV_ATTRIB_RES +6 L2CAP_CHANNEL_RFCOMM_ONLY_SABM +7 L2CAP_CHANNEL_RFCOMM_ONLY_UA +6 L2CAP_CHANNEL_AVDTP_SIGNAL_INIT //set avdtp init complete +6 L2CAP_CHANNEL_HID_HANDSHAKE_DONE +0x3f L2CAP_CHANNEL_SETUP_COMPLETE +0x7f L2CAP_CHANNEL_AVDTP_SIGNAL_COMPLETE +0xff L2CAP_CHANNEL_RFCOMM_DLCI0_OPENED +) + +/* AVDTP---lj*/ +( +0 L2CAP_AVDTP_SIGNAL_CONNECT +1 L2CAP_AVDTP_SIGNAL_CONFIG +2 L2CAP_AVDTP_MEDIA_CONNECT +3 L2CAP_AVDTP_MEDIA_CONFIG +4 L2CAP_AVDTP_REPORT_CONNECT +5 L2CAP_AVDTP_REPORT_CONFIG +6 L2CAP_AVDTP_RECOVERY_CONNECT +7 L2CAP_AVDTP_RECOVERY_CONFIG +) +/* AVCTP---lj*/ +( +0 L2CAP_AVCTP_SIGNAL_CONNECT +1 L2CAP_AVCTP_SIGNAL_CONFIG +) + +127 L2CAP_SIGNAL_MALLOC_SIZE + +//1 mem_rfcomm_malloc_fail_flag +( +0 RFCOMM_MALLOC_SUCCEED +1 RFCOMM_MALLOC_FAIL +) + +//mem_l2cap_flow_ctrl_flag +( +0 L2CAP_FLOW_CTRL_DISABLE +1 L2CAP_FLOW_CTRL_ENABLE +) + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/le.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/le.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/le.format (working copy) @@ -0,0 +1,734 @@ + +memalloc( +56 mem_le_rxbuf +262 mem_le_l2capbuf + + +/* security temp */ +4 mem_le_mic +4 mem_le_peer_mic +//8 mem_le_skdm +//8 mem_le_skds +16 mem_le_peer_ltk +16 mem_le_mrand + + +/* ========= le context =========== */ +1 mem_le_state +1 mem_le_mode +2 mem_le_tsniff +4 mem_le_anchor +6 mem_le_clk_offset +2 mem_le_receive_window +6 mem_le_plap +1 mem_le_conn_handle +1 mem_le_arq +1 mem_le_ch +1 mem_le_hop +2 mem_le_event_count +4 mem_le_supervision_timer +2 mem_le_instant +1 mem_le_channels +1 mem_le_op + + /* these 3 should NOT be seperated */ +4 mem_le_access +3 mem_le_crcinit +1 mem_le_window_size + + /* these 3 should NOT be seperated */ +2 mem_le_slave_latency +2 mem_le_superto +5 mem_le_channel_map + +2 mem_le_no_using +1 mem_le_peer_sca + +/* should be together */ +1 mem_le_att_opcode +2 mem_le_att_handle + +1 mem_le_err_code +1 mem_le_ll_pairing_fail_reason + +16 mem_le_sk + +/* test */ +1 mem_le_testtype +2 mem_le_test_sync +2 mem_le_test_pcnt + +6 mem_le_rxon_ts + +1 mem_le_rx_ll_opcode + +2 mem_le_notify_attr_start +1 mem_le_notify_len + +1 mem_cmd_le_create_conn + +2 mem_le_cur_attlist_start_ptr +2 mem_le_cur_handle_start +2 mem_le_cur_handle_end +1 mem_le_cur_uuid_length +16 mem_le_cur_uuid + +1 mem_le_curr_att_len +1 mem_le_search_res + +1 mem_le_continue_type + +) + + +xmemalloc( +2 mem_le_dsniff + +// parameters +2 mem_le_conn_interval +1 mem_le_scan_enable +2 mem_le_scan_interval +2 mem_le_scan_window + +1 mem_le_adv_enable +1 mem_le_adv_data_len +31 mem_le_adv_data +1 mem_le_scan_data_len +31 mem_le_scan_data + +//modified name +1 mem_le_name_len +30 mem_le_name + + +5 mem_le_new_map +0 mem_le_new_param +1 mem_le_new_transmitwindowsize +2 mem_le_new_transmitwindowoffset +2 mem_le_new_conninterval +2 mem_le_new_connslavelatency +2 mem_le_new_connsupervisiontimeout + +1 mem_le_txheader +1 mem_le_txlen +2 mem_le_txpayload +2 mem_le_txcid +1 mem_le_l2cap +1 mem_le_l2cap_response +31 mem_le_txbdy + +/* smp related */ +5 mem_le_pcnt_tx +5 mem_le_pcnt_rx +4 mem_le_last_mic +4 mem_le_ivm +4 mem_le_ivs +16 mem_le_ltk +1 mem_ltk_exists +16 mem_le_rconfirm +16 mem_le_srand +1 mem_le_iat +1 mem_le_rat +1 mem_le_preq +1 mem_le_preq_iocap +1 mem_le_preq_oob +1 mem_le_preq_auth +1 mem_le_preq_max_keysize +1 mem_le_preq_init_key_distribution +1 mem_le_preq_resp_key_distribution +1 mem_le_pres +1 mem_le_pres_iocap +1 mem_le_pres_oob +1 mem_le_pres_auth +1 mem_le_pres_max_keysize +1 mem_le_pres_init_key_distribution +1 mem_le_pres_resp_key_distribution + +/* att related */ +2 mem_le_search_handle_start +2 mem_le_search_handle_end +0 mem_le_att_offset +1 mem_le_search_att_type_length +16 mem_le_search_att_type +2 mem_le_notify_handle +1 mem_le_search_uuid_length +16 mem_le_search_uuid + + +//START of LE adv parameter structure +0 mem_le_adv_param +2 mem_le_adv_interval +1 mem_le_adv_type +1 mem_le_adv_own_addr_type +1 mem_le_adv_direct_addr_type +6 mem_le_adv_direct_addr +1 mem_le_adv_channel_map +//END of LE adv parameter structure + +//START of LE conn parameter structure +0 mem_le_conn_param +1 mem_le_conn_peer_addr_type +6 mem_le_conn_peer_addr +1 mem_le_conn_own_addr_type +2 mem_le_interval_min +2 mem_le_interval_max +2 mem_le_latency +2 mem_le_timeout +//START of LE conn parameter structure + +//START of LE scan parameter structure +0 mem_le_scan_params +1 mem_le_scan_type +1 mem_le_scan_own_addr_type +//END of LE scan parameter structure + +3 mem_le_lap +1 mem_le_uap +2 mem_le_nap + + +2 mem_le_local_mtu +2 mem_le_remote_mtu + +8 mem_le_skdm +8 mem_le_skds + +2 mem_le_init_superto +2 mem_ui_le_uuid_table + +1 mem_le_secure_connect_enable +1 mem_le_secure_connect_flag +1 mem_le_sc_calc +1 mem_le_secure_connect_state +1 mem_le_sc_confirm_gkey_flag +1 mem_le_sc_local_key_invalid + + +1 mem_le_pairing_state +1 mem_le_enc_state +1 mem_le_pairing_mode +4 mem_le_tk +2 mem_le_ediv +8 mem_le_rand +16 mem_le_irk + +//LE attribute list +4 mem_le_transmit_window + +//ble General configuration +1 mem_le_configuration +16 mem_le_fixed_ltk +2 mem_le_pairing_handle + +//for continue +2 mem_le_l2cap_size +1 mem_le_packet_len_recved + +//for fifo +1 mem_le_tx_buff_used +2 mem_le_tx_ptr0 +2 mem_le_tx_ptr1 +2 mem_le_tx_ptr2 +2 mem_le_tx_ptr3 + +//ble gatt signaling +1 mem_le_signaling_identifier +2 mem_le_l2cap_signaling_conn_param_update_rsp_result + +1 mem_le_packet_size +1 mem_le_packet_llid +2 mem_le_payload_ptr + +1 mem_le_md_count + +) + + +( +0x000001 param_le_features + +1636 param_sifs +0x1e0 param_clke_cal_le +0xa0 param_le_sca +) + +( +0 DEFAULT_STATES +1 IPHONE_LOST_LTK +2 MODULE_LOST_LTK +3 LTK_NOT_LOST +) + + +( +27 LE_MAX_PAKET_LEN +) + +/* advertising channel PDU type */ +( +0 ADV_IND +1 ADV_DIRECT_IND +2 ADV_NONCONN_IND +3 SCAN_REQ +4 SCAN_RSP +5 CONNECT_REQ +6 ADV_SCAN_IND +) + +( +0x01 GAP_ADTYPE_FLAGS +0x02 GAP_ADTYPE_16BIT_MORE +0x03 GAP_ADTYPE_16BIT_COMPLETE +0x04 GAP_ADTYPE_32BIT_MORE +0x05 GAP_ADTYPE_32BIT_COMPLETE +0x06 GAP_ADTYPE_128BIT_MORE +0x07 GAP_ADTYPE_128BIT_COMPLETE +0x08 GAP_ADTYPE_LOCAL_NAME_SHORT +0x09 GAP_ADTYPE_LOCAL_NAME_COMPLETE +0x0a GAP_ADTYPE_POWER_LEVEL +0xff GAP_ADTYPE_MANUFACTURER_SPECIFIC +) + + + /* LE control packet type */ + ( + 0x00 LL_CONNECTION_UPDATE_REQ + 0x01 LL_CHANNEL_MAP_REQ + 0x02 LL_TERMINATE_IND + 0x03 LL_ENC_REQ + 0x04 LL_ENC_RSP + 0x05 LL_START_ENC_REQ + 0x06 LL_START_ENC_RSP + 0x07 LL_UNKNOWN_RSP + 0x08 LL_FEATURE_REQ + 0x09 LL_FEATURE_RSP + 0x0A LL_PAUSE_ENC_REQ + 0x0B LL_PAUSE_ENC_RSP + 0x0C LL_VERSION_IND + 0x0D LL_REJECT_IND + 0x0E LL_SLAVE_FEATURE_REQ + 0x0F LL_CONNECTION_PARAM_REQ + 0x10 LL_CONNECTION_PARAM_RSP + 0x11 LL_REJECT_IND_EXT + 0x12 LL_PING_REQ + 0x13 LL_PING_RSP + 0x14 LL_LENGTH_REQ + 0x15 LL_LENGTH_RSP + ) + + /* Security Manager Protocol Code */ + ( + 0x01 SMP_PAIRING_REQUEST + 0x02 SMP_PAIRING_RESPONSE + 0x03 SMP_PAIRING_CONFIRM + 0x04 SMP_PAIRING_RANDOM + 0x05 SMP_PAIRING_FAILED + 0x06 SMP_ENCRYPTION_INFORMATION + 0x07 SMP_MASTER_IDENTIFICATION + 0x08 SMP_IDENTITY_INFORMATION + 0x09 SMP_IDENTITY_ADDRESS_INFORMATION + 0x0A SMP_SIGNING_INFORMATION + 0x0B SMP_SECURITY_REQUEST + 0x0c SMP_PAIRING_PUBLIC_KEY + 0x0d SMP_PAIRING_DHKEY_CHECK + ) + + /* L2CAP Signaling OPCODE */ + ( + 0x12 L2CAP_CONNECTION_PARAMETER_UPDATE_REQUEST + 0x13 L2CAP_CONNECTION_PARAMETER_UPDATE_RESPONSE + ) + + /* ATT OPCODE */ + ( + 0x01 ATTOP_ERROR_RESPONSE + 0x02 ATTOP_EXCHANGE_MTU_REQUEST + 0x03 ATTOP_EXCHANGE_MTU_RESPONSE + 0x04 ATTOP_FIND_INFORMATION_REQUEST + 0x05 ATTOP_FIND_INFORMATION_RESPONSE + 0x06 ATTOP_FIND_BY_TYPE_VALUE_REQUEST + 0x07 ATTOP_FIND_BY_TYPE_VALUE_RESPONSE + 0x08 ATTOP_READ_BY_TYPE_REQUEST + 0x09 ATTOP_READ_BY_TYPE_RESPONSE + 0x0A ATTOP_READ_REQUEST + 0x0B ATTOP_READ_RESPONSE + 0x0C ATTOP_READ_BLOB_REQUEST + 0x0D ATTOP_READ_BLOB_RESPONSE + 0x0E ATTOP_READ_MULTIPLE_REQUEST + 0x0F ATTOP_READ_MULTIPLE_RESPONSE + 0x10 ATTOP_READ_BY_GROUP_TYPE_REQUEST + 0x11 ATTOP_READ_BY_GROUP_TYPE_RESPONSE + 0x12 ATTOP_WRITE_REQUEST + 0x13 ATTOP_WRITE_RESPONSE + 0x16 ATTOP_PREPARE_WRITE_REQUEST + 0x17 ATTOP_PREPARE_WRITE_RESPONSE + 0x18 ATTOP_EXECUTE_WRITE_REQUEST + 0x19 ATTOP_EXECUTE_WRITE_RESPONSE + 0x1B ATTOP_HANDLE_VALUE_NOTIFICATION + 0x1D ATTOP_HANDLE_VALUE_INDICATION + 0x1E ATTOP_HANDLE_VALUE_CONFIRMATION + 0x52 ATTOP_WRITE_COMMAND + 0xD2 ATTOP_SIGNED_WRITE_COMMAND + 0x1f ATTOP_CONTINUE + 0x9e EMPTY_LE_DATA_PRE + 0x9f EMPTY_LE_DATA + ) + + /* ATT error code */ + ( + 0x01 ATT_ERR_INVALID_HANDLE + 0x02 ATT_ERR_READ_NOT_PERMITTED + 0x03 ATT_ERR_WRITE_NOT_PERMITTED + 0x04 ATT_ERR_INVALID_PDU + 0x05 ATT_ERR_INSUFFICIENT_AUTHENTICATION + 0x06 ATT_ERR_REQUEST_NOT_SUPPORTED + 0x07 ATT_ERR_INVALID_OFFSET + 0x08 ATT_ERR_INSUFFICIENT_AUTHORIZATION + 0x09 ATT_ERR_PREPARE_QUEUE_FULL + 0x0A ATT_ERR_ATTRIBUTE_NOT_FOUND + 0x0B ATT_ERR_ATTRIBUTE_NOT_LONG + 0x0C ATT_ERR_INSUFFICIENT_ENCRYPTION_KEY_SIZE + 0x0D ATT_ERR_INVALID_ATTRIBUTE_VALUE_LENGTH + 0x0E ATT_ERR_UNLIKELY_ERROR + 0x0F ATT_ERR_INSUFFICIENT_ENCRYPTION + 0x10 ATT_ERR_UNSUPPORTED_GROUP_TYPE + 0x11 ATT_ERR_INSUFFICIENT_RESOURCES + ) + /* SERVICE UUID */ + ( + 0x1800 UUID_SERVICE_GENERIC_ACC + 0x1801 UUID_SERVICE_GENERIC_ATT + 0x180a UUID_SERVICE_DEVICE_INFO + 0x180f UUID_SERVICE_BATTERY + 0x1812 UUID_SERVICE_HIDS + 0x2800 UUID_GATT_PRIMARY_SERVICE + 0x2801 UUID_GATT_SECONDARY_SERVICE + 0X2802 UUID_GATT_INCLUDE + 0X2803 UUID_GATT_CHARACTERISTIC + 0X2A00 UUID_CHRCTR_DEVICE_NAME + 0X2A19 UUID_CHRCTR_BATTERY_LEVEL + 0X2A22 UUID_CHRCTR_KEYBOARD_INPUT + 0X2A23 UUID_CHRCTR_SYSTEM_ID + 0X2A25 UUID_CHRCTR_SERIAL_NUMBER + 0X2A26 UUID_CHRCTR_FIRMWARE + 0X2A32 UUID_CHRCTR_KEYBOARD_OUTPUT + 0X2A33 UUID_CHRCTR_MOUSE_INPUT + 0X2A4A UUID_CHRCTR_HID_INFO + 0X2A4B UUID_CHRCTR_REPORT_MAP + 0X2A4C UUID_CHRCTR_HID_CTRL_POINT + 0X2A4D UUID_CHRCTR_REPORT + 0X2A4E UUID_CHRCTR_PROTOCOL_MODE + ) + + (// pairing failed reason + 0x00 PAIRING_FAILED_RESERVED + 0X01 PAIRING_FAILED_PASSKEY_ENTRY_FAILED + 0X02 PAIRING_FAILED_OOB_NOT_AVAILABLE + 0X03 PAIRING_FAILED_AUTHENTICATION_REQUIRE + 0X04 PAIRING_FAILED_CONFIRM_VALUE_FAILED + 0X05 PAIRING_FAILED_PAIRING_NOT_SUPPORTED + 0X06 PAIRING_FAILED_ENCRYPTION_KEY_SIZE + 0X07 PAIRING_FAILED_COMMAND_NOT_SUPPORTED + 0X08 PAIRING_FAILED_UNSPECIFIED_REASON + 0X09 PAIRING_FAILED_REPEATED_ATTEMPTS + 0X0A PAIRING_FAILED_INVALID_PARAMETERS + 0X0B PAIRING_FAILED_DHKEY_CHECK_FAILED + 0X0C PAIRING_FAILED_NUMERIC_COMPARISON_FAILED + 0X0D PAIRING_FAILED_BR_EDR_PAIRING_IN_PROGRESS + 0X0E PAIRING_FAILED_KEY_DERIVATION_GENERATION_NOT_ALLOWED + ) + + + //BLE ErrorCodes + ( + 0x01 ERROR_UNKNOWN_HCI_COMMAND + 0x02 ERROR_NO_CONNECTION + 0x03 ERROR_HARDWARE_FAILURE + 0x04 ERROR_PAGE_TIMEOUT + 0x05 ERROR_AUTHENTICATION_FAILURE + 0x06 ERROR_KEY_MISSING + 0x07 ERROR_MEMORY_FULL + 0x08 ERROR_CONNECTION_TIMEOUT + 0x09 ERROR_MAX_CONNECTIONS + 0x0A ERROR_MAX_SCO_CONNECTIONS + 0x0B ERROR_MAX_ACL_CONNECTIONS + 0x0C ERROR_COMMAND_DISALLOWED + 0x0D ERROR_HOST_REJECT_LIMITED_RESOURCES + 0x0E ERROR_HOST_REJECT_SECURITY_REASONS + 0x0F ERROR_HOST_REJECT_REMOTE_IS_ONLY_PERSONAL + 0x10 ERROR_HOST_TIMEOUT + 0x11 ERROR_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE + 0x12 ERROR_INVALID_HCI_COMMAND_PARAMETERS + 0x13 ERROR_REMOTE_USER_TERMINATED_CONNECTION + 0x14 ERROR_REMOTE_LOW_RESOURCES + 0x15 ERROR_REMOTE_POWERING_OFF + 0x16 ERROR_CONNECTION_TERMINATED_BY_LOCAL_HOST + 0x17 ERROR_REPEATED_ATTEMPTS + 0x18 ERROR_PAIRING_NOT_ALLOWED + 0x19 ERROR_UNKNOWN_LMP_PDU + 0x1A ERROR_UNSUPPORTED_REMOTE_FEATURE + 0x1B ERROR_SCO_OFFSET_REJECTED + 0x1C ERROR_SCO_INTERVAL_REJECTED + 0x1D ERROR_SCO_AIR_MODE_REJECTED + 0x1E ERROR_INVALID_LMP_PARAMETER + 0x1F ERROR_UNSPECIFIED_ERROR + 0x20 ERROR_UNSUPPORTED_LMP_PARAMETER_VALUE + 0x21 ERROR_ROLE_CHANGE_NOT_ALLOWD + 0x22 ERROR_LMP_RESPONSE_TIMEOUT + 0x23 ERROR_ERROR_TRANSACTION_COLLISION + 0x24 ERROR_LMP_PDU_NOT_ALLOWED + 0x25 ERROR_ENCRYPTION_MODE_NOT_ACCEPTABLE + 0x26 ERROR_UNIT_KEY_USED + 0x27 ERROR_QOS_NOT_SUPPORTED + 0x28 ERROR_INSTANT_PASSED + 0x29 ERROR_PAIRING_W_UNIT_KEY_NOT_SUPPORTED + 0x2a ERROR_DIFFERENT_TRANSACTION_COLLISION + 0x2c ERROR_QOS_UNACCEPTABLE_PARAMETER + 0x2d ERROR_QOS_REJECTED + 0x2e ERROR_CHANNEL_CLASSIFICATION_NOT_SUPPORTED + 0x2f ERROR_INSUFFICIENT_SECURITY + 0x30 ERROR_PARAMETER_OUT_OF_MANDATORY_PANGE + 0x32 ERROR_ROLE_SWITCH_PENDING + 0x34 ERROR_RESERVED_SLOT_VIOLATION + 0x35 ERROR_ROLE_SWITCH_FAILED + 0x36 ERROR_EXTENDED_INQUIRY_RESPONSE_TOO_LARGE + 0x37 ERROR_SIMPLE_PAIRING_NOT_SUPPORTED_BY_HOST + 0x38 ERROR_HOST_BUSY_PAIRING + ) + + + //modified_name + ( + 0x14 MAX_NAME_LEN + 0x16 ADV_DATA_NAME_LEN + 0X20 SPACE + + ) + /* GATT Specifications*/ + ( + 0X2900 CHARACTERTIC_EXTENDED_PROPERTIES + 0X2901 CHARACTERTIC_USER_DESCRIPTION + 0X2902 CLIENT_CHARACTERTIC_CONFIGURATION + 0X2903 SERVER_CHARACTERTIC_CONFIGURATION + 0X2904 CHARACTERTIC_PRESENTATION_FORMAT + 0X2905 CHARACTERTIC_AGGREGATE + 0X2906 VALID_RANGE + 0X2907 EXTERNAL_REPORT_REFERENCE + 0X2908 REPORT_REFERENCE + 0X290B ENVIR_SENSING_CONFIGURATION + 0X290C ENVIR_SENSING_MEASUREMENT + 0X290D ENVIR_SENSING_TRIGGER_SETTING + ) + /* LE L2CAP CID */ + ( + 0x0004 LE_L2CAP_CID_ATT + 0x0005 LE_L2CAP_CID_SIGNAL + 0x0006 LE_L2CAP_CID_SMP + ) + + //LE address type + ( + 0 LE_ADDR_TYPE_PUBLIC + 1 LE_ADDR_TYPE_RANDOM + ) + //LE address type bitmap + ( + 7 LE_RECEIVER_ADDR_BIT + 6 LE_SENDER_ADDR_BIT + ) + //LE SCAN TYPE + ( + 0x00 LE_SCAN_TYPE_PASSIVE //no SCAN_REQ shall be sent + 0x01 LE_SCAN_TYPE_ACTIVE + ) + + //LE SCAN ENABLE + ( + 0x00 LE_SCAN_DISABLE + 0x01 LE_SCAN_ENABLE + 0x0101 LE_ACTIVE_SCAN_ENABLE + ) + + //LE FIND INFORMATION RESPONSE + //THE FORMAT OF THE INFORMATION DATA + ( + 0x01 UUID_SIZE_16BIT + 0x02 UUID_SIZE_128BIT + ) + + ( + 0x0000 BLE_SIGNALING_CONNECT_PARAMETER_UPDATE_ACCEPTED + 0x0001 BLE_SIGNALING_CONNECT_PARAMETER_UPDATE_REJECTED + ) + +// le_state_map 0-2 is reserved for state_inconn,state_insniff and state_sco +( +3 lestate_got_first_packet +4 lestate_encryption +5 lestate_update_param +6 lestate_update_map +) + +// le mode +( +0 lemode_idle +1 lemode_slave +3 lemode_master +) + + +( +0x01 LLID_CONTINUE +0x02 LLID_START +0x03 LLID_LE_LL +0x01 LLID_EMPTY +) + +( +4 LE_TX_BUFF_COUNT +3 LE_TX_BUFF_UPDATE_LOOPCNT //LE_TX_BUFF_COUNT-1 + +12 LE_MD_MAX_COUNT +) + + +( +0 LE_INITATOR_LTK_BIT +1 LE_INITATOR_IRK_BIT +2 LE_INITATOR_CSRK_BIT +) + +( +0x00 LE_PAIRING_MODE_NONE +0x01 LE_PAIRING_MODE_LAGACY_JUSTWORK +0x02 LE_PAIRING_MODE_LAGACY_PASSKEY +0x81 LE_PAIRING_MODE_SECURE_CONNECT_JUSTWORK +0x82 LE_PAIRING_MODE_SECURE_CONNECT_NUMERIC +0x83 LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY + +7 LE_PAIRING_MODE_SECURE_CONNECT_BIT +) + + +( +0 FLAG_IOCAP_DISPLAYONLY +1 FLAG_IOCAP_DISPLAYYESNO +2 FLAG_IOCAP_KEYBOARDONLY +3 FLAG_IOCAP_NOINPUTNOOUTPUT +4 FLAG_IOCAP_KEYBOARDDISPLAY + +0x00 FLAG_OOB_DATA_FLAG_NO +) + +( +0x00 FLAG_LE_NO_BONDING_NO_MITM +0x01 FLAG_LE_BONDING_NO_MITM +0x04 FLAG_LE_NO_BONDING_MITM +0x05 FLAG_LE_BONDING_MITM +0x09 FLAG_LE_BONDING_NO_MITM_SECURE +0x0D FLAG_LE_BONDING_MITM_SECURE + +2 LE_AUTH_MITM_BIT +3 LE_AUTH_SECURE_CONNECTION_PAIRING_BIT +) + +( +0 LE_FIND_BY_TYPE_VAL_RES_NOT_FOUND +1 LE_FIND_BY_TYPE_VAL_RES_FOUND_STARTING_HANDLE +2 LE_FIND_BY_TYPE_VAL_RES_FOUND_ENDING_HANDLE + +) + +( +0 MASTER_PUBLIC_ADDR +1 MASTER_RANDOM_ADDR +) + +( +0x06 LE_ERR_PIN_OR_KEY_MISSING +) + + +( +96000 TIMER_SMP_PAIRING_TIMEOUT //30S +) +//mem_le_pairing_state +( +0 FLAG_LE_PAIRING_NULL +1 FLAG_LE_PAIRING_START +2 FLAG_LE_PAIRING_SEND_RECURITY_REQ +3 FLAG_LE_PAIRING_RCV_PAIRING_REQ +4 FLAG_LE_PAIRING_AUTH +5 FLAG_LE_PAIRING_AFTER_AUTH +6 FLAG_LE_PAIRING_SEND_START_ENC_RSP +7 FLAG_LE_PARING_SEND_ENC_INFORMATION +8 FLAG_LE_PARING_SEND_MASTER_IDENTIFICATION +9 FLAG_LE_PARING_SEND_INDENTITY_INFORMATION +0xff FLAG_LE_PAIRING_END +) + + + +/*LE secure connect state */ +( +0x00 LE_SC_STAT_NULL +0x01 LE_SC_STAT_RECEIVE_PUBLIC_KEY +0x02 LE_SC_STAT_WAIT_SEND_PUBLIC_KEY +0x03 LE_SC_STAT_SEND_PUBLIC_KEY +0x04 LE_SC_STAT_RECEIVE_RANDOM +0x05 LE_SC_STAT_SEND_RANDOM +0x06 LE_SC_STAT_RECEIVE_DHKEY +0x07 LE_SC_STAT_WAIT_CONFIRM_GKEY +0x08 LE_SC_STAT_PASSKEY_WAIT_CONFIRM +) + + +( +0 FLAG_LE_SC_CONFRIM_NULL +1 FLAG_LE_SC_CONFRIM_GKEY_OK +) + +//mem_le_enc_state +( +0 FLAG_LE_ENC_NULL +1 FLAG_LE_RCV_ENC_START +2 FLAG_LE_ENC_PAUSE +3 FLAG_LE_RCV_START_ENC_RSP +4 FLAG_LE_SEND_START_ENC_RSP +0xff FLAG_LE_ENC_END +) + +(//mem_le_configuration +//bit0:use fixed key , ble passkey pairing +0 BIT_BLE_PASSKEY_FIXED_KEY +//bit1:ble pairing use fixed long term key +1 BIT_BLE_PAIRING_FIXED_LTK +//bit2:ble transmit packet will set more data flag +2 BIT_BLE_TRANSMIT_PACKET_BY_MD +//bit3:master read handle, with requires an authenticated link +3 BIT_BLE_READ_AUTH +//bit4:master write handle, with requires an authenticated link +4 BIT_BLE_WRITE_AUTH +//bit5:cannot enter long sleep +5 BIT_BLE_SHORT_MULT + +) + +( +0 BIT_ADV_CHANNEL_MAP_37 +1 BIT_ADV_CHANNEL_MAP_38 +2 BIT_ADV_CHANNEL_MAP_39 +) + +( +0 BIT_CHARACTERISTIC_BROADCAST +1 BIT_CHARACTERISTIC_READ +2 BIT_CHARACTERISTIC_WRITE_WITHOUT_RESPONSE +3 BIT_CHARACTERISTIC_WRITE +4 BIT_CHARACTERISTIC_NOTIFY +5 BIT_CHARACTERISTIC_INDICATE +6 BIT_CHARACTERISTIC_SIGNED_WRITE +7 BIT_CHARACTERISTIC_EXTENDED_PROPERTIES +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/lmp.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/lmp.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/lmp.format (working copy) @@ -0,0 +1,224 @@ + +memalloc( + +1 mem_lmo_header_length +1 mem_lmo_header_opcode +17 mem_lmo_payload +1 mem_lmi_accepted_opcode +1 mem_disconn_reason_send +1 mem_tx_fixed_freq +1 mem_rx_fixed_freq +1 mem_ext_features_page +2 mem_lmpext_ssp_enable +1 mem_remote_sppcap + +1 mem_lmp_conn_state +2 mem_soft_timer +1 mem_pincode_state + +1 mem_sres_tid +1 mem_accptsco_tid + +1 mem_auth_enable +1 mem_wait_encryption + +16 mem_sniff_payload +4 mem_aurand_send_delay_time +) + +xmemalloc( +3 mem_lmp_version +2 mem_lmp_subversion +1 mem_local_name_length +3 mem_local_name +64 mem_local_name2 +1 mem_local_name_end +1 mem_unsniff2sniff_timer +1 mem_switch_flag +1 mem_classic_bt_flag +) + + ( + //bit flag:mem_classic_bt_flag + 0 FLAG_SSP_REJECT_JUSTWORK + 1 SHORT_MULT_FLAG + ) + + ( + //bit map + 0 pair_state_inrand + 1 pair_state_inrand_acpt + 2 pair_state_send_comb + 3 pair_state_recv_comb + 4 pair_state_send_aurand + 5 pair_state_recv_sres + 6 pair_state_recv_aurand + 7 pair_state_send_sres + ) + /* LMP opcodes */ + ( + 1 LMP_NAME_REQ + 2 LMP_NAME_RES + 3 LMP_ACCEPTED + 4 LMP_NOT_ACCEPTED + 5 LMP_CLKOFFSET_REQ + 6 LMP_CLKOFFSET_RES + 7 LMP_DETACH + 8 LMP_IN_RAND + 9 LMP_COMB_KEY + 10 LMP_UNIT_KEY + 11 LMP_AU_RAND + 12 LMP_SRES + 13 LMP_TEMP_RAND + 14 LMP_TEMP_KEY + 15 LMP_ENCRYPTION_MODE_REQ + 16 LMP_ENCRYPTION_KEY_SIZE_REQ + 17 LMP_START_ENCRYPTION_REQ + 18 LMP_STOP_ENCRYPTION_REQ + 19 LMP_SWITCH_REQ + 20 LMP_HOLD + 21 LMP_HOLD_REQ + 23 LMP_SNIFF_REQ + 24 LMP_UNSNIFF_REQ + 26 LMP_PARK_REQ + 27 LMP_SET_BROADCAST_SCAN_WINDOW + 28 LMP_MODIFY_BEACON + 29 LMP_UNPARK_BD_ADDR_REQ + 30 LMP_UNPARK_PM_ADDR_REQ + 31 LMP_INCR_POWER_REQ + 32 LMP_DECR_POWER_REQ + 33 LMP_MAX_POWER + 34 LMP_MIN_POWER + 35 LMP_AUTO_RATE + 36 LMP_PREFERRED_RATE + 37 LMP_VERSION_REQ + 38 LMP_VERSION_RES + 39 LMP_FEATURES_REQ + 40 LMP_FEATURES_RES + 41 LMP_QUALITY_OF_SERVICE + 42 LMP_QUALITY_OF_SERVICE_REQ + 43 LMP_SCO_LINK_REQ + 44 LMP_REMOVE_SCO_LINK_REQ + 45 LMP_MAX_SLOT + 46 LMP_MAX_SLOT_REQ + 47 LMP_TIMING_ACCURACY_REQ + 48 LMP_TIMING_ACCURACY_RES + 49 LMP_SETUP_COMPLETE + 50 LMP_USE_SEMI_PERMANENT_KEY + 51 LMP_HOST_CONNECTION_REQ + 52 LMP_SLOT_OFFSET + 53 LMP_PAGE_MODE_REQ + 54 LMP_PAGE_SCAN_MODE_REQ + 55 LMP_SUPERVISION_TIMEOUT + 56 LMP_TEST_ACTIVATE + 57 LMP_TEST_CONTROL + 58 LMP_ENC_KEY_SIZE_MASK_REQ + 59 LMP_ENC_KEY_SIZE_MASK_RES + 60 LMP_SET_AFH + + /* simple pairing support */ + 61 LMP_ENCAPSULATED_HEADER + 62 LMP_ENCAPSULATED_PAYLOAD + 63 LMP_SIMPLE_PAIRING_CONFIRM + 64 LMP_SIMPLE_PAIRING_NUMBER + 65 LMP_DHKEY_CHECK + 127 LMP_ESCAPE + 127 LMP_ESCAPE_4 /* add 2bytes LMP header support */ + ) + /* LMP EXT opcodes, ORed with bit 7 to make difference to nonEXT */ + ( + 129 LMP_EXT_ACCEPTED + 130 LMP_NOT_ACCEPTED_EXT + 131 LMP_EXT_FEATURES_REQ + 132 LMP_EXT_FEATURES_RES + 139 LMP_PACKET_TYPE_TABLE_REQ + 140 LMP_EXT_ESCO_LINK_REQ + 141 LMP_EXT_REMOVE_ESCO_REQ + 144 LMP_EXT_CHN_CLASSIFICATION_REQ + 145 LMP_EXT_CHN_CLASSIFICATION + 149 LMP_SNIFF_SUBRATING_REQ + 150 LMP_SNIFF_SUBRATING_RES + 151 LMP_PAUSE_ENCRYPTION_REQ + 152 LMP_RESUME_ENCRYPTION_REQ + 153 LMP_IO_CAP_REQ + 154 LMP_IO_CAP_RES + ) + /* LMP reason codes */ + ( + 0x05 AUTHENTICATION_FAILURE_ERROR + 0x06 KEY_MISSING + 0x0b ACL_CONNECTION_ALREADY_EXISTS + 0x13 OTHER_END_TERMINATED + 0x15 ABOUT_TO_POEWR_OFF + 0x16 LOCAL_HOST + 0x18 PAIRING_NOT_ALLOWED + 0x19 UNKNOWN_LMP_PDU + 0x1A UNSUPPORTED_LMP_FEATURE + 0x1F UNSPECIFIED_ERROR + 0x20 UNSUPPORTED_PARAMETERS + 0x21 SWITCH_NOT_ALLOWED + 0x23 TRANSACTION_COLLISION + 0x24 PDU_NOT_ALLOWED + 0x25 ENCRYPTION_MODE_NOT_ACCEPTABLE + 0x2e NOT_SUPPORT_CHN_CLASSIFICATION + 0x37 NOT_SUPPORT_SSP + ) + + /* test mode scenarios */ + ( + 0 PAUSE_TEST_MODE + 1 ZERO_PATTERN + 2 ONE_PATTERN + 3 ALT_PATTERN + 4 PSEUDORANDOM + 5 CLOSED_LOOP_BACK_ACL + 6 CLOSED_LOOP_BACK_SCO + 7 ACL_WITHOUT_WHITENING + 8 SCO_WITHOUT_WHITENING + 9 ALT2_PATTERN + 255 EXIT_TEST_MODE + ) + /* test mode hoppig modes */ + ( + 0 FIXED_FREQ + 1 NORMAL_HOP + ) + + /* mem_lmp_tid indicates which type of LMP will be sent */ + ( + 0 TID_NORM_REPLY + 1 TID_NORM_SEND + 2 TID_ONE + 3 TID_ZERO + 4 TID_PAIRING + 5 TID_ENCRYPTION + 6 TID_VARIABLE + 7 TID_RX + ) + + /* ============== lmp status ==========*/ + ( + 0 lmp_incoming + 1 lmp_outgoing + 2 lmp_reject_msg + 3 lmp_clear_msg + 4 upper_reject_msg + 5 upper_clear_msg + ) + +( +0x2ee00 TIMER_ONE_MINUTE //96000*2 +80 TIMER_SWITCH_WAITE +12 TIMER_ENPT_WAITE +) + +( +0 SWITCH_FLAG_INIT +1 SWITCH_FLAG_ACCEPT +2 SWITCH_FLAG_NOT_ACCEPT +) +( +0 NULL_ENCRYP +1 DONE_ENCRYP +) + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/memblocks.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/memblocks.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/memblocks.format (working copy) @@ -0,0 +1,66 @@ +// +// +//Large memory blocks defined in this file. +//Blocks Shall be defined with absolute address. +//Blocks' length Shall be specified in comment following Blocks' names. +//Different blocks MAY be overlap. +//Blocks defined in this file Shall NOT be overlap with variable in memmap.format. + +// USB C51 exchange area +( +0xff0 mem_mcmd +0xff1 mem_mouse_data +) + +//l2cap RX buffers +( +0x1000 mem_l2cap_rxbuff1 //0x400 +0x1400 mem_l2cap_rxbuff2 //0x400 +//end address:0x17ff +) +//l2cap TX buffers +( +0x1800 mem_tx_buff0 //128 +0x1880 mem_tx_buff1 //128 +0x1900 mem_tx_buff2 //128 +0x1980 mem_tx_buff3 //128 +0x1a00 mem_tx_buff4 //128 +0x1a80 mem_tx_buff5 //128 +0x1b00 mem_tx_buff6 //128 +0x1b80 mem_tx_buff7 //128 +//end address: 0x1bff +) + +( +0x1800 mem_le_tx_buffer0 +0x1900 mem_le_tx_buffer1 +0x1a00 mem_le_tx_buffer2 +0x1b00 mem_le_tx_buffer3 +//end addr:0x1dff +) + + +//uart buffer +( +0x1800 mem_h5rx_buf//0x400 +0x1bff mem_h5rx_buf_end +0x1c00 mem_h5tx_buf +0x1fff mem_h5tx_buf_end +) + +( +0x4c00 mem_module_rx_buf//0x400 +0x4c00 mem_module_rx_buf_little +0x4fff mem_module_rx_buf_end +0x1c00 mem_module_tx_buf +0x1fff mem_module_tx_buf_end +) + +( +0x1800 mem_ir_record +0x1c mem_ir_record_max +) + + +endif + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/patch.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/patch.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/patch.format (working copy) @@ -0,0 +1,516 @@ + +( + 0 patch00_0 + 1 patch00_1 + 2 patch00_2 + 3 patch00_3 + 4 patch00_4 + 5 patch00_5 + 6 patch00_6 + 7 patch00_7 + 8 patch01_0 + 9 patch01_1 + 10 patch01_2 + 11 patch01_3 + 12 patch01_4 + 13 patch01_5 + 14 patch01_6 + 15 patch01_7 + 16 patch02_0 + 17 patch02_1 + 18 patch02_2 + 19 patch02_3 + 20 patch02_4 + 21 patch02_5 + 22 patch02_6 + 23 patch02_7 + 24 patch03_0 + 25 patch03_1 + 26 patch03_2 + 27 patch03_3 + 28 patch03_4 + 29 patch03_5 + 30 patch03_6 + 31 patch03_7 + 32 patch04_0 + 33 patch04_1 + 34 patch04_2 + 35 patch04_3 + 36 patch04_4 + 37 patch04_5 + 38 patch04_6 + 39 patch04_7 + 40 patch05_0 + 41 patch05_1 + 42 patch05_2 + 43 patch05_3 + 44 patch05_4 + 45 patch05_5 + 46 patch05_6 + 47 patch05_7 + 48 patch06_0 + 49 patch06_1 + 50 patch06_2 + 51 patch06_3 + 52 patch06_4 + 53 patch06_5 + 54 patch06_6 + 55 patch06_7 + 56 patch07_0 + 57 patch07_1 + 58 patch07_2 + 59 patch07_3 + 60 patch07_4 + 61 patch07_5 + 62 patch07_6 + 63 patch07_7 + 64 patch08_0 + 65 patch08_1 + 66 patch08_2 + 67 patch08_3 + 68 patch08_4 + 69 patch08_5 + 70 patch08_6 + 71 patch08_7 + 72 patch09_0 + 73 patch09_1 + 74 patch09_2 + 75 patch09_3 + 76 patch09_4 + 77 patch09_5 + 78 patch09_6 + 79 patch09_7 + 80 patch0a_0 + 81 patch0a_1 + 82 patch0a_2 + 83 patch0a_3 + 84 patch0a_4 + 85 patch0a_5 + 86 patch0a_6 + 87 patch0a_7 + 88 patch0b_0 + 89 patch0b_1 + 90 patch0b_2 + 91 patch0b_3 + 92 patch0b_4 + 93 patch0b_5 + 94 patch0b_6 + 95 patch0b_7 + 96 patch0c_0 + 97 patch0c_1 + 98 patch0c_2 + 99 patch0c_3 + 100 patch0c_4 + 101 patch0c_5 + 102 patch0c_6 + 103 patch0c_7 + 104 patch0d_0 + 105 patch0d_1 + 106 patch0d_2 + 107 patch0d_3 + 108 patch0d_4 + 109 patch0d_5 + 110 patch0d_6 + 111 patch0d_7 + 112 patch0e_0 + 113 patch0e_1 + 114 patch0e_2 + 115 patch0e_3 + 116 patch0e_4 + 117 patch0e_5 + 118 patch0e_6 + 119 patch0e_7 + 120 patch0f_0 + 121 patch0f_1 + 122 patch0f_2 + 123 patch0f_3 + 124 patch0f_4 + 125 patch0f_5 + 126 patch0f_6 + 127 patch0f_7 + 128 patch10_0 + 129 patch10_1 + 130 patch10_2 + 131 patch10_3 + 132 patch10_4 + 133 patch10_5 + 134 patch10_6 + 135 patch10_7 + 136 patch11_0 + 137 patch11_1 + 138 patch11_2 + 139 patch11_3 + 140 patch11_4 + 141 patch11_5 + 142 patch11_6 + 143 patch11_7 + 144 patch12_0 + 145 patch12_1 + 146 patch12_2 + 147 patch12_3 + 148 patch12_4 + 149 patch12_5 + 150 patch12_6 + 151 patch12_7 + 152 patch13_0 + 153 patch13_1 + 154 patch13_2 + 155 patch13_3 + 156 patch13_4 + 157 patch13_5 + 158 patch13_6 + 159 patch13_7 + 160 patch14_0 + 161 patch14_1 + 162 patch14_2 + 163 patch14_3 + 164 patch14_4 + 165 patch14_5 + 166 patch14_6 + 167 patch14_7 + 168 patch15_0 + 169 patch15_1 + 170 patch15_2 + 171 patch15_3 + 172 patch15_4 + 173 patch15_5 + 174 patch15_6 + 175 patch15_7 + 176 patch16_0 + 177 patch16_1 + 178 patch16_2 + 179 patch16_3 + 180 patch16_4 + 181 patch16_5 + 182 patch16_6 + 183 patch16_7 + 184 patch17_0 + 185 patch17_1 + 186 patch17_2 + 187 patch17_3 + 188 patch17_4 + 189 patch17_5 + 190 patch17_6 + 191 patch17_7 + 192 patch18_0 + 193 patch18_1 + 194 patch18_2 + 195 patch18_3 + 196 patch18_4 + 197 patch18_5 + 198 patch18_6 + 199 patch18_7 + 200 patch19_0 + 201 patch19_1 + 202 patch19_2 + 203 patch19_3 + 204 patch19_4 + 205 patch19_5 + 206 patch19_6 + 207 patch19_7 + 208 patch1a_0 + 209 patch1a_1 + 210 patch1a_2 + 211 patch1a_3 + 212 patch1a_4 + 213 patch1a_5 + 214 patch1a_6 + 215 patch1a_7 + 216 patch1b_0 + 217 patch1b_1 + 218 patch1b_2 + 219 patch1b_3 + 220 patch1b_4 + 221 patch1b_5 + 222 patch1b_6 + 223 patch1b_7 + 224 patch1c_0 + 225 patch1c_1 + 226 patch1c_2 + 227 patch1c_3 + 228 patch1c_4 + 229 patch1c_5 + 230 patch1c_6 + 231 patch1c_7 + 232 patch1d_0 + 233 patch1d_1 + 234 patch1d_2 + 235 patch1d_3 + 236 patch1d_4 + 237 patch1d_5 + 238 patch1d_6 + 239 patch1d_7 + 240 patch1e_0 + 241 patch1e_1 + 242 patch1e_2 + 243 patch1e_3 + 244 patch1e_4 + 245 patch1e_5 + 246 patch1e_6 + 247 patch1e_7 + 248 patch1f_0 + 249 patch1f_1 + 250 patch1f_2 + 251 patch1f_3 + 252 patch1f_4 + 253 patch1f_5 + 254 patch1f_6 + 255 patch1f_7 + 0 patch20_0 + 1 patch20_1 + 2 patch20_2 + 3 patch20_3 + 4 patch20_4 + 5 patch20_5 + 6 patch20_6 + 7 patch20_7 + 8 patch21_0 + 9 patch21_1 + 10 patch21_2 + 11 patch21_3 + 12 patch21_4 + 13 patch21_5 + 14 patch21_6 + 15 patch21_7 + 16 patch22_0 + 17 patch22_1 + 18 patch22_2 + 19 patch22_3 + 20 patch22_4 + 21 patch22_5 + 22 patch22_6 + 23 patch22_7 + 24 patch23_0 + 25 patch23_1 + 26 patch23_2 + 27 patch23_3 + 28 patch23_4 + 29 patch23_5 + 30 patch23_6 + 31 patch23_7 + 32 patch24_0 + 33 patch24_1 + 34 patch24_2 + 35 patch24_3 + 36 patch24_4 + 37 patch24_5 + 38 patch24_6 + 39 patch24_7 + 40 patch25_0 + 41 patch25_1 + 42 patch25_2 + 43 patch25_3 + 44 patch25_4 + 45 patch25_5 + 46 patch25_6 + 47 patch25_7 + 48 patch26_0 + 49 patch26_1 + 50 patch26_2 + 51 patch26_3 + 52 patch26_4 + 53 patch26_5 + 54 patch26_6 + 55 patch26_7 + 56 patch27_0 + 57 patch27_1 + 58 patch27_2 + 59 patch27_3 + 60 patch27_4 + 61 patch27_5 + 62 patch27_6 + 63 patch27_7 + 64 patch28_0 + 65 patch28_1 + 66 patch28_2 + 67 patch28_3 + 68 patch28_4 + 69 patch28_5 + 70 patch28_6 + 71 patch28_7 + 72 patch29_0 + 73 patch29_1 + 74 patch29_2 + 75 patch29_3 + 76 patch29_4 + 77 patch29_5 + 78 patch29_6 + 79 patch29_7 + 80 patch2a_0 + 81 patch2a_1 + 82 patch2a_2 + 83 patch2a_3 + 84 patch2a_4 + 85 patch2a_5 + 86 patch2a_6 + 87 patch2a_7 + 88 patch2b_0 + 89 patch2b_1 + 90 patch2b_2 + 91 patch2b_3 + 92 patch2b_4 + 93 patch2b_5 + 94 patch2b_6 + 95 patch2b_7 + 96 patch2c_0 + 97 patch2c_1 + 98 patch2c_2 + 99 patch2c_3 + 100 patch2c_4 + 101 patch2c_5 + 102 patch2c_6 + 103 patch2c_7 + 104 patch2d_0 + 105 patch2d_1 + 106 patch2d_2 + 107 patch2d_3 + 108 patch2d_4 + 109 patch2d_5 + 110 patch2d_6 + 111 patch2d_7 + 112 patch2e_0 + 113 patch2e_1 + 114 patch2e_2 + 115 patch2e_3 + 116 patch2e_4 + 117 patch2e_5 + 118 patch2e_6 + 119 patch2e_7 + 120 patch2f_0 + 121 patch2f_1 + 122 patch2f_2 + 123 patch2f_3 + 124 patch2f_4 + 125 patch2f_5 + 126 patch2f_6 + 127 patch2f_7 + 128 patch30_0 + 129 patch30_1 + 130 patch30_2 + 131 patch30_3 + 132 patch30_4 + 133 patch30_5 + 134 patch30_6 + 135 patch30_7 + 136 patch31_0 + 137 patch31_1 + 138 patch31_2 + 139 patch31_3 + 140 patch31_4 + 141 patch31_5 + 142 patch31_6 + 143 patch31_7 + 144 patch32_0 + 145 patch32_1 + 146 patch32_2 + 147 patch32_3 + 148 patch32_4 + 149 patch32_5 + 150 patch32_6 + 151 patch32_7 + 152 patch33_0 + 153 patch33_1 + 154 patch33_2 + 155 patch33_3 + 156 patch33_4 + 157 patch33_5 + 158 patch33_6 + 159 patch33_7 + 160 patch34_0 + 161 patch34_1 + 162 patch34_2 + 163 patch34_3 + 164 patch34_4 + 165 patch34_5 + 166 patch34_6 + 167 patch34_7 + 168 patch35_0 + 169 patch35_1 + 170 patch35_2 + 171 patch35_3 + 172 patch35_4 + 173 patch35_5 + 174 patch35_6 + 175 patch35_7 + 176 patch36_0 + 177 patch36_1 + 178 patch36_2 + 179 patch36_3 + 180 patch36_4 + 181 patch36_5 + 182 patch36_6 + 183 patch36_7 + 184 patch37_0 + 185 patch37_1 + 186 patch37_2 + 187 patch37_3 + 188 patch37_4 + 189 patch37_5 + 190 patch37_6 + 191 patch37_7 + 192 patch38_0 + 193 patch38_1 + 194 patch38_2 + 195 patch38_3 + 196 patch38_4 + 197 patch38_5 + 198 patch38_6 + 199 patch38_7 + 200 patch39_0 + 201 patch39_1 + 202 patch39_2 + 203 patch39_3 + 204 patch39_4 + 205 patch39_5 + 206 patch39_6 + 207 patch39_7 + 208 patch3a_0 + 209 patch3a_1 + 210 patch3a_2 + 211 patch3a_3 + 212 patch3a_4 + 213 patch3a_5 + 214 patch3a_6 + 215 patch3a_7 + 216 patch3b_0 + 217 patch3b_1 + 218 patch3b_2 + 219 patch3b_3 + 220 patch3b_4 + 221 patch3b_5 + 222 patch3b_6 + 223 patch3b_7 + 224 patch3c_0 + 225 patch3c_1 + 226 patch3c_2 + 227 patch3c_3 + 228 patch3c_4 + 229 patch3c_5 + 230 patch3c_6 + 231 patch3c_7 + 232 patch3d_0 + 233 patch3d_1 + 234 patch3d_2 + 235 patch3d_3 + 236 patch3d_4 + 237 patch3d_5 + 238 patch3d_6 + 239 patch3d_7 + 240 patch3e_0 + 241 patch3e_1 + 242 patch3e_2 + 243 patch3e_3 + 244 patch3e_4 + 245 patch3e_5 + 246 patch3e_6 + 247 patch3e_7 + 248 patch3f_0 + 249 patch3f_1 + 250 patch3f_2 + 251 patch3f_3 + 252 patch3f_4 + 253 patch3f_5 + 254 patch3f_6 + 255 patch3f_7 + +) Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/regs.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/regs.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/regs.format (working copy) @@ -0,0 +1,195 @@ +( + 0x8000 core_chipid + 0x8001 core_revid + 0x8003 core_kick + 0x8005 core_lpm_wr + 0x8006 core_misc_ctrl + 0x8007 core_otp_rdata + 0x800a core_dma_start + 0x800b core_sbc_clr + 0x8010 core_reset + 0x8011 core_encrypt + 0x8015 core_uart_txd + 0x8022 core_ucode_hi + 0x8023 core_ucode_ctrl + 0x8024 core_ucode_low + 0x8025 core_ucode_data + + 0x8040 core_rthalfslot + 0x8042 core_clksel + 0x8043 core_config + 0x8044 core_sec_rsaddr + 0x8046 core_sec_readdr + 0x8048 core_sec_tsaddr + 0x804a core_sec_teaddr + 0x804c core_lpm_reg + 0x804e core_lpm_isogate + + 0x8100 core_clkn + 0x8104 core_extmclk + 0x8108 core_misc_status + 0x8109 core_debug_baud + 0x810a core_ccnt_counter + 0x810e core_gpio_in + 0x811c core_lpm_ctrl + 0x8123 core_lpm_ldocnt + 0x8124 core_lpm_xtalcnt + 0x8125 core_lpm_buckcnt + 0x8126 core_lpm_switch + 0x8127 core_lpm_buckcfg + 0x8130 core_gpio_wakeup + + + 0x8203 core_ice_ctrl + 0x8204 core_ice_status + 0x8205 core_ice_break0 + 0x8207 core_ice_break1 + + 0x8400 mem_b_box /* entire bank */ + 0x8500 mem_e_box /* entire bank */ + 0x8600 mem_l_box /* entire bank */ + + 0x8700 memk + + 0x8900 rfen_rx + 0x8901 rfen_tx + 0x8902 rfen_mdm + 0x8903 rfen_sn + 0x8904 rfen_msc + 0x8905 rfen_ck + 0x8906 rfen_adc + 0x8912 rf_agc_ctrl + 0x8914 rfen_ulp + 0x8971 rf_adc_mode + 0x8972 rf_adc_gc + 0x8973 rf_adc_ch + + 0x894b rf_rx_vctrl_reg1 + 0x894c rf_rx_vctrl_reg2 + 0x894d rf_rx_ib_lna + 0x894e rf_rx_lna_ctrim + + 0x8950 rf_bpf_ctrim + 0x8951 rf_bpf_ib + 0x8952 rf_adc_rccal + 0x8952 rf_rccal_ctrl + 0x8953 rf_rccal_sel + 0x8955 rf_tx_pa + 0x8956 rf_tx_mix + 0x895f rf_pll_rstn + 0x8964 rf_sdm_en + 0x8960 rf_pll_intg + 0x8961 rf_pll_frac + 0x8963 rf_pll_frachi + 0x896c rf_afc_cap + 0x8967 rf_clkpll_bias + 0x896f rf_clkpll_en + 0x8968 rf_clkpll_int + 0x8969 rf_clkpll_frac + 0x896d rf_balun_ctrim + 0x8972 rf_saradc_ctrl + 0x8973 rfen_chgpump + 0x897a rf_audio_voll + 0x897b rf_audio_volr + 0x897e rfen_aadc + 0x897f rf_audio_pddac0 + 0x8980 rf_audio_pddac1 + 0x8981 rf_audio_dac_ldo + + 0x8990 rf_rccal_result + 0x8991 rf_afc_d2a + 0x8992 rf_rssi + + +0x8c00 core_usb_config +0x8c01 core_usb_int_mask +0x8c04 core_usb_addr +0x8c10 core_usb_trig +0x8c11 core_usb_stall +0x8c12 core_usb_clear +0x8c18 core_usb_ep +0x8c18 core_usb_dfifo0 +0x8c19 core_usb_dfifo1 +0x8c1a core_usb_dfifo2 +0x8c20 core_usb_ep_len +0x8c26 core_usb_status +0x8c27 core_usb_fifo_empty +0x8c28 core_usb_fifo_full + + +4 rx_freq_offset +1 tx_freq_offset + +/* bit difinitions */ + 4 whiteoff_bit + 6 clksel_rc + 5 clksel_dpll + 4 clksel_xtal + 5 adc_rccal + 0 bpf_rccal + 1 demod_clkoff + +( + 7 cold_wake + 3 gpio_latch + 6 enable_retmem + 19 hibernate + 20 xram_switch + 21 pram_switch + 23 isogate + 0xb0 isogate_mask +) + +// misc ctrl +( + 0x04 set_tea_key + 0x08 lock_otp + 0x10 x_sethi + 0x20 y_sethi + 0x40 z_sethi + 0x80 ccnt_start +) + +// dma start +( + 0x01 otpd_start + 0x02 spid_start + 0x04 iicd_start + 0x08 qspi_start +) + +// dma status bit +( + 0 otpd_crcok + 1 otpd_done + 2 spid_crcok + 3 spid_done + 4 iicd_crcok + 5 iicd_done + 6 iicd_ack +) + +// core_misc_status +( + 0 CCNT_DONE + 1 KICKED + 2 SEC_PWRUP +) + +0x8b uart_ctrl_default //BCSP +0x81 uart_ctrl_h4 //H4 +0x81 uart_ctrl_normal +0x81 uart_ctrl_57600 +2 uart_baud_len +0x01 uartclk_dpll +0x1a0 uart_baud_115200 +0xbb uart_baud_256000 +0x340 uart_baud_57600 +0x2dc6c00 uart_clk + +//core_config +( +3 CLOCK_ON_AUTH_ROM +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/rfcomm.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/rfcomm.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/rfcomm.format (working copy) @@ -0,0 +1,391 @@ +/*****************************************************************************/ +/* RCS HEADER -- DO NOT ERASE */ +/* $Author: Administrator $ */ +/* $Id: bt_rfcomm_format.upper,v 1.1 2009-09-28 04:06:17 Administrator Exp $ */ +/* Orisil Technology */ +/*****************************************************************************/ + +/**********/ +/* memory */ +/**********/ + +memalloc( +1 memRemoteRPNBitRate +1 memRemotePRNDataBits +1 memRemotePRNStopBit +1 memRemotePRNParity +1 memRemotePRNFlowControl +1 memRemotePRNXon +1 memRemotePRNXoff + + +3 mem_mod2div_temp +2 mem_contw_temp +2 mem_attrib_list + +//rfcomm head +1 mem_current_adss +1 mem_current_channel +1 mem_current_frame_type +1 mem_current_fcs +2 mem_current_length +2 mem_rfcomm_uih_payload_ptr + +//rfcomm uih +1 mem_uih_cmd_type +2 mem_uih_length +2 mem_param_payload_ptr + + +//rfcomm modem status +1 mem_ms_param + +//rfcomm pn +1 mem_pn_credit_flow_type_info +1 mem_pn_priority +1 mem_pn_acknowledg_timer +1 mem_pn_max_retrans + +1 mem_rfcomm_send_adss +1 mem_rfcomm_send_frame_type +1 mem_rfcomm_send_fcs +1 mem_rfcomm_send_offset + +) + +xmemalloc( +1 mem_pn_dlci +2 mem_pn_max_frame_size + +1 memFCStemp1 +1 memFCStemp2 +1 memFCStemp3 + +1 mem_rfcomm_initiator + +1 mem_remote_spp_channel + +1 mem_HIUfcs_SPP +1 mem_HIUfcs_SPP_WCredits + +1 mem_rfcomm_send_more_pkt + +1 mem_remote_credits +1 mem_credit_given + +//rfcomm modem status +1 mem_ms_channel + +1 mem_credit_flag + +2 mem_rfcomm_max_frame_size +1 mem_rfcomm_credit_init_data + +2 mem_cb_receive_spp_data + +2 mem_nl_rx_data_src +2 mem_nl_rx_len_all +) + + +( +0 CREDIT_DISABLE +1 CREDIT_ENABLE +) + + +/************************************************************************/ + + + +/************/ +/* constant */ +/************/ + +/* RFCOMM state for Headset (memRFCOMM_State) */ + ( + 0 RFCOMM_IDLE /* before the responsor HS receive SABM */ + 1 RFCOMM_W4_DLCI0_OPEN + 2 RFCOMM_W4_DLCI0_CLOSE + 3 RFCOMM_START_DLCI0 /* After respond SABM frame (DLCI=0) */ + 4 RFCOMM_W4_DLCI_OPEN + 5 RFCOMM_W4_DLCI_CLOSE + 6 RFCOMM_DLCI_OPENED + + ) + +/* RFCOMM timer constants */ + ( + 1000 RFCOMM_T1 /* Used by SABM and DISC frames,100*20ms = 20s */ + 1000 RFCOMM_T2 /* Used by commands send in UIH on DLCI0, */ + 300 RFCOMM_T3_RINGON /* 6s for ring fade time */ + + ) + +/* Command Type */ + ( + 0x3F RSP_RX_SABM /*responsor expect SABM from initiator */ + 0x3F INI_TX_SABM + + 0x73 RSP_TX_UA /*responsor send out UA command */ + 0x73 UA_WFBIT_SET /* UA control field with F bit set */ + + 0xEF RSP_RX_UIH /*responsor expect UIH from initiator */ + + 0xEF RSP_TX_UIH /*responsor send UIH to initiator */ + + 0x1F RSP_TX_DM /*responsor send DM to initiator */ + 0x1F DM_WFBIT_SET /* DM control field with F bit set */ + 0x0F DM_WFBIT_CLEAR /* DM control field with F bit clear */ + + 0x53 RSP_RX_DISC /*responsor expect DISC from initiator */ + 0x53 INI_TX_DISC /*initiator send DISC control type command */ + + 0xFF RSP_RX_UIH_WDATA /*UIH data with credit flow control info */ + + + ) + +/* Multiplexor commands and responses frames */ + ( + 0x83 PN_COMMAND /* Bit 0 EA C/R Type = 000001 */ + 0x81 PN_RESPONSOR /* Bit 0 EA C/R Type = 000001 */ + + 0xE3 MSC_COMMAND /* Bit 0 EA C/R Type = 000111 */ + 0xE1 MSC_RESPONSOR + + 0x13 NSC_COMMAND /* Bit 0 EA C/R Type = 001000 */ + 0x11 NSC_RESPONSOR /* Bit 0 EA C/R Type = 001000 */ + + 0x23 TEST_COMMAND /* Bit 0 EA C/R Type = 000111 */ + 0x21 TEST_RESPONSOR + + 0x93 RPN_COMMAND /* Bit 0 EA C/R Type = 001001 */ + 0x91 RPN_RESPONSOR + + 0x53 RLS_COMMAND /* Bit 0 EA C/R Type = 001010 */ + 0x51 RLS_RESPONSOR + + 0xA3 FCON_COMMAND /* Bit 0 EA C/R Type = 000101 */ + 0xA1 FCON_RESPONSOR + + 0x63 FCOFF_COMMAND /* Bit 0 EA C/R Type = 000110 */ + 0x61 FCOFF_RESPONSOR + + 0x03 RLS_OVERRUN + 0x05 RLS_PARITY_ERROR + 0x09 RLS_FRAMING_ERROR + ) + +/* memLocalCredit */ + ( + 0x01 RFCOMM_CREDIT + ) + + ( + 0x007f RFCOMM_MAX_FRAME_SIZE + ) + +/* UIH received Data length */ + ( + 0 LENGTH_ZERO + + 6 LENGTH_OK + 7 LENGTH_HOT + 8 LENGTH_RING + 9 LENGTH_ERROR + 9 LENGTH_AGVOL_ONEBYTE + 10 LENGTH_AGVOL_TWOBYTE + 10 LENGTH_VOL_ONEBYTE + 11 LENGTH_VOL_TWOBYTE + 12 LENGTH_BRSF + 13 LENGTH_PLUS_CIEV + 15 LENGTH_INBANDRING + 14 LENGTH_CIEV_CALL + 17 LENGTH_CRING + 20 LENGTH_BRSF_OK + 24 LENGTH_CIND0 + 28 LENGTH_CIEV_TWO + 32 LENGTH_CIND_OK + 59 LENGTH_CIND_OK2 + 100 LENGTH_DISCARD + ) + +/************/ +/* flags */ +/************/ + +/* memRFCOMM_L2CAP_Interface */ + ( + 0 RFCOMM_TX_W4BUF_FLAG /* Wait for Tx buffer empty flag */ + 1 RFCOMM_CLOSE_LINK_FLAG + ) + + + +/* memRemoteMSC */ + ( + 0 MSC_EA_BIT + 1 MSC_FC_BIT + 2 MSC_RTC_BIT + 3 MSC_RTR_BIT + 6 MSC_IC_BIT + 7 MSC_DV_BIT + ) + +/* memRemoteRLS */ + ( + 0x0C OVERRUN_ERROR + 0x0A PARITY_ERROR + 0x09 FRAMING_RERROR + ) + +/* memRemoteRPNBitRate */ + ( + 0x00 BITS2400 + 0x01 BITS4800 + 0x02 BITS7200 + 0x03 BITS9600 + 0x04 BITS19200 + 0x05 BITS38400 + 0x06 BITS57600 + 0x07 BITS115200 + 0x08 BITS230400 + ) + +/* memRemotePRNDataBits */ + ( + 0x00 DATABITS5 + 0x01 DATABITS6 + 0x02 DATABITS7 + 0x03 DATABITS8 + ) + +/* memRemotePRNStopBit */ + ( + 0 ONESTOP + 1 ONEHALFSTOP + ) + +/* memRemotePRNParity */ + ( + 0 ODDPARITY + 1 EVENPARITY + 2 MARKPARITY + 3 SPACEPARITY + + 7 PARITY_ENABLE_BIT + ) + +/* RPN bit mask(in) */ + ( + 0 BIT_RATE_MASK_BIT + 1 DATA_BITS_MASK_BIT + 2 STOP_BITS_MASK_BIT + 3 PARITY_MASK_BIT + 4 PARITY_TYPE_MASK_BIT + 5 XON_CHAR_MASK_BIT + 6 XOFF_CHAR_MASK_BIT + ) + +/* RPN bit mask(in) 2 */ + ( + 0 XON_XOFF_INPUT_MASK_BIT + 1 XON_XOFF_OUTPUT_MASK_BIT + 2 RTR_INPUT_MASK_BIT + 3 RTR_OUTPUT_MASK_BIT + 4 RTC_INPUT_MASK_BIT + 5 RTC_OUTPUT_MASK_BIT + + ) + +/* memRFCOMM_Request */ + ( + 0 SEND_MSC_CMD_REQ_FLAG + 1 SEND_AT_CKPD_REQ_FLAG + 2 SEND_RING_REQ_FLAG + 3 SEND_SABM_CMD + ) + +/* memRFCOMM_Misc_Flag */ + ( + 0 MSC_CDM_ALREADY_SEND_FLAG + 1 CREDIT_FLOW_USED_FLAG + 2 DONT_EMBEDDED_CREDIT_FLAG + 3 MSC_EXCHANGE_DONE_FLAG + 4 FLOW_CONTROL_FCOFF_BIT /* set when receive FCoff, clear when FCon */ + ) + +/* memRemoteMSC */ + ( + 1 FLOW_CONTROL_FC_BIT /* received MSC FC bits */ + + ) +/* Address filed */ + ( + 0 ADDR_EA_BIT + 1 ADDR_CR_BIT + 2 ADDR_D_BIT + ) +//should be same as descripted in SDP +( + 1 SPP_SLAVE_CHANNEL + 7 OBEX_SERVER_CHANNEL + 8 HF_SERVER_CHANNEL + 9 HS_SERVER_CHANNEL +) +/* memRFCOMM_Flag */ +( + 0 USING_HF_PROFILE + 1 USING_HS_PROFILE + 2 USING_SPP_PROFILE +) +/*RFCOMM Frame Type*/ +( + 0x3f RFCOMM_FRAME_TYPE_SABM + 0x73 RFCOMM_FRAME_TYPE_UA + 0xEF RFCOMM_FRAME_TYPE_UIH + 0xFF RFCOMM_FRAME_TYPE_UIH_CREDITS + 0x53 RFCOMM_FRAME_TYPE_DISCONN +) +/*RFCOMM UIH CMD TYPE*/ +( + 0x41 UIH_PARAM_NEG_CMD + 0x40 UIH_PARAM_NEG_RES + 0x49 UIH_PARAM_CMD_REMOVE_PORT + 0x71 UIH_MODEM_STATUS_CMD + 0x70 UIH_MODEM_STATUS_RES +) + +/*bits in rfcomm address*/ +( + 0 RFCOMM_ADDRESS_EXT_LEN + 1 RFCOMM_ADDRESS_CR + 2 RFCOMM_ADDRESS_DERECTION + + +) + + ( + 0 RFCOMM_CHANNEL_STATE_PN_CMD + 1 RFCOMM_CHANNEL_STATE_PN_RES + 2 RFCOMM_CHANNEL_STATE_SABM + 3 RFCOMM_CHANNEL_STATE_UA + 4 RFCOMM_CHANNEL_STATE_SND_MS_CMD + 5 RFCOMM_CHANNEL_STATE_RCV_MS_CMD + 6 RFCOMM_CHANNEL_STATE_SND_MS_RES + 7 RFCOMM_CHANNEL_STATE_RCV_MS_RES + 0xff RFCOMM_CHANNEL_SETUP_COMPLETE + ) + + /*mem_rfcomm_send_more_pkt*/ + ( + 1 MORE_PKT_MSC_CMD_HF + 2 MORE_PKT_MSC_CMD_HS + 3 MORE_PKT_MSC_CMD_SPP + 4 MORE_PKT_MSC_CMD_OBEX + ) + + ( + 127 RFCOMM_MALLOC_SIZE + ) \ No newline at end of file Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/sdp.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/sdp.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/sdp.format (working copy) @@ -0,0 +1,70 @@ + +memalloc( +0 mem_sdp_mem_start +8 mem_sdp_uuid_search_ptr +2 mem_sdp_continue_byte +1 mem_sdp_pduid +2 mem_sdp_transactionid +2 mem_sdp_transactionid_local +2 mem_sdp_attribute_maxbyte +2 mem_sdp_record_maxcnt +4 mem_sdp_record_handle +1 mem_sdp_LACAP_found +1 mem_sdp_RFCOMM_found +0 mem_sdp_handle_list +32 mem_sdp_attrib_list +2 mem_sdp_error_code +2 mem_sdp_all_length +1 mem_handle_humber +2 mem_search_uuid +0 mem_sdp_mem_end +) +xmemalloc( +2 mem_ui_uuid_table +22 mem_all_uuid_16bits +34 mem_all_uuid_128bits +2 mem_sdp_l2capch_ptr +) +( +0 AGORHS_SERVICE +1 GENAUDIO_SERVICE +2 HANDSFREE_SERVICE +) +( +0 ATTRIBUTEID_0000 +1 ATTRIBUTEID_0001 +2 ATTRIBUTEID_0004 +3 ATTRIBUTEID_0009 +4 ATTRIBUTEID_0100 +5 ATTRIBUTEID_0302 +6 ATTRIBUTEID_0006 +7 ATTRIBUTEID_0311 +) + +( +0x01 SDP_ERROR_RES +0x02 SDP_SEARCH_REQ +0x03 SDP_SEARCH_RES +0x04 SDP_ATTRIBUTE_REQ +0x05 SDP_ATTRIBUTE_RES +0x06 SDP_SEARCHATTRIB_REQ +0x07 SDP_SEARCHATTRIB_RES +) +0x2600 sdp_max_amount +250 SDP_MALLOC_SIZE +0x6e sdp_tid_spp //any number + +( +0x1f11 SDP_UUID_HS_AUDIO_GATEWAY +) + +( +0X09 SDP_ATTRIBUTE_ID +0x0a SDP_ATTRIBUTE_RANGE +) + +(//mem_sdp_handle_list +7 SDP_MAX_HANDLE_NUMBER +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/security.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/security.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/security.format (working copy) @@ -0,0 +1,141 @@ + +memalloc( +/* moved from bt.format for 3dh5 1021bytes packet buffer */ +17 mem_rxbuf + +16 mem_random_number +16 mem_round_key +16 mem_kinit + +16 mem_input_store +16 mem_x +15 mem_y +1 mem_y15 +17 mem_key_store +1 mem_key_store_end +2 memp_ar_key +2 memp_ar_input +10 mem_ar_hround + + +1 mem_ec_infinite +2 mem_ec_loopc +1 mem_aes_cmac_data_length + +0 memdat +/* ecc calculation */ + +24 mem_ax +24 mem_ay +24 mem_az +24 mem_bx +0 mem_ax_256 //32 bytes +24 mem_by +8 mem_bz +16 mem_ay_256 // 32 bytes +16 mem_cx +8 mem_az_256 // 32 bytes +23 mem_cy +1 mem_cy5 +0 mem_bx_256 // 32 bytes +24 mem_cz +8 mem_k +16 mem_by_256 // 31 bytes +16 mem_align + +0 mem_bz_256 //32 bytes +0 mem_tmp1 +24 memahbak +8 mem_tmp5 +0 mem_cx_256 //32 bytes +16 memahsave +16 mem_tmp2 +0 mem_cy_256 // 32 bytes +0 memahsave_end +1 mem_addr_padding +7 mem_addr_value /* 12 bytes */ +0 mem_tmp3 +5 mem_t1 +3 mem_addr_value_end +15 mem_addr_iocap_end +1 mem_cy5_256 // 1 byte +0 mem_cz_256 // 32 bytes +0 mem_tmp0 +8 mem_t0 +16 mem_tmp0a +8 mem_t2 +16 mem_k_256 //32 bytes +16 mem_t3 +8 mem_tmp1_256 //32 bytes +24 mem_t7 + + +32 mem_tmp5_256 +32 mem_tmp2_256 +0 mem_tmp3_256 +32 mem_t1_256 +0 mem_tmp0_256 +32 mem_t0_256 +32 mem_t2_256 +32 mem_t3_256 +32 mem_t7_256 + +24 mem_p +24 mem_a +24 mem_b +24 mem_gx +24 mem_gy +32 memh0 + +//p256 +//2 mem_ec_loopc_256 +//32 mem_ax_256 +//32 mem_ay_256 +//32 mem_az_256 +//32 mem_bx_256 +//32 mem_by_256 +//32 mem_bz_256 +//32 mem_cx_256 +//31 mem_cy_256 +//1 mem_cy5_256 +//32 mem_cz_256 +//32 mem_k_256 + + +//32 mem_tmp1_256 +//32 mem_tmp5_256 +//32 mem_tmp2_256 + +//0 mem_tmp3_256 +//32 mem_t1_256 +//0 mem_tmp0_256 +//32 mem_t0_256 +//32 mem_t2_256 +//32 mem_t3_256 +//32 mem_t7_256 + +32 mem_p_256 +32 mem_a_256 +32 mem_gx_256 +32 mem_gy_256 +//4 mem_le_keyid +16 mem_le_slat + + +//64 mem_regext +//1 mem_regext_index + +//16 mem_le_mackey + + +//1 mem_AES_CMAC_flag +//16 mem_AES_CMAC_temp +//16 mem_AES_CMAC_M_last + +//4 mem_le_gkey + +//16 mem_le_r + +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/simple_pairing.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/simple_pairing.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/simple_pairing.format (working copy) @@ -0,0 +1,188 @@ +/* simple pairing page */ + +memalloc( + +//4 mem_hci_ssp_mode +0 mem_sp_state_start +1 mem_sp_state +1 mem_master_sp_state +1 mem_sp_flag +1 mem_master_sp_flag +1 mem_sp_calc +1 mem_sp_dh_ready +1 mem_sp_localsm +1 mem_pairing_auth + +0 mem_sp_flag_start +1 mem_sp_local_key_send_count +1 mem_sp_remote_key_recv_count +1 mem_sp_remote_key_invalid +1 mem_sp_dhkey_invalid + + +4 mem_gkey + + +8 mem_le_pubkey_remote_x_256 +0 mem_sp_pubkey_remote +24 mem_sp_pubkey_remote_x +0 mem_sp_pubkey_remote_x_end +8 mem_le_pubkey_remote_y_256 +24 mem_sp_pubkey_remote_y + +8 mem_le_dhkey_256 +24 mem_sp_dhkey +0 mem_sp_dhkey_end + +16 mem_sp_random_local +0 mem_sp_random_local_end +16 mem_sp_random_remote +0 mem_sp_random_remote_end +0 memresult +0 mem_sp_calc_result +4 memh +4 memg +4 memf +4 meme +0 mem_sp_calc_result_high +4 memd +4 memc +4 memb +4 mema +16 mem_sp_check_result +16 mem_sp_confirm_remote +16 mem_sp_prarm_stack +) + +xmemalloc( +1 mem_sp_local_key_invalid + + +32 mem_le_private_key_256 +32 mem_le_pubkey_local_x_256 +32 mem_le_pubkey_local_y_256 + +24 mem_sp_private_key +0 mem_sp_pubkey_local +24 mem_sp_pubkey_local_x +0 mem_sp_pubkey_local_x_end +24 mem_sp_pubkey_local_y + +1 mem_ssp_enable +3 mem_sp_iocap_local +3 mem_sp_iocap_remote + +1 mem_flag_mode_ssp_pin +1 mem_ssp_mode_flag +1 mem_authentication_passkey_times +1 mem_passkey_1bit +1 mem_flag_pairing_state + +) +/* simple pairing status flag */ +( + 0x00 SP_FLAG_STANDBY + 0x01 SP_FLAG_COMMIT + 0x02 LE_SP_FLAG_COMMIT_256 + +) + +/* simple pairing calc flag */ +( + 0x00 SP_CALC_STANDBY + 0x01 SP_CALC_PUBKEY + 0x02 SP_CALC_DHKEY + 0x03 SP_CALC_PUBKEY_256 + 0x04 SP_CALC_DHKEY_256 +) + +/* simple pairing state */ +( + 0x00 SP_STAT_NULL + 0x01 SP_STAT_KEY_RECV + 0x02 SP_STAT_KEY_GENERATE + 0x03 SP_STAT_KEY_SEND + 0x04 SP_STAT_COMMIT_CALC + 0x05 SP_STAT_COMMIT_SEND + 0x06 SP_STAT_RANDOM_RECV + 0x07 SP_STAT_RANDOM_SEND + 0x08 SP_STAT_CONFIRM_RECV + 0x09 SP_STAT_CONFIRM_CHECK + 0x0A SP_STAT_CONFIRM_CALC + 0x0B SP_STAT_CONFIRM_SEND + 0x0C SP_STAT_LINK_KEY_CALC + 0x0F SP_STAT_DONE + 0x10 SP_STAT_FEATURE_EXT_SEND + 0x11 SP_STAT_GKEY_CALC + /*simple pairing master only*/ + 0x12 SP_MASTER_STAT_START_SKIP + 0x13 SP_MASTER_STAT_START_DONE + 0x14 SP_STAT_COMMITMENT_COMPARE + 0x15 SP_STATE_END +) + + +/* simple paring invalid flag */ +( + 0x00 SP_KEY_INVALID + 0x01 SP_KEY_VALID + 0x03 SP_KEY_VALID_256 + +) + +/* encapsulated defination for P-192 key */ +( + 0x01 ENCAPSULATED_MAJOR_TYPE_P192 + 0x01 ENCAPSULATED_MINOR_TYPE_P192 + 0x30 ENCAPSULATED_LEN_P192 +) + +/* bluetooth 2.1 support flag */ +( + 0x00 SIMPLE_PAIRING_ENABLE + 0x01 ENCRYPTION_PAUSE_ENABLE + 0x02 EXTENDED_INQUIRY_RESPOSE_ENABLE + 0x03 SNIFF_SUBRATING_ENABLE +) + +/*mem_sp_localsm*/ +( + 0x00 DEFAULT_STATEMACHINE + 0x01 LOCAL_STATEMACHINE +) + +( + 0x00 DEFALT_PAIRING_AUTH + 0x01 PAIRING_AUTH +) + +( +1 SSP_MODE_SSP_PIN_FLAG +2 SSP_MODE_PASSKEY_ENTRY_FLAG +3 SSP_MODE_JUST_WORK_FLAG +) + +(//ssp mode +0x040003 SSP_MODE_JUST_WORK_IO_CAP_DATA +0X040001 SSP_MODE_SSP_PIN_IO_CAP_DATA +0X040002 SSP_MODE_PASSKEY_IO_CAP_DATA +) + +( +0x00 DISPLAY_ONLY +0x01 DISPLAY_YESNO +0x02 KEYBOARD_ONLY +0x03 NO_INPUT_NO_OUTPUT +) + +( +7 FLAG_MODE_SSP_PIN_REVICEVE_COMPARISON_BIT +6 FLAG_MODE_SSP_PIN_RECIEVE_DHKEY_BIT +0 FLAG_MODE_SSP_PIN_COMPARISON_RESULT_BIT +) +( +1 FLAG_PAIRING_STATE_PAIRING +0 FLAG_PAIRING_STATE_NOT_PAIRING +) + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/ui.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/ui.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/ui.format (working copy) @@ -0,0 +1,437 @@ +/*****************************************************************************/ +/* RCS HEADER -- DO NOT ERASE */ +/* $Author: Administrator $ */ +/* $Id: bt_ui_format.upper,v 1.1 2009-09-28 04:06:17 Administrator Exp $ */ +/************************************************************************/ + + + /* ========= memory ============== */ +memalloc( +2 mem_UI_data_txbuff_length + +1 mem_ipc_skip_continue_proc +0 mem_ui_timer_temp //length 4 +4 mem_ipc_rega_temp +) + +xmemalloc( +//UI Work area +1 mem_ipc_lock_bt +1 mem_ipc_lock_c51 +8 mem_ipc_fifo_bt2c51 +8 mem_ipc_fifo_c512bt + +4 mem_ui_timer_last_btclk +2 mem_discovery_timeout_timer_count +1 mem_hid_handshake_timer_count +1 memui_reconnect_mode +2 mem_ui_state_map + +//UI Config area +1 mem_ui_profile_supported +2 mem_discovery_timeout +1 mem_pin_length +16 mem_pin + +) +/************/ +/* constant */ +/************/ + +//mem_ui_state_map +( +0 UI_STATE_BT_CONNECTED +1 UI_STATE_BT_SETUP_COMPLETE +2 UI_STATE_BT_HID_CONN +3 UI_STATE_BT_HID_HANDSHAKE +4 UI_STATE_BT_SPP_CONN +5 UI_STATE_BT_SNIFF +6 UI_STATE_BT_DISCOVERY +7 UI_STATE_BT_RECONNECT +8 UI_STATE_BT_SLAVE_ROLE +9 UI_STATE_BLE_CONNECTED +10 UI_STATE_BLE_WRITE_RCV +11 UI_STATE_BLE_ADV +) + +( +1 UI_STATE_SPP_NL_AUTO_DISCOVER + +) + +/* UI state for Headset (memui_HS_State) */ + ( + 0 UI_HEADSET_DISCONNECT + 1 UI_HEADSET_IDLE /* before the responsor HS receive SABM */ + 2 UI_HEADSET_W4CONNECT + 3 UI_HEADSET_RINGING + 4 UI_HEADSET_CONNECTED + 5 UI_HEADSET_PARING + ) +/* memui_BB_State */ +( + 0 UI_BB_OFF + 1 UI_BB_IDLE + 2 UI_BB_DISCOVERY + 3 UI_BB_CONNECTED_ACTIVE_NO_SCO + 4 UI_BB_CONNECTED_ACTIVE_WITH_SCO + 5 UI_BB_CONNECTED_ACTIVE_WAIT_SNIFF + 6 UI_BB_CONNECTED_SNIFF + 7 UI_BB_RECONNECT + 8 UI_BB_CONNECTED_SNIFF_WITH_SCO +) + +/************/ +/* flags */ +/************/ + +/* memui_Misc_Flags */ + ( + 5 NO_IDLE_TURN_OFF + 7 ANSWER_RING_FLAG /* 1 Answer,0 no*/ + ) + +/* mem_UI_SCH_Interface */ + ( + 0 UI_HS_PAIRING + 2 UI_REQ_CLOSE_RFCOMM + 3 UI_LINK_LOST + 4 UI_REQ_OPEN_SCO + 6 UI_REQ_CLOSE_SCO + ) + +/* memui_PassOverKey */ + ( + 0 ANSWER_RING_BIT + 0 AG_SEND_RING_BIT + 1 VOL_UP_BIT + 2 VOL_DOWN_BIT + 3 INI_CALL_BIT + 4 DAIL_LAST_CALL + 5 END_CALL_BIT + 6 NOKIA_VOICE_ACTIVE + 7 REJECT_CALL_BIT + ) + +/* memui_reconnect_mode */ +( + 0 NO_RECONNECTION + 1 RECONNECT_HID + 2 RECONNECT_HF + 3 RECONNECT_HS + 4 RECONNECT_HID_HF + 5 RECONNECT_HID_HS +) +/* memui_Commands */ +( +0 BT_CMD_STANDBY +1 BT_CMD_START_DISCOVERY +2 BT_CMD_STOP_DISCOVERY +3 BT_CMD_RECONNECT +4 BT_CMD_DISCONNECT +5 BT_CMD_ENTER_SNIFF +6 BT_CMD_EXIT_SNIFF +7 BT_CMD_ENTER_SNIFF_SUBRATING +8 BT_CMD_EXIT_SNIFF_SUBRATING +9 BT_CMD_SNIFF_TEST +10 BT_CMD_SET_PIN_CODE +11 BT_CMD_START_INQUIRY +12 BT_CMD_STOP_INQUIRY +13 BT_CMD_START_ADV +14 BT_CMD_STOP_ADV +15 BT_CMD_START_DIRECT_ADV +16 BT_CMD_STOP_DIRECT_ADV +17 BT_CMD_LE_DISCONNECT +18 BT_CMD_LE_UPDATE_CONN +19 BT_CMD_LED_OFF +20 BT_CMD_LED_ON +21 BT_CMD_LED_BLINK +22 BT_CMD_LE_START_CONN +23 BT_CMD_LE_START_SCAN +24 BT_CMD_LE_STOP_SCAN +25 BT_CMD_ENTER_HIBERNATE +27 BT_CMD_LE_SMP_SECURITY_REQUEST +29 BT_CMD_ROLE_SWITCH +30 BT_CMD_BB_RECONN_CANCEL +31 BT_CMD_STORE_RECONN_INFO_LE +32 BT_CMD_STORE_RECONN_INFO_BT +33 BT_CMD_DHKEY_NOT_ACCEPT +34 BT_CMD_START_24G +35 BT_CMD_STOP_24G +36 BT_CMD_PAIR_24G +37 BT_CMD_STORE_RECONN_INFO +) + +( +0x00 BT_EVT_NULL +0x01 BT_EVT_BB_CONNECTED +0x02 BT_EVT_BB_DISCONNECTED +0x03 BT_EVT_RECONN_STARTED +0x04 BT_EVT_RECONN_FAILED +0x05 BT_EVT_SETUP_COMPLETE +0x06 BT_EVT_HID_CONNECTED +0x07 BT_EVT_HID_DISCONNECTED +0x08 BT_EVT_SPP_CONNECTED +0x09 BT_EVT_SPP_DISCONNECTED +0x0A BT_EVT_PINCODE_REQ +0x0B BT_EVT_ENTER_SNIFF +0x0C BT_EVT_EXIT_SNIFF +0x0D BT_EVT_ENTER_SNIFF_SUB +0x0E BT_EVT_EXIT_SNIFF_SUB +0x0F BT_EVT_DISCOVERY_STOPED +0x10 BT_EVT_BUTTON_LONG_PRESSED +0x12 BT_EVT_HID_HANDSHAKE +0X13 BT_EVT_RECONN_PAGE_TIMEOUT +0x14 BT_EVT_LE_CONNECTED +0X15 BT_EVT_LE_DISCONNECTED +0x16 BT_EVT_ML2CAP_CONN_REFUSED +0x17 BT_EVT_BUTTON_ENTER_HIBERNATE +0x18 BT_EVT_LINKKEY_GENERATE +0x19 BT_EVT_SWITCH_NOT_ACCEPT +0x20 BT_EVT_SWITCH_ACCEPT +0x21 BT_EVT_SNIFF_NOT_ACCEPT +0x22 BT_EVT_SNIFF_ACCEPT +0x23 BT_EVT_UNSNIFF_ACCEPT +0x24 BT_EVT_UNSNIFF_NOT_ACCEPT +0x25 BT_EVT_BUTTON_ADJUST_DPI +0x26 BT_EVT_SEND_UNSNIFF_ACCEPT +0x27 BT_EVT_VIRTUAL_CABLE_UNPLUG +0x28 BT_EVT_LE_WRITE_REQUEST +0x29 BT_EVT_LE_ENC_INFO +0x2a BT_EVT_SWITCH_FAIL_MASTER +0x2b BT_EVT_SWITCH_SUCCESS_MASTER +0x2c BT_EVT_BUTTON_DOWN +0x2d BT_EVT_BUTTON_UP +0x2e BT_EVT_REMOTE_UNSNIFF +0x30 BT_EVT_LE_PAIRING_FAIL +0x31 BT_EVT_LE_PAIRING_SUCCESS +0x32 BT_EVT_LE_START_ENC +0X33 BT_EVT_LE_PAUSE_ENC +0X34 BT_EVT_LE_TK_GENERATE +0x35 BT_EVT_BT_GKEY_GENERATE +0x36 BT_EVT_BT_GET_PASSKEY +0x37 BT_EVT_BT_PAIRING_FAIL +0x38 BT_EVT_BT_PAIRING_SUCCESS +0x39 BT_EVT_24G_PAIRING_COMPLETE +0x3a BT_EVT_24G_ATTEMPT_FAIL +0x3b BT_EVT_LE_GKEY_GENERATE +0x3c BT_EVT_24G_ATTEMPT_SUCCESS +0x3d BT_EVT_STORE_NVRAM +0x3e BT_EVT_LE_PAIRING_COMPLETE +0x3F BT_EVT_LE_RECONNECT_COMPLETE +0x40 BT_EVT_LE_PARSE_CONN_PAPA_UPDATE_RSP +0x41 BT_EVT_LE_LTK_LOST + +0x58 BT_EVT_HFP_STOP_DIALING +0x59 BT_EVT_HFP_START_DIALING +0x5a BT_EVT_HFP_INCOMMING +0x5b BT_EVT_HFP_OUTGOING +0x5c BT_EVT_HFP_CALLACTIVE +0x5d BT_EVT_HFP_CALLIMG +0x5e BT_EVT_HFP_CALLOGG +0x5f BT_EVT_HFP_CALMULTY +0x60 BT_EVT_HFP_CONNECTED +0x61 BT_EVT_HFP_DISCONNECTED +) +//switch +( +0 OFF +1 ON +) +/* memui_mem_lock */ +( + 0 MEM_UNLOCK + 1 MEM_LOCK +) +/* memui_flag0 */ +( + 0 UI_USER_DATA_FLAG + 1 UI_WII_WAITING_SLEEP + 2 UI_KEYBOARD_SNIFF_SKIP +) +/* mem_master_type */ +( + 0 MTYPE_HID_DEFAULT + 1 MTYPE_HID_SSP + 2 MTYPE_SPP +) + + ( + 0x01 RECIEVE_SDP_CONN_RES + 0x02 RECIEVE_SDP_CFG_REQ + 0x03 RECIEVE_SDP_CFG_RES + 0x04 RECIEVE_RFCOMM_CONN_RES + 0x05 RECIEVE_RFCOMM_CFG_REQ + 0x06 RECIEVE_RFCOMM_CFG_RES + 0x07 RECIEVE_HID_CTRL_CONN_RES + 0x08 RECIEVE_HID_CTRL_CFG_REQ + 0x09 RECIEVE_HID_CTRL_CFG_RES + 0x0A RECIEVE_HID_INT_CONN_RES + 0x0B RECIEVE_HID_INT_CFG_REQ + 0x0C RECIEVE_HID_INT_CFG_RES + 0x0D RECIEVE_AVCTP_CONN_RES + 0x0E RECIEVE_AVCTP_CFG_REQ + 0x0F RECIEVE_AVCTP_CFG_RES + 0x10 RECIEVE_AVDTP_SIGNAL_CONN_RES + 0x11 RECIEVE_AVDTP_SIGNAL_CFG_REQ + 0x12 RECIEVE_AVDTP_SIGNAL_CFG_RES + 0x13 RECIEVE_AVDTP_MEDIA_CONN_RES + 0x14 RECIEVE_AVDTP_MEDIA_CFG_REQ + 0x15 RECIEVE_AVDTP_MEDIA_CFG_RES + 0x16 RECIEVE_SS_REASULT_HS + 0x17 RECIEVE_SS_REASULT_HF + 0x18 RECIEVE_SS_REASULT_AVTARG + 0x19 RECIEVE_SS_REASULT_OBEX + 0x1A RECIEVE_DLCI0_UA + 0x1B RECIEVE_HS_PARAM_NEG_RES + 0x1C RECIEVE_HS_UA + 0x1D RECIEVE_HS_MODEM_STATUS_RES + 0x1E RECIEVE_HS_MODEm_STATUS_CMD + 0x1F RECIEVE_HF_PARAM_NEG_RES + 0x20 RECIEVE_HF_UA + 0x21 RECIEVE_HF_MODEM_STATUS_RES + 0x22 RECIEVE_HF_MODEm_STATUS_CMD + 0x23 RECIEVE_OBEX_PARAM_NEG_RES + 0x24 RECIEVE_OBEX_UA + 0x25 RECIEVE_OBEX_MODEM_STATUS_RES + 0x26 RECIEVE_OBEX_MODEm_STATUS_CMD + 0x27 RECIEVE_SPP_PARAM_NEG_RES + 0x28 RECIEVE_SPP_UA + 0x29 RECIEVE_SPP_MODEM_STATUS_RES + 0x2A RECIEVE_SPP_MODEm_STATUS_CMD + 0x2b RECIEVE_SDP_DISCONN_RES + ) + + + + ( + 0 UPPERSM_RP_IDLE + 1 UPPERSM_RP_SDP_CONN + 2 UPPERSM_RP_SDP_CONN_WAIT + 3 UPPERSM_RP_SDP_CFG + 4 UPPERSM_RP_SDP_CFG_WAIT + 5 UPPERSM_RP_SS_AVTARG + 6 UPPERSM_RP_SS_AVTARG_WAIT + 7 UPPERSM_RP_SS_OBEX + 8 UPPERSM_RP_SS_OBEX_WAIT + 9 UPPERSM_RP_SDP_DISCONN + 10 UPPERSM_RP_SDP_DISCONN_WAIT + 11 UPPERSM_RP_AVDTP_CONN_WAIT + 12 UPPERSM_RP_AVCTP_CONN + 13 UPPERSM_RP_AVCTP_CONN_WAIT + 14 UPPERSM_RP_AVCTP_CFG + 15 UPPERSM_RP_AVCTP_CFG_WAIT + 16 UPPERSM_RP_OBEX_CMD_PN + 17 UPPERSM_RP_OBEX_CMD_PN_WAIT + 18 UPPERSM_RP_OBEX_SABM + 19 UPPERSM_RP_OBEX_SABM_WAIT + 20 UPPERSM_RP_OBEX_CMD_MS + 21 UPPERSM_RP_OBEX_CMD_MS_WAIT + ) + ( /*mem_upper_sm_reconn*/ + 0 UPPERSM_RECONN_IDLE + 1 UPPERSM_RECONN_SDP_CONN + 2 UPPERSM_RECONN_SDP_CONN_WAIT + 3 UPPERSM_RECONN_SDP_CFG + 4 UPPERSM_RECONN_SDP_CFG_WAIT + 5 UPPERSM_RECONN_SS_HS + 6 UPPERSM_RECONN_SS_HS_WAIT + 7 UPPERSM_RECONN_SS_HF + 8 UPPERSM_RECONN_SS_HF_WAIT + 9 UPPERSM_RECONN_SS_AVTARG + 10 UPPERSM_RECONN_SS_AVTARG_WAIT + 11 UPPERSM_RECONN_SS_OBEX + 12 UPPERSM_RECONN_SS_OBEX_WAIT + 13 UPPERSM_RECONN_SDP_DISCONN + 14 UPPERSM_RECONN_SDP_DISCONN_WAIT + 15 UPPERSM_RECONN_HID_CTRL_CONN + 16 UPPERSM_RECONN_HID_CTRL_CONN_WAIT + 17 UPPERSM_RECONN_HID_CTRL_CFG + 18 UPPERSM_RECONN_HID_CTRL_CFG_WAIT + 19 UPPERSM_RECONN_HID_INT_CONN + 20 UPPERSM_RECONN_HID_INT_CONN_WAIT + 21 UPPERSM_RECONN_HID_INT_CFG + 22 UPPERSM_RECONN_HID_INT_CFG_WAIT + 23 UPPERSM_RECONN_RFCOMM_CONN + 24 UPPERSM_RECONN_RFCOMM_CONN_WAIT + 25 UPPERSM_RECONN_RFCOMM_CFG + 26 UPPERSM_RECONN_RFCOMM_CFG_WAIT + 27 UPPERSM_RECONN_RFCOMM_SABM + 28 UPPERSM_RECONN_RFCOMM_SABM_WAIT + 29 UPPERSM_RECONN_SPP_CMD_PN + 30 UPPERSM_RECONN_SPP_CMD_PN_WAIT + 31 UPPERSM_RECONN_SPP_SABM + 32 UPPERSM_RECONN_SPP_SABM_WAIT + 33 UPPERSM_RECONN_SPP_CMD_MS + 34 UPPERSM_RECONN_SPP_CMD_MS_WAIT + 35 UPPERSM_RECONN_HF_CMD_PN + 36 UPPERSM_RECONN_HF_CMD_PN_WAIT + 37 UPPERSM_RECONN_HF_SABM + 38 UPPERSM_RECONN_HF_SABM_WAIT + 39 UPPERSM_RECONN_HF_CMD_MS + 40 UPPERSM_RECONN_HF_CMD_MS_WAIT + 41 UPPERSM_RECONN_AVDTPs_CONN + 42 UPPERSM_RECONN_AVDTPs_CONN_WAIT + 43 UPPERSM_RECONN_AVDTPs_CFG + 44 UPPERSM_RECONN_AVDTPs_CFG_WAIT + 45 UPPERSM_RECONN_AVDTPm_CONN + 46 UPPERSM_RECONN_AVDTPm_CONN_WAIT + 47 UPPERSM_RECONN_AVDTPm_CFG + 48 UPPERSM_RECONN_AVDTPm_CFG_WAIT + 49 UPPERSM_RECONN_AVCTP_CONN + 50 UPPERSM_RECONN_AVCTP_CONN_WAIT + 51 UPPERSM_RECONN_AVCTP_CFG + 52 UPPERSM_RECONN_AVCTP_CFG_WAIT + 53 UPPERSM_RECONN_OBEX_CMD_PN + 54 UPPERSM_RECONN_OBEX_CMD_PN_WAIT + 55 UPPERSM_RECONN_OBEX_SABM + 56 UPPERSM_RECONN_OBEX_SABM_WAIT + 57 UPPERSM_RECONN_OBEX_CMD_MS + 58 UPPERSM_RECONN_OBEX_CMD_MS_WAIT + 59 UPPERSM_RECONN_SS_SPP + 60 UPPERSM_RECONN_SS_SPP_WAIT + + 61 UPPERSM_RECONN_SEARCH_SERVICE + 62 UPPERSM_RECONN_SEARCH_SERVICE_WAIT + 63 UPPERSM_RECONN_SEARCH_ATTRIB + 64 UPPERSM_RECONN_SEARCH_ATTRIB_WAIT + ) + (/*mem_ui_profile_supported*/ + 0 support_HID + 1 support_A2DP + 2 support_AVRCP + 3 support_HF + 4 support_HS + 5 support_PBAP + 6 support_SPP + ) + /*mem_upper_sm_ss*/ + ( + 0 UPPERSM_SS_HS + 1 UPPERSM_SS_HF + 2 UPPERSM_SS_AVTARG + 3 UPPERSM_SS_OBEX + ) + + ( + 160 UI_HUNDRED_MILLISECOND_TIME + 0XFF UI_BUTTON_GPIO_DISABLE + ) + ( + 0x01 UI_BB_INCONNECT + 0x10 UI_BB_DISCONNECT + ) +( +0x00 UI_BUTTON_STATE_DOWN +0x01 UI_BUTTON_STATE_UP +) + +//mem_ipc_skip_continue_proc +( + 0 IPC_CONTINUE_PROCESS + 1 IPC_SKIP_CONTINUE_PROCESS +) + + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/utility.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/utility.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/utility.format (working copy) @@ -0,0 +1,182 @@ +/** +* @file:bt_utility_format.upper +* @author: lei.zhu +* utility header file. inlcude timer +* Copyright: (C)Hanlynn Technology +*/ + +memalloc( + +/* + temp parameter +*/ +2 mem_hold_contr +2 mem_hold_contw +1 mem_fifo_temp + +8 mem_pdatatemp +8 mem_temp //8 bytes +4 mem_timeup // 4 bytes +4 mem_rega //4 bytes +4 mem_regb //4 bytes +3 mem_regc //3 bytes +2 mem_contr //2 bytes +2 mem_contw //2 bytes + +1 mem_wakup_from_power_flag +4 mem_saved_gpio_in + +0 mem_shutter_random_mac_data_temp +0 mem_shutter_config_data_temp +0 mem_le_adv_channel_map_temp +0 mem_le_data_len_temp //1byte +0 mem_tx_fifo_map_temp +0 mem_rpn_dlci //1byte +0 mem_event_cmd_response_content //2byte +0 mem_le_prand //16byte +0 mem_AES_CMAC_k //16 bytes +0 mem_regext_index //1 bytes +1 mem_temp_block0 +0 mem_le_data_temp //15bytes +15 mem_temp_block1 +0 mem_le_aes_128 //16byte +0 mem_regext //64 bytes +0 mem_AES_CMAC_k1 //16 bytes +16 mem_temp_block2 +0 mem_AES_CMAC_k2 //16 bytes +16 mem_temp_block3 +0 mem_AES_CMAC_temp // 16 bytes +16 mem_temp_block4 +0 mem_AES_CMAC_M_last // 16 bytes +1 mem_module_uart_cmd +1 mem_module_uart_opcode +1 mem_module_uart_len +1 mem_module_temp_nl_discard_packet +12 mem_temp_block5 +0 mem_le_mackey //16 bytes +0 mem_app_receive_temp +2 mem_key_value_temp +2 mem_key_value +1 mem_key_value_temp1 +1 mem_key_value_temp2 +1 mem_key_value_temp3 +1 mem_key_value_temp4 +1 mem_key_value_temp5 +1 mem_key_value_temp6 +6 mem_temp_block6 + +) + +bmemalloc( +1 mem_usb_status +1 mem_usb_fifo_empty +1 mem_usb_read_len +64 mem_usb_rxbuf +2 mem_bufptr +1 mem_remain +20 mem_devicedesc +2 mem_hidreportdesc_kb +2 mem_hidreportdesc_m +100 mem_confdesc +5 mem_string0 +30 mem_string1 +64 mem_string2 +30 mem_string3 +2 mem_usb_zero_packet +2 mem_usb_ones_packet +2 mem_usb_two_packet +1 mem_usb0_state + +1 mem_usb_offline_check_gpio +1 mem_usb_tx_interval + +0 mem_usb_clear_mem_start +0 mem_usb_setup +1 mem_usb_setup_bmRequestType +1 mem_usb_setup_bRequest +1 mem_usb_setup_bValue +1 mem_usb_setup_bValueH +2 mem_usb_setup_wIndex +1 mem_usb_setup_bLength +1 mem_usb_setup_bLengthH +64 mem_usb0_setup +64 mem_usb0_set_report_data +64 mem_usb0_get_report_data +1 mem_usb_state +1 mem_usb_tx_wait +1 mem_usb_tx_enable +1 mem_usb_remote_wakeup +1 mem_usb_clear_remote_wakeup +1 mem_usb_ep0_stall_status +1 mem_usb_ep1_stall_status +1 mem_usb_ep2_stall_status +1 mem_usb_ep3_stall_status +2 mem_dsc_info_data_pointer +1 mem_dsc_info_len +1 mem_usb0_data_ready_report +1 mem_usb_tx_win_enable +1 mem_usb_tx_mac_enable +1 mem_usb_device_enumeration_endflag +1 mem_usb_wakestate_onetime_flag +1 mem_usb_mac_wakeup_trig +1 mem_usb_set_high_addr_flag +1 mem_usb_set_protocol_value +1 mem_usb_set_protocol_status +1 mem_usb_get_protocol_flag +1 mem_usb_idle_flag +1 mem_usb_idle_rate +2 mem_usb_setup_bValue_temp +1 mem_usb0_get_set_report +1 mem_usb_ep1_data +1 mem_usb_ep2_data +1 mem_usb_clear_halt +16 mem_usb_mouse_data +16 mem_usb_kb_data +16 mem_usb_kb_multikey +8 mem_usb_kb_data_sta_data +8 mem_usb_kb_data_last_data +3 mem_usb_kb_multikey_sta_data +3 mem_usb_kb_multikey_last_data +1 mem_usb_kb_blank_data_enable +1 mem_usb_kb_mul_blank_data_enable +1 mem_usb_test_cnt +0 mem_usb_clear_mem_end +1 mem_usb_test_kb + +256 mem_rssi_noise_buffer +256 mem_rssi_noise_dg_buffer +256 mem_rssi_noise_ms_buffer +256 mem_rssi_noise_kb_buffer +32 mem_24g_common_temp + +) + + +( +/*mem_util_timer_flag0_7*/ + 0 UTIL_TIMER_0_USED + 1 UTIL_TIMER_1_USED + 2 UTIL_TIMER_2_USED + 3 UTIL_TIMER_3_USED + 4 UTIL_TIMER_4_USED + 5 UTIL_TIMER_5_USED + 6 UTIL_TIMER_6_USED + 7 UTIL_TIMER_7_USED +/*mem_util_timer_flag8_15*/ + 0 UTIL_TIMER_8_USED + 1 UTIL_TIMER_9_USED + 2 UTIL_TIMER_10_USED + 3 UTIL_TIMER_11_USED + 4 UTIL_TIMER_12_USED + 5 UTIL_TIMER_13_USED + 6 UTIL_TIMER_14_USED + 7 UTIL_TIMER_15_USED +) + +//util fifo param +( + +8 UTIL_FIFO_LEN +-1 UTIL_FIFO_OFFSET +) + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/var.format =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/var.format (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/format/var.format (working copy) @@ -0,0 +1,442 @@ +/************************************************************************/ +/* RCS HEADER -- DO NOT ERASE */ +/* $Author: Administrator $ */ +/* $Id: bt_var.osi,v 1.1 2009-09-28 04:06:18 Administrator Exp $ */ +/* Orisil Technology */ +/************************************************************************/ + + +/* packet types */ +( + 0x02 FHS_PACKET + 0x03 DM1_PACKET + 0x03 DM1_LMP_PACKET + 0x04 DH1_PACKET + 0x05 HV1_PACKET + 0x06 HV2_PACKET + 0x07 HV3_PACKET + 0x08 DV_PACKET + 0x09 AUX1_PACKET + 0x0a DM3_PACKET + 0x0b DH3_PACKET + 0x0e DM5_PACKET + 0x0f DH5_PACKET +) + + +/* mem_lmp_respond */ +( + 0 RESPOND_TO_ALL + 1 PASS_EVERYTHING + 2 PASS_ONLY_UNKNOWNS + 3 RESPOND_TO_LMPS +) +/* SCO algorithm defines */ +( + 0 ULAW + 1 ALAW + 2 CVSD +) +/* encryption modes */ +( + 0 NO_ENCRYPTION + 1 PT_PT_ENCRYPTION + 2 PT_BROADCAST_ENCRYPTION +) + +/* bits used in mem_lmp_state1 variable */ +( + 0 LMP_STATE_DETACH + 1 LMP_STATE_HOLD + 2 LMP_STATE_SNIFF + 3 LMP_STATE_PARK + 4 LMP_STATE_WAIT_SCO_CREATE + 5 LMP_STATE_WAIT_SCO_KILL + 6 LMP_STATE_SCO3 + 7 LMP_STATE_WAIT_SCO_START +) +/* mem_lmp_state2 */ +( + 0 LMP_WAIT_FOR_SNIFF_ACCEPT + 1 LMP_WAIT_FOR_PARK_ACCEPT + 2 LMP_SEND_UNPARK_ACCEPTED + 3 LMP_SEND_ENCRYPTION_START + 4 LMP_SEND_ENCRYPTION_STOP + 5 MESSAGE_QUEUE + 7 LMP_STATE_WAIT_BEACON +) +/* mem_lmp_state3 */ +( + 0 INQUIRY_STATE_CHECK + 1 HOST_DELAY_MESSAGE + 2 VARIABLE_DELAY + 3 TEST_MODE_START_LOOPBACK + 4 TEST_MODE_START_PATTERN + 5 PARSE_TEST_CONTROL_MESSAGE + 6 H_AUTH_SEND_COMB_KEY +) +/* mem_rx_status */ +( + 0 FROM_MASTER +) +/* mem_ms_flag */ +( + 0 MS_RECEIVE_SWITCH_REQ + 1 MS_SEND_SETUP_COMPLATE +) +/* mem_conn_sm */ +( + 0 CONN_SM_STANDBY + 1 CONN_SM_WAIT_PAGE + 2 CONN_SM_SEND_FEATURES + 3 CONN_SM_WAIT_FEATURES_RES + 4 CONN_SM_SEND_CONN_REQ + 5 CONN_SM_WAIT_CONN_ACCEPT + 6 CONN_SM_AUTH_PAIR + 7 CONN_SM_AUTH_PAIR_WAIT + 8 CONN_SM_WAIT_MUTAL_AUTH + 9 CONN_SM_ENCRYPT + 0xa CONN_SM_ENCRYPT_WAIT + 0xb CONN_SM_ENCRYPT_WAIT_CLEAR + 0xc CONN_SM_SEND_SETUP_COMPLETE + 0xd CONN_SM_WAIT_SETUP_COMPLETE + 0xe CONN_SM_SEND_SWITCH + 0xf CONN_SM_DETACH_DELAY + 0x10 CONN_SM_WAIT_SWITCH_AFTER_HOST_CONNECTION + 0x11 CONN_SM_DELAY_RESTART_CONNECTION + 0x12 CONN_SM_SEND_VERSION + 0X13 CONN_SM_WAIT_VERSION + 0x14 CONN_SM_SEND_FEATURES_EXT + 0x15 CONN_SM_WAIT_FEATURES_EXT + 0x16 CONN_SM_PAIRING + 0x17 CONN_SM_AUTH + 0x18 CONN_SM_PAIRING_WAIT + 0x19 CONN_SM_AUTH_WAIT + 0x1a CONN_SM_DONE + 0x1b CONN_SM_WAIT_DONE +) + +/* btStateConn1 */ +( + 0 CONN_STANDBY + 1 CONN_MASTER_SEND_CONN_REQ + 2 CONN_MASTER_WAIT_FOR_CONN_ACCEPTED + 3 CONN_MASTER_AUTH + 4 CONN_MASTER_WAIT_FOR_FEATURES + 5 CONN_MASTER_WAIT_FOR_SETUP_COMPLETE + 6 CONN_MASTER_WAIT_FOR_MAX_SLOT + 7 CONN_SLAVE_CONN_REQUESTED + 8 CONN_SLAVE_WAIT_FOR_SETUP_COMPLETE + 9 CONN_SLAVE_AUTH + 10 CONN_USING_HOST_OPCODE + 11 CONN_SLAVE_AUTH_WAIT + 12 CONN_SLAVE_ENCRYPT_WAIT +) + +/* mem_lmp_conn_state */ +( + 0 RECEIVED_CONN_REQ + 1 SENT_CONN_REQ + 2 RECEIVED_SETUP_COMPLETE + 3 SENT_SETUP_COMPLETE + 4 HOST_CONNECTION_MADE + 6 INIT_COMPLETE + 7 SNIFF_NEGOTIATE +) +/* btStateAuth1 */ +( + 0 WAIT_FOR_KINIT + 1 WAIT_FOR_LKA + 2 WAIT_FOR_LKB + 3 WAIT_FOR_SRES + 4 EXAMINE_RECEIVED_SRES + 5 SEND_AU_RAND + 6 WAIT_FOR_KC + 7 DELAYED_ENCRYPT_RESPONSE +) +/* btStateAuth2 */ +( + 0 SENT_SRES + 1 RECEIVED_IN_RAND + 2 SENT_AU_RAND + 3 AUTHENTICATION_FAILED + 4 AUTHENTICATION_PASSED + 5 STARTED_AUTH + 6 SENT_COMB_KEY + 7 SENT_IN_RAND +) +/* btStateAuth3 */ +( + 0 RECEIVED_AU_RAND + 1 RECEIVED_SRES + 2 MUTUALLY_AUTHENTICATE +) +/* btStateHost */ +( + 0 H_AUTH_STARTED + 2 H_ENCRYPTION_MODE_REQ_PT + 3 H_ENCRYPTION_KEY_SIZE + 4 H_ENCRYPTION_START + 5 H_ENCRYPTION_STOP + 6 H_AUTH_SECOND_TRY +) +/* btStateEncrypt2 */ +( + 0 RECEIVED_ENCRYPT_MODE_REQ_PT + 1 RECEIVED_ENCRYPT_KEY_SIZE + 2 RECEIVED_ENCRYPT_START + 3 RECEIVED_ENCRYPT_STOP + 4 STARTED_ENCRYPT_START +) +/* mem_ms_state */ +( + 0x00 MS_STANDBY + 0x11 M_MINIT_1 + 0x12 M_MINIT_2 + 0x20 M_SINIT_0 + 0x30 S_MINIT_0 + 0x31 S_MINIT_1 + 0x32 S_MINIT_2 + 0x41 S_SINIT_1 + 0x42 S_SINIT_2 + 0x43 S_SINIT_3 +) +/* mem_test_mode */ +( + 0 TEST_MODE_ALLOWED + 1 TEST_MODE_ACTIVE +) +/* values for mem_tester_emulate */ +( + 0x00 NO_TEST_MODE + 0x00 CONTINUOUS_TRANSMIT + 0x10 TRANSMIT_TEST + 0x08 LOOPBACK +) + +/* mem_tx_misc */ +( + 1 SEND_TX_ADDR +) +/* BBHWREG_page_stat */ +( + 5 PAGE_MODE_END +) +/* host_return_parameters_status codes */ +( + 0x00 HOST_RETURN_SUCCESS + 0x01 HOST_RETURN_SLAVE_CANT_ISSUE + 0x02 HOST_RETURN_NO_CONNECTION + 0x04 HOST_RETURN_PAGE_TIMEOUT + 0x05 HOST_RETURN_INQUIRY_TIMEOUT + 0x08 HOST_RETURN_CONNECTION_TIMEOUT + 0x09 HOST_RETURN_MAX_NUM_CONNECTIONS + 0x0a HOST_RETURN_MAX_NUM_SCO + 0x0b HOST_RETURN_MAX_NUM_ACL + 0x0c HOST_RETURN_SECURITY_REASONS + 0x10 HOST_RETURN_HOST_TIMEOUT + 0x11 HOST_RETURN_UNSUPPORTED_FEATURE_PARAMETER + 0x13 HOST_RETURN_OTHER_END_USER + 0x14 HOST_RETURN_OTHER_END_LOW_RESOURCE + 0x15 HOST_RETURN_OTHER_END_POWER_OFF + 0x16 HOST_RETURN_LOCAL_HOST + 0x18 HOST_RETURN_PAIRING_NOT_ALLOWED + 0x19 HOST_RETURN_UNKNOWN_PDU + 0x1a HOST_RETURN_UNSUPPORTED_REMOTE_FEATURE + 0x1d HOST_RETURN_SCO_AIR_MODE_REJECTED + 0x20 HOST_RETURN_UNSUPPORTED_LMP_VALUE + 0x21 HOST_RETURN_AUTHENTICATION_FAILURE + 0x22 HOST_RETURN_CHANGED_EXISTING_SCO + 0x23 HOST_RETURN_HOST_REJECTED + 0x24 HOST_RETURN_UNSPECIFIED_ERROR + 0x25 HOST_RESET + 0x26 HOST_RETURN_BAD_HANDLE + + 0x00 HOST_RETURN_ACCEPT_COMMAND + 0x01 HOST_RETURN_REJECT_COMMAND +) +/* host_present */ +( + 0 HOST_IS_PRESENT + 1 BCI_IS_PRESENT + 2 DONT_INIT_RADIO +) +/* mem_master_state */ +( + 0 MASTER_STATE_STANDBY + 1 MASTER_INQUIRY +) +/* misc */ +( + 92 SECOND_SWITCH_REQ + 93 SLAVE_DELAY_DETACH + 94 MASTER_DELAY_DETACH + 95 UNSNIFF_DELAY_DETACH + 0 WE_STARTED_AS_MASTER + 1 WE_STARTED_AS_SLAVE +) +/* mem_host_commands */ +( + 0x01 HOST_INQUIRY + 0x02 HOST_INQUIRY_CANCEL + 0x03 HOST_CREATE_CONNECTION + 0x04 HOST_DISCONNECT_CONNECTION + 0x05 HOST_ADD_SCO_REQUEST + 0x06 HOST_REMOTE_NAME_REQUEST + 0x07 HOST_WRITE_SUPPORTED_FEATURES + 0x08 HOST_SET_TX_LEVEL + 0x09 HOST_SET_RX_LEVEL + 0x0a HOST_SNIFF_REQUEST + 0x0b HOST_UNSNIFF_REQUEST + 0x0c HOST_WRITE_LINK_SUPERVISION_TIMEOUT + 0x0e HOST_WRITE_SCAN_ENABLE + 0x0f HOST_READ_AUDIO_QUALITY + 0x10 HOST_ENABLE_DEVICE_UNDER_TEST + 0x14 HOST_BUTTON_CONFIGURE + 0x15 HOST_SET_LOW_BATTERY_LEVEL + 0x16 HOST_WRITE_LOCAL_NAME + 0x17 HOST_WRITE_LOCAL_PIN + 0x18 HOST_KILL_SCO_REQUEST + 0x19 HOST_QOS_REQ + + 0x1a HOST_FEATURES_REQUEST + 0x1b HOST_VERSION_REQUEST + 0x1c HOST_TIMING_REQUEST + 0x1d HOST_CLK_OFFSET_REQUEST + 0x1e HOST_AUTHENTICATE + 0x1f HOST_START_ENCRYPTION + 0x20 HOST_STOP_ENCRYPTION + 0x21 HOST_HOLD_REQUEST + 0x22 HOST_HOLD_FORCE + 0x23 HOST_PARK_REQUEST + 0x24 HOST_MOD_BEACON + 0x25 HOST_SET_BROADCAST_SCAN_WINDOW + 0x26 HOST_UNPARK_PM_REQUEST + 0x27 HOST_UNPARK_BD_REQUEST + 0x28 HOST_SLAVE_REQUEST_UNPARK + 0x29 HOST_DECREASE_POWER_REQUEST + 0x2a HOST_INCREASE_POWER_REQUEST + 0x2b HOST_SEND_PREFERRED_RATE + 0x2c HOST_MAX_SLOT_REQ + 0x2d HOST_MAX_SLOT_FORCE + 0x2e HOST_PAGE_MODE_REQUEST + 0x2f HOST_PAGE_SCAN_MODE_REQUEST + 0x30 HOST_MASTER_SLAVE_SWITCH + 0x31 HOST_SEND_AUTO_RATE + 0x32 HOST_PAGE_CANCEL + 0x33 HOST_CHANGE_LINK_KEY + 0x34 HOST_RADIO_READ + 0x35 HOST_RADIO_WRITE + 0x36 HOST_REMOTE_SLAVE_INIT_UNPARK_REQUESTED + + 0x40 HOST_REMOTE_CONNECTION_REQUESTED + 0x41 HOST_REMOTE_DETACH + 0x42 HOST_REMOTE_SCO_CREATE_REQUESTED + 0x43 HOST_REMOTE_SCO_KILL_REQUESTED + 0x44 HOST_REMOTE_PARK_REQUESTED + 0x45 HOST_REMOTE_UNPARK_REQUESTED + 0x46 HOST_REMOTE_SNIFF_REQUESTED + 0x47 HOST_REMOTE_UNSNIFF_REQUESTED + 0x48 HOST_REMOTE_HOLD_REQUESTED + 0x49 HOST_REMOTE_AUTHENTICATION + 0x4a HOST_REMOTE_START_ENCRYPTION_REQUESTED + 0x4b HOST_REMOTE_STOP_ENCRYPTION_REQUESTED + 0x4c HOST_MODE_CHANGE_EVENT + 0x4d HOST_REMOTE_TEST_ACTIVATE + 0x4e HOST_REMOTE_TEST_CONTROL + 0x4f HOST_REMOTE_TIMING_REQUEST +) +/* BCI interface (not used if not compiled in ) */ +( + 0x01 BCI_INQUIRY + 0x02 BCI_INQUIRY_CANCEL + 0x03 BCI_CREATE_CONNECTION + 0x04 BCI_DISCONNECT + 0x05 BCI_ADD_SCO_CONNECTION + 0x06 BCI_REMOTE_NAME_REQUEST + 0x07 BCI_WRITE_SUPPORTED_FEATURES + 0x08 BCI_SET_TX_POWER_LEVEL + 0x09 BCI_SET_RX_POWER_LEVEL + 0x0a BCI_SNIFF_MODE + 0x0b BCI_EXIT_SNIFF_MODE + 0x0c BCI_WRITE_LINK_SUPERVISION_TIMEOUT + 0x0d BCI_WRITE_PAGE_TIMEOUT + 0x0e BCI_WRITE_SCAN_ENABLE + 0x0f BCI_GET_AUDIO_QUALITY + 0x10 BCI_ENABLE_DEVICE_UNDER_TEST + 0x11 BCI_SEND_DATA + 0x12 BCI_REGISTER_SERVICE_RECORD + 0x13 BCI_SERVICE_SEARCH_ATTRIB_REQ + 0x14 BCI_BUTTON_CONFIGURE + 0x15 BCI_SET_LOW_BATTERY_LEVEL + 0x16 BCI_WRITE_LOCAL_NAME + 0x17 BCI_WRITE_LOCAL_PIN + 0x18 BCI_REMOVE_SCO_CONNECTION + 0x19 BCI_QUALITY_OF_SERVICE + 0x40 BCI_REMOTE_CONNECTION_REQUEST + 0x41 BCI_REMOTE_DETACH + 0x42 BCI_REMOTE_ADD_SCO_REQUEST + 0x43 BCI_REMOTE_REMOVE_SCO_REQUEST + 0x44 BCI_REMOTE_PARK_REQUEST + 0x45 BCI_REMOTE_UNPARK_REQUEST + 0x46 BCI_REMOTE_SNIFF_REQUEST + 0x47 BCI_REMOTE_UNSNIFF_REQUEST + 0x48 BCI_REMOTE_HOLD_REQUEST + 0x49 BCI_REMOTE_AUTHENTICATION_PAIRING_REQUEST + 0x4a BCI_REMOTE_START_ENCRYPTION_REQUEST + 0x4b BCI_REMOTE_STOP_ENCRYPTION_REQUEST + 0x4c BCI_MODE_CHANGE_EVENT +) +/* mode changes */ +( + 0 MODE_CHANGE_ACTIVE + 1 MODE_CHANGE_SNIFFING + 2 MODE_CHANGE_PARKED + 3 MODE_CHANGE_HOLDING + 4 MODE_CHANGE_SCO_ADDED + 5 MODE_CHANGE_SCO_REMOVED + 6 MODE_CHANGE_ACL_CONNECTION + 7 MODE_CHANGE_DISCONNECT + 8 MODE_CHANGE_SCO_CHANGED + 9 MODE_CHANGE_ENCRYPTING + 10 MODE_CHANGE_NOT_ENCRYPTING + 11 MODE_CHANGE_BUTTON_UP + 12 MODE_CHANGE_BUTTON_DOWN + 13 MODE_CHANGE_BATTERY_LOW + 14 MODE_CHANGE_RESET + 15 MODE_CHANGE_INQUIRY_CANCELED_RMTCMD + 16 MODE_ACTIVE_MSSWITCH_PASSED + 17 MODE_ACTIVE_MSSWITCH_FAILED +) +/* mem_battery - low nibble is level information, upper nibble is status info */ +( + 6 BATTERY_CHECK_LEVEL + 7 BATTERY_SENT_STATUS +) +/* mem_radio_version */ +( + 0x02 RADIO_2001 + 0x12 RADIO_2002 + 0x32 RADIO_2002_DDM + 0x42 RADIO_1008A1 + 0x52 RADIO_1018A0 +) +/* mem_slave_initiated_conn */ +( + 0 SLAVE_INIT_AUTHENTICATION + 1 SLAVE_INIT_ENCRYPTION + 2 SLAVE_INIT_MASTER_SLAVE_SWITCH +) +/* connection_options */ +( + 0 CONNECTION_AUTH + 1 CONNECTION_ENCRYPT + 2 CONNECTION_SWITCH + 3 CONNECTION_ACL + 4 CONNECTION_FEATURE_EXT +) +/* mem_debug_config */ +( + 7 AA_INSERTION +) + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/app.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/app.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/app.prog (working copy) @@ -0,0 +1,469 @@ +app_init: + bpatch patch16_2,mem_patch16 + fetch 1,mem_device_option + branch app_init,blank /* wait ram to be initialized */ + beq dvc_op_module,module_init + rtn + +app_lpm_init: + bpatch patch16_3,mem_patch16 + jam 0,mem_tester_emulate + jam 0,mem_debug_config + jam 0, mem_lch_code + setarg 0 + store 5,mem_sp_state_start + fetch 1,mem_device_option + branch app_lpm_init,blank /* wait ram to be initialized */ + beq dvc_op_module,module_lpm_init +app_lpm_init0: + rtn + + +app_process_idle: + call ui_dispatch + call check_51cmd + call app_process_bb_event + fetch 2,mem_cb_idle_process + branch callback_func + +app_process_bt: + fetch 2,mem_cb_bt_process + branch callback_func + +app_process_ble: + fetch 2,mem_cb_le_process + branch callback_func + +app_process_bb_event: + bpatch patch16_4,mem_patch16 + //return if c51 need to process bb event + arg mem_ipc_fifo_bt2c51,rega + call fifo_out + rtn blank + //reaching here mains c51 cannot get bb event. + copy pdata,regc + call app_event_normal_process + branch app_process_bb_event_priority + +app_discard_event: + arg 0,regc + rtn + +//************************************************// +//*APP BB EVENT NORMAL PROCESS**// +//************************************************// +app_event_normal_process: + beq BT_EVT_BB_CONNECTED,app_evt_bt_conn + beq BT_EVT_BUTTON_LONG_PRESSED,app_evt_button_long_pressed + beq BT_EVT_SETUP_COMPLETE,app_evt_setup_complete + beq BT_EVT_HID_HANDSHAKE,app_evt_hid_handshake + beq BT_EVT_HID_CONNECTED,app_bb_event_hid_connected + beq BT_EVT_RECONN_FAILED,app_bb_event_reconn_failed + beq BT_EVT_BB_DISCONNECTED,app_bb_event_bb_disconn + beq BT_EVT_RECONN_PAGE_TIMEOUT,app_bb_event_reconn_failed + beq BT_EVT_LE_CONNECTED,app_le_event_bb_connected + beq BT_EVT_LE_DISCONNECTED,app_le_event_bb_disconn + beq BT_EVT_RECONN_STARTED,app_event_reconn_start + beq BT_EVT_ENTER_SNIFF,app_event_enter_sniff + beq BT_EVT_EXIT_SNIFF,app_event_exit_sniff + + beq BT_EVT_ML2CAP_CONN_REFUSED,app_event_ml2cap_conn_refused + beq BT_EVT_LINKKEY_GENERATE,app_event_linkkey_generate + beq BT_EVT_SWITCH_FAIL_MASTER,app_event_switch_fail_master + beq BT_EVT_SWITCH_SUCCESS_MASTER,app_event_switch_success + rtn + + +app_evt_bt_conn: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_CONNECTED,pdata + store 2,mem_ui_state_map + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set0 APP_DISC_BY_BUTTON ,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + +app_event_switch_success: + jam 0,mem_switch_fail_master_count + rtn + +app_event_switch_fail_master: + fetch 1,mem_switch_fail_master_count + increase 1,pdata + store 1,mem_switch_fail_master_count + sub pdata,1,null + branch app_bt_role_switch,positive + jam 0,mem_switch_fail_master_count + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_SWITCH_FAIL,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + branch app_bt_disconnect + +app_process_bb_event_priority: + fetch 2,mem_cb_bb_event_process + branch callback_func + +app_check_wake_lock: + fetch 2,mem_cb_check_wakelock + branch callback_func + +app_will_enter_lpm: + fetch 2,mem_cb_before_lpm + branch callback_func + +app_event_linkkey_generate: + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_AFTER_PAIRING ,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + branch app_bt_store_reconn_info + +app_event_reconn_start: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_RECONNECT,pdata + store 2,mem_ui_state_map + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_AFTER_RECONN,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + +app_evt_setup_complete: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_SETUP_COMPLETE,pdata + store 2,mem_ui_state_map + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_AFTER_SETUP_DONE,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + +app_evt_hid_handshake: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_HID_HANDSHAKE,pdata + store 2,mem_ui_state_map + rtn + +app_event_enter_sniff: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_SNIFF,pdata + store 2,mem_ui_state_map + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_AFTER_SNIFF,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + +app_event_exit_sniff: + fetch 2,mem_ui_state_map + set0 UI_STATE_BT_SNIFF,pdata + store 2,mem_ui_state_map + rtn + +app_le_event_bb_connected: + fetch 2,mem_ui_state_map + set1 UI_STATE_BLE_CONNECTED,pdata + store 2,mem_ui_state_map + rtn + +app_le_event_bb_disconn: + fetch 2,mem_ui_state_map + set0 UI_STATE_BLE_CONNECTED,pdata + store 2,mem_ui_state_map + branch app_lpm_mult_disable + +app_bb_event_hid_connected: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_HID_CONN,pdata + store 2,mem_ui_state_map + rtn + +app_evt_button_long_pressed: + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_BY_BUTTON,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + +app_event_ml2cap_conn_refused: + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_L2CAP_REFUSED,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + branch app_bt_disconnect + + +app_evt_timer: + bpatch patch16_5,mem_patch16 + store 1,mem_app_evt_timer_count +app_evt_100ms_loop: + fetch 1,mem_app_evt_timer_count + rtn blank + increase -1,pdata + store 1,mem_app_evt_timer_count + call app_lpm_wake_auto_lock_timer + call app_unsniff_delay_timer + call app_discovery_timer + fetch 2,mem_cb_event_timer + call callback_func + branch app_evt_100ms_loop + + +//regc:timer addr +//regb:timer up call back fuction +timer_single_step: + ifetch 1,regc + rtn blank + pincrease -1 + istore 1,regc + nrtn blank + copy regb,pdata + branch callback_func + +//regc:timer addr +//regb:timer up call back fuction +timer_single_step_2B: + ifetch 2,regc + rtn blank + pincrease -1 + istore 2,regc + nrtn blank + copy regb,pdata + branch callback_func + +app_unsniff_delay_timer: + arg mem_unsniff2sniff_timer_count,regc + arg app_unsniff_delay_timeout,regb + branch timer_single_step + +app_unsniff_delay_timeout: + call context_check_idle + branch app_bt_enter_sniff,zero + rtn + + +app_discovery_timer: + arg mem_discovery_timeout_timer_count,regc + arg app_discovery_timeout,regb + branch timer_single_step_2B + +app_discovery_timeout: + call app_bt_stop_discovery + call app_led_off + fetch 2,mem_cb_discovry_timeout + branch callback_func + + +app_bb_event_reconn_failed: + call app_disconn_reason_flag_clear +app_clear_reconnect_flag: + fetch 2,mem_ui_state_map + set0 UI_STATE_BT_RECONNECT,pdata + store 2,mem_ui_state_map + rtn + +app_bb_event_bb_disconn: + jam 0,mem_unsniff2sniff_timer_count + fetch 2,mem_ui_state_map + bbit1 UI_STATE_BT_RECONNECT,app_bb_event_bb_reconn_disconn + isolate0 UI_STATE_BT_SETUP_COMPLETE,pdata + call app_discard_event,true +app_bb_event_bb_reconn_disconn: + bpatch patch16_6,mem_patch16 + fetch 2,mem_ui_state_map + set0 UI_STATE_BT_CONNECTED,pdata + set0 UI_STATE_BT_SETUP_COMPLETE,pdata + set0 UI_STATE_BT_HID_CONN,pdata + set0 UI_STATE_BT_HID_HANDSHAKE,pdata + set0 UI_STATE_BT_RECONNECT,pdata + store 2,mem_ui_state_map + branch app_lpm_mult_disable + +app_bb_hibernate: + call app_disconn_reason_clear + branch app_enter_hibernate + + +app_disconn_reason_clear: + setarg 0 + store APP_DISC_RSN_SIZE,mem_app_disconn_reason + rtn +app_disconn_reason_flag_clear: + setarg 0 + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + +app_disconn_reason_collect_bt: + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + store APP_DISC_RSN_SIZE,mem_app_disconn_reason + setarg 0 + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + +app_disconn_reason_collect_ble: + fetch APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + set1 APP_DISC_BLE,pdata + store APP_DISC_RSN_SIZE,mem_app_disconn_reason + setarg 0 + store APP_DISC_RSN_SIZE,mem_app_disconn_reason_flag + rtn + + +//************************************************// +//********APP SHARED FUNCSIONS*******// +//************************************************// + + +app_check_sniff: + fetch 1,mem_ui_state_map + isolate1 UI_STATE_BT_SNIFF,pdata + rtn + +//*****************************************// +//*****************API********************// +//*****************************************// +//app_clearflag_store: +// setarg 0 +// branch app_flag_store + +app_start_auto_sniff: + fetch 1,mem_unsniff2sniff_timer + store 1,mem_unsniff2sniff_timer_count + rtn + +app_get_lpm_wake_lock: + arg wake_lock_app,queue + branch lpm_get_wake_lock + +app_put_lpm_wake_lock: + arg wake_lock_app,queue + branch lpm_put_wake_lock + +app_lpm_wake_auto_lock: + jam LPM_WAKE_UP_DELAY_TIMER,mem_wake_up_delay_timer + branch app_get_lpm_wake_lock + +app_lpm_wake_auto_lock_timer: + arg mem_wake_up_delay_timer,regc + arg app_put_lpm_wake_lock,regb + branch timer_single_step + +app_l2cap_flow_control_enable: + jam L2CAP_FLOW_CTRL_ENABLE,mem_l2cap_flow_ctrl_flag + rtn + +app_l2cap_flow_control_disable: + jam L2CAP_FLOW_CTRL_DISABLE,mem_l2cap_flow_ctrl_flag + rtn + +app_bt_set_pincode: + jam BT_CMD_SET_PIN_CODE,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_role_switch: + jam BT_CMD_ROLE_SWITCH,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_start_reconnect: + bpatch patch16_7,mem_patch16 + fetch 1,mem_app_connection_options + store 1,mem_connection_options + jam APP_FLAG_RECONNECT,mem_reconnect_flag + jam BT_CMD_RECONNECT,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_reconnect_cancel: + jam BT_CMD_BB_RECONN_CANCEL,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_disconnect: + jam BT_CMD_DISCONNECT,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_start_discovery_short: + fetch 2,mem_discovery_timeout + store 2,mem_discovery_timeout_timer_count +app_bt_start_discovery_led_blink: + call app_led_start_blink +app_bt_start_discovery: + jam BT_CMD_START_DISCOVERY,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_stop_discovery: + setarg 0 + store 2,mem_discovery_timeout_timer_count + jam BT_CMD_STOP_DISCOVERY,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_start_direct_adv: + jam BT_CMD_START_DIRECT_ADV,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_stop_direct_adv: + jam BT_CMD_STOP_DIRECT_ADV,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_stop_adv: + jam BT_CMD_STOP_ADV,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_start_adv: + jam BT_CMD_START_ADV,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_start_scan: + jam BT_CMD_LE_START_SCAN,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_stop_scan: + jam BT_CMD_LE_STOP_SCAN,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_start_conn: + jam BT_CMD_LE_START_CONN,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_disconnect: + jam BT_CMD_LE_DISCONNECT,mem_fifo_temp + branch ui_ipc_send_cmd + +app_led_start_blink: + jam BT_CMD_LED_BLINK,mem_fifo_temp + branch ui_ipc_send_cmd + +app_led_on: + jam BT_CMD_LED_ON,mem_fifo_temp + branch ui_ipc_send_cmd + +app_led_stop_blink: +app_led_off: + jam BT_CMD_LED_OFF,mem_fifo_temp + branch ui_ipc_send_cmd + +app_enter_hibernate: + jam BT_CMD_ENTER_HIBERNATE,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_sniff_exit: + jam BT_CMD_EXIT_SNIFF,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_enter_sniff: + jam BT_CMD_ENTER_SNIFF,mem_fifo_temp + branch ui_ipc_send_cmd + +app_ble_store_reconn_info: + jam BT_CMD_STORE_RECONN_INFO_LE,mem_fifo_temp + branch ui_ipc_send_cmd + +app_bt_store_reconn_info: + jam BT_CMD_STORE_RECONN_INFO_BT,mem_fifo_temp + branch ui_ipc_send_cmd + +app_store_reconn_info: + jam BT_CMD_STORE_RECONN_INFO,mem_fifo_temp + branch ui_ipc_send_cmd + +app_lpm_mult_enable: + set1 mark_lpm_mult_enable,mark + rtn + +app_lpm_mult_disable: + set0 mark_lpm_mult_enable,mark + rtn + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/app_module.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/app_module.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/app_module.prog (working copy) @@ -0,0 +1,1336 @@ + +ifdef COMPILE_MODULE + + + + +module_init: + rtn wake + call le_modified_name + setarg module_process_idle + store 2,mem_cb_idle_process + setarg module_bt_conn_process + store 2,mem_cb_bt_process + setarg module_process_bb_event + store 2,mem_cb_bb_event_process + setarg module_le_conn_process + store 2,mem_cb_le_process + setarg module_lpm_lock + store 2,mem_cb_check_wakelock + setarg module_hci_cmd_transmit_le_notify + store 2,mem_cb_ble_transmit + setarg module_hci_event_receive_spp_data + store 2,mem_cb_receive_spp_data + setarg module_le_receive_data + store 2,mem_cb_att_write + setarg module_bb_event_timer + store 2,mem_cb_event_timer + + call module_spp_clear_last_transmite_clock + bpatch patch17_0,mem_patch17 + call module_lpm_uart_init + call module_gpio_init + call check_module_disabled + branch module_hci_event_enter_standby_mode + + +module_lpm_uart_init: + fetch 2,IPC_M02BT_END_ADDR + store 2,core_sec_readdr + fetch 2,IPC_M02BT_START_ADDR + store 2,core_sec_rsaddr + copy pdata,contru + + fetch 2,IPC_BT2M0_END_ADDR + store 2,core_sec_teaddr + fetch 2,IPC_BT2M0_START_ADDR + store 2,core_sec_tsaddr + copy pdata,contwu + rtn + + + +module_lpm_init: + call module_lpm_uart_init + branch module_spp_clear_last_transmite_clock +// branch module_gpio_init + +module_gpio_init: + rtn +module_lpm_lock: + fetch 1,IPC_HOLD_BT // 1 not lpm 0 in lpm + beq 1,app_get_lpm_wake_lock + fetch 1,mem_le_pairing_state + bne FLAG_LE_PAIRING_NULL,module_lpm_lock_check_pairing + branch app_put_lpm_wake_lock +module_lpm_lock_check_pairing: + beq FLAG_LE_PAIRING_END,app_put_lpm_wake_lock + branch app_get_lpm_wake_lock + +module_le_conn_process: + rtn + +module_bt_conn_process: + call module_spp_enter_sniff + branch module_control_air_flow + +module_spp_enter_sniff: + rtn + fetch 1,mem_ui_state_map + bbit0 UI_STATE_BT_SPP_CONN,module_spp_clear_last_transmite_clock + bpatch patch17_1,mem_patch17 + setarg 0x3eff + fetcht 4,mem_last_transmite_clock + iadd temp,temp + copy clkn_bt,pdata + isub temp,null + nrtn positive + fetch 2,mem_ui_state_map + bbit1 UI_STATE_BT_SNIFF,module_spp_clear_last_transmite_clock + fetch 1,mem_module_flag + rtnbit1 MOUDLE_TASK_SNIFF + call module_set_sniff_task_flag + call app_bt_enter_sniff +module_spp_clear_last_transmite_clock: + copy clkn_bt,pdata + store 4,mem_last_transmite_clock + rtn + + +module_process_idle: + call module_control_air_flow + call l2cap_malloc_is_fifo_full + nrtn blank + branch module_process + + +module_process_bb_event: + copy regc,pdata + beq BT_EVT_BB_CONNECTED,module_process_bb_conn + beq BT_EVT_BB_DISCONNECTED,module_process_bb_event_disconned + beq BT_EVT_RECONN_FAILED,module_process_reconn_fail + beq BT_EVT_SETUP_COMPLETE,module_process_setup_complete + beq BT_EVT_SPP_CONNECTED,module_process_spp_connected + beq BT_EVT_SPP_DISCONNECTED,module_process_spp_disconnected + beq BT_EVT_PINCODE_REQ,module_process_evt_pincode_req + beq BT_EVT_ENTER_SNIFF,module_process_enter_sniff + beq BT_EVT_EXIT_SNIFF,module_process_exit_sniff + beq BT_EVT_RECONN_PAGE_TIMEOUT,module_process_page_time_out + beq BT_EVT_LE_CONNECTED,module_process_le_conn + beq BT_EVT_LE_DISCONNECTED,module_process_bb_even_le_disconn + beq BT_EVT_SNIFF_NOT_ACCEPT,module_process_sniff_not_accept + beq BT_EVT_UNSNIFF_ACCEPT,module_process_unsniff_accept + beq BT_EVT_UNSNIFF_NOT_ACCEPT,module_process_unsniff_not_accept + beq BT_EVT_LE_PAIRING_FAIL,module_hci_event_le_pairing_fail + beq BT_EVT_LE_PAIRING_SUCCESS,module_hci_event_le_pairing_success + beq BT_EVT_LE_START_ENC,module_hci_event_start_enc + beq BT_EVT_LE_PAUSE_ENC,module_hci_event_pause_enc + beq BT_EVT_LE_TK_GENERATE,module_hci_event_le_tk + beq BT_EVT_BT_GKEY_GENERATE,module_hci_event_gkey_generate + beq BT_EVT_BT_GET_PASSKEY,module_hci_event_passkey_entry_mode + beq BT_EVT_BT_PAIRING_FAIL,module_hci_event_bt_pairing_fail + beq BT_EVT_BT_PAIRING_SUCCESS,module_hci_event_bt_pairing_success +ifdef SECURE_CONNECTION + beq BT_EVT_LE_GKEY_GENERATE,module_hci_event_le_gkey +endif + beq BT_EVT_STORE_NVRAM,module_hci_event_store_device + beq BT_EVT_LE_LTK_LOST,module_process_ble_ltk_lost + rtn + + +module_process_bb_event_disconned: + call module_spp_clear_last_transmite_clock + fetch 1,mem_flag_pairing_state + ncall module_hci_event_bt_pairing_fail,blank + call module_disconn_start + fetch 2,mem_ui_state_map + rtnbit0 UI_STATE_BT_SPP_CONN + branch module_spp_disconnected + +module_process_spp_connected: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_SPP_CONN,pdata + store 2,mem_ui_state_map + fetch 1,mem_module_spp_lpm_mult + store 1,mem_lpm_mult + branch module_hci_event_spp_connect + +module_process_spp_disconnected: +// branch module_spp_disconnected +module_spp_disconnected: + fetch 2,mem_ui_state_map + rtnbit0 UI_STATE_BT_SPP_CONN + set0 UI_STATE_BT_SPP_CONN ,pdata + store 2,mem_ui_state_map + branch module_hci_event_spp_disconnect + + +module_process_enter_sniff: + +module_sniff_param_check: + call module_spp_clear_last_transmite_clock + //fetch 1,mem_context + //rtnbit0 state_insniff + fetch 2,mem_context+coffset_tsniff + rshift pdata,pdata + fetcht 2,mem_sniff_param_interval + isub temp,null + nbranch module_sniff_param_check_unsniff,zero + branch app_lpm_mult_enable +module_sniff_param_check_unsniff: + fetch 1,mem_module_flag + rtnbit1 MOUDLE_TASK_UNSNIFF +// fethc 2,core_uart_rxitems //* + fetch 2,IPC_M02BT_READ_PTR + fetcht 2,IPC_M02BT_WRITE_PTR + isub temp,null + ncall module_set_unsniff_task_flag,zero //*¼ÓƠâÁ½¾ä»° + branch app_bt_sniff_exit + +module_process_exit_sniff: + call module_clear_sniff_task_flag + branch app_lpm_mult_disable + +module_process_setup_complete: + call module_spp_clear_last_transmite_clock + branch module_conn_start + +module_process_bb_even_le_disconn: + call le_clr_config_more_data + call module_disconn_start + branch module_hci_event_le_disconnect + +module_process_evt_pincode_req: + branch app_bt_set_pincode + + +module_process_sniff_not_accept: + branch module_clear_sniff_task_flag + + +module_process_unsniff_accept: + fetch 1,mem_module_flag + bbit0 MOUDLE_TASK_UNSNIFF,app_bt_enter_sniff + branch module_clear_unsniff_task_flag + + +module_process_unsniff_not_accept: + branch module_clear_unsniff_task_flag + + +module_process_le_conn: +// call le_send_att_exchange_mtu_requset + call module_conn_start + fetch 1,mem_module_le_lpm_mult + store 1,mem_lpm_mult + branch module_hci_event_le_connect + + +module_process_bb_conn: + jam 0,mem_flag_mode_ssp_pin + call module_clear_sniff_task_flag + branch module_clear_unsniff_task_flag + +module_process_page_time_out: +module_process_reconn_fail: +module_disconn_start: + branch module_start_adv_discovery_by_command + + +module_process_ble_ltk_lost: + call le_send_reject_ind + branch le_send_smp_security_request + + +module_conn_start: + branch module_stop_adv_discovery + +module_stop_adv_discovery: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BT_BIT,pdata + call app_bt_stop_discovery,true + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BLE_BIT,pdata + call app_ble_stop_adv,true + rtn + +module_process_with_credit: + fetch 1,mem_credit_flag + rtneq CREDIT_DISABLE + branch rfcomm_send_uih_without_payload + +module_process: + fetch 2,IPC_M02BT_READ_PTR + fetcht 2,IPC_M02BT_WRITE_PTR + isub temp,null + branch module_process_with_credit,zero + call uartd_prepare_rx + ifetch 1,contru + bne 0x01,module_hci_in_excp + ifetch 1,contru + store 1,mem_module_uart_opcode + ifetcht 1,contru + copy contru,rega + storet 1,mem_module_uart_len + jam HCI_DISCARD_PACKET,mem_module_temp_nl_discard_packet + call module_hci_cmd_control + fetch 1,mem_module_temp_nl_discard_packet + rtneq HCI_NOT_DISCARD_PACKET + branch module_hci_dicard_packet //discard this packet + +module_hci_in_excp: + call delay_10ms + call module_hci_event_invalid_packet + branch module_hci_release_except + + +module_hci_release_except: + bpatch patch17_2,mem_patch17 + fetch 2,IPC_M02BT_WRITE_PTR + store 2,IPC_M02BT_READ_PTR + rtn + + +module_hci_dicard_packet: + call uartd_prepare_rx + increase 2,contru + ifetch 1,contru + iadd contru,contru +module_hci_dicard_bytes: + branch uartd_rxdone + +/*********************HCI CONTROL*********************/ +module_hci_cmd_control: + bpatch patch17_3,mem_patch17 + fetch 1,mem_module_uart_opcode + beq HCI_CMD_SET_BT_ADDR_REQ,module_hci_cmd_set_bt_addr + beq HCI_CMD_SET_LE_ADDR_REQ,module_hci_cmd_set_le_addr + beq HCI_CMD_SET_VISIBILITY_REQ,module_hci_cmd_set_visibility + beq HCI_CMD_SET_BT_NAME_REQ,module_hci_cmd_set_bt_name + beq HCI_CMD_SET_LE_NAME_REQ,module_hci_cmd_set_le_name + beq HCI_CMD_SPP_DATA_REQ,module_hci_cmd_receive_spp_data + beq HCI_CMD_LE_DATA_REQ,module_hci_cmd_receive_le_data + beq HCI_CMD_STATUS_IRQ,module_hci_cmd_inquire_status + beq HCI_CMD_SET_PAIRING_REQ,module_hci_cmd_set_pairing_mode + beq HCI_CMD_SET_PINCODE_REQ,module_hci_cmd_set_pincode + beq HCI_CMD_VERSION_REQ,module_hci_cmd_version_request + beq HCI_CMD_BT_DISCONNECT,module_hci_cmd_bt_disconnect + beq HCI_CMD_BLE_DISCONNECT,module_hci_cmd_ble_disconnect + beq HCI_CMD_SET_NVRAM_REQ,module_hci_cmd_set_nvram + beq HCI_CMD_CONFIRM_GKEY,module_hci_cmd_confirm_gkey + beq HCI_CMD_SET_CREDIT_GIVEN,module_hci_cmd_set_credit_given + beq HCI_CMD_AUTO_ADV_SCAN,module_hci_cmd_auto_adv + beq HCI_CMD_PASSKEY_ENTRY,module_hci_cmd_passkey_entry + beq HCI_CMD_LE_SET_PAIRING,module_hci_cmd_le_set_pairing_mode + beq HCI_CMD_LE_SET_ADV_DATA,module_hci_cmd_le_set_adv_data + beq HCI_CMD_LE_SET_SCAN_DATA,module_hci_cmd_le_set_scan_data + beq HCI_CMD_LE_SEND_CONN_UPDATE_REQ,module_hci_cmd_le_send_conn_update_req + beq HCI_CMD_LE_SET_ADV_PARM,module_hci_cmd_set_le_adv_parameter + beq HCI_CMD_LE_START_PAIRING,module_hci_cmd_le_start_pairing + beq HCI_CMD_SET_TX_POWER,module_hci_cmd_set_tx_power + beq HCI_CMD_LE_CONFIRM_GKEY,module_hci_cmd_le_confirm_gkey + beq HCI_CMD_REJECT_JUSTWORK,module_hci_cmd_set_reject_justwork_flag + beq HCI_CMD_RESET_CHIP_REQ,module_hci_cmd_reset_chip + beq HCI_CMD_LE_SET_FIXED_PASSKEY,module_hci_cmd_le_set_fixed_passkey + beq HCI_TEST_CMD_CLOSE_LPM,module_hci_test_cmde_close_lpm + beq HCI_TEST_CMD_REBACK,module_hci_test_cmd_reback + branch module_hci_event_receive_invalid_cmd + +/*********************HCI COMMAND*********************/ + +//command opcode 0x00 +module_hci_cmd_set_bt_addr: + fetch 1,mem_module_uart_len + bne 6,module_hci_event_receive_invalid_cmd + ifetch 6,contru + store 6,mem_lap + branch module_hci_event_receive_valid_cmd + +//command opcode 0x01 +module_hci_cmd_set_le_addr: + fetch 1,mem_module_uart_len + bne 6,module_hci_event_receive_invalid_cmd + ifetch 6,contru + store 6,mem_le_lap + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x02 +module_hci_cmd_set_visibility: + fetch 1,mem_module_uart_len + bne 1,module_hci_event_receive_invalid_cmd + copy rega,contru + call module_hci_event_receive_valid_cmd + ifetcht 1,contru + storet 1,mem_module_bluetooth_stauts_by_command + fetch 2,mem_ui_state_map + rtnbit1 UI_STATE_BLE_CONNECTED + rtnbit1 UI_STATE_BT_CONNECTED +module_start_adv_discovery_by_command: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BT_BIT,pdata + nbranch moudle_start_adv_by_command,true + fetcht 1,mem_module_bluetooth_stauts_by_command + and temp,0x03,pdata + store 1,mem_scan_mode +moudle_start_adv_by_command: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BLE_BIT,pdata + nrtn true + fetcht 1,mem_module_bluetooth_stauts_by_command + isolate1 2,temp + branch app_ble_start_adv,true + branch app_ble_stop_adv + + +//command opcode 0x03 +module_hci_cmd_set_bt_name: + fetch 1,mem_module_uart_len + sub pdata,67,null + nbranch module_hci_event_receive_invalid_cmd,positive + store 1,mem_local_name_length + arg 8,loopcnt + call memset0 + fetch 1,mem_module_uart_len + copy pdata,loopcnt + copy rega,contru + arg mem_local_name,contw + call uart_copy_rx_bytes_fast + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x04 +module_hci_cmd_set_le_name: + fetch 1,mem_module_uart_len + sub pdata,29,null + nbranch module_hci_event_receive_invalid_cmd,positive + store 1,mem_le_name_len + copy pdata,loopcnt + copy rega,contru + arg mem_le_name,contw + call uart_copy_rx_bytes_fast + call le_modified_name + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x05 +module_hci_cmd_receive_spp_data: + fetch 1,mem_ui_state_map + bbit0 UI_STATE_BT_SPP_CONN,module_hci_event_receive_invalid_cmd + call app_check_sniff + branch module_hci_cmd_spp_exit_sniff,true + jam HCI_NOT_DISCARD_PACKET,mem_module_temp_nl_discard_packet +// call p_nl_clear_last_transmite_clock + call module_spp_clear_last_transmite_clock + fetch 1,mem_remote_credits + rtn blank + fetch 2,mem_nl_rx_len_all + bne 0,module_hci_cmd_pass_init_ng_rx_len_all + fetch 1,mem_module_uart_len + store 2,mem_nl_rx_len_all + + copy rega,contru +// ifetch 2,contru +// store 2,mem_nl_rx_handle + copy contru,pdata + store 2,mem_nl_rx_data_src +module_hci_cmd_pass_init_ng_rx_len_all: + call module_hci_cmd_get_current_packet_len_and_remain_len + branch spp_tx_rfcomm_packet + +module_hci_cmd_spp_exit_sniff: + jam HCI_NOT_DISCARD_PACKET,mem_module_temp_nl_discard_packet + branch module_exit_sniff + +module_hci_cmd_get_current_packet_len_and_remain_len: + call module_hci_cmd_get_current_patcket_len + fetch 2,mem_nl_rx_len_all + fetcht 2,mem_current_packet_length + isub temp,pdata + store 2,mem_nl_rx_len_all + rtn + +module_hci_cmd_get_current_patcket_len: + fetch 2,mem_nl_rx_len_all + arg NL_RFCOMM_BUFF_LEN,temp + call not_greater_than + fetcht 2,mem_rfcomm_max_frame_size + call not_greater_than + fetcht 2,mem_pn_max_frame_size + call not_greater_than + store 2,mem_current_packet_length + rtn + +module_hci_command_tx_spp_tx_complete: + jam HCI_DISCARD_PACKET,mem_module_temp_nl_discard_packet + jam HCI_CMD_SPP_DATA_REQ,mem_module_uart_opcode + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x09 +module_hci_cmd_receive_le_data: + fetch 2,mem_ui_state_map + bbit0 UI_STATE_BLE_CONNECTED,module_hci_event_receive_invalid_cmd + call module_check_ble_encrypt_state + branch module_hci_event_receive_invalid_cmd,user + jam HCI_NOT_DISCARD_PACKET,mem_module_temp_nl_discard_packet + fetch 1,mem_module_flag + bbit1 MODULE_FLAG_BLE_DATA_FINISH,module_hci_cmd_receive_le_data_finish + fetch 1,mem_module_hci_notify_len + nrtn blank + jam HCI_DISCARD_PACKET,mem_module_temp_nl_discard_packet + ifetch 2,contru //handle + store 2,mem_module_hci_notify_handle + copy contru,pdata + store 2,mem_module_hci_nofiy_addr + fetch 1,mem_module_uart_len + pincrease -2 + nbranch module_hci_event_receive_invalid_cmd,positive + branch module_hci_event_receive_invalid_cmd,zero + store 1,mem_module_hci_notify_len + jam HCI_NOT_DISCARD_PACKET,mem_module_temp_nl_discard_packet + call le_set_config_more_data + call module_hci_cmd_transmit_le_notify + call module_hci_cmd_transmit_le_notify + call module_hci_cmd_transmit_le_notify + fetch 1,mem_module_flag + rtnbit0 MODULE_FLAG_BLE_DATA_FINISH +module_hci_cmd_receive_le_data_finish: + jam HCI_DISCARD_PACKET,mem_module_temp_nl_discard_packet + call module_clear_le_tx_data_flag + branch module_hci_event_receive_valid_cmd + +module_hci_cmd_transmit_le_notify: + fetch 1,mem_module_hci_notify_len + rtn blank + call le_fifo_check_nearly_full + nrtn blank //no fifo + call module_get_le_remote_mtu + bpatch patch17_4,mem_patch17 + add temp,-3,pdata //sub handle and opcode + fetcht 1,mem_module_hci_notify_len + call not_greater_than + copy pdata,rega + copy temp,pdata + isub rega,pdata + store 1,mem_module_hci_notify_len + fetcht 2,mem_module_hci_notify_handle + call le_att_malloc_tx_notify + fetch 2,mem_module_hci_nofiy_addr + copy pdata,contru + copy rega,loopcnt + call uart_copy_rx_bytes_fast + copy contru,pdata + store 2,mem_module_hci_nofiy_addr + fetch 1,mem_module_hci_notify_len + nrtn blank + branch module_set_le_tx_data_flag + + +//output: temp is master mtu +module_get_le_remote_mtu: + arg 0x17,temp + fetch 1,mem_module_flag + rtnbit1 MODULE_FLAG_BLE_SEND_MTU23 + fetcht 2,mem_le_remote_mtu + rtn + +module_check_ble_encrypt_state: + fetch 1,mem_module_flag + bbit1 MODULE_FLAG_BLE_DATA_ENCRYPT,le_check_encrypt_state + branch disable_user + + +//command opcode 0x0b +module_hci_cmd_inquire_status: + branch module_hci_event_status_res + + +//command opcode 0x0c +module_hci_cmd_set_pairing_mode: + copy rega,contru + ifetch 1,contru + beq PAIRING_PINCODE,module_hci_pairing_pincode_mode + beq PAIRING_JUSTWORK,module_hci_pairing_just_work_mode + beq PAIRING_PASSKEY,module_hci_pairing_passkey + beq PAIRING_CONFIRM,module_hci_pairing_numeric_comparison + branch module_hci_event_receive_invalid_cmd +module_hci_pairing_pincode_mode: + call ssp_disable + jam 0,mem_ssp_enable + branch module_hci_event_receive_valid_cmd +module_hci_pairing_just_work_mode: + setarg SSP_MODE_JUST_WORK_IO_CAP_DATA +module_hci_sspairing_mode: + store 3,mem_sp_iocap_local + store 1,mem_ssp_mode_flag + call ssp_enable + jam 1,mem_ssp_enable + branch module_hci_event_receive_valid_cmd +module_hci_pairing_passkey: + setarg SSP_MODE_PASSKEY_IO_CAP_DATA + branch module_hci_sspairing_mode + +module_hci_pairing_numeric_comparison: + setarg SSP_MODE_SSP_PIN_IO_CAP_DATA + branch module_hci_sspairing_mode + +//command opcode 0x0d +module_hci_cmd_set_pincode: + fetch 1,mem_module_uart_len + sub pdata,16,null + nbranch module_hci_event_receive_invalid_cmd,positive + store 1,mem_pin_length + copy pdata,loopcnt + arg mem_pin,contw + call uart_copy_rx_bytes + branch module_hci_event_receive_valid_cmd + + + + + +//command opcode 0x10 +module_hci_cmd_version_request: + arg 2,rega + arg mem_soft_version_num,regb + arg 0,temp + branch module_hci_event_set_cmd +module_hci_event_set_cmd_send_response: + store 2,mem_event_cmd_response_content + arg mem_event_cmd_response_content,regb + arg 0,temp + branch module_hci_event_set_cmd + + +//command opcode 0x11 +module_hci_cmd_bt_disconnect: + fetch 2,mem_ui_state_map + bbit0 UI_STATE_BT_CONNECTED,module_hci_event_receive_invalid_cmd +module_hci_cmd_bt_disconnect_doing: + call module_hci_event_receive_valid_cmd + branch app_bt_disconnect + + +//command opcode 0x12 +module_hci_cmd_ble_disconnect: + fetch 2,mem_ui_state_map + bbit0 UI_STATE_BLE_CONNECTED,module_hci_event_receive_invalid_cmd +module_hci_cmd_ble_disconnect_doing: + call module_hci_event_receive_valid_cmd + branch app_ble_disconnect + + + + +//command opcode 0x26 +module_hci_cmd_set_nvram: + fetch 1,mem_module_uart_len + copy pdata,loopcnt + copy rega,contru + fetch 2,mem_nv_data_ptr + icopy contw + call uart_copy_rx_bytes_fast + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x28 +module_hci_cmd_confirm_gkey: + fetch 1,mem_ui_state_map + bbit0 UI_STATE_BT_CONNECTED,module_hci_event_receive_invalid_cmd + ifetch 1,contru + fetcht 1,mem_flag_mode_ssp_pin + setflag blank,FLAG_MODE_SSP_PIN_COMPARISON_RESULT_BIT,temp + set1 FLAG_MODE_SSP_PIN_REVICEVE_COMPARISON_BIT ,temp + storet 1,mem_flag_mode_ssp_pin + + call module_hci_event_receive_valid_cmd + + fetch 1,mem_flag_mode_ssp_pin + bbit1 FLAG_MODE_SSP_PIN_RECIEVE_DHKEY_BIT,module_hci_cmd_spp_number_comparison_result_is1 + rtn + +dhkey_not_accept: + jam 0,mem_flag_mode_ssp_pin + jam BT_CMD_DHKEY_NOT_ACCEPT,mem_fifo_temp + branch ui_ipc_send_cmd + + +module_hci_cmd_spp_number_comparison_result_is1: + bbit1 FLAG_MODE_SSP_PIN_COMPARISON_RESULT_BIT,number_comparison_successed + branch dhkey_not_accept + + +//command opcode 0x29 +module_hci_cmd_set_credit_given: + fetch 1,mem_ui_state_map + rtnbit0 UI_STATE_BT_SPP_CONN + fetch 1,mem_credit_flag + rtneq CREDIT_DISABLE + ifetch 1,contru + fetcht 1,mem_credit_given + iadd temp,temp + storet 1,mem_credit_given + rtn + + +//command opcode 0x2a +module_hci_cmd_auto_adv: + arg 0x40,loopcnt + arg mem_le_adv_data_len,contw + call clear_mem + setarg 0 + store 1,mem_regb + copy rega,contru +module_hci_cmd_auto_adv_loop: + copy contru,pdata + store 2,mem_regc + call module_hci_cmd_auto_adv_adv_analys + + fetch 1,mem_regb + fetcht 1,mem_temp + increase 1,temp + iadd temp,pdata + store 1,mem_regb + + sub pdata,31,null + nbranch module_hci_cmd_auto_adv_store_scan,positive +module_hci_cmd_auto_adv_store_adv: + fetcht 1,mem_le_adv_data_len + setarg mem_le_adv_data + iadd temp,pdata + store 2,mem_contw + fetcht 1,mem_temp + increase 1,temp + fetch 1,mem_le_adv_data_len + iadd temp,pdata + store 1,mem_le_adv_data_len + branch module_hci_cmd_auto_adv_store_common +module_hci_cmd_auto_adv_store_scan: + fetcht 1,mem_le_scan_data_len + setarg mem_le_scan_data + iadd temp,pdata + store 2,mem_contw + fetcht 1,mem_temp + increase 1,temp + fetch 1,mem_le_scan_data_len + iadd temp,pdata + store 1,mem_le_scan_data_len +module_hci_cmd_auto_adv_store_common: + fetch 2,mem_contw + copy pdata,contw + fetch 2,mem_regc + copy pdata,contru + + copy temp,loopcnt + call uart_copy_rx_bytes_fast + + fetch 1,mem_module_uart_len + fetcht 1,mem_regb + isub temp,null + nbranch module_hci_cmd_auto_adv_loop,zero + branch module_hci_event_receive_valid_cmd + +//block of adv len in mem_temp +module_hci_cmd_auto_adv_adv_analys: + ifetch 1,contru + store 1,mem_temp + ifetch 1,contru + store 1,mem_rega + rtn + + + +//command opcode 0x30 +module_hci_cmd_passkey_entry: + ifetch 4,contru + store 4,mem_pin + jam 4,mem_pin_length + jam 0,mem_authentication_passkey_times + call module_hci_event_receive_valid_cmd + branch authentication_passkey + + + +//command opcode 0x33 +module_hci_cmd_le_set_pairing_mode: + copy rega,contru + ifetch 1,contru + copy pdata,temp +ifdef SECURE_CONNECTION + beq LE_PAIRING_MODE_SECURE_CONNECT_JUSTWORK,module_le_set_pairing_mode_secure_justwork + beq LE_PAIRING_MODE_SECURE_CONNECT_NUMERIC,module_le_set_pairing_mode_secure_numeric + beq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY,module_le_set_pairing_mode_secure_passkey +endif + store 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_NONE, module_le_set_no_pairing + beq LE_PAIRING_MODE_LAGACY_JUSTWORK,module_le_set_pairing_mode_lagacy_just_work + beq LE_PAIRING_MODE_LAGACY_PASSKEY,module_le_set_pairing_mode_lagacy_passkey + branch module_hci_event_receive_invalid_cmd + +ifdef SECURE_CONNECTION +module_le_set_pairing_mode_secure_justwork: + fetch 1,mem_le_secure_connect_enable + branch module_hci_event_receive_invalid_cmd,blank + storet 1,mem_le_pairing_mode + jam FLAG_LE_BONDING_MITM_SECURE,mem_le_pres_auth + branch module_le_set_noinputnooutput +module_le_set_pairing_mode_secure_numeric: + fetch 1,mem_le_secure_connect_enable + branch module_hci_event_receive_invalid_cmd,blank + storet 1,mem_le_pairing_mode + jam FLAG_LE_BONDING_MITM_SECURE,mem_le_pres_auth + jam FLAG_IOCAP_DISPLAYYESNO,mem_le_pres_iocap + branch module_hci_event_receive_valid_cmd +module_le_set_pairing_mode_secure_passkey: + fetch 1,mem_le_secure_connect_enable + branch module_hci_event_receive_invalid_cmd,blank + storet 1,mem_le_pairing_mode + jam FLAG_LE_BONDING_MITM_SECURE,mem_le_pres_auth + branch module_le_set_displayonly +endif +module_le_set_no_pairing: + jam FLAG_LE_NO_BONDING_NO_MITM,mem_le_pres_auth +module_le_set_noinputnooutput: + jam FLAG_IOCAP_NOINPUTNOOUTPUT,mem_le_pres_iocap + branch module_hci_event_receive_valid_cmd +module_le_set_pairing_mode_lagacy_just_work: + jam FLAG_LE_BONDING_MITM,mem_le_pres_auth + branch module_le_set_noinputnooutput +module_le_set_pairing_mode_lagacy_passkey: + jam FLAG_LE_BONDING_MITM,mem_le_pres_auth +module_le_set_displayonly: + jam FLAG_IOCAP_DISPLAYONLY,mem_le_pres_iocap + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x34 +module_hci_cmd_le_set_adv_data: + fetch 1,mem_module_uart_len + sub pdata,31,null + nbranch module_hci_event_receive_invalid_cmd,positive + store 1,mem_le_adv_data_len + copy pdata,loopcnt + copy rega,contru + arg mem_le_adv_data,contw + call uart_copy_rx_bytes_fast + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x35 +module_hci_cmd_le_set_scan_data: + fetch 1,mem_module_uart_len + sub pdata,31,null + nbranch module_hci_event_receive_invalid_cmd,positive + store 1,mem_le_scan_data_len + copy pdata,loopcnt + copy rega,contru + arg mem_le_scan_data,contw + call uart_copy_rx_bytes_fast + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x36 +module_hci_cmd_le_send_conn_update_req: + fetch 2,mem_ui_state_map + bbit0 UI_STATE_BLE_CONNECTED,module_hci_event_receive_invalid_cmd + fetch 1,mem_module_uart_len + bne 0x08,module_hci_event_receive_invalid_cmd + copy rega,contru + ifetch 8,contru + store 8,mem_le_interval_min + jam BT_CMD_LE_UPDATE_CONN,mem_fifo_temp + call ui_ipc_send_cmd + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x37 +module_hci_cmd_set_le_adv_parameter: + ifetch 2,contru + store 2,mem_le_adv_interval + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x38 +module_hci_cmd_le_start_pairing: + fetch 1,mem_le_pairing_mode + branch module_hci_event_receive_invalid_cmd,blank + fetch 1,mem_le_pairing_state + bne FLAG_LE_PAIRING_NULL,module_hci_event_receive_invalid_cmd + fetch 1,mem_le_enc_state + bne FLAG_LE_ENC_NULL,module_hci_event_receive_invalid_cmd + call check_51cmd_le_smp_sec_req + branch module_hci_event_receive_valid_cmd + + + +//command opcode 0x42 +module_hci_cmd_set_tx_power: + fetch 1,mem_module_uart_len + bne 0x01,module_hci_event_receive_invalid_cmd + ifetch 1,contru + store 1,mem_tx_power + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x48 +module_hci_cmd_le_confirm_gkey: + ifetch 1,contru + beq 0x01,module_hci_cmd_le_confirm_gkey_fail + fetch 1,mem_le_secure_connect_state + beq LE_SC_STAT_SEND_PUBLIC_KEY,module_hci_cmd_le_confirm_gkey_ok + beq LE_SC_STAT_RECEIVE_DHKEY,module_hci_cmd_le_confirm_gkey_ok + beq LE_SC_STAT_WAIT_CONFIRM_GKEY,module_hci_cmd_le_confirm_gkey_ok + branch module_hci_event_receive_invalid_cmd +module_hci_cmd_le_confirm_gkey_ok: + jam FLAG_LE_SC_CONFRIM_GKEY_OK,mem_le_sc_confirm_gkey_flag + branch module_hci_event_receive_valid_cmd + +module_hci_cmd_le_confirm_gkey_fail: + call le_send_pairing_confirm_value_failed + branch module_hci_event_receive_valid_cmd + + +//command opcode 0x49 +module_hci_cmd_set_reject_justwork_flag: + fetch 1,mem_module_uart_len + bne 0x01,module_hci_event_receive_invalid_cmd + call module_hci_event_receive_valid_cmd + ifetch 1,contru + branch classic_bt_clr_reject_justwork_flag,blank + branch classic_bt_set_reject_justwork_flag + + +//command opcode 0x51 +module_hci_cmd_reset_chip: + call module_hci_event_receive_valid_cmd +// call wait_uarttx + hjam 0x01,core_reset // rest YC1021 + branch loop + + +//command opcode 0x61 +module_hci_cmd_le_set_fixed_passkey: + fetch 1,mem_module_uart_len + beq 0,module_hci_event_receive_invalid_cmd + ifetch 1,contru + branch module_hci_cmd_le_set_random_passkey,blank + fetch 1,mem_module_uart_len + bne 5,module_hci_event_receive_invalid_cmd + ifetch 4,contru + arg 1000000,temp + isub temp,null + branch module_hci_event_receive_invalid_cmd,positive + store 4,mem_le_tk + call le_set_config_fixed_tk + branch module_hci_event_receive_valid_cmd + +module_hci_cmd_le_set_random_passkey: + call le_clr_config_fixed_tk + branch module_hci_event_receive_valid_cmd + + +//command opcode 0xff +module_hci_test_cmde_close_lpm: + ifetch 1,contru + store 1,mem_lpm_mode + branch module_hci_event_receive_valid_cmd + +//command opcode 0xee +module_hci_test_cmd_reback: + fetch 1,mem_module_uart_len + call module_hci_prepare_tx + fetch 1,mem_module_uart_len + copy pdata,loopcnt + copy rega,contru + call copy_tx_bytes + branch uartd_send + +copy_tx_bytes: + deposit loopcnt + rtn blank +copy_tx_bytes_loop: + ifetch 1,contru + istore 1,contwu + loop copy_tx_bytes_loop + rtn + +/*********************HCI EVENT*********************/ + +module_hci_event_receive_invalid_cmd: + arg 1,temp + arg 0,rega + branch module_hci_event_set_cmd + + +module_hci_event_receive_valid_cmd: + arg 0,temp + arg 0,rega + branch module_hci_event_set_cmd + + +//event opcode 0x00 +module_hci_event_spp_connect: + jam HCI_EVENT_SPP_CONN_REP,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +//event opcode 0x02 +module_hci_event_le_connect: + jam HCI_EVENT_LE_CONN_REP,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +//event opcode 0x03 +module_hci_event_spp_disconnect: + jam HCI_EVENT_SPP_DIS_REP,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +//event opcode 0x05 +module_hci_event_le_disconnect: + jam HCI_EVENT_LE_DIS_REP,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +//event opcode 0x06 +//input: +// temp: success 0; fail 1 +// rega:Response Content length +// regb:Response Content address +module_hci_event_set_cmd: + fetch 1,mem_module_uart_opcode + copy pdata,regc + jam HCI_EVENT_CMD_RES,mem_module_uart_opcode + setarg 2 + iadd rega,pdata + call module_hci_prepare_tx + copy regc,pdata + istore 1,contwu + istoret 1,contwu + copy rega,loopcnt + copy regb,contr + call uart_copy_tx_bytes + branch uartd_send + + +//event opcode 0x07 +module_hci_event_receive_spp_data: +// call p_nl_clear_last_transmite_clock + call module_spp_clear_last_transmite_clock + jam HCI_EVENT_SPP_DATA_REP,mem_module_uart_opcode + fetch 1,mem_current_length + rtn blank + call module_hci_prepare_tx + fetch 1,mem_current_length + copy pdata,loopcnt + fetch 2,mem_rfcomm_uih_payload_ptr + copy pdata,contr + call uart_copy_tx_bytes_fast + branch uartd_send + + +//event opcode 0x08 +module_hci_event_receive_le_data: + jam HCI_EVENT_LE_DATA_REP,mem_module_uart_opcode + fetch 1,mem_module_le_rx_data_len + icopy loopcnt + increase 2,pdata + call module_hci_prepare_tx + fetch 2,mem_module_le_rx_data_handle // Attribute handle + istore 2,contwu + fetch 2,mem_module_le_rx_data_address + icopy contr + call uart_copy_tx_bytes_fast + branch uartd_send + + +//event opcode 0x09 +module_hci_event_enter_standby_mode: + jam HCI_EVENT_STANDBY_REP,mem_module_uart_opcode +module_hci_event_enter_standby_mode_len0: + setarg 0 + call module_hci_prepare_tx + branch uartd_send + + +//event opcode 0x0a +module_hci_event_status_res: + jam HCI_EVENT_STATUS_RES,mem_module_uart_opcode + setarg 1 + call module_hci_prepare_tx + + call module_hci_read_bt_status + + fetch 2,mem_ui_state_map + arg UI_STATE_BT_HID_CONN,queue + qisolate1 pdata + setflag true,3,temp + + arg UI_STATE_BLE_CONNECTED,queue + qisolate1 pdata + setflag true,5,temp + + fetch 1,mem_ui_state_map + arg UI_STATE_BT_SPP_CONN,queue + qisolate1 pdata + setflag true,4,temp + + istoret 1,contwu + branch uartd_send + +// temp: bit0 3.0 inquiry;bit1 3.0 scan;bit2 ble adv; + +module_hci_read_bt_status: + arg 0,temp + fetch 1,mem_scan_mode + arg inq_scan_mode,queue + qisolate1 pdata + setflag true,0,temp + arg page_scan_mode,queue + qisolate1 pdata + setflag true,1,temp + + fetch 1,mem_le_adv_enable + arg 0,queue + qisolate1 pdata + setflag true,2,temp + rtn + + +//event opcode 0x0d +module_hci_event_store_device: + jam HCI_EVENT_NVRAM_REP,mem_module_uart_opcode + fetch 1,mem_nv_data_number + mul32 pdata,34,pdata + icopy loopcnt + call module_hci_prepare_tx + fetch 2,mem_nv_data_ptr + icopy contr + call uart_copy_tx_bytes_fast + branch uartd_send + + +//event opcode 0x0e +module_hci_event_gkey_generate: + jam HCI_EVENT_GKEY,mem_module_uart_opcode + setarg 4 + call module_hci_prepare_tx + fetch 4,mem_gkey + istore 4,contwu + branch uartd_send + + +//event opcode 0x0f +module_hci_event_invalid_packet: + jam HCI_EVENT_INVALID_PACKET,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +//event opcode 0x10 +module_hci_event_passkey_entry_mode: + jam HCI_EVENT_GET_PASSKEY,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +//event opcode 0x11 +module_hci_event_le_tk: + jam HCI_EVENT_LE_TK,mem_module_uart_opcode + setarg 4 + call module_hci_prepare_tx + fetch 4,mem_le_tk + istore 4,contwu + branch uartd_send + + +//event opcode 0x14 +module_hci_event_le_pairing_fail: + arg FLAG_BLE_PAIRING_FAIL,rega + branch module_hci_event_pairing_completed + +module_hci_event_le_pairing_success: + arg FLAG_BLE_PAIRING_SUCCESS,rega + branch module_hci_event_pairing_completed + +module_hci_event_bt_pairing_fail: + arg FLAG_BT_PAIRING_FAIL,rega + branch module_hci_event_pairing_completed + +module_hci_event_bt_pairing_success: + arg FLAG_BT_PAIRING_SUCCESS,rega + +module_hci_event_pairing_completed: + jam 0,mem_flag_mode_ssp_pin + jam HCI_EVENT_LE_PAIRING_STATE,mem_module_uart_opcode + setarg 2 + call module_hci_prepare_tx + copy rega,pdata + istore 2,contwu + branch uartd_send + + +//event opcode 0x15 +module_hci_event_pause_enc: + arg FLAG_EVENT_PAUSE_ENC,regc + branch module_hci_event_enc + +module_hci_event_start_enc: + arg FLAG_EVENT_START_ENC,regc + +module_hci_event_enc: + jam HCI_EVENT_LE_ENCRYPTION_STATE,mem_module_uart_opcode + setarg 1 + call module_hci_prepare_tx + copy regc,pdata + istore 1,contwu + branch uartd_send + + +//event opcode 0x1d +module_hci_event_le_gkey: + jam HCI_EVENT_LE_GKEY,mem_module_uart_opcode + setarg 4 + call module_hci_prepare_tx + fetch 4,mem_gkey + istore 4,contwu + branch uartd_send + + +//****************************************************************// + //module_hci_prepare_tx + //function:write hci packet header + //input: pdata-----packet length (1byte) + //input: mem_uart_opcode------opcode (1byte) + //output:contwu --- pointer to packet payload + //use reg: contwu,pdata +//****************************************************************// +module_hci_prepare_tx: + jam 0x02,mem_module_uart_cmd + store 1,mem_module_uart_len + storet 8,mem_temp + bpatch patch17_5,mem_patch17 + fetcht 8,mem_temp + call uartd_prepare_tx + fetch 3,mem_module_uart_cmd + istore 3,contwu + rtn + + + + +/*********************hci command end*********************/ + +/*********************hci ble receive data start*********************/ + +//rega is le rx data address +//regb is le rx data length +//mem_le_att_handle is write handle +module_le_receive_data: + call module_check_ble_encrypt_state + rtn user + copy rega,pdata + store 2,mem_module_le_rx_data_address + copy regb,pdata + store 1,mem_module_le_rx_data_len + fetch 2,mem_le_att_handle + fetcht 2,mem_module_data_write_handle + isub temp,null + branch module_le_receive_data_ok,zero + fetcht 2,mem_module_data_write_handle2 + isub temp,null + nrtn zero +module_le_receive_data_ok: + store 2,mem_module_le_rx_data_handle + branch module_hci_event_receive_le_data + + +/*********************hci ble receive data end*********************/ + +module_exit_sniff: + fetch 1,mem_module_flag + rtnbit1 MOUDLE_TASK_UNSNIFF + call module_set_unsniff_task_flag + branch app_bt_sniff_exit + + +module_set_lpm_mult_2: + jam 2,mem_lpm_mult + rtn + + + +module_bb_event_timer: + rtn + + +check_ipc_tx_buff: + call get_ipc_tx_buff + arg UART_AIR_CONTROL_THRESHOLD,temp +pdata_sub_temp: + isub temp,null + rtn + +calc_ipc_tx_buff_pos: + isub rega,pdata + sub pdata,0,pdata + rtn + +get_ipc_tx_buff: + fetcht 2,IPC_BT2M0_START_ADDR + fetch 2,IPC_BT2M0_END_ADDR + isub temp,rega + fetcht 2,IPC_BT2M0_READ_PTR + fetch 2,IPC_BT2M0_WRITE_PTR + isub temp,pdata + ncall calc_ipc_tx_buff_pos,positive + rtn + +module_control_air_flow: + call check_ipc_tx_buff + branch app_l2cap_flow_control_enable,positive + branch app_l2cap_flow_control_disable + + +/**************module state *******************/ +module_set_sniff_task_flag: + arg MOUDLE_TASK_SNIFF,queue + branch module_set_state + +module_clear_sniff_task_flag: + arg MOUDLE_TASK_SNIFF,queue + branch module_clr_state + +module_set_unsniff_task_flag: + arg MOUDLE_TASK_UNSNIFF,queue + branch module_set_state + +module_clear_unsniff_task_flag: + arg MOUDLE_TASK_UNSNIFF,queue + branch module_clr_state + +module_set_le_tx_data_flag: + arg MODULE_FLAG_BLE_DATA_FINISH,queue + branch module_set_state + +module_clear_le_tx_data_flag: + arg MODULE_FLAG_BLE_DATA_FINISH,queue + branch module_clr_state + +module_clr_state: + fetch 1,mem_module_flag + qset0 pdata + store 1,mem_module_flag + rtn + +module_set_state: + fetch 1,mem_module_flag + qset1 pdata + store 1,mem_module_flag + rtn + +/**************module state end*******************/ + + +else + +endif Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/bt.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/bt.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/bt.prog (working copy) @@ -0,0 +1,4130 @@ +define REVD +//define FPGA +define ROMCODE +define PATCH +define ADC +//define RAM_VERSION +//define CLK6M +//define DEBUG_MALLOC +//define DEBUG_H4LOG_ENABLE +//define DEBUG_LIGHT_STATE +//define E2_LOG +//define LMP_DBG +//define ACL_DEBUG +//define DCDC +define NVRAM +define RELEASE +define SECURE_CONNECTION +define DEBUG_RF_INIT +//define SPI_SIMULATE +//define ROM_RESPIN_OPTIONAL + +define SIMPLE_PAIRING +define COMPILE_RFCOMM +define COMPILE_SHUTTER +define COMPILE_AntiLost +//define COMPILE_IR +define COMPILE_KEYBOARD +define COMPILE_MOUSE +define COMPILE_MODULE +//define COMPILE_AT +//define COMPILE_PRCP +//define COMPILE_USB +//define COMPILE_DONGLE +define COMPILE_LE +define COMPILE_24G +define COMPILE_CAR +define COMPILE_REMOTE_CAR + +INCLUDE "bt_format" + +org 0x0000 // start from patch ram address start +ifdef SIM +include sim.prog +else +include patch.prog +endif + +/******************************************/ +/*********** ROM Start ***************/ +/******************************************/ + +org 0x4000 // start from rom address start +start: + call lpmstate +soft_reset: + bpatch patch00_0,mem_patch00 + clear_stack + call initialize_radio + call init_param + call l2cap_init + bpatch patch00_1,mem_patch00 + call rfcomm_init + call init_lmp + call ui_init + call app_init + bpatch patch00_2,mem_patch00 + call app_lpm_init,wake +ifdef SIMPLE_PAIRING + call publickey_init +else + call ssp_disable +ifdef SECURE_CONNECTION + call publickey_init + +endif +endif + call lpm_recover_clk,wake +main_loop: + bpatch patch00_3,mem_patch00 +ifdef SIMPLE_PAIRING + call sp_calc_sequence +endif +ifdef SECURE_CONNECTION + call sp_calc_sequence_256 +endif +ifdef SIMPLE_PAIRING +ifdef SECURE_CONNECTION + call sp_calc_sequence_256_check +endif +endif + call le_dispatch + bpatch patch00_4,mem_patch00 + call idle_dispatch + call app_process_idle + call inquiry_dispatch + call inquiry_scan_dispatch + call page_scan_dispatch + call connection_dispatch + call lpm_dispatch + branch main_loop + +connection_dispatch: + call connection_incontext + rtnmark0 mark_context + set0 mark_context,mark + call context_save + branch le_disable + +connection_incontext: + bpatch patch00_5,mem_patch00 + call context_search_insniff + nbranch connection_nosniff,zero + call context_load + add rega,coffset_mode,contr + ifetch 1,contr + bbit1 mode_le,le_conn_dispatch + bbit1 mode_master,master_dispatch + branch slave_dispatch +connection_nosniff: + call context_get_next + copy loopcnt,null + rtn zero + call context_load + fetch 1,mem_state + bbit1 state_inpage,master_page + fetch 1,mem_mode + bbit1 mode_master,master_dispatch + branch slave_dispatch + + + +/**************************************/ +/**************idle dispatch*********/ +/**************************************/ + +idle_dispatch: + fetch 1,mem_hci_cmd + rtn blank + beq hci_cmd_inquiry,idle_inquiry + beq hci_cmd_inquiry_cancel,idle_inquiry_cancel + beq hci_cmd_remote_name_req,idle_remote_name_req + beq hci_cmd_create_conn,idle_create_conn + beq hci_cmd_le_create_conn,idle_le_create_conn + call context_search_conn_handle + rtn zero + call context_search_plap + rtn zero +idle_exit: + jam 0,mem_hci_cmd + rtn + +idle_le_create_conn: + jam hci_cmd_le_create_conn,mem_cmd_le_create_conn + jam 0,mem_hci_cmd + rtn + +idle_inquiry: + set1 mark_inquiry_on,mark + set0 mark_inquiry_trainb,mark + jam param_ninquiry,mem_ninqy_index + jam 31,mem_nfreq_index_inq + branch idle_exit + +idle_inquiry_cancel: + set0 mark_inquiry_on,mark + force 0,stop_watch + branch idle_exit + +idle_remote_name_req: + call context_search_plap + rtn zero + force LMP_NAME_REQ,temp + jam 5,mem_nameres_cnt + branch idle_start_page + +idle_create_conn: + bpatch patch00_6,mem_patch00 +idle_create_conn_device: + fetch 6,mem_hci_plap + branch idle_exit,blank + jam RECONNECT_HID,memui_reconnect_mode + //jam HS_INIT_CALL,mem_hs_mode //init as master + jam CONN_SM_WAIT_FEATURES_RES,mem_conn_sm + branch idle_create_conn_cont + +idle_create_conn_cont: + force LMP_VERSION_REQ,temp +idle_start_page: + bpatch patch00_7,mem_patch00 + fetch 1,mem_page_mode + branch idle_page_mode_r0,blank + lshift3 pdata,pdata + lshift4 pdata,pdata + increase -1,pdata +idle_page_mode_r0: + store 1,mem_npage + store 1,mem_npage_index + jam 31,mem_nfreq_index_page + set0 mark_page_trainb,mark + call context_new + nbranch idle_page_fail,zero + call get_free_amaddr + store 1,mem_amaddr + storet 1,mem_lmo_opcode2 + fetch 6,mem_hci_plap + store 6,mem_plap + bpatch patch01_0,mem_patch01 + call timer_reinit + force 0,pdata + compare LMP_NAME_REQ,temp,0xff + nsetflag true,state_init_seq,pdata + set1 state_inpage,pdata + store 1,mem_state + jam BT_EVT_RECONN_STARTED,mem_fifo_temp + call ui_ipc_send_event + force 0,pdata + setflag true,smap_name_req,pdata + store 1,mem_state_map + setarg 0 + set1 mode_master,pdata + store 1,mem_mode + enable master + call context_save + disable master + force page_length_timer,queue + fetch 2,mem_page_to + call timer_init + branch idle_exit +idle_page_fail: + bpatch patch01_1,mem_patch01 + fetch 6,mem_hci_plap + store 6,mem_plap + compare LMP_NAME_REQ,temp,0xff + branch idle_name_fail,true + branch idle_exit +idle_name_fail: + arg mem_tmp_buffer,contw + arg 8,loopcnt + call memset0 + jam BT_EVT_RECONN_FAILED,mem_fifo_temp + call ui_ipc_send_event + branch idle_exit + + +/******************************************/ +/************** Inquiry *****************/ +/******************************************/ + +inquiry_dispatch: + rtnmark0 mark_inquiry_on + force inquiry_length_timer,queue + call timer_check + nsetflag blank,mark_inquiry_on,mark + nbranch inquiry_start,blank + rtn + + + +inquiry_start: + bpatch patch01_2,mem_patch01 + fetcht 2,mem_inq_window + force 4,queue + call sniff_check_window + rtn user + call afh_clear + force 0,freq_mode +inquiry_restart: + rtn timeout + set0 mark_fhs_already_good,mark + set0 mark_fhs_eir,mark +inquiry_rx_restart: + add clkn_bt,1,bt_clk + isolate1 mark_inquiry_trainb,mark + setflag true,2,freq_mode + compare 0x00,bt_clk,0x02 /* see if this is even slot */ + nbranch inquiry_receive,true + +inquiry_transmit: + bpatch patch01_3,mem_patch01 + fetch 1,mem_inquiry_transmit + increase 1,pdata + store 1,mem_inquiry_transmit + call fetch_giac + call tx_radio_freq + call fetch_diac + call start_transmitter /* get ready for that id packet */ + call start_tx_native + call send_access_word + call end_of_packet + call inquiry_check_train + branch inquiry_restart + +inquiry_check_train: + bpatch patch01_4,mem_patch01 + fetch 1,mem_nfreq_index_inq + increase -1,pdata + store 1,mem_nfreq_index_inq + rtn positive /* if it's time to incremnt N */ + jam 31,mem_nfreq_index_inq + fetch 1,mem_ninqy_index + increase -1,pdata + store 1,mem_ninqy_index + rtn positive /* if it's time to change train */ + setflip mark_inquiry_trainb,mark + jam param_ninquiry,mem_ninqy_index + rtn + +inquiry_receive: + bpatch patch01_5,mem_patch01 + call fetch_giac + call rx_radio_freq + call fetch_diac + call start_rx_native + call start_receiver /* get ready for that id packet */ + call wait_access_clkn_rt + branch inquiry_sync,sync /* try look for id packet again if not found */ + call inquiry_check_train + branch inquiry_rx_restart +inquiry_sync: + bpatch patch01_6,mem_patch01 + call save_rssi + call scan_mode_whiten + call receive_packet_whitened + set0 mark_rxbuf_inuse,mark + rtnmark0 mark_fhs_already_good +inquiry_receive_rtn: + bpatch patch01_7,mem_patch01 +inquiry_receive_eir_rtn: + fetch 1,mem_inquiry_rcv + increase 1,pdata + store 1,mem_inquiry_rcv + rtn + +/******************************************/ +/************** Master Dispatch *************/ +/******************************************/ + + + +master_page: + bpatch patch02_0,mem_patch02 + enable master + enable clknt + fetch 2,mem_page_interval + branch master_page_no_interval,blank + force page_interval_timer,queue + call timer_check + nrtn blank +master_page_no_interval: + bpatch patch02_1,mem_patch02 + fetcht 2,mem_page_window + force 40,queue + call sniff_check_window + branch page_exit,user + force page_length_timer,queue + call timer_check + nbranch page_start,blank + fetch 1,mem_state_map + bbit1 smap_name_req,master_npage_timeout + branch master_page_timeout +master_npage_timeout: + arg mem_tmp_buffer,contw + arg 8,loopcnt + call memset0 +master_page_timeout: + bpatch patch02_2,mem_patch02 + jam 0,mem_state + call init_lmp_work + jam 0,memui_reconnect_mode + jam BT_EVT_RECONN_PAGE_TIMEOUT,mem_fifo_temp + call ui_ipc_send_event + branch page_exit + +page_start: + bpatch patch02_3,mem_patch02 + force 0,timeup + until clkn_rt,meet + fetch 1,mem_page_clk + increase -1,pdata + ixor clkn_bt,pdata + compare 0,pdata,3 + nbranch page_start,true + deposit am_addr + store 1,mem_fhs_am_addr + force 0,N_tx_slot + force 0,freq_mode + +page_restart: + bpatch patch02_4,mem_patch02 + branch page_exit,timeout + call fetch_page_bt_adr + arg param_rf_setup, timeup + until clkn_rt,meet /* wait for the start_receiver time against native real clk */ +page_rx_restart: + bpatch patch02_5,mem_patch02 + fetch 4,mem_page_clk /* deposit clk_estimate */ + iforce bt_clk + increase 1,pdata + store 4,mem_page_clk + isolate1 mark_page_trainb,mark + setflag true,2,freq_mode + compare 0x00,bt_clk,0x02 /* see if this is even slot */ + nbranch page_receive,true + fetch 1, mem_page_transmit + increase 1,pdata + store 1, mem_page_transmit + call tx_radio_freq + call start_transmitter /* get ready for that id packet */ + call start_tx_native + call send_access_word + call end_of_packet + call page_check_train + branch page_restart +page_exit: + bpatch patch02_6,mem_patch02 + disable master + fetch 2,mem_page_interval + rtn blank + force page_interval_timer,queue + branch timer_init + +page_check_train: + bpatch patch02_7,mem_patch02 + fetch 1,mem_nfreq_index_page + increase -1,pdata + store 1,mem_nfreq_index_page + rtn positive + jam 31,mem_nfreq_index_page + fetch 1,mem_npage_index + increase -1,pdata /* increment N */ + store 1,mem_npage_index + rtn positive /* if it's time to change train */ + setflip mark_page_trainb,mark /* change train */ + fetch 1,mem_npage + store 1,mem_npage_index + rtn + +page_receive: + bpatch patch03_0,mem_patch03 + call rx_radio_freq + call start_rx_native + call start_receiver /* get ready for that id packet */ + call wait_access_clkn_rt /* try id look for id packet again */ + branch page_sync,sync /* restart if didn't receive anything */ + call page_check_train + branch page_rx_restart +page_sync: + call end_of_packet + fetch 1, mem_page_rcv + increase 1,pdata + store 1, mem_page_rcv + force 0,stop_watch + fetch 4,mem_page_clk +page_send_fhs: + bpatch patch03_1,mem_patch03 + call rf_setup_time_master_slot + call fetch_page_bt_adr + increase 1,N_tx_slot +page_send_fhs_continue: + and_into 0x1fd,bt_clk + and_into 0x1fc,freq_mode /* master response = x00, even_train settin must remain the same */ + call tx_radio_freq + call start_transmitter /* get ready for that id packet */ + call start_tx_native + call send_access_word + deposit clkn_bt + store 4,mem_clkn_bt + force 0,am_addr + force type_fhs,type + call scan_mode_whiten + call transmit_packet_whitened +page_wait_fhs_reply: + bpatch patch03_2,mem_patch03 + call rf_setup_time_slave_slot + or_into 0x02,bt_clk + and_into 0x1fc,freq_mode /* master response sequence = x00, even train setting must be preserved */ + call rx_radio_freq + call start_rx_native + call start_receiver /* get ready for that id packet */ + call wait_access_clkn_rt /* look for that reply */ + call end_of_packet,sync /* id reply is enough */ + branch page_wait_fhs_reply_ok,sync /* no reply then send fhs again */ + fetch 1,mem_fhs_wait_counter + branch page_restart,blank + increase -1,pdata + store 1,mem_fhs_wait_counter + branch page_send_fhs + +page_wait_fhs_reply_ok: + bpatch patch03_3,mem_patch03 + fetch 1, mem_page_rcv_fhs + increase 1,pdata + store 1, mem_page_rcv_fhs + call prepare_newconn +master_newconn_loop: + call master_newconn_once + branch newconn_poll_responded,sync + call new_conn_timeout + nbranch master_newconn_loop,blank + branch page_restart + +newconn_poll_responded: + bpatch patch03_4,mem_patch03 + fetch 1,mem_state + set0 state_inpage,pdata + store 1,mem_state + call newconn_init + disable master + rtn + + +master_dispatch: + bpatch patch03_5,mem_patch03 + enable master + enable clknt + call role_switch_master + rtn user + call check_bt_disabled + call rf_setup_time_master_slot + add clkn_bt,1,bt_clk + call fetch_self_bt_adr + force 0x03,freq_mode + call scheduler_tx_l2cap_pkt + call prepare_tx + call tx_radio_freq + call start_transmitter + call start_tx_native + call send_access_word + call transmit_packet +master_loop: + bpatch patch03_6,mem_patch03 + call parse_lmp + call master_conn_recv_packet + nbranch master_notmatch,match + call supervision_flush + call parse_l2cap + fetch 1,mem_master_rcvcnt + increase 1,pdata + store 1,mem_master_rcvcnt +master_notmatch: + bpatch patch03_7,mem_patch03 + call scheduler_process + call check_master_disconnect + nrtn master /* disconnected */ + call check_attempt + nbranch master_attempt,blank +master_exit: + disable master + rtn + +master_attempt: + call prepare_tx + call master_conn_send_packet + branch master_loop + + +check_master_disconnect: + branch check_master_match,match + call supervision_update + branch master_disconnect,positive +check_master_match: + call check_disconnect_timeout + nbranch master_disconnect,user + fetch 1,mem_state_map + rtnbit0 smap_name_req + rtnbit1 smap_name_res + fetch 1,mem_op + rtnbit1 op_disconn + call conn_timer_expired + nrtn blank + fetch 1,mem_nameres_cnt + increase -1,pdata + store 1,mem_nameres_cnt + nrtn blank + branch lmp_disconnect + +master_disconnect: + bpatch patch04_0,mem_patch04 + call quit_connection + disable master + fetch 1,mem_state_map + bbit1 smap_name_req,master_name_disconnect + rtn + +master_name_disconnect: + fetch 1,mem_state_map + rtnbit1 smap_name_res +master_name_error: + arg mem_tmp_buffer,contw + arg 8,loopcnt + branch memset0 + +check_disconnect_timeout: + bpatch patch04_1,mem_patch04 + enable user + fetch 1,mem_op + rtnbit0 op_disconn + call conn_timer_expired + nrtn blank + branch disable_user + +conn_timer_expired: + fetch 1,mem_conn_timer + increase -1,pdata + store 1,mem_conn_timer + rtn + +linkkey_ready: + bpatch patch04_2,mem_patch04 + fetch 1,mem_state + bbit1 state_linkkey,linkkey_set + fetch 1,mem_pairing_auth + branch linkkey_set,blank + jam DEFALT_PAIRING_AUTH,mem_pairing_auth + jam BT_EVT_LINKKEY_GENERATE,mem_fifo_temp + call ui_ipc_send_event + branch linkkey_set +linkkey_set: + bpatch patch04_3,mem_patch04 + call context_traverse_linkkey + fetch 1,mem_state + set1 state_linkkey,pdata + store 1,mem_state + jam 1,mem_link_key_exists + fetch 1,mem_conn_sm + bne CONN_SM_PAIRING,linkkey_set_continue +linkkey_set_continue: + rtn + +generate_linkkey_continue: + jam PAIRING_AUTH,mem_pairing_auth +clear_linkstate: + fetch 1,mem_state + set0 state_linkkey,pdata + store 1,mem_state + rtn + + + /* rtn user if switch */ +role_switch_check: + bpatch patch04_4,mem_patch04 + disable user + fetch 2,mem_tsniff + arg 0xffff,temp + isub temp,null + nrtn zero + fetch 4,mem_sniff_anchor + branch role_switch_clkn,clknt + isub clke_bt,pdata + branch role_switch_clke +role_switch_clkn: + isub clkn_bt,pdata +role_switch_clke: + sub pdata,4,null + nrtn positive + force 0,pdata + store 2,mem_tsniff + branch enable_user + + + /* pdata: switch instant, set tsniff=0 for special sniff */ +role_switch_prepare: + copy pdata,temp + bpatch patch04_5,mem_patch04 + storet 4,mem_sniff_anchor +role_switch_prepare0: + jam SWITCH_FLAG_ACCEPT,mem_switch_flag + setarg 0xffff + store 2,mem_tsniff + jam 1,mem_sniff_attempt + rtn + + +role_switch_master: + bpatch patch04_6,mem_patch04 + call role_switch_check + nrtn user + disable user + jam param_newconnto,mem_newconnto_counter + set0 mark_fhs_already_good,mark +roles_waitfhs_loop: + call rf_setup_time_master_slot + call master_recv_packet + bmark1 mark_fhs_already_good,roles_replyto_fhs + call new_conn_timeout + nbranch roles_waitfhs_loop,blank +role_switch_fail_master: + bpatch patch04_7,mem_patch04 + disable user + deposit clkn_bt + store 4,mem_next_btclk + enable clknt + enable master + jam BT_EVT_SWITCH_FAIL_MASTER,mem_fifo_temp + branch ui_ipc_send_event + +roles_replyto_fhs: + bpatch patch05_0,mem_patch05 + call rf_setup_time_slave_slot + arg type_id,type + call master_send_packet + disable clknt + disable master + call apply_switch_clke + call prepare_newconn +roles_newconns_loop: + bpatch patch05_1,mem_patch05 + call slave_newconn_once + branch roles_newconns_responded,match + call new_conn_timeout + nbranch roles_newconns_loop,blank + branch role_switch_fail_master +roles_newconns_responded: + fetch 1,mem_mode + set0 mode_master,pdata + store 1,mem_mode + call supervision_flush + call calc_clke_offset + enable user + jam BT_EVT_SWITCH_SUCCESS_MASTER,mem_fifo_temp + branch ui_ipc_send_event + + + + +context_load: + bpatch patch05_2,mem_patch05 + set1 mark_context,mark + deposit rega + store 2,mem_context_ptr + force context_size,loopcnt + arg mem_le_state,contw + add rega,coffset_mode,contr + ifetch 1,contr + copy rega,contr + bbit1 mode_le,memcpy + arg mem_state,contw + call memcpy + disable attempt + fetch 1,mem_amaddr + iforce am_addr + jam 1,mem_current_sniff_attempt + branch context_load_master,master + jam 1,mem_current_sniff_attempt +context_load_master: + fetch 1,mem_state + rtnbit0 state_insniff + fetch 1,mem_sniff_attempt + store 1,mem_current_sniff_attempt + fetch 1,mem_sniff_timeout + store 1,mem_current_sniff_timeout + rtn + +context_save: + bpatch patch05_3,mem_patch05 + fetch 2,mem_context_ptr + iforce contw + force context_size,loopcnt + arg mem_le_state,contr + branch memcpy,le + arg mem_state,contr + branch memcpy + + + +context_get_next: + arg context_num,loopcnt + fetcht 1,mem_current_context +context_get_next_loop: + increase 1,temp + compare context_num,temp,0xff + nbranch context_get_next_cont,true + arg 0,temp +context_get_next_cont: + storet 1,mem_current_context + mul32 temp,context_size,pdata + arg mem_context,rega + iadd rega,rega + ifetch 1,rega + bbit1 state_insniff,context_get_next_sniff + rtnbit1 state_inconn + rtnbit1 state_inpage +context_get_next_sniff: + loop context_get_next_loop + rtn + +context_new: + bpatch patch05_4,mem_patch05 + arg context_search_empty,regc + call context_search + nrtn zero // all occupied + deposit rega + store 2,mem_context_ptr + force 0,null + rtn + + //return zero if anyone's wack is 1. + //return nzero if all wack is 0 +context_check_all_wack: + call check_esco_amaddr + branch context_check_esco_wack,true + fetch 2,mem_context_ptr + add pdata,coffset_arq,contw + fetch 1,mem_arq + istore 1,contw + arg context_check_a_wack,regc + branch context_search + +context_check_esco_wack: + fetch 1,mem_arq + isolate1 wack,pdata + branch context_esco_wack,true + force 1,null + rtn +context_esco_wack: + force 0,null + rtn + + //rtn nzero if idle(no conn) +context_check_idle: + arg context_check_inconn,regc + branch context_search + +context_traverse_linkkey: + fetcht 2,mem_context_ptr + arg context_traverse_clearkey,regc + branch context_search + + + /* return zero if conn handle is found */ +context_search_conn_handle: + fetcht 1,mem_hci_conn_handle +context_search_conn_handle2: + arg context_search_handle,regc + branch context_search + /* return zero if plap is found */ +context_search_plap: + bpatch patch05_5,mem_patch05 + fetcht 6,mem_hci_plap +context_search_plap2: + arg context_search_lap,regc + branch context_search + /* return zero if sniff anchor is meet and rega pointers to context */ +context_search_insniff: + arg context_search_sniff,regc + branch context_search + /* return zero if sniff window is in content with current transaction */ +context_search_sniff_window: + arg context_search_window,regc +context_search: + bpatch patch05_6,mem_patch05 + arg mem_context,rega + arg context_num,loopcnt +context_search_loop: + ifetch 1,rega + copy regc,pc +context_search_next: + increase context_size,rega + loop context_search_loop + force 1,null + rtn + +context_search_empty: + bbit1 state_inconn,context_search_next + bbit1 state_inpage,context_search_next + force 0,null + rtn + +context_search_lap: + bbit1 state_inpage,context_search_lap_cont + bbit0 state_inconn,context_search_next +context_search_lap_cont: + add rega,coffset_plap,contr + ifetch 6,contr + isub temp,null + rtn zero + branch context_search_next + +context_search_handle: + bbit0 state_inconn,context_search_next + add rega,coffset_conn_handle,contr + ifetch 1,contr + isub temp,null + rtn zero + branch context_search_next + +context_search_sniff: + bbit0 state_insniff,context_search_next +context_search_sniff_loop: + call context_get_anchor + call sign_pdata_temp + isub temp,pdata + increase 1,pdata + branch context_search_sniff_miss,positive + copy contr,regb + store 9,mem_temp + fetch 1,mem_le_sc_calc + nbranch context_search_sniff_sc,blank + fetch 9,mem_temp + copy regb,contr + increase 5,pdata + branch context_search_meet1 +context_search_sniff_sc: + fetch 9,mem_temp + copy regb,contr + increase 20,pdata +context_search_meet1: + nbranch context_search_next,positive +context_search_meet: + copy temp,bt_clk + call context_next_anchor + force 0,null + rtn + + +context_search_sniff_miss: + iforce regb + add rega,coffset_tsniff,contr + ifetch 2,contr + branch context_search_meet,blank + call context_next_anchor + branch context_search_sniff_loop + +sign_pdata_temp: + rshift16 pdata,timeup + rshift8 timeup,timeup + branch sign_pdata_temp_p0,zero + compare 0xf,timeup,0xf + nrtn true + rshift16 temp,timeup + rshift8 timeup,timeup + nrtn zero + set1 28,temp + rtn +sign_pdata_temp_p0: + rshift16 temp,timeup + rshift8 timeup,timeup + compare 0xf,timeup,0xf + nrtn true + set1 28,pdata + rtn + +context_check_inconn: + bbit0 state_inconn,context_search_next + force 0,null // found + rtn + +context_check_a_wack: + bbit0 state_inconn,context_search_next + add rega,coffset_mode,contr + ifetch 1,contr + bbit1 mode_le,context_search_next + add rega,coffset_arq,contr + ifetch 1,contr + bbit0 wack,context_search_next + force 0,null // found + rtn + +context_get_anchor: + add rega,coffset_mode,contr + ifetcht 1,contr + deposit clkn_bt + isolate1 mode_master,temp + add rega,coffset_sniff_anchor,contr + ifetcht 4,contr + rtn true + add rega,coffset_clk_offset,contr + ifetch 6,contr + call calc_clke2 + deposit clke_bt + rtn + +context_next_anchor: + add rega,coffset_tsniff,contr + add rega,coffset_sniff_anchor,contw + ifetch 2,contr + iadd temp,timeup /* wrap to 28 bits */ + deposit timeup + istore 4,contw + branch le_context_nexthop + + +context_search_window: + bbit0 state_insniff,context_search_next + call context_get_anchor + iadd stop_watch,pdata + iadd stop_watch,pdata + iadd queue,pdata + isub temp,null + nbranch context_search_next,positive + force 0,null + rtn + +context_traverse_clearkey: + bbit0 state_inconn,context_search_next + deposit temp + isub rega,null + branch context_search_next,null + add rega,coffset_mode,contr + ifetch 1,contr + bbit1 mode_le,context_search_next + ifetch 1,rega + set0 state_linkkey,pdata + istore 1,rega + branch context_search_next + + +master_conn_send_packet: + bpatch patch05_7,mem_patch05 + call rf_setup_time_master_slot +master_send_packet: + add clkn_bt,1,bt_clk /* master start to use native clock */ + call fetch_self_bt_adr + force 0x03,freq_mode /* we are in connection!! */ + call tx_radio_freq + call start_transmitter + call start_tx_native + call send_access_word + branch transmit_packet + +master_conn_recv_packet: + bpatch patch06_0,mem_patch06 + call rf_setup_time_slave_slot +master_recv_packet: + add clkn_bt,1,bt_clk /* master start to use native clock */ + call fetch_self_bt_adr + force 0x03,freq_mode /* we are in connection!! */ + call rx_radio_freq + call init_rx_packet_flags + call prep_crypt + call start_rx_native /* start listening at start_rx time */ + call start_receiver +master_rx_conn_finish_packet: + call wait_access_clkn_rt /* master use native clock */ + nrtn sync + call save_rssi + branch receive_packet + + + +master_newconn_once: + bpatch patch06_1,mem_patch06 + fetch 1,mem_fhs_am_addr + iforce am_addr //review + force type_poll,type + call master_conn_send_packet + branch master_conn_recv_packet + + + + + + +/******************************************/ +/************* Inquiry Scan ***************/ +/******************************************/ + +inquiry_scan_dispatch: + fetch 1,mem_scan_mode + rtnbit0 inq_scan_mode + force iscan_interval_timer,queue + call timer_check + nrtn blank + fetcht 2,mem_iscan_window + force 4,queue + call sniff_check_window + rtn user + call inquiry_scan_start + force iscan_interval_timer,queue + fetch 2,mem_iscan_interval + nbranch timer_init,sync + random pdata /* inquiry scan backoff */ + iand mask3ff,pdata + branch timer_init + + +inquiry_scan_start: + bpatch patch06_2,mem_patch06 + jam 0,mem_fhs_am_addr + disable clknt + disable attempt + call afh_clear + and clkn_bt,0x1fc,bt_clk /* freeze the clock, set bit[1] 0, this is version 1.1 */ + force 0x01,freq_mode /* slave in inquiry scan, kind of same as inquriy_response, this is version 1.1 */ + call fetch_giac + call rx_radio_freq + setflip mark_inquiry_state,mark + fetch 1,mem_inquiryscan_waitcnt + increase 1,pdata + store 1,mem_inquiryscan_waitcnt + call fetch_diac + call start_receiver /* get ready for that id packet */ + call wait_access_forever /* until there is timeout, or matched (true) */ + nrtn sync + bpatch patch06_3,mem_patch06 + force 0,stop_watch + call shutdown_radio /* must have heard */ + fetch 1,mem_inquiryscan_rcvcnt + increase 1,pdata + store 1,mem_inquiryscan_rcvcnt + call fetch_giac + call rf_setup_time_slave_slot + or_into 0x002,bt_clk /* put clk(1) to 1 */ + force 0x01,freq_mode /* slave in inquriy and page, response only */ + call tx_radio_freq + call fetch_diac + call start_transmitter /* get ready for that id packet */ + call start_tx_external + deposit clkn_bt + store 4,mem_clkn_bt + call send_access_word + force type_fhs,type + force 0,am_addr /* put 0 into am_addr field for fhs */ + call scan_mode_whiten + call transmit_packet_whitened + call send_eir + and_into 0x1fd,bt_clk /* put clk(1) back to 0 */ + increase 1,N_tx_slot + rtn + +send_eir: + bpatch patch06_4,mem_patch06 + fetch 1,mem_eir_enable + rtn blank + arg mem_eir,contw + fetch 1,mem_local_name_length + copy pdata,loopcnt + increase 1,pdata + istore 1,contw + copy contw,temp + increase 1,pdata + store 2,mem_tx_len + copy temp,contw + setarg 0x09 //type:name + istore 1,contw + arg mem_local_name,contr + call memcpy //name + + arg mem_all_uuid_128bits,regc + arg 4,loopcnt + call get_all_uuid + arg mem_all_uuid_16bits,regc + arg 1,loopcnt + call get_all_uuid + + force type_dm3,type /* DM3 */ + jam 2,mem_tx_lch + setarg mem_eir + store 2,mem_txptr + call rf_setup_time_slave_slot + call tx_radio_freq + call start_transmitter /* get ready for that id packet */ + call start_tx_external + call send_access_word + call scan_mode_whiten + call transmit_packet_whitened + rtn + + +get_all_uuid: + copy contw,temp + copy regc,contr + ifetch 1,contr + rtn blank +lshift_loop: + lshift pdata,pdata + loop lshift_loop + copy pdata,rega + increase 2,pdata + copy pdata,queue + fetch 2,mem_tx_len + iadd queue,pdata + store 2,mem_tx_len + copy temp,contw + copy rega,pdata + increase 1,pdata + istore 1,contw + copy regc,contr + ifetch 1,contr + ifetch 1,contr //fetch type + istore 1,contw + copy rega,loopcnt + branch memcpy //copy uuid + +/******************************************/ +/******** Slave dispatch ***********/ +/******************************************/ + +page_scan_dispatch: + fetch 1,mem_scan_mode + rtnbit0 page_scan_mode + force pscan_interval_timer,queue + call timer_check + nrtn blank + fetcht 2,mem_pscan_window + force 40,queue + call sniff_check_window + rtn user + force 0,am_addr + jam param_pagerespto,mem_fhs_wait_counter + set0 mark_fhs_already_good,mark + call page_scan_start + force pscan_interval_timer,queue + fetch 2,mem_pscan_interval + branch timer_init + + +page_scan_start: + bpatch patch06_5,mem_patch06 + disable clknt + call afh_clear + fetch 1,mem_pagescan_waitcnt + increase 1,pdata + store 1,mem_pagescan_waitcnt + force 0,N_tx_slot + call fetch_self_bt_adr + add clkn_bt,1,bt_clk /* freeze the clock on native clock until scan window is up */ + force 0x02, freq_mode /* slave in inquiry and page, not response */ + bpatch patch06_6,mem_patch06 + call rx_radio_freq + call start_receiver /* wait for that id packet from master */ + call wait_access_forever + nrtn sync /* pscan window timeout occured, back to dispatch */ + call shutdown_radio /* got the id packet */ + fetch 1,mem_pagescan_rcvcnt + increase 1,pdata + store 1,mem_pagescan_rcvcnt + force 0,stop_watch + call rf_setup_time_slave_slot + or_into 0x002,bt_clk /* put clk(1) to 1 */ + force 0x01,freq_mode /* slave in inquriy and page, response only */ + call tx_radio_freq + call start_transmitter + call start_tx_external + call send_access_word + call end_of_packet + force 0,am_addr + arg param_rf_setup, timeup + until clke_rt,meet + or_into 0x03,clke_bt + and_into 0x1fd,bt_clk +page_scan_wait_fhs_restart: + bpatch patch06_7,mem_patch06 + increase 1,N_tx_slot + call rx_radio_freq + call start_receiver + call wait_access_mhalfbnd + nbranch page_scan_wait_fhs_again,sync /* go back if didn't find access code */ + call scan_mode_whiten + call receive_packet_whitened + bmark1 mark_fhs_already_good,page_scan_reply_to_fhs +page_scan_wait_fhs_again: + bpatch patch07_0,mem_patch07 + fetch 1,mem_fhs_wait_counter + rtn blank + increase -1,pdata + store 1,mem_fhs_wait_counter + call rf_setup_time_master_slot /* set up expiration time */ + branch page_scan_wait_fhs_restart + + +page_scan_reply_to_fhs: + bpatch patch07_1,mem_patch07 + set0 1,clke_bt + set1 0,clke_bt + fetch 1,mem_pagescan_rcvfhscnt + increase 1,pdata + store 1,mem_pagescan_rcvfhscnt + call rf_setup_time_slave_slot + or_into 0x02,bt_clk + call tx_radio_freq + call start_transmitter + call start_tx_external + call send_access_word + call end_of_packet +slave_apply_clke_bt: + compare 0x03,clke_bt,0x03 + branch slave_apply_clke_bt_now,true + until null,mhalfbnd + branch slave_apply_clke_bt +slave_apply_clke_bt_now: + fetch 4,mem_clke_bt + or_into 0x03,pdata + icopy clke_bt + +start_slave_connection: + bpatch patch07_2,mem_patch07 + fetch 6,extm_lap + store 6,mem_plap + call prepare_newconn +slave_newconn_loop: + call slave_newconn_once + branch sconn_successful,match /* we were talked to */ + call new_conn_timeout + nbranch slave_newconn_loop,blank + rtn + + +sconn_successful: + bpatch patch07_3,mem_patch07 + call newconn_init + call context_new + nrtn zero + jam 0,mem_mode + call calc_clke_offset + branch context_save + + + + +slave_dispatch: + bpatch patch07_4,mem_patch07 + call calc_clke + call role_switch_slave + rtn user +slave_loop: + bpatch patch07_5,mem_patch07 + call check_bt_disabled + call scheduler_process + call slave_conn_recv_packet /* go listen for a packet */ + nbranch slave_notmatch,match + call supervision_flush + call scheduler_tx_l2cap_pkt + call prepare_tx + call slave_conn_send_packet + call parse_l2cap + call parse_lmp + fetch 1,mem_slave_rcvcnt + increase 1,pdata + store 1,mem_slave_rcvcnt + call calc_clke_offset +slave_notmatch: + bpatch patch07_6,mem_patch07 + call lpm_set_mult + call supervision_update + branch slave_disconnect,positive + call check_disconnect_timeout + nbranch slave_disconnect,user + call check_attempt + nbranch slave_loop,blank + rtn + +slave_disconnect: + bpatch patch07_7,mem_patch07 + jam 0,mem_tester_emulate + jam 0,mem_debug_config + call quit_connection + set0 mark_testmode,mark + call test_enable_white + fetch 1,mem_state + rtn + + +role_switch_slave: + bpatch patch08_0,mem_patch08 + call role_switch_check + nrtn user + copy am_addr,temp + call get_free_amaddr + store 1,mem_fhs_am_addr + copy temp,am_addr + jam param_newconnto,mem_newconnto_counter +roles_sendfhs_loop: + bpatch patch08_1,mem_patch08 + call rf_setup_time_master_slot + force type_fhs,type + call slave_send_access + deposit clkn_bt + store 4,mem_clkn_bt + call transmit_packet + call rf_setup_time_slave_slot + enable user3 + call slave_receive_access + branch roles_got_fhs_reply,sync + call shutdown_radio + call new_conn_timeout + nbranch roles_sendfhs_loop,blank + rtnmark0 mark_accept_switch + jam LMP_SLOT_OFFSET,mem_lmo_opcode2 + set1 mark_switch_initiated,mark + rtn +roles_got_fhs_reply: + enable clknt + call prepare_newconn + call afh_clear +roles_newconn_loop: + bpatch patch08_2,mem_patch08 + call master_newconn_once + branch roles_newconn_responded,sync + call new_conn_timeout + nbranch roles_newconn_loop,blank + disable clknt + deposit clke_bt + store 4,mem_next_btclk + rtn +roles_newconn_responded: + enable master + bmark0 mark_accept_switch,roles_newconn_nolmp + set0 mark_accept_switch,mark + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_HOST_CONNECTION_REQ,mem_lmi_opcode2 + call tid_set_reply +roles_newconn_nolmp: + deposit am_addr + store 1,mem_amaddr + force 0,pdata + store 6,mem_clk_offset + fetch 1,mem_mode + set1 mode_master,pdata + store 1,mem_mode + call supervision_flush + disable master + enable user + rtn + + + +init_rx_packet_flags: + bpatch patch08_3,mem_patch08 + disable match + set0 mark_loopback,mark + set0 mark_am_addr_broadcast,mark /* initialize slave flags */ + set0 mark_longpacket,mark + set0 mark_old_packet,mark + fetch 1,mem_arq /* mem_arq + am_addr */ + set0 arqnx,pdata + set1 flowx,pdata + store 1,mem_arq + rtn + +prepare_newconn: + bpatch patch08_4,mem_patch08 + jam param_newconnto,mem_newconnto_counter + jam param_newconn_arq,mem_arq + fetch 2,mem_rx_window_init + store 2,mem_rx_window + deposit clkn_bt + store 4,mem_next_btclk + rtn clknt + deposit clke_bt + store 4,mem_next_btclk + rtn + +newconn_init: + bpatch patch08_5,mem_patch08 + call init_lmp_reinit + call new_conn_handle + store 1,mem_conn_handle + setarg 0 + store 2,mem_l2cap_rxbuff1_len + setarg param_supervision_to + store 2,mem_supervision_to + fetch 1,mem_state + set1 state_inconn,pdata + store 1,mem_state + jam 0,mem_op + jam 0,mem_state_map + jam 0,mem_lpm_current_mult + branch supervision_flush + + +clear_linkkey: + bpatch patch08_6,mem_patch08 + force 0,pdata + store 8,mem_link_key + istore 8,contw + call clear_linkstate + branch context_traverse_linkkey + +new_conn_timeout: + fetch 1,mem_newconnto_counter + increase -1,pdata + store 1,mem_newconnto_counter + rtn + +new_conn_handle: + fetch 1,mem_handle_num + increase 1,pdata + store 1,mem_handle_num + rtn + + +quit_connection: + bpatch patch08_7,mem_patch08 + fetch 1,mem_hci_cmd + beq hci_cmd_remote_name_req,quit_connection_name + fetch 1,mem_lmp_to_send + bne LMP_NAME_REQ,quit_connection_cont +quit_connection_name: + call cmd_check_plap + nbranch quit_connection_cont,zero + call master_name_error + jam 0,mem_hci_cmd +quit_connection_cont: + bpatch patch09_0,mem_patch09 + call app_disconn_reason_collect_bt + call sniff_exit + jam BT_EVT_BB_DISCONNECTED,mem_fifo_temp + call ui_ipc_send_event + call init_lmp_work + call l2cap_init_work +ifdef SIMPLE_PAIRING + call sp_initialize +endif + fetch 1,mem_state + set0 state_inconn + store 1,mem_state + jam 0,memui_reconnect_mode + + fetch 1,mem_state_map + compare 0x0,pdata,0xc0 + branch quit_connection_not_clear_mark,true + set0 mark_rxbuf_inuse,mark +quit_connection_not_clear_mark: + fetch 1,mem_arq + bbit0 wack,quit_connection_not_clear_tx +quit_connection_not_clear_tx: + fetch 1,mem_op + rtnbit0 op_txl2cap + set0 mark_tx_l2cap,mark + rtn + +slave_newconn_once: + bpatch patch09_1,mem_patch09 + fetch 1,extm_newconn_am_addr + rtn blank + icopy am_addr + call slave_conn_recv_packet + nrtn match + force type_null,type + call slave_conn_send_packet + deposit am_addr + store 1,mem_amaddr /* now the new am_addr is official */ + force 0,pdata + store 1,extm_newconn_am_addr + rtn + + +/******************************************/ +/******** Time consuming task ***********/ +/******************************************/ +prepare_tx: + bpatch patch09_2,mem_patch09 + fetch 1,mem_state + bbit0 state_insco,prepare_tx_not_sco + force type_hv3,type + bmark0 mark_esco,prepare_tx_not_esco + call check_esco_amaddr + nbranch prepare_tx_not_sco,true + branch prepare_tx_not_sco,attempt + call set_wait_ack /* send esco only at the first attempt */ + setarg 2 /* esco only has 1 retry */ + store 2,mem_retransmission_cnt + rtn +prepare_tx_not_esco: + nrtn attempt /* send sco only at the first attempt */ +prepare_tx_not_sco: + bpatch patch09_3,mem_patch09 + call context_check_all_wack //abandon mark_retransmit, use context_check_all_wack instead. + nbranch prepare_tx_no_retransmit,zero + fetch 1,mem_arq + bbit0 wack,prepare_tx_pollnull /* other wack, tx buffer in use, but not me */ +prepare_tx_retransmit: + bmark1 mark_loopback,prepare_tx_loopback + fetch 1,mem_debug_config + bbit1 debug_tx_pattern,prepare_tx_txpat + fetch 2,mem_retransmission_cnt + increase -1,pdata + store 2,mem_retransmission_cnt + branch prepare_tx_nomore_retransmit,blank + fetch 1,mem_last_type + iforce type + rtn + +prepare_tx_nomore_retransmit: + bpatch patch09_4,mem_patch09 + call clear_got_tx +prepare_tx_no_retransmit: + call check_esco_amaddr + branch prepare_tx_pollnull,true + call send_lmp + branch prepare_tx_sendlmp,user + fetch 1,mem_op + bbit1 op_txl2cap,prepare_tx_sendl2cap + bmark1 mark_loopback,prepare_tx_loopback + fetch 1,mem_debug_config + bbit1 debug_tx_pattern,prepare_tx_txpat +prepare_tx_pollnull: + force type_poll,type /* POLL for master */ + rtn master + force type_null,type /* default is NULL */ + rtn +prepare_tx_loopback: + bpatch patch09_5,mem_patch09 + fetch 1,mem_rx_type + iforce type + rtnne 1 + force type_null,type + rtn +prepare_tx_txpat: + fetch 1,test_mode_packet_type + and pdata,0xf,type + set1 mark_loopback,mark + rtn +prepare_tx_sendlmp: + force type_lmp,type + branch set_wait_ack +prepare_tx_sendl2cap: + call tx_l2cap_type + +set_wait_ack: + bpatch patch09_6,mem_patch09 + fetcht 1,mem_arq + set1 wack,temp + storet 1,mem_arq + deposit type + store 1,mem_last_type + setarg 0xffff + store 2,mem_retransmission_cnt + rtn + +tx_l2cap_type: + bpatch patch09_7,mem_patch09 + fetch 1,mem_state_map + isolate1 smap_edr,pdata + fetch 2,mem_tx_len + branch tx_l2cap_type_edr,true + force type_dm1,type /* DM1 */ + sub pdata,17,null + rtn positive + force type_dh1,type /* DH1 */ + sub pdata,27,null + rtn positive + force type_dm3,type /* DM3 */ + sub pdata,121,null + rtn positive + force type_dh3,type /* DH3 */ + sub pdata,183,null + rtn positive + force type_dm5,type /* DM5 */ + sub pdata,224,null + rtn positive + force type_dh5,type /* DH5 */ + rtn +tx_l2cap_type_edr: + force type_dm1,type + sub pdata,17,null + rtn positive + force type_dh1,type /*2-DH1*/ + sub pdata,54,null + rtn positive + force type_dm3,type /*2-DH3*/ + arg 367,temp + isub temp,null + nrtn positive + force type_dm5,type /*2-DH5*/ + arg 679,temp + isub temp,null + nrtn positive + force type_dh5,type /*3-DH5*/ + rtn + + +/******************************************/ +/*********** Receive Packet *************/ +/******************************************/ + + + +slave_receive_master_slot: + fetch 1,mem_state + bbit0 state_insniff,slave_receive_notsniff + fetch 2,mem_tsniff + branch slave_receive_notsniff,blank /* role switch */ + nbranch slave_receive_sniff,attempt +slave_receive_notsniff: + call rf_setup_time_master_slot +slave_receive_access: + add clke_bt,1,bt_clk +slave_receive_sniff: + enable swfine + fetch 2,mem_rx_window + rshift pdata,pdata + arg param_pll_setup,temp + iadd temp,pdata + call ahead_window + call fetch_extm_bt_adr + force 0x03,freq_mode /* connection hop */ + call rx_radio_freq + call init_rx_packet_flags + call prep_crypt + bpatch patch0a_0,mem_patch0a + fetch 2,mem_rx_window + rshift pdata,pdata + call ahead_window + call start_receiver + enable decode_fec0 + fetch 2,mem_rx_window + arg param_clke_cal,temp + iadd temp,stop_watch + correlate null,timeout + copy clke,temp + storet 6,mem_sync_clke + disable decode_fec0 + nrtn sync + arg param_clke_cal,clke_rt + copy bt_clk,clke_bt + branch lpm_adjust_clk,wake + rtn + + +slave_conn_recv_packet: + bpatch patch0a_1,mem_patch0a + call slave_receive_master_slot + nbranch shutdown_radio,sync + call save_rssi + bmark0 mark_testmode,receive_packet + fetch 2,mem_tst_pktcnt_sync + increase 1,pdata + store 2,mem_tst_pktcnt_sync +receive_packet: + rshift bt_clk,temp + or temp,0x40,white_init +receive_packet_whitened: + bpatch patch0a_2,mem_patch0a + enable enable_white + enable enable_hec + enable decode_fec1 + parse demod,bucket,3 /* get am_addr */ + rshift8 pwindow,pdata + store 1,mem_temp_am_addr + parse demod,bucket,4 /* get type */ + inject bucket,7 /* align up to pwindow */ + copy pwindow,pdata + store 1,mem_rx_type + parse demod,bucket,3 /* get arq */ + rshift8 pwindow,pdata + store 1,mem_temp_arq + fetch 1,mem_rx_type + sub pdata,3,null + branch receive_packet_noedr,positive + beq 7,receive_packet_noedr /* esco packet */ + fetch 1,mem_state_map + isolate1 smap_edr,pdata + setflag true,PSK,radio_ctrl +receive_packet_noedr: + bpatch patch0a_3,mem_patch0a + parse demod,bucket,8 /* cycle thru hec */ + disable decode_fec1 + disable enable_hec /* at this moment, 1 seqn + 8 hec is in shift */ + branch error_header,crc_failed /* if hec error, nothing is valid */ + bmark0 mark_testmode,receive_packet_amchk + fetch 2,mem_tst_pktcnt_hec + increase 1,pdata + store 2,mem_tst_pktcnt_hec +receive_packet_amchk: + bpatch patch0a_4,mem_patch0a + fetch 1,mem_temp_am_addr + compare 0,pdata,0x07 /* check for broadcast */ + setflag true,mark_am_addr_broadcast,mark /* received a broadcast message, can fire ar_addr if during unpark_req */ + branch am_addr_ok,true + icompare 0x07,am_addr + branch am_addr_match,true + bmark0 mark_esco,end_of_packet + fetcht 1,mem_saved_amaddr + icompare 0x7,temp + nbranch end_of_packet,true + fetch 1,mem_arq /* mem_arq + am_addr */ + set0 arqnx,pdata + set1 flowx,pdata + store 1,mem_arq +am_addr_match: + enable match +am_addr_ok: + bpatch patch0a_5,mem_patch0a + fetch 1,mem_rx_type + icopy type + bmark1 mark_am_addr_broadcast,arqn_bypass /* arqn doesn't make sense */ + fetcht 1,mem_temp_arq + fetch 1,mem_arq + set0 flow,pdata + isolate1 flow,temp + setflag true,flow,pdata + isolate1 arqn,temp + setflag true,arqn,pdata + store 1,mem_arq + isolate0 arqn,temp + branch arqn_bypass,true + call clear_got_tx +arqn_bypass: + bpatch patch0a_6,mem_patch0a + arg 0,temp + call reserve_slot + and type,0xf,pdata + beq type_poll,process_poll + beq type_null,end_of_packet /* null */ + beq type_fhs,process_fhs + fetcht 1,mem_temp_arq + fetch 1,mem_arq + icompare 0x04,temp /* bit 2 is seqn */ + nbranch rx_type_dispatch,true /* different then it's new */ + bmark0 mark_am_addr_broadcast,failed_seqn /* seqn failed, and not broadcast */ + bbit0 bcast1,rx_type_dispatch /* first broadcast never fail seqn */ +failed_seqn: + set1 mark_old_packet,mark +rx_type_dispatch: + bpatch patch0a_7,mem_patch0a + deposit type + beq type_dm1, process_dm1 + beq type_dh1, process_dh1 + beq type_hv3, process_hev + beq type_3dh1, process_3dh1 + arg 4,temp + call reserve_slot + beq type_dm3, process_dm3 + beq type_dh3, process_dh3 + arg 8,temp + call reserve_slot + beq type_dm5, process_dm5 + beq type_dh5, process_dh5 + rtn + + +process_hev: + bpatch patch0b_0,mem_patch0b + enable decode_fec0 + enable enable_crc + enable encrypt + arg mem_sco_ibuf,contw + force 30,loopcnt +process_hev_loop: + parse demod,bucket,8 + rshift3 pwindow,pdata + istore 1,contw + loop process_hev_loop + bmark0 mark_esco,end_of_packet + parse demod,bucket,16 /* cycle through the crc */ + nsetflag crc_failed,mark_esco_rxok,mark + branch error_payload,crc_failed + branch ack_payload + + +process_poll: + branch end_of_packet + +process_dm3: +process_dm5: + set1 mark_longpacket,mark +process_dm1: + enable decode_fec2 + branch process_dmh + +process_dh3: +process_dh5: + set1 mark_longpacket,mark +process_3dh1: + set1 PSK3M,radio_ctrl +process_dh1: + enable decode_fec0 +process_dmh: + bpatch patch0b_1,mem_patch0b + bmark1 mark_rxbuf_inuse,end_of_packet /* buffer in use, nack */ + isolate0 PSK,radio_ctrl + branch process_dmh_noedr,true + disable enable_white + enable decode_fec0 + disable decode_fec2 + add clkn_bt,2,timeup + correlate clkn_bt,meet + nbranch error_payload,sync + set1 mark_longpacket,mark + enable enable_white +process_dmh_noedr: + bpatch patch0b_2,mem_patch0b + enable encrypt + enable enable_crc + parse demod,bucket,3 /* parse in lch+l2cap flow */ + rshift8 pwindow,pdata + store 1,mem_lch_code /* for loopback */ + parse demod,bucket,5 /* parse in 5 bit packetlength */ + bmark1 mark_longpacket,process_dmh_long + rshift3 pwindow,loopcnt + rshift3 loopcnt,loopcnt + branch process_dmh_common +process_dmh_long: + parse demod,bucket,5 /* multi slot packet length of dh3 dh5 dm3 dm5 */ + rshift pwindow,loopcnt + parse demod,bucket,3 /* undefined+bit 9 of length */ +process_dmh_common: + bpatch patch0b_3,mem_patch0b + deposit loopcnt + store 2,mem_len + branch process_dmh_data_end,blank + isub mask3ff,null + branch error_payload,positive /* packet too large, discard */ + bpatch patch0b_4,mem_patch0b + set0 mark_fhs_eir,mark + fetch 1,mem_lch_code + and_into 0x03,pdata + arg mem_rxbuf,contw //lmp_data or test packet + beq LLID_LMP,process_lmp + bmark1 mark_testmode,process_dmh_data + //non-HCI mode + fetch 1,mem_lch_code + and_into 0x03,pdata + beq LLID_L2CAP_START,process_dmh_data_l2cap_start_pkt + beq LLID_L2CAP_CONT,process_dmh_data_l2cap_continue_pkt + branch error_payload + +process_lmp: + fetch 2,mem_len + sub pdata,0x70,null //lmp buffer size + nbranch error_payload,positive + bmark1 mark_old_packet,ack_payload + branch process_dmh_data + + +process_dmh_data_l2cap_start_pkt: + bpatch patch0b_5,mem_patch0b + bmark1 mark_old_packet,ack_payload + fetch 2,mem_len + arg 0x2e0,temp //l2cap buffer size + isub temp,null + branch error_payload,positive + fetch 1,mem_l2cap_rxbuff_inuse + bbit0 L2CAP_INUSE_BUFF1,process_dmh_data_into_buff1 + bbit0 L2CAP_INUSE_BUFF2,process_dmh_data_into_buff2 + branch end_of_packet +process_dmh_data_into_buff1: + jam 1,mem_l2cap_rxbuff_new //new data in buff 1 + fetch 2,mem_l2cap_rxbuff1_len + bne 0,end_of_packet //baseband head error + arg mem_l2cap_rxbuff1,contw + branch process_dmh_data +process_dmh_data_into_buff2: + jam 2,mem_l2cap_rxbuff_new //new data in buff 2 + fetch 2,mem_l2cap_rxbuff2_len + bne 0,end_of_packet + arg mem_l2cap_rxbuff2,contw + branch process_dmh_data + +process_dmh_data_l2cap_continue_pkt: + bpatch patch0b_6,mem_patch0b + bmark1 mark_old_packet,ack_payload + fetch 2,mem_len + arg 0x2e0,temp //l2cap buffer size + isub temp,null + branch error_payload,positive + fetch 1,mem_l2cap_rxbuff_new + beq 1,process_dmh_data_l2cap_continue_pkt1 + beq 2,process_dmh_data_l2cap_continue_pkt2 + branch end_of_packet +process_dmh_data_l2cap_continue_pkt1: + arg mem_l2cap_rxbuff1,contw + fetch 2,mem_l2cap_rxbuff1_len + iadd contw,contw + branch process_dmh_data +process_dmh_data_l2cap_continue_pkt2: + arg mem_l2cap_rxbuff2,contw + fetch 2,mem_l2cap_rxbuff2_len + iadd contw,contw +process_dmh_data: + parse demod,bucket,8 + rshift3 pwindow,pdata + istore 1,contw + loop process_dmh_data +process_dmh_data_end: + bpatch patch0b_7,mem_patch0b + parse demod,bucket,16 /* cycle through the crc */ + branch error_payload_crc,crc_failed + fetch 1,mem_l2cap_flow_ctrl_flag + beq L2CAP_FLOW_CTRL_ENABLE,end_of_packet + bmark1 mark_testmode,process_dmh_cont + bmark1 mark_old_packet,redundant_payload + fetch 1,mem_lch_code + compare 3,pdata,3 + branch process_dmh_cont,true + fetch 2,mem_len + branch process_dmh_cont,blank + bpatch patch0c_0,mem_patch0c + fetch 1,mem_l2cap_rxbuff_new + beq 1,process_l2cap_pass_crc_buff1 + beq 2,process_l2cap_pass_crc_buff2 + branch assert +process_l2cap_pass_crc_buff1: + fetch 2,mem_l2cap_rxbuff1_len + fetcht 2,mem_len + iadd temp,pdata + store 2,mem_l2cap_rxbuff1_len + beq 0,assert + fetcht 2,mem_l2cap_rxbuff1// l2cap payload length + increase 4,temp + isub temp,null + call l2cap_buff1_inuse,zero //l2cap pkts not ended + branch process_dmh_cont +process_l2cap_pass_crc_buff2: + fetch 2,mem_l2cap_rxbuff2_len + fetcht 2,mem_len + iadd temp,pdata + store 2,mem_l2cap_rxbuff2_len + beq 0,assert + fetcht 2,mem_l2cap_rxbuff2// l2cap payload length + add temp,4,temp + isub temp,null + call l2cap_buff2_inuse,zero //l2cap pkts not ended + branch process_dmh_cont +process_dmh_cont: + bpatch patch0c_1,mem_patch0c + fetcht 1,mem_state_map + fetch 1,mem_lch_code + compare 3,pdata,0x03 + setflag true,smap_rxlmp,temp + nsetflag true,smap_rxl2cap,temp + storet 1,mem_state_map + nbranch process_dmh_cont_rxbuf_not_use,true + set1 mark_rxbuf_inuse,mark +process_dmh_cont_rxbuf_not_use: + bmark0 mark_testmode,ack_payload + isolate1 smap_rxlmp,temp + branch ack_payload,true + fetch 2,mem_tst_pktcnt_crc + increase 1,pdata + store 2,mem_tst_pktcnt_crc + set1 mark_loopback,mark + set0 smap_rxl2cap,temp + set0 mark_rxbuf_inuse,mark + storet 1,mem_state_map +ack_payload: + bpatch patch0c_2,mem_patch0c + fetcht 1,mem_temp_arq + fetch 1,mem_arq + set1 arqnx,pdata + isolate1 seqn,temp /* if accept, seqn always copies from the header */ + setflag true,seqn,pdata + isolate1 mark_am_addr_broadcast,mark + setflag true,bcast1,pdata + store 1,mem_arq + fetch 2,mem_len + nbranch end_of_packet,blank + fetch 1,mem_state_map + set0 smap_rxl2cap,pdata//better to do this in l2cap_flow_ctrl_stop + store 1,mem_state_map + fetch 1,mem_lch_code + compare 0x01,pdata,0x07 + //call l2cap_flow_ctrl_stop,true + branch end_of_packet + +error_header: + bpatch patch0c_3,mem_patch0c + disable match + fetch 2,mem_rx_hec_err + increase 1,pdata + store 2,mem_rx_hec_err + branch end_of_packet +error_payload_crc: + fetch 2,mem_rx_crc_err + increase 1,pdata + store 2,mem_rx_crc_err + call discard_pkt + bmark0 mark_testmode,error_payload + set1 mark_loopback,mark +error_payload: + branch end_of_packet + +discard_pkt: + bpatch patch0c_4,mem_patch0c + fetch 1,mem_lch_code + compare 3,pdata,0x03 + nbranch discard_pkt_l2cap,true +discard_pkt_lmp: + fetcht 1,mem_state_map + set0 smap_rxlmp,temp + storet 1,mem_state_map + rtn +discard_pkt_l2cap: +// isolate1 mark_testmode,mark +// setflag true,mark_loopback,mark + fetcht 1,mem_state_map + set0 smap_rxl2cap,temp + storet 1,mem_state_map + rtn + +redundant_payload: + fetch 1,mem_arq + set1 arqnx,pdata + store 1,mem_arq +end_of_packet: + bpatch patch0c_5,mem_patch0c + disable encode_fec0 + disable encode_fec2 + disable decode_fec0 + disable decode_fec2 + disable enable_crc + disable encrypt + disable enable_white + branch shutdown_radio,is_rx + until null,tx_clear + nop 100 /* flush out the last bit */ + branch shutdown_radio + +process_fhs: + bpatch patch0c_6,mem_patch0c + enable enable_crc + enable decode_fec2 + parse demod,bucket,72 + isolate1 58,pdata + setflag true,mark_fhs_eir,mark + copy bt_adr,temp /* save current address to aside */ + ialigned bt_adr /* send it to access gen */ + ialigned fhs0 /* get fhs_misc */ + pulse recalc /* calc the lap just received from the other guy */ + setsect 2,0xfffff /* preset ms of shift reg as big mask */ + setsect 3,0x0ffff /* preset ms of shift reg as big mask */ + nop 32 /* 30 cycles after recalc */ + iverify fhs_parity /* check fhs_parity against ls 34 bits at shift reg, with msb 36 bits as mask */ + deposit lap + store 3,extm_lap + deposit uap + store 1,extm_uap + copy temp,bt_adr /* put the address back */ + branch fhs_parity_ok,true /* fhs parity failed */ + branch error_payload +fhs_parity_ok: + bpatch patch0c_7,mem_patch0c + parse demod,bucket,72 + ialigned fhs1 /* give host the information on class and fhs_misc */ + ialigned am_addr /* store the am_addr the master assigned us */ + ialigned nap + ialigned regb /* store external clock in regb according to clock format */ + force 0,pdata + parse demod,bucket,16 /* cycle through the crc */ + branch error_payload,crc_failed + setarg 0x0ffffffc + iand regb,pdata + store 4,mem_clke_bt + deposit fhs_class + store 3,extm_class + deposit fhs_misc + store 1,extm_fhs_misc + deposit am_addr + store 1,extm_newconn_am_addr + deposit nap + store 2,extm_nap + deposit bt_clk + inject rxf,32 + compare type_fhs,type,0x0f /* see if this was fhs packet */ + setflag true,mark_fhs_already_good,mark + branch end_of_packet + +clear_got_tx: + bpatch patch0d_0,mem_patch0d + fetch 1,mem_arq + rtnbit0 wack + set0 wack,pdata + setflip seqnx,pdata + store 1,mem_arq + fetch 1,mem_last_type + beq type_lmp,clear_got_txlmp + rtneq type_hv3 + fetch 1,mem_op + rtnbit0 op_txl2cap,pdata + set0 op_txl2cap,pdata + set1 op_pkt_comp,pdata + store 1,mem_op + set0 mark_tx_l2cap,mark + fetch 2,mem_l2cap_tx_multi_offset + nrtn blank + fetch 1,mem_op + set0 op_pkt_comp,pdata + store 1,mem_op + branch l2cap_malloc_free + +clear_got_txlmp: + bpatch patch0d_1,mem_patch0d + fetch 1,mem_lmo_header_opcode + rshift pdata,pdata + beq LMP_START_ENCRYPTION_REQ,start_encryption + beq LMP_STOP_ENCRYPTION_REQ,stop_encryption + beq LMP_UNSNIFF_REQ, sniff_exit + beq LMP_ESCAPE,clear_lmp_escape + rtnne LMP_ACCEPTED + fetch 1,mem_lmo_payload + beq LMP_SCO_LINK_REQ,sco_link_req_by_slave + beq LMP_START_ENCRYPTION_REQ,clear_send_setup_complete + rtn + +clear_lmp_escape: + fetch 1,mem_lmo_payload + set1 7,pdata + rtn +clear_send_setup_complete: + rtn master + fetch 1,mem_state + rtnbit1 state_conn_comp + jam LMP_SETUP_COMPLETE,mem_lmo_opcode2 + rtn + +// nokia BH-105 CALLING when reconnection +sco_link_req_by_slave: + rtn master + fetch 1,mem_mode + isolate1 send_sco_when_slave,pdata + branch clean_mem_mode,true + //jam LMP_REMOVE_SCO_LINK_REQ,mem_lmo_opcode2 + rtn +clean_mem_mode: + set0 send_sco_when_slave,pdata + store 1,mem_mode + rtn + +start_encryption: + bpatch patch0d_2,mem_patch0d + fetch 1,mem_state_map + set1 smap_encryption,pdata + store 1,mem_state_map + hjam 1,core_encrypt + fetch 1,mem_state + isolate1 state_conn_comp,pdata + rtn + +stop_encryption: + bpatch patch0d_3,mem_patch0d + fetch 1,mem_state_map + set0 smap_encryption,pdata + store 1,mem_state_map + hjam 0,core_encrypt + rtn + + +sniff_init: + bpatch patch0d_4,mem_patch0d + copy clkn_bt,pdata + store 4,mem_lpm_delay_after_sniff + add clkn_bt,3,rega + branch sniff_init_master,master + add clke_bt,3,rega +sniff_init_master: + fetcht 2,mem_tsniff + deposit rega + set0 27,pdata + idiv temp + fetch 2,mem_dsniff + call wait_div_end + remainder regc + isub regc,pdata + branch sniff_init_nowrap,positive + iadd temp,pdata +sniff_init_nowrap: + iadd rega,pdata + store 4,mem_sniff_anchor + jam SWITCH_FLAG_INIT,mem_switch_flag + fetch 1,mem_state + set1 state_insniff,pdata + store 1,mem_state + fetch 1,mem_sniff_attempt + store 1,mem_current_sniff_attempt + setarg 0 + store 3,mem_sniff_rcv + store 3,mem_sniff_lost + store 1,mem_sniff_unint_lost + jam BT_EVT_ENTER_SNIFF,mem_fifo_temp + call ui_ipc_send_event + fetch 2,mem_rx_window_sniff + store 2,mem_rx_window + nrtn master + add am_addr,-1,queue + rtn + +sniff_exit: + bpatch patch0d_5,mem_patch0d + fetch 1,mem_state + rtnbit0 state_insniff + set0 state_insniff,pdata + store 1,mem_state + fetch 2,mem_rx_window_init + store 2,mem_rx_window + disable wake + jam BT_EVT_EXIT_SNIFF,mem_fifo_temp + branch ui_ipc_send_event + + +check_attempt: + bpatch patch0d_6,mem_patch0d + enable attempt + fetch 1,mem_state + bbit1 state_insniff,check_attempt_sniff + rtnmark1 mark_testmode /* pdata won't be blank now, try attempt */ + fetch 1,mem_arq + rtnbit1 wack + fetch 1,mem_lmp_to_send + nrtn blank + fetch 1,mem_op + rtnbit1 op_txl2cap +check_attempt_nomore: + force 0,pdata + rtn + +check_attempt_sniff: + bbit0 state_insco,check_attempt_not_sco + fetch 1,mem_current_sniff_attempt + beq 2,check_attempt_sniff_restore_sco + fetch 1,mem_arq + bbit1 wack,check_attempt_notimeout + bmark0 mark_esco_rxok,check_attempt_notimeout +check_attempt_sniff_restore_sco: + nbranch check_attempt_notimeout,master + fetch 1,mem_lmp_to_send + nbranch check_attempt_notimeout,blank +check_attempt_sco_master: + fetch 1,mem_sco_poll + increase -1,pdata + store 1,mem_sco_poll + nbranch check_attempt_nomore,blank + jam param_sco_poll,mem_sco_poll + branch check_attempt_notimeout + + + + + + +check_attempt_not_sco: + fetch 1,mem_current_sniff_attempt + bne 1,check_attempt_notimeout + fetch 1,mem_current_sniff_timeout + branch check_attempt_notimeout,blank + increase -1,pdata + store 1,mem_current_sniff_timeout + fetch 1,mem_arq + rtnbit1 wack // waiting for next ack + nrtn match // waiting for next poll +check_attempt_notimeout: + fetch 1,mem_current_sniff_attempt + increase -1,pdata + store 1,mem_current_sniff_attempt + rtn + + + + + + + + + + /* enable user if sniff window vialation, queue is extra overhead */ +sniff_check_window: + bpatch patch0d_7,mem_patch0d + disable swfine + copy temp,stop_watch + call context_search_sniff_window + disable user + nrtn zero + force 0,stop_watch + enable user + rtn + + //return true if it is esco context +check_esco_amaddr: + fetch 1,mem_esco_addr + icompare 0xff,am_addr + rtn + + +parse_l2cap: + bpatch patch0e_0,mem_patch0e + set0 mark_rxbuf_inuse,mark +parse_l2cap_cont: + jam L2CAP_RX_CLEAR,mem_l2cap_rx_done + fetch 1,mem_l2cap_rxbuff_inuse + rtn blank + isolate1 L2CAP_INUSE_BUFF1,pdata + arg mem_l2cap_rxbuff1,contr + call process_rx_l2cap_pkt,true + bpatch patch0e_1,mem_patch0e + fetch 1,mem_l2cap_rx_done + beq L2CAP_RX_DONE,parse_l2cap_release_buff1 + + jam L2CAP_RX_CLEAR,mem_l2cap_rx_done + fetch 1,mem_l2cap_rxbuff_inuse + rtnbit0 L2CAP_INUSE_BUFF2 + arg mem_l2cap_rxbuff2,contr + call process_rx_l2cap_pkt + fetch 1,mem_l2cap_rx_done + beq L2CAP_RX_DONE,parse_l2cap_release_buff2 + rtn + +parse_l2cap_release_buff1: + fetch 1,mem_l2cap_rxbuff_inuse + set0 L2CAP_INUSE_BUFF1,pdata + store 1,mem_l2cap_rxbuff_inuse + setarg 0 + store 2,mem_l2cap_rxbuff1_len + rtn +parse_l2cap_release_buff2: + fetch 1,mem_l2cap_rxbuff_inuse + set0 L2CAP_INUSE_BUFF2,pdata + store 1,mem_l2cap_rxbuff_inuse + setarg 0 + store 2,mem_l2cap_rxbuff2_len + rtn + +l2cap_buff1_inuse: + fetch 1,mem_l2cap_rxbuff_inuse + set1 L2CAP_INUSE_BUFF1,pdata + store 1,mem_l2cap_rxbuff_inuse + rtn + +l2cap_buff2_inuse: + fetch 1,mem_l2cap_rxbuff_inuse + set1 L2CAP_INUSE_BUFF2,pdata + store 1,mem_l2cap_rxbuff_inuse + rtn + +/******************************************/ +/********** Transmit Packet *************/ +/******************************************/ + +slave_send_access: + bpatch patch0e_2,mem_patch0e + add clke_bt,1,bt_clk /* slave start to use native clock */ + call fetch_extm_bt_adr + force 0x03,freq_mode /* connection frequency */ + call tx_radio_freq + call start_transmitter + call start_tx_external + branch send_access_word + + +slave_conn_send_packet: + bpatch patch0e_3,mem_patch0e + call rf_setup_time_slave_slot + deposit clke_bt + fetcht 4,mem_next_btclk + isub temp,pdata + rtnne 1 /* missed slave slot */ + compare type_null,type,0x1f + nbranch slave_conn_send_access,true + fetch 1,mem_rx_type + rtn blank /* null packet, do nothing */ +slave_conn_send_access: + call slave_send_access +transmit_packet: + compare type_id,type,0x1f /* is this id only ? */ + branch end_of_packet,true + rshift bt_clk,temp + or temp,0x40,white_init +transmit_packet_whitened: + bpatch patch0e_4,mem_patch0e + enable enable_white + enable enable_hec + enable encode_fec1 + set0 mark_longpacket,mark + deposit am_addr + inject mod,3 /* am_addr, temp is disabled */ + deposit type + inject mod,4 + fetch 1,mem_arq /* aka mem_arq */ + inject bucket,4 /* align up to flowx, arqnx, seqnx */ + inject mod,3 + enable enable_parity + inject mod,8 /* transmit parity */ + disable encode_fec1 + disable enable_parity + disable enable_hec + set0 PSK3M,radio_ctrl + arg 0,temp + call reserve_slot + bpatch patch0e_5,mem_patch0e + and type,0x1f,pdata + beq type_lmp, transmit_lmp + beq type_null, end_of_packet + beq type_poll, end_of_packet + beq type_fhs, transmit_fhs /* master mode fhs need got_tx and ack */ + beq type_dm1, transmit_dm1 + beq type_dh1, transmit_dh1 + beq type_hv3, transmit_hev + beq type_3dh1, transmit_3dh1 + arg 4,temp + call reserve_slot + beq type_dm3, transmit_dm3 + beq type_dh3, transmit_dh3 + arg 8,temp + call reserve_slot + beq type_dh5, transmit_dh5 + branch transmit_dm5 /* must be 14, dm5 */ + + +transmit_hev: + bpatch patch0e_6,mem_patch0e + enable encode_fec0 + enable enable_crc + enable encrypt + force 30,loopcnt + arg mem_sco_obuf,contr +transmit_ev_loop: + ifetch 1,contr + inject mod,8 + loop transmit_ev_loop + bmark1 mark_esco,transmit_end + branch end_of_packet + +transmit_fhs: + bpatch patch0e_7,mem_patch0e + fetch 1,mem_fhs_am_addr /* this is the am_addr to assign to slave */ + icopy am_addr + fetch 1,mem_fhs_misc + icopy fhs_misc /* [7:6]SR [5:4]SP [3:1]PS [0]undef */ + fetch 3,mem_class /* store away class */ + icopy fhs_class + fetch 2,mem_nap + icopy nap + enable enable_crc + enable encode_fec2 + copy bt_adr,rega + call fetch_self_bt_adr + pulse recalc + nop 32 /* 30 cycles after recalc for sync word generation */ + copy bt_clk,timeup + fetch 4,mem_clkn_bt + icopy bt_clk + preload fhs0 + set1 58,pdata /* eir */ + inject mod,72 + preload fhs1 + inject mod,72 + copy timeup,bt_clk + copy rega,bt_adr + enable enable_parity + inject mod,16 /* generate CRC */ + disable enable_parity + branch end_of_packet + +transmit_lmp: /* expect the payload ready as in bb spec */ + bpatch patch0f_0,mem_patch0f + enable encrypt + enable enable_crc + enable encode_fec2 + fetch 1,mem_lmo_header_length /* this is the payload header */ + and pdata,0x1f8,temp /* temp is number of bits, check payload header format */ + arg mem_lmo_header_length,contr + increase 8,temp /* temp is in bits */ +transmit_lmp_loop: + add temp,-72,regc /* regc is remainder */ + nbranch transmit_lmp_finish,positive + ifetch 9,contr + inject mod,72 + copy regc,temp + branch transmit_lmp_loop +transmit_lmp_finish: + ifetch 9,contr + iinject mod,temp + branch transmit_end + +transmit_dm1: + enable encode_fec2 + branch transmit_dmh +transmit_dm3: +transmit_dm5: + enable encode_fec2 + set1 mark_longpacket,mark + branch transmit_dmh + +transmit_3dh1: + set1 PSK3M,radio_ctrl +transmit_dh1: + enable encode_fec0 + branch transmit_dmh + +transmit_dh3: +transmit_dh5: + set1 PSK3M,radio_ctrl + enable encode_fec0 + set1 mark_longpacket,mark + +transmit_dmh: + bpatch patch0f_1,mem_patch0f + fetch 1,mem_state_map + bbit0 smap_edr,transmit_noedr + sub type,3,null + branch transmit_noedr,positive + disable encrypt + disable encode_fec2 + enable encode_fec0 + disable enable_white + set1 PSK,radio_ctrl + isolate1 PSK3M,radio_ctrl + branch transmit_edr3m,true + setarg 0xabeee + inject mod,20 + branch transmit_edr_sync_end +transmit_edr3m: + setarg 0x5faeba + inject mod,24 + setarg 0x12 + inject mod,6 +transmit_edr_sync_end: + enable enable_white + set1 mark_longpacket,mark +transmit_noedr: + enable encrypt + enable enable_crc + bmark1 mark_loopback,transmit_loopback + fetch 1,mem_tx_lch + inject mod,3 + fetch 2,mem_tx_len + iforce loopcnt + bmark1 mark_longpacket,transmit_long + inject mod,5 + branch transmit_stuff +transmit_long: + inject mod,13 +transmit_stuff: + deposit loopcnt + branch transmit_end,blank + fetch 2,mem_txptr + iforce contr +transmit_stuff_loop: + ifetch 1,contr + inject mod,8 + loop transmit_stuff_loop +// branch transmit_end + +transmit_end: + enable enable_parity + inject mod,16 + disable enable_parity + call set_wait_ack + fetch 1,mem_state_map + bbit0 smap_edr,end_of_packet + force 0,pdata + inject mod,6 /* edr trailer */ + branch end_of_packet + + +transmit_loopback: + bpatch patch0f_2,mem_patch0f + bmark1 mark_longpacket,transmit_loopback_long +transmit_loopback_short: + fetch 1,mem_lch_code + inject mod,3 /* LLID and FLOW */ + fetch 1,mem_len /* take packet length */ + iforce regc + inject mod,5 + branch transmit_loopback_cont +transmit_loopback_long: + fetch 1,mem_lch_code + inject mod,3 /* LLID and FLOW */ + fetch 2,mem_len /* take packet length */ + iforce regc + inject mod,13 +transmit_loopback_cont: + arg mem_rxbuf,contr +transmit_loopback_loop: + copy regc,null + branch transmit_loopback_end,zero + ifetch 1,contr + inject mod,8 + increase -1,regc + branch transmit_loopback_loop +transmit_loopback_end: + fetch 2,mem_tst_pktcnt_dmh + increase 1,pdata + store 2,mem_tst_pktcnt_dmh + branch transmit_end + + +apply_switch_clke: + fetch 4,mem_clke_bt + add pdata,7,rega + fetch 2,mem_slot_offset + nbranch apply_switch_nozero,blank + increase -3,rega + branch apply_switch_wait_loop +apply_switch_nozero: + mul32 pdata,12,pdata + fetcht 2,core_rthalfslot + increase 1,temp +apply_switch_loop: + isub temp,pdata + nbranch apply_switch_bt,positive + increase -1,rega + branch apply_switch_loop +apply_switch_bt: + sub pdata,0,pdata +apply_switch_wait_loop: + until null,oneslot + compare 0,clkn_bt,3 + nbranch apply_switch_wait_loop,true + iforce clke_rt + copy rega,clke_bt + iforce clke_rt + rtn + + +calc_slot_offset: + bpatch patch0f_3,mem_patch0f + until null,halfslot + deposit clke + iforce contr + rshift16,pdata,pdata + isub clkn_bt,loopcnt + and_into 3,loopcnt /* bt portion */ + nbranch calc_bt_portion,zero + force 0,pdata + branch calc_skip_bt +calc_bt_portion: + arg 3750,temp + force 0,pdata +calc_slot_offset_loop: + iadd temp,pdata + loop calc_slot_offset_loop +calc_skip_bt: + iadd contr,pdata /* add rt portion */ + div pdata,12 + call wait_div_end + quotient pdata + store 2,mem_slot_offset + rtn + +calc_clke_offset: + bpatch patch0f_4,mem_patch0f + deposit clke + copy clkn,temp + isub temp,null + nsetflag positive,44,pdata + isub temp,temp + setarg 3750 + isolate0 15,temp + branch calc_clke_pos,true + setarg -61786 + iadd temp,temp +calc_clke_pos: + storet 6,mem_le_clk_offset + rtn le + storet 6,mem_clk_offset + rtn + +calc_clke: + disable clknt + fetch 6,mem_le_clk_offset + branch calc_clke2,le + fetch 6,mem_clk_offset +calc_clke2: + iadd clkn,alarm + increase 10,alarm + setarg 3750 + isub alarm,pdata + isolate0 15,pdata + branch calc_clke_pos_adj,true + setarg 0xf15a + iadd alarm,alarm +calc_clke_pos2: + copy alarm,clke + rtn +calc_clke_pos_adj: /* add 2 clock */ + force 0,null + branch calc_clke_pos2 + +/******************************************/ +/********* RF related functions ***********/ +/******************************************/ + + +calc_radio_freq: + bpatch patch0f_5,mem_patch0f + call set_sync_on + copy bt_clk,pdata + and_into 0x180,pdata + compare 3,freq_mode,0x07 + nbranch freq_not_connection,true /* don't do the hack if not in connection */ + rshift3 pdata,pdata + iadd freq_index,pdata + branch do_hop_mod_now +freq_not_connection: + copy freq_index,pdata +do_hop_mod_now: + div pdata,79 + pulse recalc /* now is good time to recalc id */ + call wait_div_end + remainder rega + add rega,-40,temp + branch odd_half,positive + lshift rega,temp + branch freq_result +odd_half: + lshift temp,temp + increase 1,temp +freq_result: + bpatch patch0f_6,mem_patch0f + fetch 1,mem_mode + bbit0 afh_change,afh_process_con +afh_process_0: + fetch 4, mem_afh_instant + isub bt_clk, null + branch afh_process_con,positive + call afh_clear + fetch 1,mem_afh_new_mod + rtn blank + fetch 1,mem_mode + set1 afh_enable,pdata + store 1,mem_mode + fetch 5,mem_afh_map_new + store 5,mem_afh_map_lo + ifetch 5,contr + store 5,mem_afh_map_hi + call afh_process_freq_map +afh_process_con: + fetch 1,mem_mode + rtnbit0 afh_enable + isolate1 1,bt_clk + branch afh_same_channel,true /* at odd slot, use the same as last even */ + rshift3 temp,rega + and temp,7,queue + setarg mem_afh_map_lo + iadd rega, rega + ifetch 1, rega + qisolate0 pdata + branch afh_process_1,true /* not in map, do afh */ + deposit temp + branch afh_process_end +afh_process_1: + fetch 1, mem_afh_used + iforce regb + deposit bt_clk + and_into 0x180, pdata + rshift3 pdata,pdata + iadd freq_index,pdata + idiv regb + setarg mem_afh_map + call wait_div_end + remainder rega + iadd rega,contr + ifetch 1,contr +afh_process_end: + store 1,mem_afh_index + iforce temp + rtn + +afh_same_channel: + fetch 1, mem_afh_index /* last afh index */ + iforce temp + rtn + +afh_clear: + fetch 1,mem_mode + set0 afh_enable,pdata + set0 afh_change,pdata + store 1,mem_mode + rtn +/* +fixed_frequency: + fetcht 1,mem_fixed_freq + rtn +*/ +afh_process_freq_map: + bpatch patch0f_7,mem_patch0f + arg mem_afh_map,contw + force 10,loopcnt + call memset0 + arg mem_afh_map,contw + force 0,regC + force 2,queue +process_freq_3: + fetch 5,mem_afh_map_lo + iforce temp + compare 2,queue,0xff + branch process_freq_1,true + rshift temp,temp +process_freq_1: + isolate0 0,temp + branch process_freq_0,true + deposit regC + istore 1,contw +process_freq_0: + rshift2 temp,temp + increase 2,regC + compare 40,regC,0xfe + nbranch process_freq_2,true + fetch 5,mem_afh_map_hi + iforce temp + compare 2,queue,0xff + branch process_freq_2,true + rshift temp,temp +process_freq_2: + sub regC,78,null + branch process_freq_1,positive + force 1,regC + increase -1,queue + nbranch process_freq_3,zero + arg mem_afh_map,rega + deposit contw + isub rega,pdata + store 1,mem_afh_used + rtn + +rx_radio_freq: + bpatch patch10_0,mem_patch10 + call calc_radio_freq + fetch 1,mem_debug_config + bbit0 debug_rx_fixed_freq,rx_radio_freq_now + fetcht 1,mem_rx_fixed_freq +rx_radio_freq_now: + branch set_freq_rx + + +tx_radio_freq: + bpatch patch10_1,mem_patch10 + call calc_radio_freq + fetch 1,mem_debug_config + bbit0 debug_tx_fixed_freq,tx_radio_freq_now + fetcht 1,mem_tx_fixed_freq +tx_radio_freq_now: + branch set_freq_tx + + +fetch_giac: + force 0,uap + fetch 3,mem_glap + iforce lap + rtn + +fetch_page_bt_adr: + bpatch patch10_2,mem_patch10 + fetch 1,mem_hci_puap + icopy uap + fetch 3,mem_hci_plap + icopy lap + rtn + +fetch_self_bt_adr: + bpatch patch10_3,mem_patch10 + fetch 2,mem_nap + icopy nap + fetch 1,mem_uap + icopy uap + fetch 3,mem_lap + icopy lap /* copy self_adr,bt_adr */ /* use own address */ + rtn + +fetch_extm_bt_adr: + bpatch patch10_4,mem_patch10 + fetch 2,mem_pnap + icopy nap + fetch 1,mem_puap + icopy uap + fetch 3,mem_plap + icopy lap + rtn + + +fetch_diac: + bmark1 mark_all_diac,fetch_diac_do + rtnmark0 mark_inquiry_state + rtnmark0 mark_periodical_diac +fetch_diac_do: + and_into -256,lap + pulse recalc + nop 32 + rtn + + +shutdown_radio: + bpatch patch10_5,mem_patch10 + branch shutdown_radio0,is_rx + hjam 0xd4, 0x955 + nop 4 + hjam 0xd2, 0x955 + nop 4 + hjam 0xd1, 0x955 + nop 4 + fetch 1,mem_tx_power + beq TX_POWER_0DB,shutdown_radio_0db + beq TX_POWER_3DB,shutdown_radio_3db + beq TX_POWER_5DB,shutdown_radio_5db + beq TX_POWER_f3DB,shutdown_radio_f3db + beq TX_POWER_f5DB,shutdown_radio_f5db + beq TX_POWER_PAIR,shutdown_radio_pair +shutdown_radio_5db: +shutdown_radio_0db: + hjam 0xd0, 0x955 + hjam 0xe0, 0x956 +shutdown_radio0: + force 0x08,radio_ctrl + force 0,radio_ctrl + disable is_rx + disable is_tx + pulse packet_end + hjam 0x0,rfen_mdm + hjam 0x0,rfen_tx + hjam 0x0,rfen_rx + hjam 0,rfen_sn + hjam 0x70,rfen_msc + hjam 0x0,rfen_adc + rtn + +shutdown_radio_pair: +shutdown_radio_f5db: +shutdown_radio_f3db: +shutdown_radio_3db: + hjam 0xd0,0x955 + hjam 0xc0,0x956 + branch shutdown_radio0 + +set_sync_on: + bpatch patch10_6,mem_patch10 + hjam 0x0,rfen_mdm /* if called from tx or rx */ + hjam 0x0,rfen_tx + hjam 0x18,rfen_rx + hjam 0xa7,rfen_sn + hjam 0x7f,rfen_msc + rtn + +set_freq_rx: + bpatch patch10_7,mem_patch10 + /* IF is +2MHz */ + storet 1,mem_last_freq + add temp,rx_freq_offset,rega /* index to frequency */ + hjam 0x07,0x96d /*Max added, for best sensitivity*/ + branch rf_write_freq +rf_rx_enable: + bpatch patch11_0,mem_patch11 + hjam 0xcf,rfen_tx + nop 10 /* wait adc clk48 ready */ + hjam 0xff,rfen_rx + hjam 0xaf,rfen_sn + hjam 0xff,rfen_msc + nop 10 + hjam 0xa0,rfen_mdm + rtn + +set_freq_tx_offset: + fetch 1,mem_250k_freq_enable //default: 0 + branch set_freq_tx_2M_offset,blank +set_freq_tx_0M_offset: + add temp,2,rega //250k + rtn +set_freq_tx_2M_offset: + add temp,0,rega // bt 2M Medium Frequency + rtn + +set_freq_tx: + bpatch patch11_1,mem_patch11 + storet 1,mem_last_freq + call set_freq_tx_offset + call rf_write_freq + setarg param_pll_setup + call sleep +txon: + hjam 0x1,rfen_adc + hjam 0x3c,rfen_rx + hjam 0xe0,rfen_tx + hjam 0x12,0x96d + nop 10 + hjam 0x01,rfen_mdm + hjam 0x3d,rfen_mdm + nop 10 + hjam 0xb7,rfen_sn + nop 10 + hjam 0x7f, rfen_mdm + fetch 1,mem_tx_power + beq TX_POWER_0DB,set_tx_power_0db + beq TX_POWER_3DB,set_tx_power_3db + beq TX_POWER_5DB,set_tx_power_5db + beq TX_POWER_f3DB,set_tx_power_f3db + beq TX_POWER_f5DB,set_tx_power_f5db + beq TX_POWER_PAIR,set_tx_power_pair +set_tx_power_0db: + hjam 0xf0,0x956 + call txon_common + hjam 0xd8,0x955 + rtn + +set_tx_power_3db: + hjam 0xdf,0x956 + call txon_common + hjam 0xdf,0x955 + rtn + +set_tx_power_5db: + hjam 0xff,0x956 + call txon_common + hjam 0xdf,0x955 + rtn +set_tx_power_f3db: + hjam 0xce,0x956 + call txon_common + hjam 0xd8,0x955 + rtn + +set_tx_power_f5db: + hjam 0xcb,0x956 + call txon_common + hjam 0xd8,0x955 + rtn + +set_tx_power_pair: + hjam 0xd0,0x955 + hjam 0xc0,0x956 + hjam 0x4c,0x957 + hjam 0x6c,0x958 + hjam 0x50,0x959 + rtn + +txon_common: + nop 4 + hjam 0xd1,0x955 + nop 4 + hjam 0xd2,0x955 + nop 4 + hjam 0xd4,0x955 + nop 4 + rtn + + +initialize_radio: + hjam clksel_rc,core_clksel + ncall wake_up_m0,wake +initialize_radio_wait: + fetch 2,mem_rf_init_ptr + bbit0 14,initialize_radio_wait + iforce contr + arg 0x8900,temp +initialize_radio_loop: + ifetch 1,contr + beq 0xff,initialize_radio_cont + ior temp,contw + ifetch 1,contr + istore 1,contw + branch initialize_radio_loop +initialize_radio_cont: + bpatch patch11_2,mem_patch11 + call lpm_cal_xtal_startup + call switchto_dpllclk +// ncall check_dpll,wake + setarg param_dpll_start_delay + iadd clkn_bt,pdata + store 4,mem_dpll_clkn + set1 RESET,radio_ctrl + force 0,radio_ctrl + ncall do_rccal,wake + branch set_rccal + + /* rega is frequency, 00=2400Mhz */ +rf_write_freq: + bpatch patch11_3,mem_patch11 + setarg 2400 + iadd rega,temp + fetch 1,mem_fcomp_mul + hjam 0x04,rf_pll_rstn + imul32 temp,pdata + fetcht 1,mem_fcomp_div + idiv temp + call wait_div_end + quotient rega /* rega is FLOOR(FVCO/fcomp) */ + remainder pdata + lshift16 pdata,pdata + lshift4 pdata,pdata /* pdata is frac * 2^20 */ + idiv temp + call wait_div_end + quotient pdata /* pdata is frac *2^20/fcomp */ + lshift8 pdata,pdata + lshift pdata,pdata + ior rega,pdata + hstore 4,rf_pll_intg + hjam 0x44,rf_pll_rstn + hjam 0xc4,rf_pll_rstn + rtn + + +do_rccal: + bpatch patch11_4,mem_patch11 + hjam 0x02,rfen_adc + setarg 250000 + call sleep /* wait clkpll&xtal stable */ + hjam 0x7f,rfen_rx + nop 130 + hjam 0x30,rf_rccal_ctrl + hjam 0xd0,rfen_tx + hjam 0x70,rf_rccal_ctrl + hjam 0xf0,rf_rccal_ctrl + force 50,loopcnt +do_rccal_loop: + hfetch 1,rf_rccal_result + bbit1 5,do_rccal_end + loop do_rccal_loop +do_rccal_end: + store 1,mem_rf_rccal + hjam 0,rfen_tx + hjam 0,rfen_rx + hjam 0x00,rfen_adc + rtn + +set_rccal: + bpatch patch11_5,mem_patch11 + fetch 1,mem_rf_rccal + set1 5,pdata + hstore 1,rf_rccal_ctrl + hfetcht 1,rf_bpf_ctrim + and_into 7,temp + lshift3 pdata,pdata + ior temp,pdata + hstore 1,rf_bpf_ctrim + hfetch 1,rf_bpf_ib + set0 bpf_rccal,pdata + hstore 1,rf_bpf_ib + hfetch 1,rf_adc_rccal + set0 adc_rccal,pdata + hstore 1,rf_adc_rccal + rtn + +save_rssi: + bpatch patch11_6,mem_patch11 + hfetch 2,rf_afc_d2a + rshift4 pdata,pdata + rshift3 pdata,pdata + sub pdata,0,pdata + and_into 0xff,pdata + div pdata,10 + call wait_div_end + quotient pdata + lshift4 pdata,pdata + remainder temp + ior temp,pdata + store 1,mem_rssi /* bcd value */ + rtn + + +switchto_dpllclk: + hjam clksel_rc,core_clksel + hfetch 1,rf_clkpll_frac+2 + set0 4,pdata + set0 5,pdata + hstore 1,rf_clkpll_frac+2 + hjam 0x00,rfen_ck + hjam 0x00,rfen_msc + hjam 0x70,rfen_msc + hjam 0xff,rfen_ck + hfetch 1,rf_clkpll_frac+2 + set1 4,pdata + set1 5,pdata + hstore 1,rf_clkpll_frac+2 + call init_lpm_ctrl + hfetch 1,rf_clkpll_int + set1 7,pdata + hstore 1,rf_clkpll_int + set0 7,pdata + hstore 1,rf_clkpll_int + set1 7,pdata + hstore 1,rf_clkpll_int + hjam clksel_dpll,core_clksel + nop 1 + hjam clksel_xtal,core_clksel + hfetch 1,rf_clkpll_frac+2 + and_into 0xcf,pdata + hstore 1,rf_clkpll_frac+2 + or_into 0x30,pdata + hstore 1,rf_clkpll_frac+2 + rtn + + +xtal_fast_wake: + setarg 0xf0f + branch lpm_write_config + +init_lpm_ctrl: + setarg 0x80f + branch lpm_write_config + + + +start_receiver: + bpatch patch11_7,mem_patch11 + call rf_rx_enable + disable is_tx + enable is_rx + pulse init_encrypt + rtn + +prep_crypt: + bpatch patch12_0,mem_patch12 + fetch 1,mem_state_map + isolate1 smap_encryption,pdata + setflag true,0,pdata + hstore 1,core_encrypt + arg mem_kc,contr + ifetch 9,contr + iforce kc_ls + ifetch 7,contr + iforce kc_ms + fetch 1,mem_key_size + add pdata,-1,g1l + pulse kc_p_activate /* immediately start calculating primary Key */ + rtn + +wait_access_end: + deposit clke + store 6,mem_sync_clke + disable decode_fec0 + nbranch shutdown_radio,sync + arg param_clke_cal,clke_rt + increase 1,clke_bt + and_into 0x1fc,clke_bt + rtn + + + +wait_access_mhalfbnd: + enable decode_fec0 +wait_access_mhalfbnd_correlate: + correlate null,mhalfbnd /* keep correlating until sync is found, or clke half */ + branch wait_access_end,sync + compare 0x02,clke_bt,0x02 + nbranch wait_access_mhalfbnd_correlate,true + branch wait_access_end + +wait_access_clkn_rt: + bpatch patch12_1,mem_patch12 + arg param_conn_access,timeup /* found sync must occur within this time */ + enable decode_fec0 + correlate clkn_rt,meet /* keep correlating until sync is found, or until clkn_rt timeup */ + disable decode_fec0 + nbranch shutdown_radio,sync + rtn + +wait_access_forever: + bpatch patch12_2,mem_patch12 + enable decode_fec0 + correlate null,timeout /* keep correlating until sync is found, or timeout */ + disable decode_fec0 + nbranch shutdown_radio,sync + arg param_clke_cal,clke_rt + and_into 0x1fc,clke_bt + rtn + + /* reserve slots for mult-slot packet */ +reserve_slot: + bpatch patch12_3,mem_patch12 + iforce rega + deposit bt_clk + iadd temp,timeup + copy timeup,pdata + store 4,mem_next_btclk + deposit rega + rtn + + /* pdata = clks ahead of bt_clk */ +ahead_window: + copy pdata,temp + bpatch patch12_4,mem_patch12 + copy temp,pdata + call clk2bt + lshift16 bt_clk,pdata + set1 44,pdata + call clk_diff + set0 44,pdata + call get_clk + call clk_diff + rtn user + call clk2rt + iforce stop_watch + until null,timeout + rtn + + +setup_clk: + bpatch patch12_5,mem_patch12 + branch setup_clkn,clknt + until clke_rt,meet +skip_setup_clke: + copy clke_bt,temp + branch setup_clknbt +setup_clkn: + branch skip_setup_clkn,attempt + until clkn_rt,meet +skip_setup_clkn: + copy clkn_bt,temp +setup_clknbt: + branch setup_clk11,user + compare 1,temp,3 + nbranch setup_clk,true +setup_complete: + bpatch patch12_6,mem_patch12 + fetch 1,mem_state + rtnbit0 state_inconn + fetch 4,mem_next_btclk + isub temp,pdata + nrtn positive + sub pdata,0xff,null + branch setup_clk,positive + rtn +setup_clk11: + compare 3,temp,3 + nbranch setup_clk,true + branch setup_complete + +rf_setup_time: + bpatch patch12_7,mem_patch12 + arg param_rf_setup,timeup + branch setup_clk + +rf_setup_time_slave_slot: + disable user + branch rf_setup_time + +rf_setup_time_master_slot: + enable user + branch rf_setup_time + +start_transmitter: + bpatch patch13_0,mem_patch13 + call prep_crypt + disable is_rx + enable is_tx + rtn + + + +start_tx_native: + bpatch patch13_1,mem_patch13 + arg param_tx_setup,timeup + until clkn_rt,meet /* wait until start_tx time */ + pulse init_encrypt + rtn + +start_rx_native: + bpatch patch13_2,mem_patch13 + arg param_rx_setup,timeup + until clkn_rt,meet + rtn + + +start_tx_external: + bpatch patch13_3,mem_patch13 + arg param_tx_setup,timeup + until clke_rt,meet /* wait until start_tx time */ + pulse init_encrypt + rtn + +send_access_word: + bpatch patch13_4,mem_patch13 + preload access /* load in access word ready to be sent */ + enable encode_fec0 + set1 TXGFSK,radio_ctrl + inject mod,72 + disable encode_fec0 + rtn + + +scan_mode_whiten: + copy xin,temp + or_into 0x60,temp /* extend xin with 5->1, 6->1 */ + copy temp,white_init + rtn + + + + /* return blank if free amaddr is found */ +get_free_amaddr: + bpatch patch13_5,mem_patch13 + fetch 1,mem_current_amaddr + increase 1,pdata + bne param_esco_addr,get_free_amaddr_cont + force 1,pdata +get_free_amaddr_cont: + store 1,mem_current_amaddr + iforce am_addr + rtn + +get_clk: + copy clkn,temp + rtn master + copy clke,temp + rtn + +get_clkbt: + deposit clkn_bt + rtn master + deposit clke_bt + rtn + + +supervision_update: + bpatch patch13_6,mem_patch13 + fetcht 4,mem_supervision_timer + call get_clkbt + isub temp,timeup /* and to 28 bits */ + deposit timeup + fetcht 2,mem_supervision_to + lshift temp,temp + isub temp,pdata + rtn + +supervision_flush: + bpatch patch13_7,mem_patch13 + call get_clkbt + store 4,mem_supervision_timer + rtn + +assert: + bpatch patch14_0,mem_patch14 + branch assert + +loop: + branch loop + +sleep: + rtn blank + /* sleep pdata clocks, only even clocks are accurate */ + rshift pdata,pdata + increase -3,pdata +sleep_loop: + increase -1,pdata + nbranch sleep_loop,zero + force 0,pdata + rtn + + + +init_param: + /* clear specified sched ram */ + arg 0x10,loopcnt + arg 0,contw + call memset0 + arg mem_le_state,contw + arg 10,loopcnt + call memset0 + jam 0,mem_sp_calc + jam 0,mem_fifo_temp + jam 0,mem_le_testtype + jam 0,mem_debug_config + jam 0,mem_lmp_conn_state + bpatch patch14_1,mem_patch14 + jam 0,mem_connection_options + jam 0,mem_tester_emulate + jam 0,mem_tester_cnt + setarg param_glap + store 3,mem_glap + setarg param_acl_pktlen + store 2,mem_acl_pktlen + jam param_sco_pktlen,mem_sco_pktlen + jam param_acl_pktcnt,mem_acl_pktcnt + jam param_sco_pktcnt,mem_sco_pktcnt + setarg param_hci_version + store 3,mem_hci_version +// setarg param_lmp_version +// store 3,mem_lmp_version +// setarg param_lmp_subversion +// store 2,mem_lmp_subversion + jam 0x60,mem_fhs_misc /* R1 for 1.28s ps interval,P2 */ + jam param_max_slot,mem_max_slot + jam 0x02,mem_fw_ver /* set firmware version */ +ifdef SIMPLE_PAIRING + fetch 1,mem_ssp_enable + ncall init_memp,blank +endif +ifdef SECURE_CONNECTION + fetch 1,mem_le_secure_connect_enable + ncall init_memp_256,blank +endif + bpatch patch14_2,mem_patch14 + rtn wake + setarg 0 + store 2,mem_tx_len + rshift clkn_bt,pdata + store 4,mem_last_clkn + rtn + + + + +/*****************************************LPO************************************************/ + +lpmstate: + fetch 4,core_lpm_xtalcnt + isolate1 hibernate,pdata + bbit0 isogate,lpm_open_isogate + nbranch clean_mem,true // power on + arg param_hibernate_clks,temp + deposit auxcnt + branch lpm_enter_sleep,blank // hibernate timeout, continue sleeping +lpm_open_isogate: + set1 isogate,pdata + set1 xram_switch,pdata + set1 pram_switch,pdata + store 4,core_lpm_reg + until null,lpo_edge // delay to wait lpo rstn release + until null,lpo_edge + call lpm_write_ctrl2 + fetch 1,core_lpm_isogate + set1 enable_retmem,pdata + store 1,core_lpm_isogate + call lpm_write_ctrl2 + branch clean_mem,true // doze or hibernate + enable wake +lpm_load_context: + jam 0x1,core_config // signal m0 for NOT loading patch + fetch 8,mem_saved_mark + iforce mark + fetch 6,core_gpio_wakeup + store 6,mem_gpio_wakeup + rtn + +lpm_save_context: + deposit mark + store 8,mem_saved_mark + branch lpm_write_gpio_wakeup + + +lpo_calibration: + fetcht 1,core_clksel + and temp,0xf0,pdata + nbranch lpo_cal_inited,blank + fetch 3,mem_clks_per_lpo + nrtn blank + and temp,0xf,pdata + or_into 0xc0,pdata + store 1,core_clksel + jam ccnt_start,core_dma_start +lpo_cal_inited: + fetch 1,core_misc_status + rtnbit0 CCNT_DONE + fetch 3,core_ccnt_counter + store 3,mem_clks_per_lpo + rtn + + + /* temp is synced clke */ +lpm_adjust_clk: + bpatch patch14_3,mem_patch14 + deposit clke + call clk_diff_rt + fetcht 4,mem_sleep_counter_all + sub temp,0xff,null + rtn positive // interval too small + lshift8 pdata,pdata + lshift4 pdata,pdata + idiv temp + call wait_div_end + quotient pdata + arg param_lpm_adjmax,temp + call ceiling + store 1,mem_lpm_adjust + nbranch lpm_adjust_positive,user + sub pdata,0,pdata +lpm_adjust_positive: + fetcht 3,mem_clks_per_lpo + iadd temp,pdata + store 3,mem_clks_per_lpo +lpm_clear_counter: + setarg 0 + store 4,mem_sleep_counter_all + rtn + +lpm_doze: + fetch 1,mem_lpm_doze_switch + branch lpm_hibernate_normal + + /* no retention memory at all */ +lpm_hibernate: + fetch 1,mem_lpm_hibernate_switch +lpm_hibernate_normal: + store 1,mem_lpm_xtalcnt + 3 + bpatch patch14_4,mem_patch14 + call lpm_write_gpio_wakeup + arg param_hibernate_clks,temp + fetch 1,mem_lpm_config+1 + set0 7,pdata /* lowest lpo */ + store 1,mem_lpm_config+1 + + /* temp is lpo clocks to sleep */ +lpm_sleep: + bpatch patch14_5,mem_patch14 + call xtal_fast_wake + fetch 4,mem_sleep_counter_all + iadd temp,pdata + store 4,mem_sleep_counter_all + call lpm_save_context + fetch 3,mem_lpm_xtalcnt + store 3,core_lpm_reg + ifetchr rega,1,contr + fetch 1,core_lpm_buckcfg + istore 1,contw + until null,lpo_edge + storer clkn,6,mem_sleep_clkn + hjam lpmreg_sel_ctrl2,core_lpm_wr + until null,lpo_edge + until null,lpo_edge + storer rega,1,core_lpm_isogate + hjam lpmreg_sel_ctrl2,core_lpm_wr +lpm_enter_sleep: + until null,lpo_edge + until null,lpo_edge + hstoret 4,core_lpm_reg + hjam lpmreg_sel_counter,core_lpm_wr + until null,never + + + + +lpm_recover_clk: + bpatch patch14_6,mem_patch14 + setarg 0 + copy auxcnt,null + branch lpm_recover_timeout,zero + hfetch 1,core_lpm_xtalcnt + hfetcht 1,core_lpm_buckcnt + isub temp,null + branch lpm_recover_xtal,positive + deposit temp +lpm_recover_xtal: + isub auxcnt,pdata + increase 1,pdata +lpm_recover_timeout: + increase 8,pdata + until null,lpo_edge + iadd lpo_time,pdata + fetcht 4,mem_sleep_counter + iadd temp,pdata + fetcht 3,mem_clks_per_lpo + imul32 temp,pdata + rshift8 pdata,pdata + rshift4 pdata,pdata + increase param_lpm_fix,pdata + arg 3750,temp + idiv temp + call wait_div_end + quotient pdata + lshift16 pdata,pdata + remainder temp + ior temp,pdata + fetcht 6,mem_sleep_clkn + call clk_add + copy temp,clkn + fetch 6,mem_context + coffset_clk_offset + call calc_clke2 + rtn + +lpm_dispatch: + bpatch patch14_7,mem_patch14 + call lpo_calibration + fetch 3,mem_clks_per_lpo + rtn blank + fetch 1,mem_lpm_mode + rtn blank + fetch 1,mem_ssp_enable + branch lpm_dispatch_next,blank + fetch 1,mem_sp_local_key_invalid // simple pairing is not ready + rtn blank +lpm_dispatch_next: + fetch 1,mem_le_sc_calc + nrtn blank + call lpm_check_wake_lock + nrtn blank + fetch 1,mem_context + compare 3,pdata,0x7 /* sco won't sleep */ + nbranch lpm_dispatch_unconn,true + fetch 2,mem_context + coffset_tsniff + rtn blank /* role switch */ + rtn wake + bpatch patch15_0,mem_patch15 + fetcht 1,mem_lpm_current_mult + fetch 2,mem_context + coffset_tsniff + imul32 temp,pdata + rshift4 temp,temp + rshift2 temp,temp + isub temp,pdata + fetcht 4,mem_context + coffset_sniff_anchor + iadd temp,pdata + fetcht 1,mem_lpm_overhead + isub temp,pdata + lshift16 pdata,alarm + bpatch patch15_1,mem_patch15 + fetch 2,mem_context + coffset_rx_window + rshift pdata,pdata + call clk2bt + deposit alarm + call clk_diff + copy clke,temp + call clk_diff_rt + rtn user +lpm_dispatch_sleep: + call clk2lpo +lpm_dispatch_lpo: + bpatch patch15_2,mem_patch15 + fetch 1,mem_lpm_xtalcnt + isub temp,null + branch lpm_clear_counter,positive + storet 4,mem_sleep_counter + call app_will_enter_lpm + call l2cap_lpm_save_txbuf + fetcht 4,mem_sleep_counter + branch lpm_sleep + +lpm_dispatch_unconn: + bpatch patch15_3,mem_patch15 + fetch 1,mem_context + rtnbit1 state_inconn // wont sleep in connection + rtnbit1 state_inpage // wont sleep when paging + fetch 1,mem_ssp_enable + branch lpm_unconn_nossp,blank + fetch 1,mem_sp_local_key_invalid // simple pairing is not ready + rtn blank +lpm_unconn_nossp: + bpatch patch15_4,mem_patch15 + fetch 1,mem_le_adv_enable + nbranch lpm_unconn_cont,blank + fetch 1,mem_scan_mode + rtn blank +lpm_unconn_cont: + fetch 2,mem_lpm_interval + rtn blank +lpm_sleep_btclk: + fetcht 1,mem_lpm_overhead + isub temp,pdata + arg 7500,temp /* 1.25ms */ + imul32 temp,pdata + branch lpm_dispatch_sleep + +lpm_set_mult: + bpatch patch15_5,mem_patch15 + disable wake + fetch 1,mem_state + rtnbit0 state_insniff + nbranch lpm_not_match,match + call lpm_match + fetch 2,mem_rx_window_sniff + store 2,mem_rx_window + fetch 1,mem_arq + bbit1 wack,lpm_mult_short + bmark0 mark_lpm_mult_enable,lpm_mult_short + call l2cap_malloc_is_fifo_empty + nbranch lpm_mult_short,blank + fetch 1,mem_classic_bt_flag + bbit1 SHORT_MULT_FLAG,lpm_mult_short +lpm_mult_wait_timeout: + jam 0,mem_lpm_current_mult + bmark0 mark_lpm_mult_enable,lpm_mult_short + fetch 1,mem_lpm_mult_cnt + branch lpm_mult_long,blank + increase -1,pdata + store 1,mem_lpm_mult_cnt + rtn + + +classic_bt_set_mult_short_flag: + arg SHORT_MULT_FLAG,queue + branch classic_bluetooth_set_flag + +classic_bt_clr_mult_short_flag: + arg SHORT_MULT_FLAG,queue + branch classic_bluetooth_clr_flag + + + +lpm_match: + jam 0,mem_sniff_unint_lost + fetch 3,mem_sniff_rcv + increase 1,pdata + store 3,mem_sniff_rcv + rtn + +lpm_not_match: + bpatch patch15_6,mem_patch15 + fetcht 2,mem_rx_window_sniff + rshift temp,temp + fetch 2,mem_rx_window + iadd temp,pdata + store 2,mem_rx_window +lpm_lost: + jam 0,mem_lpm_current_mult + fetch 3,mem_sniff_lost + increase 1,pdata + store 3,mem_sniff_lost + fetch 1,mem_sniff_unint_lost + increase 1,pdata + store 1,mem_sniff_unint_lost + rtn + +lpm_mult_short: + jam 0,mem_lpm_current_mult + fetch 1,mem_lpm_mult_timeout + store 1,mem_lpm_mult_cnt + rtn + +lpm_mult_long: + fetcht 1,mem_lpm_mult + storet 1,mem_lpm_current_mult + rtn + +lpm_cal_xtal_startup: + bpatch patch15_7,mem_patch15 + fetch 1,mem_lpm_xtalcnt + nrtn blank + hjam clksel_rc,core_clksel + setarg 0xf0c + call lpm_write_config + setarg 200000 + call sleep + until null,lpo_edge + copy lpo_time,alarm + call xtal_fast_wake + hjam clksel_xtal,core_clksel + nop 10 + until null,lpo_edge + deposit lpo_time + isub alarm,pdata + increase 0x30,pdata + arg 0xff,temp + call ceiling + store 1,mem_lpm_xtalcnt + nop 30000 + nop 30000 + nop 30000 + rtn + + + + /* pdata is lpm_reg[11:0] */ +lpm_write_config: + arg 0xfff,contw + iand contw,contw + fetch 1,mem_lpm_config + and_into 0xf0,pdata + lshift8 pdata,pdata + ior contw,pdata + hstore 2,core_lpm_reg + ifetch 2,contr + istore 2,contw + +lpm_write_ctrl: + setarg lpmreg_sel_ctrl + branch lpm_write + +lpm_write_ctrl2: + setarg lpmreg_sel_ctrl2 +lpm_write: + hstore 1,core_lpm_wr + until null,lpo_edge + until null,lpo_edge + until null,lpo_edge + rtn + + +lpm_write_gpio_wakeup: + bpatch patch16_0,mem_patch16 + fetch 4,mem_gpio_wakeup + store 4,core_lpm_reg + setarg lpmreg_sel_gpiolow + call lpm_write + ifetch 2,contr + store 4,core_lpm_reg + setarg lpmreg_sel_gpiohigh + branch lpm_write + +lpm_get_wake_lock: + fetch 2,mem_lpm_wake_lock + qset1 pdata + store 2,mem_lpm_wake_lock + rtn + +lpm_put_wake_lock: + fetch 2,mem_lpm_wake_lock + qset0 pdata + store 2,mem_lpm_wake_lock + rtn + + + +lpm_check_wake_lock: + bpatch patch16_1,mem_patch16 + call app_check_wake_lock + fetch 2,mem_lpm_wake_lock + copy pdata,rega + fetch 1,mem_state_map + isolate1 smap_rxlmp,pdata + setflag true,wake_lock_lmp_rx,rega + fetch 1,mem_lmo_opcode1 + fetcht 1,mem_lmo_opcode2 + iadd temp,pdata + fetcht 1,mem_lmp_to_send + iadd temp,pdata + nsetflag blank,wake_lock_lmp_tx,rega + fetch 1,mem_le_tx_buff_used + nsetflag blank,wake_lock_ble_tx,rega + fetch 2,mem_l2cap_rxbuff1_len + fetcht 2,mem_l2cap_rxbuff2_len + iadd temp,pdata + nsetflag blank,wake_lock_l2cap_rx,rega + fetch UTIL_FIFO_LEN,mem_ipc_fifo_bt2c51 + nsetflag blank,wake_lock_ipc_bt2c51,rega + fetch UTIL_FIFO_LEN,mem_ipc_fifo_c512bt + nsetflag blank,wake_lock_ipc_c512bt,rega + fetch 2,IPC_BT2M0_READ_PTR + fetcht 2,IPC_BT2M0_WRITE_PTR + isub temp,null + nsetflag zero,wake_lock_ipc_bt2m0,rega + fetch 2,IPC_M02BT_READ_PTR + fetcht 2,IPC_M02BT_WRITE_PTR + isub temp,null + nsetflag zero,wake_lock_ipc_m02bt,rega + fetch 1,core_config + isolate1 7,pdata + setflag true,wake_lock_m0_single,rega + fetch 1,mem_hci_cmd + nsetflag blank,wake_lock_cmd,rega + copy rega,pdata + store 2,mem_lpm_wake_lock + rtn + +lpm_shut_down: + hfetch 4,core_lpm_ctrl + set0 27,pdata + hstore 4,core_lpm_reg + call lpm_write_ctrl + branch assert + +lpm_disable_exen_output: + hfetch 4,core_lpm_xtalcnt + set0 20,pdata + hstore 4,core_lpm_reg + branch lpm_write_ctrl2 + +check_bt_disabled: + fetch 2,mem_chip_functions + bbit1 bt_disabled,assert + rtn +check_ble_disabled: + fetch 2,mem_chip_functions + bbit1 ble_disabled,assert + rtn +check_module_disabled: + fetch 2,mem_chip_functions + bbit1 module_disable,assert + rtn + +test_init: + setarg test_proc + store 2,mem_cb_bt_process + setarg test_sleep + store 2,mem_cb_bb_event_process + setarg test_proc + store 2,mem_cb_idle_process + rtn wake + rtn + +test_proc: + fetch 1,mem_state + bbit0 state_insniff,check_test_cond + set1 mark_lpm_mult_enable,mark + fetch 6,mem_sniff_rcv + store 6,mem_local_name + rtn + +check_test_cond: + fetch 1,mem_tester_emulate + rtnbit0 tester_change + fetch 1,mem_tester_cnt + increase 1,pdata + store 1,mem_tester_cnt + rtnne 5 + jam 0,mem_tester_cnt + fetch 1,mem_tester_emulate + set0 tester_change,pdata + store 1,mem_tester_emulate + bbit1 tester_exit,check_test_exit + isolate1 tester_no_whitening,pdata + call test_no_white,true + ncall test_enable_white,true + fetch 1,test_mode_packet_type + compare 0x20,pdata,0x30 + fetch 1,mem_state_map + setflag true,smap_edr,pdata + store 1,mem_state_map + fetch 1,mem_tester_emulate + fetcht 1,mem_debug_config + isolate1 tester_pattern_test,pdata + setflag true,debug_tx_pattern,temp + isolate1 tester_fixed_freq,pdata + setflag true,debug_tx_fixed_freq,temp + setflag true,debug_rx_fixed_freq,temp + storet 1,mem_debug_config + fetch 1,test_mode_tx_freq + store 1,mem_tx_fixed_freq + fetch 1,test_mode_rx_freq + store 1,mem_rx_fixed_freq + set1 mark_testmode,mark + rtn + + +check_test_exit: + set0 mark_testmode,mark + jam 0,mem_tester_emulate + fetch 1,mem_test_mode_old_debug_config + store 1,mem_debug_config + hfetch 1,core_config + and_into 0xfb,pdata /* whitening on */ + hstore 1,core_config + rtn + + +test_sleep: + deposit regc + rtnne BT_EVT_BUTTON_LONG_PRESSED +test_sleep_loop: +// call ui_button_polling +// fetch 1,mem_ui_button_last_state + rtn + beq 1,test_sleep_loop + branch lpm_hibernate + + +test_tx: + force 2,temp + increase -2,temp + call set_sync_on + call set_freq_tx + disable enable_white + enable encode_fec0 + set1 TXGFSK,radio_ctrl + call start_transmitter +test_tx_loop: + fetch 1,0 + inject mod,8 + branch test_tx_loop +wait_sec_powerup: + fetch 1,core_misc_status + bbit0 SEC_PWRUP, wait_sec_powerup + rtn + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hci_h4.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hci_h4.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hci_h4.prog (working copy) @@ -0,0 +1,4 @@ + + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hci_main.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hci_main.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hci_main.prog (working copy) @@ -0,0 +1,53 @@ +/*********************************/ +/********** HCI *****************/ +/*********************************/ + +cmd_exit: + jam 0,mem_hci_cmd + rtn +cmd_check_plap: + fetch 6,mem_hci_plap + fetcht 6,mem_plap + isub temp,null + rtn + + + +//enable ssp master sm +cmd_pair: + fetch 1,mem_op + bbit1 op_inrand_req,cmd_pair_passive + call tid_initiate + jam LMP_IN_RAND,mem_lmo_opcode2 + branch cmd_exit +cmd_pair_passive: + set0 op_inrand_req,pdata + store 1,mem_op + call lmp_accept_inrand + setarg 0 + setflag master,smap_lmptid,pdata + store 1,mem_lmo_tid2 + branch cmd_exit + rtn +cmd_in_sniff: + jam LMP_SNIFF_REQ,mem_lmo_opcode2 + arg mem_sniff_payload,contw + setarg 0 + isolate1 27,clke_bt + setflag true,1,pdata /* use init 2 if bit27 of clke is 1 */ + istore 1,contw + setarg 0 /* dsniff */ + istore 2,contw + fetch 2,mem_sniff_param_interval /* tsniff */ + istore 2,contw + fetch 1,mem_sniff_param_attempt /* attempt */ + istore 2,contw + fetch 1,mem_sniff_param_timeout /* timeout */ + istore 2,contw + branch cmd_exit + +cmd_exit_sniff: + jam LMP_UNSNIFF_REQ,mem_lmo_opcode2 + branch cmd_exit + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hid.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hid.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/hid.prog (working copy) @@ -0,0 +1,84 @@ +/** +* the following API is to send the HID data +* +*/ + +/** +* the following API is to process the hid rx data +* +*/ +//handle the hid data + +hid_rx_process: + bpatch patch17_6,mem_patch17 + fetch 2,mem_l2cap_payload_ptr + copy pdata,contr + ifetch 1,contr + and pdata,0x0f,temp + rshift4 pdata,pdata //hidtype + beq hid_type_set_idle,hid_rx_process_handshake + beq hid_type_set_protocol,hid_rx_process_handshake + beq hid_type_data,hid_rx_process_data + beq HID_TYPE_SET_REPORT,hid_rx_process_set_report + beq HID_TYPE_CONTROL,hid_rx_process_hid_control + rtn + +hid_rx_process_hid_control: + copy temp,pdata + beq HID_CONTROL_P_VIRTUALCABLEUNPLUG,hid_rx_process_virtual_cable_unplug + beq HID_CONTROL_P_SUSPEND,hid_rx_process_suspend + rtn + +hid_rx_process_virtual_cable_unplug: + jam BT_EVT_VIRTUAL_CABLE_UNPLUG,mem_fifo_temp + call ui_ipc_send_event + fetch 1,mem_device_option + rtnbit0 dvc_op_mouse + copy temp,pdata +// beq HID_CONTROL_P_VIRTUALCABLEUNPLUG,mouse_irtual_cable_unplug + rtn +hid_rx_process_suspend: + rtn + +hid_rx_process_set_report: + call hid_rx_process_data + arg 0x01,rega + call hid_malloc_tx_buff + fetch 2,mem_hid_ctrl_remote_cid + istore 2,contw + setarg 0x00 + istore 1,contw + rtn + +hid_rx_process_handshake: + arg 1,regA//payload length + call hid_malloc_tx_buff + fetch 2,mem_hid_ctrl_remote_cid + istore 2,contw + setarg 0 + istore 1,contw + jam 1,mem_ui_data_txbuff_length + fetch 1,mem_hid_control_state + set1 l2cap_channel_hid_handshake_done + store 1,mem_hid_control_state + jam BT_EVT_HID_HANDSHAKE,mem_fifo_temp + branch ui_ipc_send_event + +hid_rx_process_data: + ifetch 1,contr + beq HID_REPORT_ID_KB,hid_rx_process_data_hid_kb + rtn + +hid_rx_process_data_hid_kb: + rtn + + +hid_malloc_tx_buff: + call l2cap_malloc + copy rega,temp + storet 1,mem_ui_data_txbuff_length + copy pdata,contw + copy rega,pdata + istore 2,contw //hid payload length + rtn + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/l2cap.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/l2cap.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/l2cap.prog (working copy) @@ -0,0 +1,1929 @@ +/************************************/ +/*initialize L2CAP related variables*/ +/************************************/ +l2cap_init: + branch l2cap_init_wake,wake +l2cap_init_work: + setarg mem_l2cap_xmem_end + arg mem_l2cap_xmem_start,contw + isub contw,loopcnt + call clear_mem +l2cap_init_wake: + bpatch patch17_7,mem_patch17 + setarg mem_sdp_mem_end + arg mem_sdp_mem_start,contw + isub contw,loopcnt + call clear_mem + setarg mem_l2cap_mem_end + arg mem_l2cap_mem_start,contw + isub contw,loopcnt + call clear_mem + branch l2cap_lpm_load_txbuf + +process_rx_l2cap_pkt: + bpatch patch18_0,mem_patch18 + copy contr,temp + //call l2cap_malloc_is_fifo_full + //nrtn blank + copy temp,contr + ifetch 2,contr + store 2,mem_l2cap_rx_pkt_length + ifetch 2,contr + store 2,mem_l2cap_rx_cid + deposit contr + store 2,mem_l2cap_payload_ptr + fetch 1,memui_reconnect_mode + beq NO_RECONNECTION,l2cap_rx_multiplexing + branch ml2cap_rx_multiplexing + +l2cap_rx_multiplexing: + fetch 2, mem_l2cap_rx_pkt_length + branch l2cap_rx_reset_state,blank + bpatch patch18_1,mem_patch18 + fetch 1,mem_l2cap_rx_cid + beq L2CAP_signal_channel,l2cap_call_proc_signal +l2cap_rx_multiplexing0: + beq L2CAP_SDP_channel,l2cap_call_proc_sdp + beq L2CAP_RFCOMM_channel,l2cap_call_proc_rfcomm + beq L2CAP_HID_Control_channel,l2cap_call_proc_hid + beq L2CAP_HID_Interrupt_channel,l2cap_call_proc_hid + branch l2cap_rx_reset_state + +l2cap_check_map: +// call l2cap_malloc_is_fifo_full +// nrtn blank + bpatch patch18_2,mem_patch18 + call l2cap_malloc_get_full_map + fetch 1,mem_used_map + beq 0,set_pdata_0 + beq 1,set_pdata_0 + beq 2,set_pdata_0 + beq 3,set_pdata_0 + beq 0x81,set_pdata_0 + beq 0xc0,set_pdata_0 + beq 0x80,set_pdata_0 + beq 0x40,set_pdata_0 + rtn + +set_pdata_0: + setarg 0 + rtn + + +l2cap_call_proc_signal: + call l2cap_check_map + nrtn blank +l2cap_call_proc_signal0: + call l2cap_malloc_signal_channel + call l2cap_process_signal_pkt + fetcht 2,mem_l2cap_signal_tx_length + branch l2cap_call_proc_no_reply,blank + call l2cap_get_signal_tx_buff + fetch 2,mem_l2cap_signal_tx_length + istore 2,contw + force L2CAP_signal_channel,pdata + istore 2,contw + branch l2cap_rx_reset_state + +l2cap_call_proc_sigal_pending: + fetch 1,mem_l2cap_pending_item + rtn blank + copy pdata,rega + bpatch patch18_3,mem_patch18 + fetch 4,mem_l2cap_sdpres_delay_time + arg 0x100,temp + iadd temp,temp + copy clkn_bt,pdata + isub temp,null + nrtn positive + jam 0,mem_l2cap_pending_item + copy rega,pdata + beq L2CAP_SDP_channel,l2cap_sdp_conn_succ + branch assert +l2cap_sdp_conn_succ: + arg 0,debug + call l2cap_malloc_signal_channel + call restore_l2cap_req_param + call l2cap_get_signal_tx_payload + call save_cont_pointers + call send_connection_sdp_res + call l2cap_get_signal_tx_buff + //fetch 2,mem_l2cap_signal_tx_length + setarg 0x000c + istore 2,contw + force L2CAP_signal_channel,pdata + istore 2,contw + branch l2cap_rx_reset_state + + + +l2cap_reset_sdp_map: + bpatch patch18_4,mem_patch18 + fetch 2,mem_sdp_tx_pkt_length + increase 4,pdata + rshift4 pdata,pdata + rshift3 pdata,pdata + add pdata,1,temp ///temp: how many128 + arg mem_tx_fifo3,contr + ifetch 3,contr + rtn blank + store 3,mem_tx_fifo_map_temp + fetch 1,mem_tx_fifo_map_temp + copy pdata,rega + call check_l2cap_map + copy regb,pdata + store 1,mem_tx_fifo3 + rtn + +check_l2cap_map: + arg 0,queue + arg 0,regb + +check_l2cap_map_loop: + sub queue,7,null + nrtn positive + qisolate1 rega + branch check_l2cap_map_used,true + branch check_l2cap_map_used2 + +check_l2cap_map_used: + copy temp,pdata + branch check_l2cap_map_used2,blank + qset1 regb + increase -1,temp + +check_l2cap_map_used2: + increase 1,queue + branch check_l2cap_map_loop + +l2cap_call_proc_sdp: + call l2cap_malloc_is_fifo_empty + nrtn blank// not process this packet until fifo empty + call l2cap_check_map + nrtn blank + call l2cap_malloc_sdp_channel + call sdp_process + call l2cap_reset_sdp_map + branch l2cap_call_proc_sdp_common + + +ml2cap_call_proc_sdp: + call l2cap_malloc_is_fifo_empty + nrtn blank// not process this packet until fifo empty + call l2cap_malloc_sdp_channel + call sdp_process +l2cap_call_proc_sdp_common: + call l2cap_get_sdp_tx_buff + fetch 2,mem_sdp_tx_pkt_length + branch l2cap_call_proc_no_reply,blank + istore 2,contw + fetch 2,mem_sdp_remote_cid + istore 2,contw + branch l2cap_rx_reset_state + +l2cap_call_proc_hid: + call hid_rx_process + branch l2cap_rx_reset_state + +l2cap_call_proc_rfcomm: + bpatch patch18_5,mem_patch18 + jam RFCOMM_MALLOC_SUCCEED,mem_rfcomm_malloc_fail_flag + call rfcomm_rx_process + fetch 1,mem_rfcomm_malloc_fail_flag + rtneq RFCOMM_MALLOC_FAIL + branch l2cap_rx_reset_state +l2cap_call_proc_no_reply: + call l2cap_malloc_discard + //fall through +l2cap_rx_reset_state: + setarg 0 + store 2,mem_l2cap_rx_pkt_length + store 2,mem_l2cap_rx_cid + jam L2CAP_RX_DONE,mem_l2cap_rx_done + rtn +/* To process one L2CAP signalling pkt consisting of 1 or more signalling commands. */ +l2cap_process_signal_pkt: + bpatch patch18_6,mem_patch18 + call l2cap_get_signal_tx_payload + force 0,regB + fetch 2,mem_l2cap_rx_pkt_length + copy pdata,regC + fetch 2,mem_l2cap_payload_ptr + iforce contr +l2cap_process_signal_pkt_loop: + call l2cap_process_one_signal + deposit regC + increase -4,regC + increase -4,pdata + nbranch l2cap_process_signal_pkt_loop,blank + copy regB,pdata + store 2,mem_l2cap_signal_tx_length + rtn + +l2cap_process_one_signal: + bpatch patch18_7,mem_patch18 + ifetch 1,contr + beq signal_cmd_reject,l2cap_proc_signal_cmd_reject + beq signal_connect_req,l2cap_proc_signal_connect_req + beq signal_connect_rsp,l2cap_proc_signal_connect_rsp + beq signal_config_req,l2cap_proc_signal_config_req + beq signal_config_rsp,l2cap_proc_signal_config_rsp + beq signal_disconnect_req,l2cap_proc_signal_disconnect_req + beq signal_disconnect_rsp,l2cap_proc_signal_disconnect_rsp + beq signal_echo_req,l2cap_proc_signal_echo_req + beq signal_echo_rsp,l2cap_proc_signal_echo_rsp + beq signal_info_req,l2cap_proc_signal_info_req + beq signal_info_rsp,l2cap_proc_signal_info_rsp + call l2cap_reject_command +l2cap_process_one_signal_rtn: + rtn + +l2cap_proc_signal_info_req: + ifetch 1,contr //IDs + copy pdata,queue + ifetch 2,contr //length + copy pdata,rega + copy regc,pdata + isub rega,regc + setarg signal_info_rsp + istore 1,contw + copy queue,pdata + istore 1, contw + ifetch 2,contr +l2cap_proc_signal_info_req_reply: + beq L2CAP_SIG_EXT_FEATRUE,l2cap_proc_signal_info_req_ext + beq L2CAP_SIG_FIX_FEATRUE,l2cap_proc_signal_info_req_fix + rtn +l2cap_proc_signal_info_req_ext: + setarg 0x020008 + istore 6, contw + setarg 0x0280 + istore 4, contw + force 12,pdata + branch l2cap_proc_signal_info_req_common +l2cap_proc_signal_info_req_fix: + setarg 0x3000c + istore 6, contw + setarg 0x0006 + istore 8, contw + force 16,pdata +l2cap_proc_signal_info_req_common: + iadd regb,regb + branch l2cap_process_one_signal_rtn + +ml2cap_proc_signal_info_req: + ifetch 1,contr //IDs + copy pdata,queue + ifetch 2,contr //length + copy pdata,rega + ifetch 2,contr + store 2,mem_temp + copy regc,pdata + isub rega,regc + call l2cap_get_signal_tx_payload + setarg signal_info_rsp + istore 1,contw + copy queue,pdata + istore 1,contw + fetch 2,mem_temp + branch l2cap_proc_signal_info_req_reply + + +/* Respond to the command reject signal sent from the remote BD. */ +l2cap_proc_signal_cmd_reject: + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + iadd contr,contr + copy regC,pdata + isub regA,regC +l2cap_proc_signal_cmd_reject_rtn: + branch l2cap_process_one_signal_rtn +/* Respond to an L2CAP connection request from remote BD. (generate a connection_rsp) */ +l2cap_proc_signal_connect_req: + call save_cont_pointers + //fetch 6,mem_inquiry_bd_addr + //store 6,mem_master_paged_bd_addr + call load_cont_pointers + arg 0,debug + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + ifetch 2,contr + copy pdata,temp //PSM + ifetch 2,contr + copy pdata,timeup + bpatch patch19_0,mem_patch19 + copy temp,pdata + beq PSM_SDP,l2cap_proc_signal_connect_req_sdp + beq PSM_RFCOMM,l2cap_proc_signal_connect_req_rfcomm + beq PSM_HID_control,l2cap_proc_signal_connect_req_hid_ctrl + beq PSM_HID_interrupt,l2cap_proc_signal_connect_req_hid_int + call l2cap_reject_command + branch l2cap_proc_signal_connect_req_rtn + +l2cap_proc_signal_connect_req_sdp: + call save_cont_pointers + arg L2CAP_SDP_channel,temp + fetch 2,mem_sdp_remote_cid + nbranch already_connected,blank + copy timeup,pdata + store 2,mem_sdp_remote_cid + copy clkn_bt,pdata + store 4,mem_l2cap_sdpres_delay_time + call store_l2cap_req_param + branch send_connection_pending + +store_l2cap_req_param: + storet 2,mem_psm + deposit timeup + store 2,mem_scid + deposit rega + store 2,mem_cmd_length + deposit regb + store 2,mem_tt2 + deposit regc + store 2,mem_tt3 + deposit queue + store 2,mem_id + rtn + +restore_l2cap_req_param: + fetcht 2,mem_psm + fetch 2,mem_scid + copy pdata,timeup + fetch 2,mem_cmd_length + copy pdata,rega + fetch 2,mem_tt2 + copy pdata,regb + fetch 2,mem_tt3 + copy pdata,regc + fetch 2,mem_id + copy pdata,queue + rtn + +l2cap_proc_signal_connect_req_rfcomm: + call save_cont_pointers + setarg L2CAP_RFCOMM_channel + arg L2CAP_RFCOMM_channel,temp + fetch 2,mem_RFCOMM_remote_CID + nbranch already_connected,blank + copy timeup,pdata + store 2,mem_RFCOMM_remote_CID + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_rfcomm_state + branch send_connection_res +l2cap_proc_signal_connect_req_hid_ctrl: + call save_cont_pointers + arg L2CAP_HID_Control_channel,temp + fetch 2,mem_hid_ctrl_remote_cid + nbranch already_connected,blank + copy timeup,pdata + store 2,mem_hid_ctrl_remote_cid + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_hid_control_state + branch send_connection_res +l2cap_proc_signal_connect_req_hid_int: + call save_cont_pointers + deposit clke + arg L2CAP_HID_Interrupt_channel,temp + fetch 2,mem_hid_int_remote_cid + nbranch already_connected,blank + copy timeup,pdata + store 2,mem_hid_int_remote_cid + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_hid_interrupt_state + branch send_connection_res + +send_connection_pending: + setarg L2CAP_connect_pending + store 2,memL2CAP_T1 + jam L2CAP_SDP_channel,mem_l2cap_pending_item + branch send_connection_res0 +send_connection_sdp_res: + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_sdp_state +send_connection_res: + setarg L2CAP_connect_successful + store 2,memL2CAP_T1 +send_connection_res0: + bpatch patch19_1,mem_patch19 + call load_cont_pointers + setarg signal_connect_rsp + istore 1,contw + copy queue,pdata + istore 1,contw + setarg 0x0008 + istore 2,contw + copy temp,pdata + istore 2,contw + copy timeup,pdata + istore 2,contw + fetch 2,memL2CAP_T1 + beq L2CAP_connect_pending,connect_pending + isolate0 0,debug + branch connect_suc,true + setarg L2CAP_connect_refused_no_resources +connect_suc: + istore 2,contw + force 0x0000,pdata + istore 2,contw + setarg 12 + branch connect_req_update_byte_counts +connect_pending: + istore 2,contw + force 0x0002,pdata + istore 2,contw + setarg 12 + branch connect_req_update_byte_counts + +already_connected: + set1 0,debug + branch send_connection_res +connect_req_update_byte_counts: + iadd regB,regB + copy regC,pdata + isub regA,regC + branch l2cap_proc_signal_connect_req_rtn +l2cap_proc_signal_connect_req_rtn: + branch l2cap_process_one_signal_rtn + +l2cap_proc_signal_connect_rsp: + ifetch 1,contr //identifier + copy pdata,queue + ifetch 2,contr //length + copy pdata,regA + copy regC,pdata + isub regA,regC + ifetch 2,contr //remote cid + copy pdata,timeup + ifetch 2,contr //local cid + copy pdata,temp + bpatch patch19_2,mem_patch19 + setarg L2CAP_SDP_channel + isub temp,null + branch l2cap_proc_signal_connect_rsp_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch l2cap_proc_signal_connect_rsp_rfcomm,zero + setarg L2CAP_HID_Control_channel + isub temp,null + branch l2cap_proc_signal_connect_rsp_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + isub temp,null + branch l2cap_proc_signal_connect_rsp_hid_int,zero + rtn + +l2cap_proc_signal_connect_rsp_sdp: + copy timeup,pdata + store 2,mem_sdp_remote_cid + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_sdp_state + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_connect_rsp_rfcomm: + copy timeup,pdata + store 2,mem_rfcomm_remote_CID + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_rfcomm_state + rtn +l2cap_proc_signal_connect_rsp_hid_int: + copy timeup,pdata + store 2,mem_hid_ctrl_remote_cid + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_hid_interrupt_state + rtn +l2cap_proc_signal_connect_rsp_hid_ctrl: + copy timeup,pdata + store 2,mem_hid_int_remote_cid + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_CONN_RES,pdata + store 1,mem_hid_control_state + rtn + +l2cap_proc_signal_config_req: + ifetch 1,contr//identifier + copy pdata,queue + ifetch 2,contr//length + copy pdata,regA + copy regC,pdata + isub regA,regC + ifetch 2,contr//dest cid + copy pdata,temp + copy temp,regA + bpatch patch19_3,mem_patch19 + setarg L2CAP_SDP_channel + isub temp,null + branch l2cap_proc_signal_config_req_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch l2cap_proc_signal_config_req_rfcomm,zero + setarg L2CAP_HID_Control_channel + isub temp,null + branch l2cap_proc_signal_config_req_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + isub temp,null + branch l2cap_proc_signal_config_req_hid_int,zero + branch l2cap_reject_command + //branch L2CAP_proc_signal_config_req_rtn +l2cap_proc_signal_config_req_sdp: + copy contw, timeup + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + //set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_sdp_state + copy timeup,contw + arg L2CAP_SDP_channel,timeup + fetch 2,mem_sdp_remote_cid + copy pdata,temp + branch l2cap_send_config_rsp +l2cap_proc_signal_config_req_hid_ctrl: + copy contw, timeup + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + //set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_hid_control_state + copy timeup,contw + arg L2CAP_HID_Control_channel,timeup + fetch 2,mem_hid_ctrl_remote_cid + copy pdata,temp + branch l2cap_send_config_rsp +l2cap_proc_signal_config_req_hid_int: + copy contw, timeup + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + //set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_hid_interrupt_state + copy timeup,contw + arg L2CAP_HID_Interrupt_channel,timeup + fetch 2,mem_hid_int_remote_cid + copy pdata,temp + branch l2cap_send_config_rsp +l2cap_proc_signal_config_req_rfcomm: + copy contw, timeup + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + //set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_rfcomm_state +// jam UPPERSM_RP_SDP_CONN,mem_upper_sm_remote_page + copy timeup,contw + arg L2CAP_RFCOMM_channel,timeup + fetch 2,mem_RFCOMM_remote_CID + copy pdata,temp +l2cap_send_config_rsp: + bpatch patch19_4,mem_patch19 + setarg signal_config_rsp + istore 1,contw + copy queue,pdata + istore 1,contw + setarg 0x0006 + istore 2,contw + copy temp,pdata + istore 2,contw + force 0x00,pdata + istore 2,contw + force L2CAP_config_success,pdata + istore 2,contw + force 10,pdata + iadd regB,regB + //copy temp,pdata + storet 2,mem_config_req_dest_CID + copy queue,pdata + store 1,mem_config_identifier + force L2CAP_SDP_channel,pdata + icompare 0xff,timeup + branch l2cap_send_config_rsp_is_sdp,true + increase 1,pdata +l2cap_send_config_rsp_is_sdp: + //store 1,mem_send_config_req + rtn +l2cap_check_channel_state: + disable user + rtnbit1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + rtnbit0 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + rtnbit0 L2CAP_CHANNEL_STATE_CONN_RES,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + copy contr,contw + increase -1,contw + istore 1,contw + enable user + rtn +l2cap_send_config_req: +l2cap_send_config_req_sdp: + fetch 1,mem_sdp_state + call l2cap_check_channel_state + nbranch l2cap_send_config_req_rfcomm,user + jam L2CAP_SDP_channel,mem_send_config_req + fetch 2,mem_sdp_remote_cid + store 2,mem_config_req_dest_CID + branch l2cap_generate_config_req +l2cap_send_config_req_rfcomm: + fetch 1,mem_rfcomm_state + call l2cap_check_channel_state + nbranch l2cap_send_config_req_hid_ctrl,user + jam L2CAP_RFCOMM_channel,mem_send_config_req + fetch 2,mem_RFCOMM_remote_CID + store 2,mem_config_req_dest_CID + branch l2cap_generate_config_req +l2cap_send_config_req_hid_ctrl: + fetch 1,mem_hid_control_state + call l2cap_check_channel_state + nbranch l2cap_send_config_req_hid_int,user + jam L2CAP_HID_Control_channel,mem_send_config_req + fetch 2,mem_hid_ctrl_remote_cid + store 2,mem_config_req_dest_CID + branch l2cap_generate_config_req +l2cap_send_config_req_hid_int: + fetch 1,mem_hid_interrupt_state + call l2cap_check_channel_state + nrtn user//End of sending config req + jam L2CAP_HID_Interrupt_channel,mem_send_config_req + fetch 2,mem_hid_int_remote_cid + store 2,mem_config_req_dest_CID + //branch L2CAP_generate_config_req + +l2cap_generate_config_req: + bpatch patch19_5,mem_patch19 + call l2cap_get_req_id + call l2cap_malloc_signal_channel + force 0,regB + call l2cap_get_signal_tx_payload + force signal_config_req,pdata + istore 1,contw + fetch 1,mem_ML2CAP_comm_id + istore 1,contw + setarg 0x0008 + istore 2,contw + fetch 2,mem_config_req_dest_CID + istore 2,contw + setarg 0x0000 + istore 2,contw + force 1,pdata + istore 1,contw + force 2,pdata + istore 1,contw + fetch 1,mem_send_config_req + beq L2CAP_RFCOMM_channel,l2cap_generate_config_req_rfcomm + setarg L2CAP_config_MTU_SDP + istore 2,contw + branch l2cap_generate_config_req_done +l2cap_generate_config_req_rfcomm: + setarg L2CAP_config_MTU_RFCOMM + istore 2,contw +l2cap_generate_config_req_done: + arg 0x0c,temp + storet 2,mem_l2cap_signal_tx_length + call l2cap_get_signal_tx_buff + fetch 2,mem_l2cap_signal_tx_length + istore 2,contw + force L2CAP_signal_channel,pdata + istore 2,contw + jam 0,mem_send_config_req +l2cap_proc_signal_config_req_rtn: + branch l2cap_process_one_signal_rtn + +l2cap_proc_signal_config_rsp: + increase 1,contr + ifetch 2,contr + copy pdata,regA + copy regC,pdata + isub regA,regC + ifetch 2,contr //source cid + copy pdata,regA + bpatch patch19_6,mem_patch19 + setarg L2CAP_SDP_channel + isub rega,null + branch l2cap_proc_signal_config_rsp_sdp,zero + setarg L2CAP_RFCOMM_channel + isub rega,null + branch l2cap_proc_signal_config_rsp_rfcomm,zero + setarg L2CAP_HID_Control_channel + isub rega,null + branch l2cap_proc_signal_config_rsp_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + isub rega,null + branch l2cap_proc_signal_config_rsp_hid_int,zero + increase 2,contr + ifetch 2,contr + iforce null + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_config_rsp_sdp: + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES,pdata + store 1,mem_sdp_state + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_config_rsp_rfcomm: + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES,pdata + store 1,mem_rfcomm_state + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_config_rsp_hid_ctrl: + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES,pdata + store 1,mem_hid_control_state + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_config_rsp_hid_int: + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES,pdata + store 1,mem_hid_interrupt_state + jam BT_EVT_HID_CONNECTED,mem_fifo_temp + branch ui_ipc_send_event + + + +l2cap_proc_signal_disconnect_req: + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + copy regC,pdata + isub regA,regC + ifetch 2,contr + copy pdata,regA + ifetch 2,contr + copy pdata,timeup + copy regA,temp + call save_cont_pointers + bpatch patch19_7,mem_patch19 + setarg L2CAP_SDP_channel + isub temp,null + branch l2cap_proc_signal_disconnect_req_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch l2cap_proc_signal_disconnect_req_rfcomm,zero + setarg L2CAP_HID_Control_channel + isub temp,null + branch l2cap_proc_signal_disconnect_req_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + isub temp,null + branch l2cap_proc_signal_disconnect_req_hid_int,zero + call l2cap_reject_command + branch l2cap_proc_signal_disconnect_req_err_rtn +l2cap_proc_signal_disconnect_req_hid_ctrl: + copy timeup,temp + fetch 2,mem_hid_ctrl_remote_cid + isub temp,null + branch l2cap_disconnect_hid_control_now,zero + call l2cap_reject_command + branch l2cap_proc_signal_disconnect_req_err_rtn +l2cap_proc_signal_disconnect_req_hid_int: + copy timeup,temp + fetch 2,mem_hid_int_remote_cid + isub temp,null + branch l2cap_disconnect_hid_interrupt_now,zero + call l2cap_reject_command + branch l2cap_proc_signal_disconnect_req_err_rtn + +l2cap_proc_signal_disconnect_req_sdp: + copy timeup,temp + fetch 2,mem_sdp_remote_cid + isub temp,null + branch l2cap_disconnect_sdp_now,zero + call l2cap_reject_command + branch l2cap_proc_signal_disconnect_req_err_rtn +l2cap_disconnect_hid_control_now: + call l2cap_reset_hid_ctrl_state + branch l2cap_send_disconnect_rsp_pkt +l2cap_disconnect_hid_interrupt_now: + call l2cap_reset_hid_int_state + fetch 2, mem_hid_ctrl_remote_cid + branch l2cap_send_disconnect_rsp_pkt, blank + //set the flag,hid channel close + //should we set here? + //call HID_mem_lock + //fetch 1, mem_hid_cb1 + //set1 HID_CB_APP_HID_DISCONNECTED,pdata + //store 1, mem_hid_cb1 + //call HID_mem_unlock + branch l2cap_send_disconnect_rsp_pkt + +l2cap_disconnect_sdp_now: + call l2cap_reset_sdp_channel_state + fetch 1,mem_upper_sm_ss + nbranch l2cap_send_disconnect_rsp_pkt,blank + //jam LMP_ENCRYPTION_MODE_REQ,mem_lmo_opcode2 + //jam UPPERSM_RP_SDP_CONN,mem_upper_sm_remote_page + branch l2cap_send_disconnect_rsp_pkt +l2cap_proc_signal_disconnect_req_rfcomm: + copy timeup,temp + fetch 2, mem_RFCOMM_remote_CID + isub temp,null + branch l2cap_disconnect_rfcomm_now,zero + call l2cap_reject_command + branch l2cap_proc_signal_disconnect_req_err_rtn +l2cap_disconnect_rfcomm_now: + call l2cap_reset_rfcomm_channel_state + branch l2cap_send_disconnect_rsp_pkt +l2cap_send_disconnect_rsp_pkt: + call load_cont_pointers + setarg signal_disconnect_rsp + istore 1,contw + copy queue,pdata + istore 1,contw + setarg 0x0004 + istore 2,contw + copy regA,pdata + istore 2,contw + copy timeup,pdata + istore 2,contw + force 8,pdata + branch l2cap_proc_signal_disconnect_req_rtn +l2cap_proc_signal_disconnect_req_err_rtn: + call load_cont_pointers + branch l2cap_proc_signal_disconnect_req_rtn +l2cap_proc_signal_disconnect_req_rtn: + iadd regB,regB + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_disconnect_rsp: + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + copy regC,pdata + isub regA,regC + ifetch 2,contr + copy pdata,timeup + ifetch 2,contr + copy pdata,temp + call save_cont_pointers + bpatch patch1a_0,mem_patch1a + setarg L2CAP_SDP_channel + isub temp,null + branch l2cap_proc_signal_disconnect_rsp_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch l2cap_proc_signal_disconnect_rsp_rfcomm,zero + setarg L2CAP_HID_Control_channel + isub temp,null + branch l2cap_proc_signal_disconnect_rsp_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + isub temp,null + branch l2cap_proc_signal_disconnect_rsp_hid_int,zero + call l2cap_reject_command + branch l2cap_proc_signal_disconnect_rsp_err_rtn +l2cap_proc_signal_disconnect_rsp_sdp: + copy temp,regA + copy timeup,temp + fetch 2,mem_sdp_remote_cid + isub temp,null + call l2cap_reset_sdp_channel_state,zero + branch l2cap_proc_signal_disconnect_rsp_rtn +l2cap_proc_signal_disconnect_rsp_rfcomm: + copy temp,regA + copy timeup,temp + fetch 2,mem_rfcomm_remote_CID + isub temp,null + call l2cap_reset_rfcomm_channel_state,zero + branch l2cap_proc_signal_disconnect_rsp_rtn +l2cap_proc_signal_disconnect_rsp_hid_ctrl: + copy temp,regA + copy timeup,temp + fetch 2,mem_hid_ctrl_remote_cid + isub temp,null + call l2cap_reset_hid_ctrl_state,zero + branch l2cap_proc_signal_disconnect_rsp_rtn +l2cap_proc_signal_disconnect_rsp_hid_int: + copy temp,regA + copy timeup,temp + fetch 2,mem_hid_int_remote_cid + isub temp,null + call l2cap_reset_hid_int_state,zero + branch l2cap_proc_signal_disconnect_rsp_rtn +l2cap_proc_signal_disconnect_rsp_rtn: + call load_cont_pointers + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_disconnect_rsp_err_rtn: + branch l2cap_process_one_signal_rtn + +/* received an echo request from remote BD. Will echo the 1st 1 byte back, */ +l2cap_proc_signal_echo_req: + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + iadd contr,contr + setarg 9 + istore 1,contw + copy queue,pdata + istore 1,contw + force 0x0000,pdata + istore 2,contw + force 4,pdata + iadd regB,regB + copy regC,pdata + isub regA,regC + branch l2cap_process_one_signal_rtn +l2cap_proc_signal_echo_rsp: + branch l2cap_process_one_signal_rtn + +l2cap_proc_signal_info_rsp: + branch l2cap_process_one_signal_rtn +l2cap_reject_command: + force 0,regB + call l2cap_get_signal_tx_payload + setarg signal_cmd_reject + istore 1,contw + copy queue,pdata + istore 1,contw + setarg 2 + istore 2,contw + setarg cmd_not_understood + istore 2,contw + increase 6,regB + arg 4,regC + branch l2cap_process_one_signal_rtn + + + +l2cap_reset_rfcomm_channel_state: + setarg 0 + store 2,mem_RFCOMM_Tx_pkt_length + store 2,mem_RFCOMM_remote_CID + jam 0,mem_rfcomm_state + rtn +l2cap_reset_sdp_channel_state: + setarg 0 + store 2,mem_sdp_tx_pkt_length + store 2,mem_sdp_remote_cid + jam 0,mem_sdp_state + rtn +l2cap_reset_hid_ctrl_state: + setarg 0 + store 2,mem_hid_ctrl_remote_cid + jam 0,mem_hid_control_state + fetch 1,mem_hid_interrupt_state + beq 0,l2cap_reset_hid_disconnected + rtn + +l2cap_reset_hid_int_state: + setarg 0 + store 2,mem_hid_int_remote_cid + jam 0,mem_hid_interrupt_state + fetch 1,mem_hid_control_state + beq 0,l2cap_reset_hid_disconnected + rtn + +l2cap_reset_hid_disconnected: + jam BT_EVT_HID_DISCONNECTED,mem_fifo_temp + branch ui_ipc_send_event + +l2cap_disconnect_interrupt_req: + fetch 1,mem_CONTROL_tasks + set0 L2CAP_DISCONNECT_INTERRUPT, pdata + store 1,mem_CONTROL_tasks + fetch 2, mem_hid_int_remote_cid + rtn blank + call l2cap_malloc_signal_channel + fetch 2, mem_hid_int_remote_cid + copy pdata,regA + force L2CAP_HID_Interrupt_channel,regB + branch l2cap_generate_disconnect_req +l2cap_disconnect_control_req: + fetch 1,mem_CONTROL_tasks + set0 L2CAP_DISCONNECT_CONTROL, pdata + store 1,mem_CONTROL_tasks + fetch 2, mem_hid_ctrl_remote_cid + rtn blank + call l2cap_malloc_signal_channel + fetch 2, mem_hid_ctrl_remote_cid + copy pdata,regA + force L2CAP_HID_Control_channel,regB +l2cap_generate_disconnect_req: + call l2cap_get_req_id + call l2cap_get_signal_tx_payload + force signal_disconnect_req,pdata + istore 1,contw + fetch 1,mem_ML2CAP_comm_id + istore 1,contw + setarg 0x0004 + istore 2,contw + copy regA,pdata + istore 2,contw + copy regB,pdata + istore 2,contw + force 0x08,temp //signal tx length in temp + branch ml2cap_send_signal + +ml2cap_send_signal_connect_req: + bpatch patch1a_1,mem_patch1a + call l2cap_get_req_id + call l2cap_get_signal_tx_payload + setarg signal_connect_req + istore 1,contw + fetch 1,mem_ML2CAP_comm_id + istore 1,contw + setarg 0x0004 + istore 2,contw + copy temp,pdata //PSM + istore 2,contw + copy timeup,pdata + istore 2,contw + arg 8,temp + branch ml2cap_send_signal +ml2cap_send_signal_config_req: + bpatch patch1a_2,mem_patch1a + call l2cap_get_req_id + call l2cap_get_signal_tx_payload + setarg signal_config_req + istore 1,contw + fetch 1,mem_ML2CAP_comm_id + istore 1,contw + setarg 0x0008 + istore 2,contw + /****modigy for nokia*****/ + copy temp,pdata + /*setarg 0x0040*/ + istore 2,contw + setarg 0x0000 + istore 2,contw + setarg 0x01 + istore 1,contw + setarg 0x02 + istore 1,contw + setarg L2CAP_config_MTU_RFCOMM + istore 2,contw + arg 0xc,temp + branch ml2cap_send_signal +ml2cap_send_signal_disconn_req: + bpatch patch1a_3,mem_patch1a + call l2cap_get_req_id + call l2cap_get_signal_tx_payload + setarg signal_disconnect_req + istore 1,contw + fetch 1,mem_ML2CAP_comm_id + increase 1,pdata + copy contw,regA + store 1,mem_ML2CAP_comm_id + copy regA,contw + istore 1,contw + setarg 0x0004 + istore 2,contw + copy temp,pdata + istore 2,contw + copy timeup,pdata + istore 2,contw + arg 0x8,temp + //branch ml2cap_send_signal + //Fall through +ml2cap_send_signal: + storet 2,mem_l2cap_signal_tx_length + copy temp,pdata + branch l2cap_malloc_discard,blank + call l2cap_get_signal_tx_buff + fetch 2,mem_l2cap_signal_tx_length + istore 2,contw //make sure that length is still in temp! + force L2CAP_signal_channel,pdata + istore 2,contw + rtn + +msdp_send_req_done: + fetch 2,mem_sdp_tx_pkt_length + branch assert,blank + call l2cap_get_sdp_tx_buff + fetch 2,mem_sdp_tx_pkt_length + istore 2,contw + fetch 2,mem_sdp_remote_cid + istore 2,contw + rtn +ml2cap_rx_multiplexing: + fetch 2, mem_l2cap_rx_pkt_length + branch l2cap_rx_reset_state,blank + bpatch patch1a_4,mem_patch1a + fetch 1,mem_l2cap_rx_cid + beq L2CAP_signal_channel,ml2cap_call_proc_signal + beq L2CAP_SDP_channel,ml2cap_call_proc_sdp + beq L2CAP_RFCOMM_channel,l2cap_call_proc_rfcomm + beq L2CAP_HID_Control_channel,l2cap_call_proc_hid + beq L2CAP_HID_Interrupt_channel,l2cap_call_proc_hid + branch l2cap_rx_reset_state + +ml2cap_call_proc_signal: + bpatch patch1a_5,mem_patch1a + call l2cap_malloc_signal_channel + force 0,regB + call l2cap_get_signal_tx_payload + copy pdata,contw + fetch 2,mem_l2cap_rx_pkt_length + copy pdata,regC + fetch 2,mem_l2cap_payload_ptr + iforce contr +ml2cap_proc_one_comm_loop: + call ml2cap_proc_one_comm + increase -4,regC + nbranch ml2cap_proc_one_comm_loop,zero + copy regB,temp + call ml2cap_send_signal + branch l2cap_rx_reset_state + +ml2cap_proc_one_comm: + ifetch 1,contr + beq signal_connect_req,ml2cap_proc_signal_connect_req + beq signal_cmd_reject,ml2cap_proc_signal_cmd_reject + beq signal_connect_rsp,ml2cap_proc_signal_connect_rsp + beq signal_config_rsp,ml2cap_proc_signal_config_rsp + beq signal_config_req,ml2cap_proc_signal_config_req + beq signal_disconnect_rsp,ml2cap_proc_signal_disconn_rsp + beq signal_disconnect_req,ml2cap_proc_signal_disconn_req + beq signal_echo_req,l2cap_proc_signal_echo_req + beq signal_info_req,ml2cap_proc_signal_info_req + branch ml2cap_proc_send_reject + +ml2cap_proc_signal_connect_req: + call save_cont_pointers + //jam NO_RECONNECTION,memui_reconnect_mode + call load_cont_pointers + branch l2cap_proc_signal_connect_req +ml2cap_proc_signal_cmd_reject: + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + copy regC,pdata + isub regA,regC +mvptr: + ifetch 1,contr + increase -1,regA + nbranch mvptr,zero + rtn +ml2cap_proc_signal_connect_rsp: + ifetch 1,contr //id + copy pdata,queue + ifetch 2,contr + copy pdata,regA //length + ifetch 2,contr + copy pdata,timeup //destination cid + ifetch 2,contr + copy pdata,temp //source cid + ifetch 2,contr // result + sub pdata,0,null + branch ml2cap_proc_signal_connect_rsp_sucessful,zero + beq L2CAP_connect_refused_PSM_unsupported,ml2cap_proc_signal_connect_refused_result + beq L2CAP_connect_refused_no_resources,ml2cap_proc_signal_connect_refused_result + branch ml2cap_proc_signal_connect_rsp_mnosucc +ml2cap_proc_signal_connect_refused_result: + jam BT_EVT_ML2CAP_CONN_REFUSED,mem_fifo_temp + call ui_ipc_send_event +ml2cap_proc_signal_connect_rsp_mnosucc: + ifetch 2,contr //reason + branch mnosucc +ml2cap_proc_signal_connect_rsp_sucessful: + call save_cont_pointers + //fetch 1,mem_ML2CAP_comm_id + //icompare 0xff,queue + //nbranch mnosucc1,true + bpatch patch1a_6,mem_patch1a + setarg L2CAP_SDP_channel + isub temp,null + branch ml2cap_proc_signal_connect_rsp_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch ml2cap_proc_signal_connect_rsp_rfcomm,zero + setarg L2CAP_HID_Interrupt_channel + isub temp,null + branch ml2cap_proc_signal_connect_rsp_hid_int,zero + setarg L2CAP_HID_Control_channel + isub temp,null + branch ml2cap_proc_signal_connect_rsp_hid_ctrl,zero + branch mnosucc +ml2cap_proc_signal_connect_rsp_sdp: + copy timeup,pdata + store 2,mem_sdp_remote_cid + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_CONN_RES + store 1,mem_sdp_state + branch mnosucc1 +ml2cap_proc_signal_connect_rsp_rfcomm: + copy timeup,pdata + store 2,mem_RFCOMM_remote_CID + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_CONN_RES + store 1,mem_rfcomm_state + branch mnosucc1 +ml2cap_proc_signal_connect_rsp_hid_ctrl: + copy timeup,pdata + store 2,mem_hid_ctrl_remote_cid + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_CONN_RES + store 1,mem_hid_control_state + branch mnosucc1 +ml2cap_proc_signal_connect_rsp_hid_int: + copy timeup,pdata + store 2,mem_hid_int_remote_cid + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_CONN_RES + store 1,mem_hid_interrupt_state + //branch mnosucc1 + +mnosucc1: + call load_cont_pointers +mnosucc: + copy regC,pdata + isub regA,regC + rtn + +ml2cap_proc_signal_config_rsp: + ifetch 1,contr // Ident + copy pdata,queue + ifetch 2,contr // SigLen + copy pdata,regA + copy regC,pdata + isub regA,regC + ifetch 2,contr // DestnCID + copy pdata,timeup + ifetch 2,contr + ifetch 2,contr // Get the result value, check success + nbranch mcrsdone1,blank + call save_cont_pointers + //fetch 1,mem_ML2CAP_comm_id + //icompare 0xff,queue + //nbranch mcfrsdone,true + copy timeup,temp + bpatch patch1a_7,mem_patch1a + setarg L2CAP_SDP_channel + isub temp,null + branch ml2cap_proc_signal_config_rsp_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch ml2cap_proc_signal_config_rsp_rfcomm,zero + setarg L2CAP_HID_Control_channel + isub temp,null + branch ml2cap_proc_signal_config_rsp_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + isub temp,null + branch ml2cap_proc_signal_config_rsp_hid_int,zero +ml2cap_proc_signal_config_rsp_sdp: + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES + store 1,mem_sdp_state + rtn +ml2cap_proc_signal_config_rsp_rfcomm: + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES + store 1,mem_rfcomm_state + rtn +ml2cap_proc_signal_config_rsp_hid_ctrl: + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES + store 1,mem_hid_control_state + rtn +ml2cap_proc_signal_config_rsp_hid_int: + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_RES + store 1,mem_hid_interrupt_state + jam BT_EVT_HID_CONNECTED,mem_fifo_temp + branch ui_ipc_send_event + + +mcfrsdone: + call load_cont_pointers +mcrsdone1: + increase -6,regA +mloop2: + branch mcrsdone,zero + increase 1,contr + increase -1,regA + branch mloop2 +mcrsdone: + rtn +ml2cap_proc_signal_config_req: + ifetch 1,contr // Ident + copy pdata,queue + ifetch 2,contr // SigLen + copy pdata,regA + copy regC,pdata + isub regA,regC + ifetch 2,contr // DestnCID + increase 2,contr + copy pdata,temp + setarg signal_config_rsp + istore 1,contw + copy queue,pdata + istore 1,contw + increase 2,regA + copy regA,pdata + istore 2,contw + call save_cont_pointers + bpatch patch1b_0,mem_patch1b + setarg L2CAP_SDP_channel + isub temp,null + branch ml2cap_proc_signal_config_req_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch ml2cap_proc_signal_config_req_rfcomm,zero + setarg L2CAP_HID_Control_channel + isub temp,null + branch ml2cap_proc_signal_config_req_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + isub temp,null + branch ml2cap_proc_signal_config_req_hid_int,zero + branch mcfgrq_done +ml2cap_proc_signal_config_req_sdp: + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + store 1,mem_sdp_state + bbit1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,ml2cap_proc_signal_config_req_sdp_nsndreq + fetcht 1,mem_CONTROL_tasks + set1 L2CAP_init_Config_Req,temp + storet 1,mem_CONTROL_tasks + copy queue,pdata + increase 1,pdata + store 1,mem_config_identifier + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_sdp_state +ml2cap_proc_signal_config_req_sdp_nsndreq: + fetch 2,mem_sdp_remote_cid + store 2,mem_config_req_dest_CID + branch mcfgrq_done +ml2cap_proc_signal_config_req_rfcomm: + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + store 1,mem_rfcomm_state + fetch 2,mem_RFCOMM_remote_CID + branch mcfgrq_done +ml2cap_proc_signal_config_req_hid_ctrl: + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + store 1,mem_hid_control_state + fetch 2,mem_hid_ctrl_remote_cid + branch mcfgrq_done +ml2cap_proc_signal_config_req_hid_int: + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_RCV_CFG_REQ,pdata + set1 L2CAP_CHANNEL_STATE_SND_CFG_RES,pdata + store 1,mem_hid_interrupt_state + fetch 2,mem_hid_int_remote_cid + //branch mcfgrq_done + +mcfgrq_done: + copy pdata,timeup + call load_cont_pointers +/*******for Nokia**************/ + copy timeup,pdata + /*setarg 0x0040*/ + istore 2,contw + force 0x0000,pdata + istore 2,contw + force 0x0000,pdata + istore 2,contw + force 10,pdata + iadd regB,regB + increase -6,regA +mloop1: + branch mcrqdone,zero + ifetch 1,contr + istore 1,contw + increase 1,regB + increase -1,regA + branch mloop1 +mcrqdone: + rtn +ml2cap_proc_signal_disconn_req: + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + copy regC,pdata + isub regA,regC + + ifetch 2,contr + copy pdata,regA + ifetch 2,contr + copy pdata,timeup + call save_cont_pointers + bpatch patch1b_1,mem_patch1b + setarg L2CAP_SDP_channel + copy regA,temp + isub temp,null + branch ml2cap_proc_signal_disconn_sdp,zero + setarg L2CAP_HID_Control_channel + copy regA,temp + isub temp,null + branch ml2cap_proc_signal_disconn_hid_ctrl,zero + setarg L2CAP_HID_Interrupt_channel + copy regA,temp + isub temp,null + branch ml2cap_proc_signal_disconn_hid_int,zero + branch mclsrfc +ml2cap_proc_signal_disconn_sdp: + setarg 0x0000 + store 2,mem_sdp_tx_pkt_length + store 2,mem_sdp_remote_cid + store 1,mem_sdp_state + branch mclssdp +ml2cap_proc_signal_disconn_hid_ctrl: + call l2cap_reset_hid_ctrl_state + branch mclssdp +ml2cap_proc_signal_disconn_hid_int: + call l2cap_reset_hid_int_state + //call HID_mem_lock + //fetch 1, mem_hid_cb1 + //set1 HID_CB_APP_HID_DISCONNECTED,pdata + //store 1, mem_hid_cb1 + //call HID_mem_unlock + branch mclssdp +mclsrfc: + setarg 0x0000 + store 2,mem_RFCOMM_Tx_pkt_length +mclssdp: + call load_cont_pointers + setarg signal_disconnect_rsp + istore 1,contw + copy queue,pdata + istore 1,contw + setarg 0x0004 + istore 2,contw + copy regA,pdata + istore 2,contw + copy timeup,pdata + istore 2,contw + force 8,pdata + iadd regB,regB + rtn + +ml2cap_proc_signal_disconn_rsp: + ifetch 1,contr + copy pdata,queue + ifetch 2,contr + copy pdata,regA + ifetch 2,contr + copy pdata,timeup + ifetch 2,contr + copy pdata,temp + call save_cont_pointers + bpatch patch1b_2,mem_patch1b + fetch 1,mem_ML2CAP_comm_id + icompare 0xff,queue + nbranch mdisdone,true + setarg L2CAP_SDP_channel + isub temp,null + branch ml2cap_proc_signal_disconn_rsp_sdp,zero + setarg L2CAP_RFCOMM_channel + isub temp,null + branch ml2cap_proc_signal_disconn_rsp_rfcomm,zero + branch mdisdone +ml2cap_proc_signal_disconn_rsp_sdp: + jam 0,mem_sdp_remote_cid + jam 0,mem_sdp_state + branch mdisdone +ml2cap_proc_signal_disconn_rsp_rfcomm: + // + // +mdisdone: + call load_cont_pointers + copy regC,pdata + isub regA,regC + rtn + +ml2cap_proc_send_reject: + setarg signal_cmd_reject + istore 1,contw + ifetch 1,contr + istore 1,contw + setarg 0x0002 + istore 2,contw + setarg 0x0000 + istore 2,contw + setarg 0x0006 + iadd regB,regB + force 4,regC + rtn + +//l2cap command id, 0 is not allowed +l2cap_get_req_id: + fetch 1,mem_ML2CAP_comm_id + increase 1,pdata + bne 0,l2cap_get_req_id_ok + increase 1,pdata +l2cap_get_req_id_ok: + store 1,mem_ML2CAP_comm_id + rtn + + +/*********************************************************/ +//char* malloc(short len) +//input: regA -> len +//rtn: regB -> pbuff;return from pdata +//val: queue -> i +//val: timeup -> buff_cnt +/*********************************************************/ +l2cap_malloc: + bpatch patch1b_3,mem_patch1b + arg 0,regb + call l2cap_malloc_is_fifo_full + nbranch assert,blank//assert when fifo full + call l2cap_malloc_get_full_map +ifdef DEBUG_MALLOC + call l2cap_malloc_log_get_ptr + copy regA,pdata + istore 2,contw + sub pdata,1024,null + branch assert,positive + branch assert,blank +endif + arg mem_tx_buff0,regB//pbuff = buff0; + arg 0,queue // i = 0; +l2cap_malloc_loop: + fetcht 1,mem_used_map + qisolate1 temp + branch l2cap_malloc_next,true//if(1 == (used_map & (1 << i)))goto next; + call l2cap_malloc_enough + sub timeup,0,null// (0 - timeup) + branch l2cap_malloc_next,positive//if(buff_cnt <= 0)goto next; + call l2cap_malloc_into_fifo + branch l2cap_malloc_rtn//return (pbuff); +l2cap_malloc_next: + increase 128,regB//pbuff += BUFF_SIZE;//point to next buff + increase 1,queue + setarg 8//BUFF_MAX_COUNT + isub queue,null //BUFF_MAX_COUNT - i + branch l2cap_malloc_loop,positive//while(i < buff_max_count) + arg 0,regB//return NULL +l2cap_malloc_rtn: +ifdef DEBUG_MALLOC + call l2cap_malloc_log_get_ptr + copy regB,pdata + istore 2,contw +endif + copy regB,pdata + branch assert,blank + rtn//return pointer via pdata + +/*********************************************************/ +//void* l2cap_malloc_fifo_out(void) +//output:len -> temp +//output:ptr ->pdata +//only get ptr,not free +/*********************************************************/ +l2cap_malloc_fifo_out: + bpatch patch1b_4,mem_patch1b + call l2cap_malloc_fifo_get_first_ptr + increase 1,contr + ifetch 2,contr //ptr ->pdata + rtn + +/*********************************************************/ +//void free_first_buff_in_fifo(void) +//only free the first one +/*********************************************************/ +l2cap_malloc_free: + bpatch patch1b_5,mem_patch1b + call l2cap_malloc_fifo_get_first_ptr + copy contr,contw + copy contr,temp + setarg 0 + istore 3,contw +ifdef DEBUG_MALLOC + call l2cap_malloc_log_get_ptr + setarg 0xaa + istore 1,contw + istoret 1,contw +endif + rtn +/*********************************************************/ +//void l2cap_malloc_discard(void) +//discard the latest malloc +/*********************************************************/ +l2cap_malloc_discard: + bpatch patch1b_6,mem_patch1b + call l2cap_malloc_is_fifo_empty + branch assert,blank + fetch 3,mem_tx_fifo2 + store 3,mem_tx_fifo3 + fetch 3,mem_tx_fifo1 + store 3,mem_tx_fifo2 + fetch 3,mem_tx_fifo0 + store 3,mem_tx_fifo1 + rtn +/*********************************************************/ +//bool fifo_is_full(void) +//blank == 1: not full +//blank == 0: full +/*********************************************************/ +l2cap_malloc_is_fifo_full: + bpatch patch1b_7,mem_patch1b + fetch 3,mem_tx_fifo0 + rtn +/*********************************************************/ +//bool fifo_nearly_full(void) +//blank == 1: nearly full +//blank == 0: not nearly full +/*********************************************************/ +l2cap_malloc_is_fifo_nearly_full: + bpatch patch1c_0,mem_patch1c + fetch 3,mem_tx_fifo1 + rtn +/*********************************************************/ +//bool fifo_is_empty(void) +//blank == 1: empty +//blank == 0: not empty +/*********************************************************/ +l2cap_malloc_is_fifo_empty: + bpatch patch1c_1,mem_patch1c + fetch 3,mem_tx_fifo3 + rtn +/*********************************************************/ +//char* l2cap_malloc_fifo_get_first_ptr(void) +//output:contr -->ptr +/*********************************************************/ +l2cap_malloc_fifo_get_first_ptr: + call l2cap_malloc_is_fifo_empty + branch assert,blank // fifo is empty + arg mem_tx_fifo0,contr +ifdef DEBUG_MALLOC + arg 5,loopcnt +l2cap_malloc_free_loop: + increase -1,loopcnt + copy loopcnt,pdata + branch assert,blank +else +l2cap_malloc_free_loop: +endif + ifetch 3,contr + branch l2cap_malloc_free_loop,blank + increase -3,contr + rtn + +/*********************************************************/ +//char* l2cap_malloc_get_full_map(void) +//output:mem_used_map -->full_map +//add all maps into one +/*********************************************************/ +l2cap_malloc_get_full_map: + bpatch patch1c_2,mem_patch1c + arg 4,loopcnt + arg mem_tx_fifo0_map,contr + arg 0,temp +l2cap_malloc_get_full_map_loop: + ifetch 3,contr + and pdata,0xff,pdata + ior temp,temp + loop l2cap_malloc_get_full_map_loop + storet 1,mem_used_map + rtn +/*********************************************************/ +//void buff_into_fifo(char buff_index, char buff_cnt, short len) +//input: regA -> len +//input: regC -> buff_index +//input: timeup -> buff_cnt +//val:temp -> (fifo->map) +/*********************************************************/ +l2cap_malloc_into_fifo: + bpatch patch1c_3,mem_patch1c + call l2cap_malloc_is_fifo_full + nbranch assert,blank //fifo full + call l2cap_malloc_is_fifo_empty + branch l2cap_malloc_into_fifo_no_push,blank//fifo empty, no need to push + fetch 3,mem_tx_fifo1 + store 3,mem_tx_fifo0 + ifetch 3,contr//mem_tx_fifo2 + istore 3,contw//mem_tx_fifo1 + ifetch 3,contr//mem_tx_fifo3 + istore 3,contw//mem_tx_fifo2 + setarg 0 + istore 3,contw//mem_tx_fifo3 +l2cap_malloc_into_fifo_no_push: + arg 0,temp + copy timeup,pdata + iadd queue,pdata +l2cap_malloc_into_fifo_loop: + qset1 temp//fifo->map |= 1 << i; + increase 1,queue + isub queue,null + nbranch l2cap_malloc_into_fifo_loop,zero + //map in temp + lshift8 regB,pdata + ior temp,pdata + store 3,mem_tx_fifo3 + rtn + +/*********************************************************/ +//char is_size_enough(char buff_index, short len) +//input: regA -> len +//input: queue -> buff_index +//rtn: timeup -> buff_cnt +//val: max_size_fom_buff_index -> temp +//val: i -> loopcnt +/*********************************************************/ +l2cap_malloc_enough: + bpatch patch1c_4,mem_patch1c + call l2cap_malloc_get_full_map + copy queue,regC//restore buff_index to regC + arg 0,temp + arg 0,timeup//default return val + //increase 1,queue +l2cap_malloc_enough_loop: + copy queue,pdata + beq 8,l2cap_malloc_enough_end + fetch 1,mem_used_map + qisolate1 pdata + branch l2cap_malloc_enough_end,true + increase 128,temp + increase 1,queue + copy regA,pdata + isub temp,null + branch l2cap_malloc_enough_end,zero//(max_size_fom_buff_index == len) + branch l2cap_malloc_enough_loop,positive//(max_size_fom_buff_index < len) +l2cap_malloc_enough_end: + copy temp,pdata + isub regA,null + nbranch l2cap_malloc_enough_rtn,positive// max_size_fom_buff_index - len > 0 + copy queue,pdata//i + copy regC,temp//buff_index + isub temp,timeup//return (i - buff_index) +l2cap_malloc_enough_rtn: + copy regC,queue//restore buff_index to queue + rtn + +ifdef DEBUG_MALLOC +l2cap_malloc_log_get_ptr: + fetch 2,mem_tx_malloc_log + increase 2,pdata + store 2,mem_tx_malloc_log + sub pdata,62,null + nbranch l2cap_malloc_log_clean,positive + increase -2,pdata + iadd contw,contw + rtn +l2cap_malloc_log_clean: + jam 0x00,mem_tx_malloc_log + branch l2cap_malloc_log_get_ptr +endif + +l2cap_malloc_signal_channel: + bpatch patch1c_5,mem_patch1c + arg L2CAP_SIGNAL_MALLOC_SIZE,regA + call l2cap_malloc + store 2,mem_l2cap_signal_tx_buff_ptr + increase 4,pdata + store 2,mem_l2cap_signal_tx_payload_ptr + setarg 0 + store 2,mem_l2cap_signal_tx_length + rtn + +l2cap_get_signal_tx_buff: + fetch 2,mem_l2cap_signal_tx_buff_ptr + branch l2cap_util_pdata_to_contw + +l2cap_get_signal_tx_payload: + fetch 2,mem_l2cap_signal_tx_payload_ptr + branch l2cap_util_pdata_to_contw + + +l2cap_malloc_sdp_channel: + bpatch patch1c_6,mem_patch1c + arg SDP_MALLOC_SIZE,regA + call l2cap_malloc + store 2,mem_sdp_tx_buff_ptr + increase 4,pdata + store 2,mem_sdp_tx_payload_ptr + setarg 0 + store 2,mem_sdp_tx_pkt_length + rtn + +l2cap_get_sdp_tx_buff: + fetch 2,mem_sdp_tx_buff_ptr + branch l2cap_util_pdata_to_contw + +l2cap_get_sdp_tx_payload: + fetch 2,mem_sdp_tx_payload_ptr + branch l2cap_util_pdata_to_contw + + +l2cap_malloc_rfcomm_channel: + bpatch patch1c_7,mem_patch1c + call push_stack + jam RFCOMM_MALLOC_FAIL,mem_rfcomm_malloc_fail_flag + call l2cap_malloc_is_fifo_full + nrtn blank + arg RFCOMM_MALLOC_SIZE,regA + call l2cap_malloc + store 2,mem_rfcomm_tx_buff_ptr + increase 4,pdata + store 2,mem_rfcomm_tx_payload_ptr + setarg 0 + store 2,mem_rfcomm_tx_pkt_length + jam RFCOMM_MALLOC_SUCCEED,mem_rfcomm_malloc_fail_flag + branch pop_stack + +l2cap_get_rfcomm_tx_buff: + fetch 2,mem_rfcomm_tx_buff_ptr + branch l2cap_util_pdata_to_contw + +l2cap_util_pdata_to_contw: + branch assert,blank + copy pdata,contw + rtn + + +l2cap_lpm_save_calc_len: + bpatch patch1d_0,mem_patch1d + arg 0,regb + arg mem_tx_fifo0_map,rega + increase -2,rega +l2cap_lpm_save_calc_len_loop: + increase 2,rega + setarg mem_tx_fifo_end + isub rega,null + branch l2cap_lpm_save_calc_len_end,zero //end of 2lcap tx fifo + ifetch 1,rega + increase 1,rega + branch l2cap_lpm_save_calc_len_loop,blank + ifetcht 2,rega + ifetch 2,temp + iadd regb,regb + increase 4,regb //l2cap header len + branch l2cap_lpm_save_calc_len_loop +l2cap_lpm_save_calc_len_end: + copy regb,pdata + rtn + + +l2cap_lpm_get_wake_lock: + arg wake_lock_l2cap_tx,queue + branch lpm_get_wake_lock + +l2cap_lpm_put_wake_lock: + arg wake_lock_l2cap_tx,queue + branch lpm_put_wake_lock + +l2cap_lpm_save_txbuf: + bpatch patch1d_1,mem_patch1d + call l2cap_malloc_get_full_map + fetch 1,mem_used_map + rtn blank + call l2cap_lpm_save_calc_len + arg l2cap_lpm_txbuf_len,temp + isub temp,null + branch l2cap_lpm_get_wake_lock,positive //no enougth space to save l2cap tx data + call l2cap_lpm_put_wake_lock + arg mem_l2cap_lpm_txbuf,contw + arg mem_tx_fifo0,rega +l2cap_lpm_save_txbuf_loop: + setarg mem_tx_fifo_end + isub rega,null + rtn zero //end of 2lcap tx fifo + ifetch 1,rega //mem_tx_fifoX_map + increase 1,rega + nbranch l2cap_lpm_save_txbuf_nempty,blank + istore 2,contw // length = 0 + increase 2,rega + branch l2cap_lpm_save_txbuf_loop +l2cap_lpm_save_txbuf_nempty: + ifetch 2,rega //ptr + increase 2,rega + copy pdata,contr + ifetch 2,contr //l2cap len + istore 2,contw + copy pdata,loopcnt + increase 2,loopcnt //add CID len + call memcpy + branch l2cap_lpm_save_txbuf_loop + +l2cap_lpm_load_txbuf: + bpatch patch1d_2,mem_patch1d + call l2cap_malloc_get_full_map + fetch 1,mem_used_map + rtn blank + arg mem_tx_fifo0_ptr,rega + increase -3,rega //mem_tx_fifo0_ptr -3 + arg mem_l2cap_lpm_txbuf,contr +l2cap_lpm_load_txbuf_loop: + increase 3,rega //mem_tx_fifoX_ptr + setarg mem_tx_fifo_end+1 + isub rega,null + rtn zero //end of 2lcap tx fifo + ifetch 2,contr + branch l2cap_lpm_load_txbuf_loop,blank + increase 4,pdata //l2cap header len + copy pdata,loopcnt + copy contr,regb + ifetch 2,rega //ptr + copy pdata,contw + copy regb,contr + increase -2,contr + call memcpy + branch l2cap_lpm_load_txbuf_loop + + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le.prog (working copy) @@ -0,0 +1,1849 @@ +ifdef COMPILE_LE +//******************************************// +//*************LE INIT ****************// +//******************************************// + + +le_init_conn: + bpatch patch1d_3,mem_patch1d + disable wake + jam 1,mem_le_conn_handle + jam 3,mem_le_state + jam 1,mem_le_arq + setarg -1 + store 2,mem_le_event_count + force 0,pdata + store 1,mem_le_ch + store 1,mem_le_op + store 3,mem_sniff_rcv + store 3,mem_sniff_lost + store 5,mem_le_pcnt_tx + set1 39,pdata + store 5,mem_le_pcnt_rx + jam 1,mem_le_txheader + jam 0,mem_le_txlen + branch le_supervision_flush + +le_init_master: + bpatch patch1d_4,mem_patch1d + enable master + jam lemode_master,mem_le_mode + jam 1,mem_le_att_handle + jam 1,mem_le_search_handle_start + setarg 0xffff + store 2,mem_le_search_handle_end + force 0,pdata + store 5,mem_le_pcnt_rx + set1 39,pdata + store 5,mem_le_pcnt_tx + branch le_init_conn + + +le_init_slave: + bpatch patch1d_5,mem_patch1d + disable master + setarg 0x17 + store 2,mem_le_remote_mtu + jam lemode_slave,mem_le_mode + jam 0,mem_le_adv_enable + jam 0,mem_lpm_current_mult + jam FLAG_LE_PAIRING_NULL,mem_le_pairing_state + jam FLAG_LE_ENC_NULL,mem_le_enc_state + fetch 2,mem_le_superto + store 2,mem_le_init_superto + fetch 2,mem_le_tsniff + mul32 pdata,5,pdata + rshift4 pdata,pdata + store 2,mem_le_superto // vol.6 part B 4.5.2 only 6*conninterval before establish + branch le_init_conn + + +//******************************************// +//*************LE main process*********// +//******************************************// +le_dispatch: + call le_enable + call le_scan + call le_adv + branch le_disable + +le_conn_dispatch: + bpatch patch1d_6,mem_patch1d + call le_enable + call app_process_ble + fetch 1,mem_le_mode + beq lemode_master,le_master_dispatch + branch le_slave_dispatch + +//******************************************// +//***********LE master process*********// +//******************************************// + +le_master_dispatch: + bpatch patch1d_7,mem_patch1d + enable master + call le_supervision_update + branch le_master_disconn,positive + call check_ble_disabled + call le_setup + call le_prepare_tx + disable match + call le_transmit_receive_sifs + nrtn match + bpatch patch1e_0,mem_patch1e + fetch 1,mem_le_conn_rcv + increase 1,pdata + store 1,mem_le_conn_rcv + call le_acknowledge + disable master + rtn + +le_master_disconn: + call le_disconnect + disable master + rtn + +//******************************************// +//***********LE slave process***********// +//******************************************// +le_slave_dispatch: + bpatch patch1e_1,mem_patch1e + jam 0,mem_le_md_count +ifdef SECURE_CONNECTION + call sp_calc_sequence_256 + call le_secure_connect_sm +endif + disable attempt + call le_supervision_update + branch le_slave_disconn,positive + call check_ble_disabled + call le_setup + call le_receive_slave + nbranch le_slave_unsync,sync // vol.6 part B 4.5.1 respond even crc error + call le_got_first_packet + branch le_slave_match,match + branch le_slave_cont + + +le_slave_match: + bpatch patch1e_2,mem_patch1e + fetch 1,mem_le_md_count + pincrease 1 + store 1,mem_le_md_count + beq LE_MD_MAX_COUNT,le_slave_cont + call le_acknowledge + call le_prepare_tx + call le_transmit_norx + call le_parse + fetch 2,mem_cb_ble_transmit + call callback_func + call le_check_md + branch le_slave_more_data,user +le_slave_cont: + bpatch patch1e_3,mem_patch1e + call le_pairing_sm + call le_check_paring_time + call check_51cmd + fetch 1,mem_le_op + bbit1 op_disconn,le_slave_disconn +le_slave_unsync: + bpatch patch1e_4,mem_patch1e + call le_lpm_set_mult + call le_update_channel_map + call le_update_param + branch calc_clke_offset + + +le_check_md: + disable user + bmark1 mark_ble_rx_md,enable_user + bmark1 mark_ble_tx_md,enable_user + rtn + + +le_slave_more_data: + bpatch patch1e_5,mem_patch1e + enable attempt + call le_transmit_receive_sifs_notx + branch le_slave_match,match + branch le_slave_cont + +le_slave_disconn: + + //fall through +le_disconnect: + bpatch patch1e_6,mem_patch1e + call le_clear_connection_info + call app_disconn_reason_collect_ble +ifdef SECURE_CONNECTION + call sp_initialize_256 +endif + jam BT_EVT_LE_DISCONNECTED,mem_fifo_temp + branch ui_ipc_send_event + +le_clear_connection_info: + setarg 0 + store 9,mem_le_tx_buff_used + jam 0,mem_le_conn_handle + jam lemode_idle,mem_le_mode + jam 0,mem_le_state + jam FLAG_LE_ENC_NULL,mem_le_enc_state + jam FLAG_LE_PAIRING_NULL,mem_le_pairing_state + rtn + +le_got_first_packet: + bpatch patch1e_7,mem_patch1e + fetch 1,mem_le_conn_rcv + increase 1,pdata + store 1,mem_le_conn_rcv + fetch 1,mem_le_state + rtnbit1 lestate_got_first_packet + set1 lestate_got_first_packet + store 1,mem_le_state + fetch 2,mem_le_init_superto + store 2,mem_le_superto + setarg 0 + store 4,mem_le_transmit_window + rtn + + +le_enable: + bpatch patch1f_0,mem_patch1f + hjam 0x36,0x90f /*For BLE, tune AGC_gain_offset, Max added*/ + hjam 0x5f,0x90b //for BLE + enable le + hjam 7,rfen_ulp /* enable ulp */ + call check_ble_disabled + fetch 1,mem_250k_freq_enable //default: 0 + rtn blank + hjam 0xb8,0x90a + rtn + +le_disable: + bpatch patch1f_1,mem_patch1f + hjam 0x2e,0x90f /*For BR/EDR, tune AGC_gain_offset, Max added*/ + hjam 0xff,0x90b //for EDR&BR + disable le + hjam 3,rfen_ulp + arg 0,stop_watch + rtn + +le_prep: + disable enable_crc + disable enable_white + fetch 3,mem_le_crcinit + iforce crc24_init + fetch 1,mem_le_ch_mapped + reverse pdata,temp + set1 1,temp + rshift temp,white_init + rtn + + +lerx_setfreq: + call le_setfreq + call set_freq_rx + setarg param_pll_setup + call sleep + branch rf_rx_enable + +letx_setfreq: + branch txon,match +letx_setfreq0: + call le_setfreq + branch set_freq_tx +le_setfreq: + bpatch patch1f_2,mem_patch1f + call set_sync_on + fetch 1, mem_le_testtype + nbranch le_ctf_test,blank + fetch 1,mem_le_ch_mapped + sub pdata,36,null + branch le_ctf_normal,positive + force 0,temp + rtneq 37 + force 24,temp + rtneq 38 + force 78,temp + rtn + +le_ctf_normal: + sub pdata,10,null + branch le_ctf_low,positive + increase 1,pdata + +le_ctf_low: + lshift pdata,pdata + add pdata,2,temp + rtn + +le_ctf_test: + fetch 1,mem_le_ch_mapped + lshift pdata,temp + rtn + +le_sca_map: + arg 500,temp + rtn blank + arg 250,temp + rtneq 1 + arg 150,temp + rtneq 2 + arg 100,temp + rtneq 3 + arg 75,temp + rtneq 4 + arg 50,temp + rtneq 5 + arg 40,temp + rtneq 6 + arg 20,temp + rtn + + + +le_adv_access: + setarg 0x8e89be + lshift8 pdata,pdata + or_into 0xd6,pdata + iforce access + setarg 0x555555 + store 3,mem_le_crcinit + rtn + +le_setup: + bpatch patch1f_3,mem_patch1f + enable swfine + fetch 4,mem_le_access + iforce access + call le_map_channel + setarg 0x200 + branch le_setup_master,master + fetch 2,mem_le_receive_window + rshift pdata,pdata +le_setup_master: + arg param_pll_setup,temp + iadd temp,pdata + call ahead_window + deposit clke + store 6,mem_le_rxon_ts + rtn + +le_next_adv_channel: + bpatch patch1f_4,mem_patch1f + fetch 1,mem_le_ch_mapped + beq 37,le_next_adv_channel_curr_channel_37 + beq 38,le_next_adv_channel_curr_channel_38 + beq 39,le_next_adv_channel_curr_channel_39 + branch le_next_adv_channel_curr_channel_39 + +le_next_adv_channel_curr_channel_37: + fetcht 1,mem_le_adv_channel_map + isolate1 BIT_ADV_CHANNEL_MAP_38,temp //check 38 channel enable + branch set_le_next_adv_channel_38,true + isolate1 BIT_ADV_CHANNEL_MAP_39,temp //check 39 channel enable + branch set_le_next_adv_channel_39,true + branch set_le_next_adv_channel_37 + + +le_next_adv_channel_curr_channel_38: + fetcht 1,mem_le_adv_channel_map + isolate1 BIT_ADV_CHANNEL_MAP_39,temp //check 39 channel enable + branch set_le_next_adv_channel_39,true + isolate1 BIT_ADV_CHANNEL_MAP_37,temp //check 37 channel enable + branch set_le_next_adv_channel_37,true + branch set_le_next_adv_channel_38 + + +le_next_adv_channel_curr_channel_39: + fetcht 1,mem_le_adv_channel_map + isolate1 BIT_ADV_CHANNEL_MAP_37,temp //check 37 channel enable + branch set_le_next_adv_channel_37,true + isolate1 BIT_ADV_CHANNEL_MAP_38,temp //check 38 channel enable + branch set_le_next_adv_channel_38,true + branch set_le_next_adv_channel_39 + + + +set_le_next_adv_channel_37: + jam 37,mem_le_ch_mapped + fetch 1,mem_le_adv_channel_map_temp + set1 BIT_ADV_CHANNEL_MAP_37,pdata + store 1,mem_le_adv_channel_map_temp + rtn + +set_le_next_adv_channel_38: + jam 38,mem_le_ch_mapped + fetch 1,mem_le_adv_channel_map_temp + set1 BIT_ADV_CHANNEL_MAP_38,pdata + store 1,mem_le_adv_channel_map_temp + rtn + +set_le_next_adv_channel_39: + jam 39,mem_le_ch_mapped + fetch 1,mem_le_adv_channel_map_temp + set1 BIT_ADV_CHANNEL_MAP_39,pdata + store 1,mem_le_adv_channel_map_temp + rtn + + + +le_context_nexthop: + bpatch patch1f_5,mem_patch1f + add rega,coffset_mode,contr + ifetch 1,contr + rtnbit0 mode_le + add rega,coffset_le_event_cnt,contw + ifetch 2,contw + increase 1,pdata + istore 2,contw + add rega,coffset_le_hop,contr + ifetch 1,contr + add rega,coffset_le_ch,contw + ifetcht 1,contw + iadd temp,pdata + sub pdata,36,null + branch le_nexthop_nowrap,positive + increase -37,pdata +le_nexthop_nowrap: + istore 1,contw + rtn + + +le_calc_channel_map: + bpatch patch1f_6,mem_patch1f + fetch 5,mem_le_channel_map + force 0,temp + force 37,loopcnt +le_count_channels_loop: + bbit0 0,le_count_channels_notused + increase 1,temp +le_count_channels_notused: + rshift pdata,pdata + loop le_count_channels_loop + add temp,-1,pdata + store 1,mem_le_channels + rtn + +le_map_channel: + bpatch patch1f_7,mem_patch1f + fetch 1,mem_le_ch + iforce queue + fetcht 5,mem_le_channel_map + qisolate1 temp + branch le_map_channel_end,true +le_map_channel_next: + bpatchx patch20_0,mem_patch20 + fetch 1,mem_le_channels + isub queue,pdata + branch le_map_channel_cont,positive + sub pdata,-1,queue + branch le_map_channel_next +le_map_channel_cont: + copy queue,loopcnt + force 0,queue +le_map_channel_loop: + qisolate1 temp + branch le_map_channel_skip,true + increase 1,loopcnt +le_map_channel_skip: + deposit loopcnt + branch le_map_channel_end,blank + increase 1,queue + increase -1,loopcnt + branch le_map_channel_loop +le_map_channel_end: + deposit queue + store 1,mem_le_ch_mapped + rtn + + +le_wait_tx: + branch le_wait_master,master + until null,timeout + rtn + +le_wait_master: + arg 0xea0,timeup + until clkn_rt,meet + rtn + +le_receive_adv: + disable swfine + fetch 2,mem_le_scan_window + copy pdata,timeup + branch le_receive_packet + + +le_receive_slave: + bpatchx patch20_1,mem_patch20 + enable swfine + fetch 2,mem_le_receive_window + fetcht 4,mem_le_transmit_window + iadd temp,timeup +le_receive_packet: + call lerx_setfreq +le_receive_rxon: + bpatchx patch20_2,mem_patch20 + call le_prep + disable match + enable decode_fec0 + enable is_rx + disable is_tx + copy timeup,stop_watch + correlate null,timeout + branch le_receive_on_attempt,attempt + copy clke,temp + storet 6,mem_sync_clke +le_receive_on_attempt: + nbranch end_of_packet,sync + branch le_receive_skip,attempt + arg param_clke_cal_le,clke_rt + copy bt_clk,clke_bt + fetch 1,mem_le_state + bbit0 lestate_got_first_packet,le_receive_skip + call lpm_adjust_clk,wake +le_receive_skip: + bpatchx patch20_3,mem_patch20 + call save_rssi + enable enable_white + enable enable_crc + parse demod,bucket,8 + rshift3 pwindow,pdata + store 1,mem_le_rxbuf + parse demod,bucket,8 + rshift3 pwindow,pdata + istore 1,contw + and pdata,0x3f,loopcnt + branch lerx_nopayload,zero + +lerx_loop: + parse demod,bucket,8 + rshift3 pwindow,pdata + istore 1,contw + loop lerx_loop + +lerx_nopayload: + bpatchx patch20_4,mem_patch20 + parse demod,bucket,24 + enable swfine + arg param_sifs,stop_watch // start SIFS timer after last bit of crc + rshift32 pdata,pdata + rshift16 pdata,pdata + istore 3,contw + branch end_of_packet,crc_failed + enable match + fetch 1,mem_last_freq + add pdata,0,rega // ble 2M Medium Frequency + call rf_write_freq /* set frequency to tx mode freq */ + disable decode_fec0 + branch set_sync_on + +le_transmit_receive_sifs: + bpatchx patch20_5,mem_patch20 + call le_transmit +le_transmit_receive_sifs_notx: + fetcht 1,mem_last_freq + call set_freq_rx + call rf_rx_enable + enable swfine + arg 5500,timeup + branch le_receive_rxon + +le_transmit_norx: + call le_transmit + branch end_of_packet + +le_transmit: + bpatchx patch20_6,mem_patch20 + call le_prep + call letx_setfreq + branch le_transmit0 + +le_transmit0: + set1 TXGFSK,radio_ctrl + enable encode_fec0 + enable is_tx + disable is_rx + call le_wait_tx + rshift16 access,pdata + rshift8 pdata,pdata + rshift4 pdata,pdata + inject mod,40 + enable enable_white + enable enable_crc + bpatchx patch20_7,mem_patch20 + fetch 1,mem_le_txheader + inject mod,8 + ifetch 1,contr + and pdata,0x3f,loopcnt + inject mod,8 + branch letr_nopayload,zero +letr_loop: + ifetch 1,contr + inject mod,8 + loop letr_loop + +letr_nopayload: + enable enable_parity + inject mod,24 + disable enable_parity + until null,tx_clear + nop 100 /* flush out the last bit */ + disable encode_fec0 + rtn + +le_send_adv_ind: + bpatchx patch21_0,mem_patch21 + fetch 1,mem_le_adv_type + beq ADV_DIRECT_IND,le_send_adv_direct_ind + fetch 1,mem_le_adv_own_addr_type + lshift4 pdata,pdata + lshift2 pdata,pdata + store 1,mem_le_txheader + fetcht 1,mem_le_adv_data_len + add temp,6,pdata + store 1,mem_le_txlen + fetch 6,mem_le_lap + store 6,mem_le_txpayload + copy temp,loopcnt + arg mem_le_adv_data,contr + call memcpy_fast + branch le_send_adv_transmit +le_send_adv_direct_ind: + fetch 1,mem_le_adv_direct_addr_type + lshift4 pdata,pdata + lshift2 pdata,pdata + increase 1,pdata + store 1,mem_le_txheader + setarg 12 + store 1,mem_le_txlen + fetch 6,mem_le_lap + store 6,mem_le_txpayload + fetch 6,mem_hci_plap + istore 6,contw +le_send_adv_transmit: + bpatchx patch21_1,mem_patch21 + fetch 1,mem_le_adv_transmit + increase 1,pdata + store 1,mem_le_adv_transmit + arg 1800,stop_watch + disable match + branch le_transmit_receive_sifs + +le_send_scan_request: + bpatchx patch21_2,mem_patch21 + fetch 1,mem_le_scan_type + rtnne LE_SCAN_TYPE_ACTIVE + fetch 1,mem_le_adv_transmit + increase 1,pdata + store 1,mem_le_adv_transmit + arg 0x0c03,temp// length + SCAN_REQ PDU + fetch 1,mem_le_scan_own_addr_type + nsetflag blank,LE_SENDER_ADDR_BIT,temp + copy regA,pdata + nsetflag blank,LE_RECEIVER_ADDR_BIT,temp + storet 2,mem_le_txheader + fetch 6,mem_le_lap + istore 6,contw + fetch 6,mem_le_plap + istore 6,contw + branch le_transmit_receive_sifs + + +le_send_scan_response: + bpatchx patch21_3,mem_patch21 + arg SCAN_RSP,temp + fetch 1,mem_le_adv_own_addr_type + nsetflag blank,LE_SENDER_ADDR_BIT,temp + storet 1,mem_le_txheader + fetcht 1,mem_le_scan_data_len + add temp,6,pdata + store 1,mem_le_txlen + fetch 6,mem_le_lap + store 6,mem_le_txpayload + arg mem_le_scan_data,contr + copy temp,loopcnt + call memcpy_fast + call le_transmit_norx + branch le_adv_not_match + +le_connect_request: + bpatchx patch21_4,mem_patch21 + force -1,pdata + setsect 2,1 + store 5,mem_le_channel_map + call le_calc_channel_map + force 4,loopcnt + arg mem_le_access,contw + call generate_random_loop + fetch 2,mem_le_timeout + store 2,mem_le_superto +le_con_req_hop_retry: + random pdata + and_into 0xf,pdata + sub pdata,4,null + branch le_con_req_hop_retry,positive + store 1,mem_le_hop + store 1,mem_tmp1 + bpatchx patch21_5,mem_patch21 + fetcht 2,mem_le_conn_interval + storet 2,mem_le_tsniff + copy temp,regc // tsniff in regc + add clkn_bt,7,pdata // leave space for offset + idiv regc + call wait_div_end + remainder rega + isub rega,pdata + iadd regc,pdata + fetcht 2,mem_le_dsniff + iadd temp,pdata + store 4,mem_le_anchor + isub clkn_bt,rega + increase -6,rega // window offset + arg 0x2205,regb // length & CONN_REQ PDU + fetch 1,mem_le_conn_own_addr_type + nsetflag blank,LE_SENDER_ADDR_BIT,regb + fetch 1,mem_le_conn_peer_addr_type + nsetflag blank,LE_RECEIVER_ADDR_BIT,regb + copy regb,pdata + store 2,mem_le_txheader + fetch 6,mem_le_lap + istore 6,contw//own addr + fetch 6,mem_le_plap + istore 6,contw// peer addr + fetch 4,mem_le_access + istore 4,contw + random pdata + istore 2,contw /* crc init */ + random pdata + istore 1,contw + force 2,pdata /* window size */ + istore 1,contw + rshift2 rega,pdata + istore 2,contw /* window offset */ + rshift2 regc,pdata + istore 2,contw /* conn Interval */ + bpatchx patch21_6,mem_patch21 + setarg 0 /* slave latency */ + istore 2,contw + fetch 2,mem_le_timeout + istore 2,contw + fetch 5,mem_le_channel_map + istore 5,contw /* channel map */ + fetch 1,mem_le_hop + arg param_le_sca,temp + ior temp,pdata + istore 1,contw + call le_transmit_norx + setarg mem_le_txheader + add pdata,18,contr + ifetch 3,contr + store 3,mem_le_crcinit + rtn + +le_init_adv: + bpatchx patch21_7,mem_patch21 + disable master + branch le_adv_access + + + +le_update_param: + fetch 1,mem_le_state + rtnbit0 lestate_update_param + fetch 2,mem_le_event_count + fetcht 2,mem_le_instant + isub temp,pdata + nrtn positive + store 2,mem_pdatatemp + bpatchx patch22_0,mem_patch22 + fetch 1,mem_le_state + set0 lestate_update_param,pdata + set0 lestate_got_first_packet,pdata + store 1,mem_le_state + fetch 4,mem_le_anchor + fetcht 2,mem_le_tsniff + storet 2,mem_temp + isub temp,rega + bpatchx patch22_1,mem_patch22 + fetch 1,mem_le_new_param + store 1,mem_le_window_size + ifetcht 2,contr + ifetch 2,contr + lshift2 pdata,pdata + store 2,mem_le_tsniff + lshift2 temp,temp + iadd temp,pdata + ifetcht 4,contr + storet 4,mem_le_slave_latency // and superTO + iadd rega,pdata + copy pdata,regab + fetch 2,mem_le_tsniff + fetcht 2,mem_temp //last sniff + isub temp,pdata //last sniff - new sniff + fetcht 2,mem_pdatatemp + imul32 temp,pdata + iadd regab,pdata + store 4,mem_le_anchor + call le_receive_window_size + fetch 2,mem_le_superto + store 2,mem_le_init_superto + rtn + + +le_update_channel_map: + bpatchx patch22_2,mem_patch22 + fetch 1,mem_le_state + rtnbit0 lestate_update_map + fetch 2,mem_le_event_count + fetcht 2,mem_le_instant + isub temp,pdata + nrtn positive + fetch 1,mem_le_state + set0 lestate_update_map,pdata + store 1,mem_le_state + fetch 5,mem_le_new_map + store 5,mem_le_channel_map + branch le_calc_channel_map + + +le_acknowledge: + bpatchx patch22_3,mem_patch22 + call le_supervision_flush + call le_check_wak + fetch 1,mem_le_rxbuf + isolate1 md,pdata + setflag true,mark_ble_rx_md,mark + rshift pdata,pdata + ixor temp,pdata + isolate1 nesn,pdata + setflag true,mark_old_packet,mark /* retransmit */ + rtnmark1 mark_old_packet + fetch 1,mem_le_rxbuf+1 + branch le_ack_unenc,blank /* empty packet, no decryption */ + fetch 1,mem_le_state + bbit0 lestate_encryption,le_ack_unenc + call load_sk + call le_decrypt + nrtn blank +le_ack_unenc: + fetcht 1,mem_le_arq + setflip nesn,temp + storet 1,mem_le_arq + rtn + + +le_check_wak: + bpatchx patch22_4,mem_patch22 + fetcht 1,mem_le_arq + isolate0 wak,temp + rtn true + fetch 1,mem_le_rxbuf + lshift pdata,pdata + ixor temp,pdata + rtnbit0 sn /* received NESN is same as SN, NAK */ + set0 wak,temp + setflip sn,temp + storet 1,mem_le_arq + compare 3,temp,3 + nrtn true + fetch 1,mem_le_txpayload + beq LL_START_ENC_REQ,le_set_enc + fetch 1,mem_le_enc_state + beq FLAG_LE_ENC_PAUSE,le_clear_enc + rtn + + +le_set_enc: + fetch 1,mem_le_state + set1 lestate_encryption,pdata + store 1,mem_le_state + rtn + +le_clear_enc: + bpatchx patch22_5,mem_patch22 + jam FLAG_LE_ENC_NULL,mem_le_enc_state + arg 0,pdata + store 4,mem_le_last_mic + store 5,mem_le_pcnt_tx + set1 39,pdata + store 5,mem_le_pcnt_rx + fetch 1,mem_le_state + set0 lestate_encryption,pdata + store 1,mem_le_state + rtn + + +le_wait_adv: + bpatchx patch22_6,mem_patch22 + call le_next_adv_channel + call le_receive_adv + fetch 1,mem_le_adv_waitcnt + increase 1,pdata + store 1,mem_le_adv_waitcnt + rtn + + +le_scan: + bpatchx patch22_7,mem_patch22 + fetch 1,mem_le_scan_enable + rtnne LE_SCAN_ENABLE + arg le_scan_interval_timer,queue + call timer_check + nrtn blank + fetch 2,mem_le_scan_interval + fetcht 2,mem_le_scan_window + isub temp,pdata + arg le_scan_interval_timer,queue + call timer_init + disable master + call le_init_adv + call le_wait_adv + nrtn match + bpatchx patch23_0,mem_patch23 + fetch 6,mem_le_rxbuf+2 + store 6,mem_le_plap +// call le_scan_dongle + + fetch 1,mem_le_adv_rcv + increase 1,pdata + store 1,mem_le_adv_rcv + call le_create_conn + rtn master + call le_send_scan_request + nrtn match + bpatchx patch23_1,mem_patch23 + fetch 1,mem_le_scanrsp_rcv + increase 1,pdata + store 1,mem_le_scanrsp_rcv + fetch 9,mem_le_rxbuf+8 + store 9,mem_tmp_buffer + rtn + +le_create_conn: + bpatchx patch23_2,mem_patch23 + fetch 1,mem_cmd_le_create_conn + rtnne hci_cmd_le_create_conn + fetch 6,mem_le_plap + fetcht 6,mem_le_conn_peer_addr + isub temp,null + nrtn zero + call context_new + nrtn zero + call le_connect_request + call le_init_master + bpatchx patch23_3,mem_patch23 + jam 0,mem_hci_cmd + jam 0,mem_le_peer_sca + jam 0,mem_le_scan_enable + jam 0,mem_cmd_le_create_conn + branch context_save + +le_scan_check_sender_addr_type: + arg 1,rega// sender_addr_type + fetch 1,mem_le_rxbuf + rtnbit1 LE_SENDER_ADDR_BIT + arg 0,rega + rtn + + + +le_prepare_tx: + bpatchx patch23_4,mem_patch23 + fetch 1,mem_le_arq + rtnbit1 wak + call le_check_tx_md + call le_fifo_get_first_tx_ptr //no packet to send + branch le_send_empty,blank + ifetch 1,contr + ifetcht 1,contr + copy temp,rega + isub rega,pdata + arg LE_MAX_PAKET_LEN,temp + call not_greater_than + copy pdata,temp + ifetch 1,contr + copy pdata,type + copy rega,pdata + iadd contr,contr + arg mem_le_txpayload,contw + copy temp,loopcnt + call memcpy + call le_update_tx_type + call le_send_packet + + call le_fifo_get_first_tx_ptr + ifetch 1,contr + copy pdata,rega + copy contr,regc + ifetcht 1,contr + copy temp,regb + isub regb,pdata + arg LE_MAX_PAKET_LEN,temp + call not_greater_than + iadd regb,pdata + istore 1,regc + isub rega,null + nrtn zero + branch le_fifo_release_first_node + + +le_check_tx_md: + call le_check_continue + rtnmark1 mark_ble_tx_md + fetch 1,mem_le_configuration + bbit0 BIT_BLE_TRANSMIT_PACKET_BY_MD,le_clear_md + call le_fifo_get_second_tx_ptr //no packet to send + branch le_clear_md,blank + branch le_set_md + + +le_check_continue: + call le_fifo_get_first_tx_ptr //no packet to send + branch le_clear_md,blank + ifetch 1,contr //pdata:length + ifetcht 1,contr //temp:offest + isub temp,pdata //pdata:length - offset + sub pdata,LE_MAX_PAKET_LEN,null + branch le_clear_md,positive //27 > length -offset +le_set_md: + set1 mark_ble_tx_md,mark + rtn + +le_clear_md: + set0 mark_ble_tx_md,mark + rtn + +le_update_tx_type: + copy rega,pdata + rtn blank + arg LLID_CONTINUE,type + rtn + + +le_att_check_notification_enable: // temp ->handle,output-> pdata,output :contr->rega + bpatchx patch23_5,mem_patch23 + increase 1,temp + call le_att_get_handle_ptr + increase -2,contr + ifetch 2,contr + arg CLIENT_CHARACTERTIC_CONFIGURATION,temp + isub temp,null + nrtn zero + increase 1,contr + copy contr,rega + ifetch 1,contr + rtn + + +le_send_empty: + force 0,temp + force 1,type + +le_send_packet: + bpatchx patch23_6,mem_patch23 + storet 1,mem_le_txlen + fetcht 1,mem_le_arq + set1 wak,temp + and temp,0xfc,pdata + ior type,pdata + store 1,mem_le_arq + and_into 0x1f,pdata + isolate1 mark_ble_tx_md,mark + setflag true,md,pdata + store 1,mem_le_txheader + + fetch 1,mem_le_txheader + compare 1,type,3 + nbranch le_send_no_txlen,true + fetch 1,mem_le_txlen + rtn blank +le_send_no_txlen: + fetch 1,mem_le_state + rtnbit0 lestate_encryption + call load_sk + branch le_encrypt + + +get_lpm_wake_ble_rx_lock: + arg wake_lock_ble_rx,queue + branch lpm_get_wake_lock + +put_lpm_wake_ble_rx_lock: + arg wake_lock_ble_rx,queue + branch lpm_put_wake_lock + + +le_parse: + bpatchx patch23_7,mem_patch23 + rtnmark1 mark_old_packet + call le_fifo_check_full + nrtn blank + fetch 1,mem_le_rxbuf + and pdata,0x3,pdata + store 1,mem_le_packet_llid + ifetch 1,contr + and pdata,0x1f,pdata + store 1,mem_le_packet_size + rtn blank //empty rtn + copy contr,pdata + store 2,mem_le_payload_ptr + bpatchx patch24_0,mem_patch24 + fetch 1,mem_le_packet_llid + beq LLID_LE_LL,le_parse_ll +le_parse_l2cap: + bpatchx patch24_1,mem_patch24 + call le_check_l2cap_complete + nbranch get_lpm_wake_ble_rx_lock,user + call put_lpm_wake_ble_rx_lock + fetch 2,mem_le_payload_ptr + copy pdata,contr + ifetch 2,contr //l2cap len + store 2,mem_le_l2cap_size + bpatchx patch24_2,mem_patch24 + ifetch 2,contr + beq LE_L2CAP_CID_ATT,le_parse_att + beq LE_L2CAP_CID_SMP,le_parse_smp + beq LE_L2CAP_CID_SIGNAL,le_parse_signaling + rtn + + +le_check_l2cap_complete: + fetch 1,mem_le_packet_llid + beq LLID_START,le_check_l2cap_llid_start + beq LLID_CONTINUE,le_check_l2cap_llid_continue + rtn + +//input: pdata is CID number +//output: if CID is legal ,enable user +// if ICD is illegal,disable user +le_check_l2cap_CID_legal: + call enable_user + arg LE_L2CAP_CID_ATT,temp + isub pdata,null + rtn zero + arg LE_L2CAP_CID_SIGNAL,temp + isub pdata,null + rtn zero + arg LE_L2CAP_CID_SMP,temp + isub pdata,null + rtn zero + branch disable_user + + +le_check_l2cap_llid_start: + fetch 2,mem_le_payload_ptr + copy pdata,contr + ifetch 2,contr + store 2,mem_le_l2cap_size + ifetch 2,contr //CID + call le_check_l2cap_CID_legal + nrtn user + fetcht 1,mem_le_packet_size + storet 1,mem_le_packet_len_recved + fetch 2,mem_le_l2cap_size + increase 4,pdata + isub temp,null + branch enable_user,zero + fetch 1,mem_le_packet_size + copy pdata,loopcnt + arg mem_le_l2capbuf,contw + fetch 2,mem_le_payload_ptr + copy pdata,contr + call memcpy + branch disable_user + +//no input +//output: if CID is legal ,enable user +// if ICD is illegal,disable user +le_check_l2cap_continue_legal: + call enable_user + fetch 1,mem_le_packet_len_recved + nrtn blank + branch disable_user + +le_check_l2cap_llid_continue: + call le_check_l2cap_continue_legal + nrtn user + fetch 1,mem_le_packet_len_recved + arg mem_le_l2capbuf,contw + iadd contw,rega + fetcht 1,mem_le_packet_size + iadd temp,pdata + store 1,mem_le_packet_len_recved + fetch 1,mem_le_packet_size + copy pdata,loopcnt + copy rega,contw + fetch 2,mem_le_payload_ptr + copy pdata,contr + call memcpy_fast + setarg mem_le_l2capbuf + store 2,mem_le_payload_ptr //update ptr->mem_le_l2capbuff + fetch 2,mem_le_l2cap_size + increase 4,pdata + fetcht 1,mem_le_packet_len_recved + isub temp,null + branch enable_user,zero + branch disable_user + + + + + +le_get_search_att_type: + call store_contr + arg mem_le_search_att_type_length,contw +le_get_search_common: + fetch 2,mem_le_l2cap_size + increase -5,pdata +le_get_search_common2: + istore 1,contw + copy pdata,loopcnt + call get_contr + branch memcpy_fast + +le_get_search_att_uuid: + call store_contr + arg mem_le_search_uuid_length,contw + branch le_get_search_common + + + /* rega pointers to data, regb is length */ +le_writeatt_cb: + fetch 2,mem_cb_att_write + branch callback_func + +le_supervision_update: + fetcht 4,mem_le_supervision_timer + call get_clkbt + isub temp,timeup /* and to 28 bits */ + deposit timeup + fetcht 2,mem_le_superto + lshift4 temp,temp + lshift temp,temp + isub temp,pdata + rtn + +le_supervision_flush: + call get_clkbt + store 4,mem_le_supervision_timer + rtn + + +le_adv: + jam 36,mem_le_ch_mapped + jam 0,mem_le_adv_channel_map_temp +le_adv_loop: + bpatchx patch24_3,mem_patch24 + fetch 1,mem_le_adv_enable + rtn blank + arg le_adv_interval_timer,queue + call timer_check + nrtn blank + bpatchx patch24_4,mem_patch24 +le_adv_loop_tx: + disable master + enable swfine + call le_init_adv + call le_next_adv_channel + call le_send_adv_ind + nbranch le_adv_not_match,match + fetch 1,mem_le_req_rcv + increase 1,pdata + store 1,mem_le_req_rcv + fetch 1,mem_le_rxbuf + and pdata,0x0f,pdata + beq SCAN_REQ,le_send_scan_response + beq CONNECT_REQ,le_parse_connect_req +le_adv_not_match: + bpatchx patch24_5,mem_patch24 + random pdata + arg 0x1ff,temp + iand temp,pdata + add pdata,250,pdata + call delay + fetch 1,mem_le_adv_channel_map_temp + fetcht 1,mem_le_adv_channel_map + isub temp,null + nbranch le_adv_loop,zero + arg le_adv_interval_timer,queue + fetch 2,mem_le_adv_interval + branch timer_init + +delay: + increase -1,pdata + nop 38 + nbranch delay,blank + rtn + + +le_receive_window_size: + bpatchx patch24_6,mem_patch24 + fetch 1,mem_le_peer_sca + call le_sca_map + fetch 2,mem_le_tsniff + imul32 temp,pdata + arg 375,temp + imul32 temp,pdata + arg 100000,temp + idiv temp + fetch 1,mem_le_window_size + arg 20000,temp + imul32 temp,pdata + iadd temp,pdata + store 4,mem_le_transmit_window + bpatchx patch24_7,mem_patch24 + fetch 2,mem_rx_window_sniff + call wait_div_end + quotient temp + iadd temp,pdata + store 2,mem_le_receive_window + rtn + +le_parse_connect_req: + bpatchx patch25_0,mem_patch25 + fetch 6,mem_le_rxbuf+8 + fetcht 6,mem_le_lap + isub temp,null + nrtn zero + call le_scan_check_sender_addr_type + copy rega,pdata + store 1,mem_le_conn_peer_addr_type + fetch 7,mem_le_rxbuf+21 + store 7,mem_tmp_buffer + ifetch 8,contr + istore 8,contw + fetch 6,mem_le_rxbuf+2 + store 6,mem_le_plap + increase 6,contr + ifetch 8,contr + store 8,mem_le_access // and crcinit & window size + ifetcht 2,contr // transmit offset + bpatchx patch25_1,mem_patch25 +// increase 1,temp + lshift2 temp,temp + ifetch 2,contr // connInterval + lshift2 pdata,pdata + store 2,mem_le_tsniff + store 4,mem_le_anchor + isub temp,pdata + add pdata,-2,clke_bt + ifetch 9,contr + store 9,mem_le_slave_latency// and super to & channel map + bpatchx patch25_2,mem_patch25 + ifetch 1,contr + rshift4 pdata,temp + rshift temp,temp + storet 1,mem_le_peer_sca + and_into 0x1f,pdata + store 1,mem_le_hop + call le_receive_window_size + call le_calc_channel_map + call le_init_slave + call context_new + nrtn zero + bpatchx patch25_3,mem_patch25 + call calc_clke_offset + call le_l2cap_reset_signaling_identifier + jam BT_EVT_LE_CONNECTED,mem_fifo_temp + call ui_ipc_send_event +// call app_get_lpm_wake_lock + branch context_save + + +le_init_attlist_search: + bpatchx patch25_4,mem_patch25 + fetch 2,mem_le_search_handle_start + iforce regb + fetch 2,mem_le_search_handle_end + iforce regc + fetch 2,mem_ui_le_uuid_table + iforce contr + enable user + rtn + + /* return handle in pdata, blank:end of list, positive:in range */ +le_att_handle_inrange: + ifetch 2,contr + rtn blank + isub regb,null /* less than start ? */ + nrtn positive + isub regc,null /* greater than end ? */ + rtn zero + branch le_att_handle_blank,positive + force 1,null + rtn +le_att_handle_blank: + force 0,pdata + rtn + + + /* handle in temp, return pointer in contr to length, blank not found */ +le_att_get_handle_ptr: + call le_att_get_handle_ptr2 + branch le_att_get_handle_ptr_found,zero + rtn + +le_att_get_handle_ptr2: + bpatchx patch25_5,mem_patch25 + fetch 2,mem_ui_le_uuid_table + iforce contr +le_att_get_handle_loop1: + ifetch 2,contr + rtn blank + isub temp,null + rtn zero + ifetch 1,contr + iadd contr,contr + ifetch 1,contr // length + iadd contr,contr + branch le_att_get_handle_loop1 +le_att_get_handle_ptr_found: + ifetch 1,contr + iadd contr,contr + rtn + + + +le_att_get_short_uuid_ptr: + bpatchx patch25_6,mem_patch25 + fetch 2,mem_ui_le_uuid_table + iforce contr +le_att_get_short_uuid_loop: + ifetch 2,contr + rtn blank + ifetch 1,contr + iadd contr,contr + increase -2,contr + ifetch 2,contr + isub temp,null + rtn zero + ifetch 1,contr + iadd contr,contr + branch le_att_get_short_uuid_loop + + + +le_att_get_handle_info_from_ptr: + fetch 2, mem_le_cur_attlist_start_ptr + branch le_att_get_handle_info_fast + +le_att_get_handle_info: + bpatchx patch25_7,mem_patch25 + fetch 2,mem_ui_le_uuid_table +le_att_get_handle_info_fast: + iforce contr + copy temp,rega +le_att_get_handle_loop: + ifetch 2,contr + branch le_att_unfind_handle,blank + isub rega,null + branch le_att_finded_handle, zero + ifetch 1,contr // length + iadd contr,contr + ifetch 1,contr //length + iadd contr,contr + branch le_att_get_handle_loop +le_att_unfind_handle: + branch disable_blank + +le_att_finded_handle: + ifetch 1,contr + store 1,mem_le_cur_uuid_length + copy pdata,loopcnt + arg mem_le_cur_uuid,contw + call memcpy_fast + ifetch 1,contr + store 1,mem_le_curr_att_len + call store_contr + branch enable_blank + + +le_modified_name: + bpatchx patch26_0,mem_patch26 + call le_modified_name_att_list + branch le_modified_name_adv + +le_modified_name_att_list: + arg UUID_CHRCTR_DEVICE_NAME,temp + call le_att_get_short_uuid_ptr + rtn blank + ifetch 1,contr // attribute length + copy contr,contw + fetcht 1,mem_le_name_len + copy temp,loopcnt + isub temp,null + nbranch le_name_length_longer_than_att,positive + isub temp,temp + arg mem_le_name,contr + call memcpy + copy temp,loopcnt + ncall memcpy_empty,zero + rtn +le_name_length_longer_than_att: + copy pdata,loopcnt + arg mem_le_name,contr + branch memcpy_fast + + +le_modified_name_adv: + arg mem_le_adv_data_len+32,regc + arg mem_le_adv_data,rega + call le_modified_name_adv_and_scan + setarg 0 + setflag user,0,pdata + store 1,mem_pdatatemp + arg mem_le_scan_data_len+32,regc + arg mem_le_scan_data,rega + call le_modified_name_adv_and_scan + rtn user + fetch 1,mem_pdatatemp + branch assert,blank + rtn + + +le_modified_name_adv_and_scan: + bpatchx patch26_1,mem_patch26 + call enable_user + call clear_temp_block + arg 0,regb //current length + arg mem_le_data_temp,contw + call le_modified_name_adv_loop + fetch 1,mem_le_name_len + add pdata,1,temp + iadd regb,rega + increase 2,rega + sub rega,0x1f,null + nbranch le_modified_name_adv_and_scan_name_overflow,positive + istoret 1,contw //store ble name length + arg GAP_ADTYPE_LOCAL_NAME_COMPLETE,temp + istoret 1,contw //store ble name type + iforce loopcnt + call memcpy_fast + copy rega,regb +le_modified_name_adv_and_scan_store_data: + deposit regb + store 1,mem_le_data_len_temp + arg mem_le_data_len_temp,contr + setarg -32 + iadd regc,contw + branch memcpy32 + +le_modified_name_adv_and_scan_name_overflow: + call disable_user + branch le_modified_name_adv_and_scan_store_data + +le_modified_name_adv_loop: + ifetch 1,rega //pdata:length + rtn blank //length is zero,ending find + pincrease 1 //length += 1 + ifetcht 1,contr //pdata:type + sub temp,GAP_ADTYPE_LOCAL_NAME_COMPLETE,null + branch le_modified_name_adv_found_name,zero + iadd regb,regb + copy rega,contr + iforce loopcnt + call memcpy_fast + copy contr,rega +le_modified_name_adv_loop2: + deposit rega + isub regc,null + rtn positive + branch le_modified_name_adv_loop + +le_modified_name_adv_found_name: + iadd rega,rega + branch le_modified_name_adv_loop2 + + +memcpy_empty: + setarg SPACE + istore 1,contw + loop memcpy_empty + rtn + + +le_lpm_set_mult: + bpatchx patch26_2,mem_patch26 + disable wake + branch le_lpm_set_mult_attempt,attempt + nbranch le_lpm_lost,match +le_lpm_set_mult_attempt: + call lpm_match + fetch 2,mem_rx_window_sniff + store 2,mem_le_receive_window + + nbranch lpm_mult_short,match + bmark1 mark_old_packet,lpm_mult_short + + fetch 1,mem_le_packet_size + nbranch lpm_mult_short,blank // rx not empty, short interval + fetch 1,mem_le_txlen + nbranch lpm_mult_short,blank // tx not empty, short interval + + fetch 1,mem_le_configuration + bbit1 BIT_BLE_SHORT_MULT,lpm_mult_short //check flag,if flag is 1,always short mult + + fetch 1,mem_le_state + bbit1 lestate_update_param,lpm_mult_short + branch lpm_mult_wait_timeout + +le_lpm_lost: + fetcht 2,mem_rx_window_sniff + rshift temp,temp + fetch 2,mem_le_receive_window + iadd temp,pdata + store 2,mem_le_receive_window + branch lpm_lost + +///////////////////////////////BLE CONFIG////////////////////////////////////////// +le_set_config_fixed_tk: + arg BIT_BLE_PASSKEY_FIXED_KEY,queue + branch le_set_config + +le_clr_config_fixed_tk: + arg BIT_BLE_PASSKEY_FIXED_KEY,queue + branch le_clr_config + +le_set_config_fixed_ltk: + arg BIT_BLE_PAIRING_FIXED_LTK,queue + branch le_set_config + +le_clr_config_fixed_ltk: + arg BIT_BLE_PAIRING_FIXED_LTK,queue + branch le_clr_config + +le_set_config_more_data: + arg BIT_BLE_TRANSMIT_PACKET_BY_MD,queue + branch le_set_config + +le_clr_config_more_data: + arg BIT_BLE_TRANSMIT_PACKET_BY_MD,queue + branch le_clr_config + +le_set_config_read_authentication: + arg BIT_BLE_READ_AUTH,queue + branch le_set_config + +le_clr_config_read_authentication: + arg BIT_BLE_READ_AUTH,queue + branch le_clr_config + +le_set_config_write_authentication: + arg BIT_BLE_WRITE_AUTH,queue + branch le_set_config + +le_clr_config_write_authentication: + arg BIT_BLE_WRITE_AUTH,queue + branch le_clr_config + +le_set_config_short_mult: + arg BIT_BLE_SHORT_MULT,queue + branch le_set_config + +le_clr_config_short_mult: + arg BIT_BLE_SHORT_MULT,queue + branch le_clr_config + + +le_set_config: + fetch 1,mem_le_configuration + qset1 pdata + store 1,mem_le_configuration + rtn + +le_clr_config: + fetch 1,mem_le_configuration + qset0 pdata + store 1,mem_le_configuration + rtn + +le_set_fixed_ltk: + setarg 0x112233 + store 3,mem_le_fixed_ltk + setarg 0x445566 + istore 3,contw + setarg 0x778899 + istore 3,contw + setarg 0x001122 + istore 3,contw + setarg 0x334455 + istore 3,contw + setarg 0x66 + istore 1,contw + rtn + + +le_set_justwork: + setarg 0x01000302 + store 4,mem_le_pres + setarg 0x010010 + store 3,mem_le_pres_max_keysize + jam 1,mem_le_pairing_mode + rtn + +///////////////////////////////////////////////////////////////////////// + +le_fifo_malloc_tx_empty: + arg 0,rega + arg LLID_EMPTY,type + branch le_fifo_malloc_tx + + +//rega:len regb:ll opcode +le_fifo_malloc_tx_ll: + arg LLID_LE_LL,type + call le_fifo_malloc_tx + copy regb,pdata + istore 1,contw + rtn + + +//rega:len regb:cid +le_fifo_malloc_tx_l2cap: + force LLID_START,type + increase 4,rega + call le_fifo_malloc_tx + increase -4,rega + copy rega,pdata + istore 2,contw + copy regb,pdata + istore 2,contw + rtn + + +//rega:len type:llid +le_fifo_malloc_tx: + sub rega,240,null //check max len + nbranch assert,positive + fetch 1,mem_le_tx_buff_used + arg 1,temp + arg LE_TX_BUFF_COUNT,loopcnt +le_fifo_malloc_tx_loop: + iand temp,null + branch le_fifo_malloc_tx_got_empty,zero + lshift temp,temp + loop le_fifo_malloc_tx_loop + branch assert //no empty buff +le_fifo_malloc_tx_got_empty: + ixor temp,pdata + store 1,mem_le_tx_buff_used + sub loopcnt,LE_TX_BUFF_COUNT,pdata + lshift4 pdata,pdata + lshift4 pdata,pdata + arg mem_le_tx_buffer0,temp + iadd temp,temp +le_fifo_tx_find_empty_ptr: + arg 0,loopcnt + arg mem_le_tx_ptr0,contr +le_fifo_tx_find_empty_ptr_loop: + ifetch 2,contr + branch le_fifo_tx_found_empty_ptr,blank + copy loopcnt,pdata + increase 1,loopcnt + bne LE_TX_BUFF_COUNT,le_fifo_tx_find_empty_ptr_loop + branch assert + + +le_fifo_tx_found_empty_ptr: + increase -2,contr + istoret 2,contr + copy temp,contw + copy rega,pdata + istore 1,contw //lengh + setarg 0 + istore 1,contw //offset + copy type,pdata + istore 1,contw //LLID + rtn + + + +le_fifo_get_first_tx_ptr: + fetch 2,mem_le_tx_ptr0 + copy pdata,contr + rtn + +le_fifo_get_second_tx_ptr: + fetch 2,mem_le_tx_ptr1 + copy pdata,contr + rtn + +le_fifo_get_last_tx_ptr: + call le_fifo_get_last_tx_ptr0 + copy pdata,contr + rtn +le_fifo_get_last_tx_ptr0: + fetch 2,mem_le_tx_ptr3 + nrtn blank + fetch 2,mem_le_tx_ptr2 + nrtn blank + fetch 2,mem_le_tx_ptr1 + nrtn blank + fetch 2,mem_le_tx_ptr0 + rtn + +le_fifo_get_first_l2cap_ptr: + call le_fifo_get_first_tx_ptr + increase 3,contr + rtn + +le_fifo_get_first_att_ptr: + call le_fifo_get_first_tx_ptr + increase 7,contr + rtn + +le_fifo_get_last_att_ptr: + call le_fifo_get_last_tx_ptr + increase 7,contr + rtn + +le_fifo_get_last_l2cap_ptr: + call le_fifo_get_last_tx_ptr + increase 3,contr + rtn + + + +le_fifo_check_full: + fetch 2,mem_le_tx_ptr3 + rtn + + +le_fifo_check_nearly_full: + fetch 2,mem_le_tx_ptr2 + rtn + + +le_fifo_check_empty: + fetch 2,mem_le_tx_ptr0 + rtn + + +le_fifo_release_first_node: + fetch 2,mem_le_tx_ptr0 + arg mem_le_tx_buffer0,temp + isub temp,pdata + rshift4 pdata,pdata + rshift4 pdata,queue + fetch 1,mem_le_tx_buff_used + qset0 pdata + store 1,mem_le_tx_buff_used + arg 0,loopcnt +le_fifo_release_first_node_loop: + lshift loopcnt,pdata + arg mem_le_tx_ptr1,temp + iadd temp,temp + ifetch 2,temp + increase -2,temp + istore 2,temp + copy loopcnt,pdata + increase 1,loopcnt + bne LE_TX_BUFF_UPDATE_LOOPCNT,le_fifo_release_first_node_loop + setarg 0 + istore 2,temp + rtn + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_att.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_att.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_att.prog (working copy) @@ -0,0 +1,713 @@ + + +le_parse_att: + ifetch 3,contr + store 3,mem_le_att_opcode + beq ATTOP_EXCHANGE_MTU_REQUEST,le_parse_att_exchange_mtu_request + beq ATTOP_EXCHANGE_MTU_RESPONSE,le_parse_att_exchange_mtu_response + beq ATTOP_FIND_INFORMATION_REQUEST,le_parse_att_find_information_request + beq ATTOP_FIND_BY_TYPE_VALUE_REQUEST,le_parse_att_find_by_type_value_request + beq ATTOP_READ_BY_TYPE_REQUEST,le_parse_att_read_by_type_request + beq ATTOP_READ_REQUEST,le_parse_att_read_request + beq ATTOP_READ_BLOB_REQUEST,le_parse_att_read_blob_request + beq ATTOP_READ_BY_GROUP_TYPE_REQUEST,le_parse_att_read_by_group_type_request + beq ATTOP_WRITE_REQUEST,le_parse_att_write_request + beq ATTOP_PREPARE_WRITE_REQUEST,le_parse_att_prepare_write_request + beq ATTOP_EXECUTE_WRITE_REQUEST,le_parse_att_execute_write_request + beq ATTOP_WRITE_COMMAND,le_parse_att_write_command + rtn + + +le_send_att_exchange_mtu_requset: + force 3,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_EXCHANGE_MTU_REQUEST + istore 1,contw + fetch 2,mem_le_local_mtu + istore 2,contw + rtn + + +le_parse_att_exchange_mtu_request: + call le_parse_att_exchange_mtu_response +le_send_att_exchange_mtu_response: + force 3,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_EXCHANGE_MTU_RESPONSE + istore 1,contw + fetch 2,mem_le_local_mtu + istore 2,contw + rtn + +le_parse_att_exchange_mtu_response: + rshift8 pdata,pdata + store 2,mem_le_remote_mtu + rtn + +le_parse_att_find_information_request: + call le_get_search_handle_start_end_common + call enable_user + branch le_send_att_find_information_response + +le_send_att_find_information_response: + arg 3,timeup + call le_init_attlist_search +le_send_att_find_information_res_loop: + call le_att_handle_inrange + branch le_send_att_find_information_res_end,blank + nbranch le_send_att_find_information_res_next,positive + increase -2,contr + call store_contr + call get_contw + nbranch le_send_att_find_information_res_store_info,user + call push_stack_rega_b_c + call disable_user + force 20,rega + call le_fifo_malloc_tx_l2cap_gatt + call pop_stack_rega_b_c + setarg ATTOP_FIND_INFORMATION_RESPONSE + istore 1,contw + setarg UUID_SIZE_16BIT + istore 1,contw +le_send_att_find_information_res_store_info: + call get_contr + ifetch 2,contr + istore 2,contw + ifetch 1,contr + copy pdata,loopcnt + call memcpy + call store_contw + increase -1,timeup + branch le_send_att_find_information_res_end,zero +le_send_att_find_information_res_cont: + ifetch 1,contr + iadd contr,contr + branch le_send_att_find_information_res_loop +le_send_att_find_information_res_next: + ifetch 1,contr + iadd contr,contr + branch le_send_att_find_information_res_cont +le_send_att_find_information_res_end: + branch le_send_att_error_response_notfound,user + branch le_send_auto_len_by_mem + + +le_parse_att_find_by_type_value_request: + call le_get_search_handle_start_end_common + ifetch 2,contr + store 2,mem_le_search_uuid + call store_contr + arg mem_le_search_att_type_length,contw + fetch 2,mem_le_l2cap_size + increase -7,pdata + call le_get_search_common2 + branch le_send_att_find_by_type_value_response + + +le_start_end_handle_check_1: + disable user + fetcht 2,mem_le_search_handle_start + fetch 2,mem_le_search_handle_end + isub temp,null + nbranch le_start_end_handle_check_1_fail,positive + deposit temp + rtnne 0 +le_start_end_handle_check_1_fail: + enable user + jam ATT_ERR_INVALID_HANDLE,mem_le_err_code + branch le_send_att_error_response + + +le_send_att_find_by_type_value_response: + call le_start_end_handle_check_1 + rtn user + fetcht 2,mem_le_search_uuid + setarg UUID_GATT_PRIMARY_SERVICE + isub temp,null + branch le_send_att_find_by_type_value_res_primary,zero + branch le_send_att_error_response_notfound + + +le_send_att_find_by_type_value_res_primary: + jam LE_FIND_BY_TYPE_VAL_RES_NOT_FOUND,mem_le_search_res + fetcht 2,mem_le_search_handle_start + storet 2,mem_temp + call le_att_get_handle_info + nbranch le_send_att_error_response_notfound,blank +le_send_att_find_primary_search_loop: + fetcht 2,mem_temp + call le_att_get_handle_info + nbranch le_send_att_error_response_notfound2,blank + copy contr,rega + fetch 1,mem_le_curr_att_len + copy pdata,loopcnt + fetcht 1,mem_le_search_att_type_length + isub temp,null + nbranch le_send_att_find_primary_search_loop1,zero + arg mem_le_search_att_type,regb + call string_compare + + branch le_send_att_find_primary_search_end_start_handle_found,zero + + fetch 2,mem_le_cur_uuid + fetcht 2,mem_le_search_uuid + isub temp,null + branch le_send_att_find_primary_search_end_ending_handle_found,zero +le_send_att_find_primary_search_loop1: + fetch 2,mem_temp + increase 1,pdata + store 2,mem_temp + branch le_send_att_find_primary_search_loop + +le_send_att_error_response_notfound2: + fetch 1,mem_le_search_res + beq LE_FIND_BY_TYPE_VAL_RES_FOUND_STARTING_HANDLE,le_send_att_find_primary_search_end_ending_handle_found + branch le_send_att_error_response_notfound + + +le_send_att_find_primary_search_end_start_handle_found: + fetch 2,mem_le_cur_uuid + fetcht 2,mem_le_search_uuid + isub temp,null + nbranch le_send_att_find_primary_search_loop1,zero + jam LE_FIND_BY_TYPE_VAL_RES_FOUND_STARTING_HANDLE,mem_le_search_res +// copy rega,temp + fetcht 2,mem_temp + storet 2,mem_le_cur_handle_start + branch le_send_att_find_primary_search_loop1 + +le_send_att_find_primary_search_end_ending_handle_found: + fetch 1,mem_le_search_res + beq LE_FIND_BY_TYPE_VAL_RES_NOT_FOUND,le_send_att_find_primary_search_loop1 + jam LE_FIND_BY_TYPE_VAL_RES_FOUND_ENDING_HANDLE,mem_le_search_res + fetcht 2,mem_temp + increase -1,temp + storet 2,mem_le_cur_handle_end + +le_send_att_find_primary_search_end: + arg 5,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_FIND_BY_TYPE_VALUE_RESPONSE + istore 1,contw + fetch 2,mem_le_cur_handle_start + istore 2,contw + fetch 2,mem_le_cur_handle_end + istore 2,contw + rtn + + + +le_parse_att_read_by_type_request: + call le_get_search_handle_start_end_common + call le_get_search_att_uuid + branch le_send_att_read_by_type_response + +le_send_att_read_by_type_response: + fetcht 2,mem_le_search_handle_start + storet 2,mem_temp + call le_init_attlist_search + call le_att_get_handle_ptr2 + increase -2,contr + copy contr,pdata + store 2,mem_le_cur_attlist_start_ptr + + fetcht 2,mem_le_search_uuid + setarg UUID_CHRCTR_DEVICE_NAME + isub temp,null + branch le_send_att_read_by_type_res_device_name,zero + setarg UUID_GATT_CHARACTERISTIC + isub temp,null + nbranch le_send_att_read_by_type_res_not_characteristic,zero + arg 2,timeup +le_send_att_read_by_type_response_loop: + call le_att_check_handle_end + nbranch le_send_att_read_by_type_response_end,positive + fetcht 2,mem_temp + call le_att_get_handle_info_from_ptr + beq 1,le_send_att_read_by_type_response_end + call le_att_same_uuid + nbranch le_send_att_read_by_type_response_next_handle,zero + nbranch le_send_att_read_by_type_res_found_next,user + disable user + arg 20,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_READ_BY_TYPE_RESPONSE + istore 1,contw + copy contw,alarm + increase 1,contw + + call le_send_att_read_by_type_write_properties + call le_att_next_handle + call le_att_get_handle_info_from_ptr + call le_send_att_read_by_type_write_uuid + fetch 1,mem_le_cur_uuid_length + increase 5,pdata + istore 1,alarm + fetch 1,mem_le_cur_uuid_length + beq 16,le_send_att_read_by_type_response_end + increase -1,timeup + branch le_send_att_read_by_type_response_end,zero +le_send_att_read_by_type_response_next_handle: + call le_att_next_handle + branch le_send_att_read_by_type_response_loop +le_send_att_read_by_type_response_end: + branch le_send_att_error_response_notfound,user + branch le_send_auto_len_by_mem + +le_send_att_read_by_type_res_found_next: + call le_store_att_record + call le_att_next_handle + call le_att_get_handle_info_from_ptr + fetch 1,mem_le_cur_uuid_length + beq 16,le_send_att_read_by_type_response_end + + call get_contw + fetch 2,mem_temp + increase -1,pdata + istore 2,contw + call le_write_att_record_common + call le_send_att_read_by_type_write_uuid + increase -1,timeup + branch le_send_att_read_by_type_response_end,zero + branch le_send_att_read_by_type_response_next_handle + + +le_send_att_read_by_type_write_properties: + fetch 2,mem_temp + istore 2,contw + + fetch 1,mem_le_curr_att_len + copy pdata,loopcnt + call get_contr + call memcpy_fast + branch store_contw +le_send_att_read_by_type_write_uuid: + call get_contw + fetch 2,mem_temp + istore 2,contw + call store_contw + fetch 1,mem_le_cur_uuid_length + copy pdata,loopcnt + call get_contw + call get_contr + isub loopcnt,contr + increase -1,contr + call memcpy_fast + branch store_contw + + + +le_send_att_read_by_type_res_not_characteristic: + fetcht 2,mem_le_search_handle_start + storet 2,mem_temp +le_send_att_read_by_type_res_not_char_loop: + call le_att_check_handle_end + nbranch le_send_att_error_response_notfound,positive + call le_att_get_handle_info_from_ptr + beq 1,le_send_att_error_response_notfound + call le_att_same_uuid + nbranch le_send_att_read_by_type_res_not_char_next,zero + +le_send_att_read_by_type_res_not_char_common: + arg 20,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_READ_BY_TYPE_RESPONSE + istore 1,contw + fetch 1,mem_le_curr_att_len + copy pdata,loopcnt + increase 2,pdata + istore 1,contw + fetch 2,mem_temp + istore 2,contw + call get_contr + call memcpy_fast + call store_contw + branch le_send_auto_len_by_mem + +le_send_att_read_by_type_res_not_char_next: + call le_att_next_handle + branch le_send_att_read_by_type_res_not_char_loop + + +le_send_att_read_by_type_res_device_name: + arg UUID_CHRCTR_DEVICE_NAME,temp + call le_att_get_short_uuid_ptr + rtn blank + increase -5,contr // point to handle + ifetch 2,contr + store 2,mem_temp + arg 20,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_READ_BY_TYPE_RESPONSE + istore 1,contw + fetch 1,mem_le_name_len + copy pdata,loopcnt + increase 2,pdata + istore 1,contw + fetch 2,mem_temp + istore 2,contw + arg mem_le_name,contr + call memcpy_fast + call store_contw + branch le_send_auto_len_by_mem + + + +le_parse_att_read_request: + fetcht 2,mem_le_att_handle + fetch 1,mem_le_configuration + bbit1 BIT_BLE_READ_AUTH,le_send_att_read_response_check_auth + +le_send_att_read_response: + call le_att_get_handle_ptr + branch le_send_att_error_response_notfound,blank + increase -2,contr + ifetch 2,contr + arg UUID_CHRCTR_DEVICE_NAME,temp + isub temp,null + branch le_send_device_name,zero + ifetch 1,contr + sub pdata,22,null + branch le_send_att_read_response_less,positive + force 22,pdata +le_send_att_read_response_less: + copy pdata,regc + call store_contr + add regc,1,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_READ_RESPONSE + istore 1,contw + copy regc,loopcnt + call get_contr + branch memcpy + +le_send_device_name: + call store_contr + fetch 1,mem_le_name_len + add pdata,1,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_READ_RESPONSE + istore 1,contw + fetch 1,mem_le_name_len + copy pdata,loopcnt + arg mem_le_name,contr + branch memcpy + + +le_send_att_read_response_check_auth: + fetch 2,mem_le_pairing_handle + isub temp,null + nbranch le_send_att_read_response,zero +//le_send_att_read_response_error_insufficient_auth: + call le_check_encrypt_state + nbranch le_send_att_read_response,user + jam ATT_ERR_INSUFFICIENT_AUTHENTICATION,mem_le_err_code + branch le_send_att_error_response + + +le_parse_att_read_blob_request: + ifetch 2,contr + store 2,mem_le_att_offset +le_send_att_read_blob_response: + arg 20,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_READ_BLOB_RESPONSE + istore 1,contw + fetch 2,mem_le_att_offset + iforce rega + fetcht 2,mem_le_att_handle + call le_att_get_handle_ptr + branch le_send_att_error_response_notfound,blank + ifetch 1,contr + isub rega,loopcnt + nbranch le_send_att_error_response_notfound,positive + sub loopcnt,22,null + branch le_send_att_read_blob_response_less,positive + force 22,loopcnt +le_send_att_read_blob_response_less: + deposit rega + iadd contr,contr + call memcpy_fast + call store_contw + branch le_send_auto_len_by_mem + + +le_parse_att_read_by_group_type_request: + call le_get_search_handle_start_end_common + call le_get_search_att_type + branch le_send_att_read_by_group_type_response + +//mem_le_search_att_type +//mem_le_search_handle_start +//mem_le_search_handle_end +le_send_att_read_by_group_type_response: + arg 2,timeup + fetcht 2,mem_le_search_handle_start +// arg 23,pdata +// isub temp,null +// call ice_break,zero + storet 2,mem_temp + call le_init_attlist_search + call le_att_get_handle_ptr2 + increase -2,contr + copy contr,pdata + store 2,mem_le_cur_attlist_start_ptr +le_send_att_read_by_group_type_response_loop: + call le_att_check_handle_end + nbranch le_send_att_read_by_group_type_end0,positive + fetcht 2,mem_temp + call le_att_get_handle_info_from_ptr + beq 1,le_send_att_read_by_group_type_end1 + + call le_att_same_type + nbranch le_send_att_read_by_group_type_next_handle,zero + copy timeup,pdata + beq 0,le_send_att_read_by_group_type_end1 + nbranch le_send_att_read_by_group_type_store_write_record,user //un first + disable user + //first att uuid + arg 20,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_READ_BY_GROUP_TYPE_RESPONSE + istore 1,contw + fetch 1,mem_le_curr_att_len + increase 4,pdata + istore 1,contw + call store_contw + branch le_send_att_read_by_group_type_store_record +le_send_att_read_by_group_type_store_write_record: + fetch 1,mem_le_curr_att_len + beq 16,le_send_att_read_by_group_type_end1 + fetch 2,mem_temp + increase -1,pdata + store 2,mem_le_cur_handle_end + call le_write_att_record +le_send_att_read_by_group_type_store_record: + fetch 2,mem_temp + store 2,mem_le_cur_handle_start + call le_store_att_record + increase -1,timeup +// branch le_send_att_read_by_group_type_last_find,zero +le_send_att_read_by_group_type_next_handle: + call le_att_next_handle + branch le_send_att_read_by_group_type_response_loop + +le_send_att_read_by_group_type_end0: //> att handle end + fetch 2,mem_temp + store 2,mem_le_cur_handle_end + branch le_send_att_read_by_group_type_end_common +le_send_att_read_by_group_type_end1: //>att max list handle or diff len + fetch 2,mem_temp + increase -1,pdata + store 2,mem_le_cur_handle_end + branch le_send_att_read_by_group_type_end_common +le_send_att_read_by_group_type_end_common: + branch le_send_att_error_response_notfound,user + call le_write_att_record + branch le_send_auto_len_by_mem + + + + +le_parse_att_write_request: + copy contr,rega + fetch 2,mem_le_l2cap_size + add pdata,-3,regb + call le_writeatt_cb +le_send_att_write_response_check_auth: + fetch 1,mem_le_configuration + bbit0 BIT_BLE_WRITE_AUTH,le_send_att_write_response + + fetcht 2,mem_le_att_handle + fetch 2,mem_le_pairing_handle + isub temp,null + nbranch le_send_att_write_response,zero + call le_check_encrypt_state + nbranch le_send_att_write_response,user + jam ATT_ERR_INSUFFICIENT_AUTHENTICATION,mem_le_err_code + branch le_send_att_error_response + +le_send_att_write_response: + force 1,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_WRITE_RESPONSE + istore 1,contw + rtn + +le_check_encrypt_state: + call disable_user + fetch 1,mem_le_pairing_mode + rtneq LE_PAIRING_MODE_NONE + fetch 1,mem_context + rtnbit1 lestate_encryption + branch enable_user + + +le_parse_att_prepare_write_request: + add contr,2,rega + fetch 2,mem_le_l2cap_size + add pdata,-5,regb + call le_writeatt_cb + branch le_send_att_prepare_write_response + + +le_send_att_prepare_write_response: + fetch 2,mem_le_l2cap_size + copy pdata,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_PREPARE_WRITE_RESPONSE + istore 1,contw + fetch 2,mem_le_att_handle + istore 2,contw + fetch 2,mem_le_l2cap_size + add pdata,-5,loopcnt + fetch 2,mem_le_payload_ptr + add pdata,7,contr + ifetch 2,contr //offset + istore 2,contw + branch memcpy_fast + + + +le_parse_att_execute_write_request: + +le_send_att_execute_write_response: + force 1,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_EXECUTE_WRITE_RESPONSE + istore 1,contw + rtn + + + +le_parse_att_write_command: + copy contr,rega + fetch 2,mem_le_l2cap_size + add pdata,-3,regb + branch le_writeatt_cb + + + +//rga:len temp:handle;rgea,regb,regc already used +le_att_malloc_tx_notify: + copy temp,regc + increase 3,rega + call le_fifo_malloc_tx_l2cap_gatt + increase -3,rega + setarg ATTOP_HANDLE_VALUE_NOTIFICATION + istore 1,contw + copy regc,temp + istoret 2,contw + rtn + +//rga:len temp:handle;rgea,regb,regc already used +le_att_malloc_tx_indication: + copy temp,regc + increase 3,rega + call le_fifo_malloc_tx_l2cap_gatt + increase -3,rega + setarg ATTOP_HANDLE_VALUE_INDICATION + istore 1,contw + copy regc,temp + istoret 2,contw + rtn + + +///////////////////////////ATT common function//////////////////////////////////// + +le_send_att_error_response_notfound: + jam ATT_ERR_ATTRIBUTE_NOT_FOUND,mem_le_err_code +le_send_att_error_response: + force 5,rega + call le_fifo_malloc_tx_l2cap_gatt + setarg ATTOP_ERROR_RESPONSE + istore 1,contw + fetch 1,mem_le_att_opcode + istore 1,contw + fetch 2,mem_le_att_handle + istore 2,contw + fetch 1,mem_le_err_code + istore 1,contw + rtn + + +le_fifo_malloc_tx_l2cap_gatt: + force LE_L2CAP_CID_ATT,regb + branch le_fifo_malloc_tx_l2cap + + +le_att_next_handle: + fetcht 2,mem_temp + increase 1,temp + storet 2,mem_temp + rtn + +le_att_check_handle_end: + fetcht 2,mem_temp + fetch 2,mem_le_search_handle_end + isub temp,null + rtn + + +le_att_same_type: + fetcht 1,mem_le_search_att_type_length + arg mem_le_search_att_type,rega +le_att_check_same_common: + fetch 1,mem_le_cur_uuid_length + copy pdata,loopcnt + isub temp,null + nrtn zero + arg mem_le_cur_uuid ,regb + branch string_compare + +le_att_same_uuid: + fetcht 1,mem_le_search_uuid_length + arg mem_le_search_uuid,rega + branch le_att_check_same_common + + +le_store_att_record: + fetch 1,mem_le_curr_att_len + store 1, mem_tmp_buffer + copy pdata,loopcnt + call get_contr + branch memcpy_fast + + +le_write_att_record: + call get_contw + fetch 2,mem_le_cur_handle_start + istore 2,contw + fetch 2,mem_le_cur_handle_end + istore 2,contw +le_write_att_record_common: + fetch 1,mem_tmp_buffer + copy pdata,loopcnt + call memcpy_fast + branch store_contw + + + +le_send_auto_len_by_mem: + call get_contw + call le_fifo_get_last_att_ptr + copy contw,pdata + isub contr,rega + call le_fifo_get_last_l2cap_ptr + copy rega,pdata + istore 2,contr + increase 4,rega + call le_fifo_get_last_tx_ptr + copy rega,pdata + istore 1,contr + rtn + + +le_get_search_handle_start_end_common: + rshift8 pdata,pdata + store 2,mem_le_search_handle_start + ifetch 2,contr + store 2,mem_le_search_handle_end + rtn + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_signalling.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_signalling.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_signalling.prog (working copy) @@ -0,0 +1,54 @@ + + +le_parse_signaling: + ifetch 1,contr + ifetcht 1,contr //id + ifetcht 2,contr //length + beq L2CAP_CONNECTION_PARAMETER_UPDATE_RESPONSE,le_l2cap_parse_conn_parameter_update_rsp + rtn +le_l2cap_parse_conn_parameter_update_rsp: + ifetch 2,contr //result + store 2,mem_le_l2cap_signaling_conn_param_update_rsp_result + jam BT_EVT_LE_PARSE_CONN_PAPA_UPDATE_RSP,mem_fifo_temp + branch ui_ipc_send_event + + +//mem_le_interval_min:the ptr that connection parameter, +//include ConnIntervalMin,ConnIntervalMax, +// ConnSlaveLatency,ConnSupervisionTimeout +le_l2cap_tx_update_req: + arg 0x0c,rega + arg L2CAP_CONNECTION_PARAMETER_UPDATE_REQUEST,regc + call le_fifo_malloc_tx_l2cap_signaling + setarg 0x08 + istore 2,contw + fetch 8,mem_le_interval_min + istore 8,contw + rtn + + +//rega:len regc:signaling opcode +le_fifo_malloc_tx_l2cap_signaling: + call le_l2cap_update_signaling_identifier + arg LE_L2CAP_CID_SIGNAL,regb + call le_fifo_malloc_tx_l2cap + copy regc,pdata + istore 1,contw + fetch 1,mem_le_signaling_identifier + istore 1,contw + rtn + + +le_l2cap_update_signaling_identifier: + fetch 1,mem_le_signaling_identifier + //beq 0xff,le_l2cap_signaling_identifier_set_1 + pincrease 1 + store 1,mem_le_signaling_identifier + rtnne 0 + +le_l2cap_reset_signaling_identifier: + jam 1,mem_le_signaling_identifier + rtn + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_smp.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_smp.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_l2cap_smp.prog (working copy) @@ -0,0 +1,594 @@ + +le_pairing_mode_init: + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_NONE, le_set_no_pairing + beq LE_PAIRING_MODE_LAGACY_JUSTWORK,le_set_pairing_mode_lagacy_just_work + beq LE_PAIRING_MODE_LAGACY_PASSKEY,le_set_pairing_mode_lagacy_passkey +ifdef SECURE_CONNECTION + beq LE_PAIRING_MODE_SECURE_CONNECT_JUSTWORK,le_set_pairing_mode_secure_justwork + beq LE_PAIRING_MODE_SECURE_CONNECT_NUMERIC,le_set_pairing_mode_secure_numeric + beq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY,le_set_pairing_mode_secure_passkey +endif + rtn + +ifdef SECURE_CONNECTION +le_set_pairing_mode_secure_justwork: + jam FLAG_LE_BONDING_MITM_SECURE,mem_le_pres_auth + branch le_set_noinputnooutput +le_set_pairing_mode_secure_numeric: + jam FLAG_LE_BONDING_MITM_SECURE,mem_le_pres_auth + jam FLAG_IOCAP_DISPLAYYESNO,mem_le_pres_iocap + rtn +le_set_pairing_mode_secure_passkey: + jam FLAG_LE_BONDING_MITM_SECURE,mem_le_pres_auth + branch le_set_displayonly +endif +le_set_no_pairing: + jam FLAG_LE_NO_BONDING_NO_MITM,mem_le_pres_auth +le_set_noinputnooutput: + jam FLAG_IOCAP_NOINPUTNOOUTPUT,mem_le_pres_iocap + rtn +le_set_pairing_mode_lagacy_just_work: + jam FLAG_LE_BONDING_MITM,mem_le_pres_auth + branch le_set_noinputnooutput +le_set_pairing_mode_lagacy_passkey: + jam FLAG_LE_BONDING_MITM,mem_le_pres_auth +le_set_displayonly: + jam FLAG_IOCAP_DISPLAYONLY,mem_le_pres_iocap + rtn + + +le_secure_connection_enable: + fetch 1,mem_le_pres_auth + set1 LE_AUTH_SECURE_CONNECTION_PAIRING_BIT,pdata + store 1,mem_le_pres_auth + rtn +le_secure_connection_disable: + fetch 1,mem_le_pres_auth + set0 LE_AUTH_SECURE_CONNECTION_PAIRING_BIT,pdata + store 1,mem_le_pres_auth + rtn + +le_parse_smp: + ifetch 1,contr + beq SMP_PAIRING_REQUEST,le_parse_smp_pairing_request +// beq SMP_PAIRING_RESPONSE,le_parse_smp_pairing_response + beq SMP_PAIRING_CONFIRM,le_parse_smp_pairing_confirm + beq SMP_PAIRING_RANDOM,le_parse_smp_pairing_random + beq SMP_PAIRING_FAILED,le_parse_smp_pairing_failed + beq SMP_ENCRYPTION_INFORMATION,le_parse_smp_encryption_information + beq SMP_MASTER_IDENTIFICATION,le_parse_smp_master_identification + beq SMP_IDENTITY_INFORMATION,le_parse_smp_identity_information + beq SMP_IDENTITY_ADDRESS_INFORMATION,le_parse_smp_identity_address_information + beq SMP_SIGNING_INFORMATION,le_parse_smp_signing_information + beq SMP_SECURITY_REQUEST,le_parse_smp_security_request +ifdef SECURE_CONNECTION + beq SMP_PAIRING_PUBLIC_KEY,le_parse_smp_public_key + beq SMP_PAIRING_DHKEY_CHECK,le_parse_smp_dhkey_check +endif + rtn + + + +le_send_smp_security_request: + force 2,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_SECURITY_REQUEST + istore 1,contw + fetch 1,mem_le_pres_auth + istore 1,contw + rtn + +le_parse_smp_pairing_request: + store 1,mem_le_preq + ifetch 6,contr + istore 6,contw + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_NONE,le_smp_pairing_fail_reason_not_support_pairing + call le_send_smp_pairing_response + call le_check_master_support_secure_connect + jam FLAG_LE_PAIRING_RCV_PAIRING_REQ,mem_le_pairing_state + fetch 1,mem_le_preq_iocap + beq FLAG_IOCAP_DISPlAYONLY,le_set_tk_0 + beq FLAG_IOCAP_DISPLAYYESNO,le_set_tk_0 + beq FLAG_IOCAP_NOINPUTNOOUTPUT,le_set_tk_0 + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_LAGACY_PASSKEY,le_parse_smp_pairing_req_passkey + rtneq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY +le_set_tk_0: + arg 0,pdata + store 4,mem_le_tk + rtn + +le_parse_smp_pairing_req_passkey: + fetch 1,mem_le_configuration + bbit1 BIT_BLE_PASSKEY_FIXED_KEY,le_parse_smp_pairing_req_fixed_passkey +le_genernate_tk: + arg mem_le_tk,rega + copy rega,contw + arg 3,loopcnt + call generate_random_loop + fetch 2,mem_le_tk + 2 + and_into 0x7,pdata + store 2,mem_le_tk + 2 +le_parse_smp_pairing_req_fixed_passkey: + jam BT_EVT_LE_TK_GENERATE,mem_fifo_temp + branch ui_ipc_send_event + +le_check_master_support_secure_connect: + fetch 1,mem_le_preq_auth + rtnbit1 LE_AUTH_SECURE_CONNECTION_PAIRING_BIT + fetch 1,mem_le_pairing_mode + rtnbit0 LE_PAIRING_MODE_SECURE_CONNECT_BIT + branch app_ble_disconnect + +le_send_smp_pairing_response: + force 7,rega + call le_fifo_malloc_tx_l2cap_smp + fetch 7,mem_le_pres + istore 7,contw + rtn + + +le_parse_smp_pairing_confirm: +ifdef SECURE_CONNECTION + copy contr,rega + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY,le_parse_smp_pairing_confirm_secure_passkey + copy rega,contr +endif + arg mem_le_rconfirm,contw + call memcpy16 + branch le_send_smp_pairing_confirm +ifdef SECURE_CONNECTION +le_parse_smp_pairing_confirm_secure_passkey: + copy rega,contr + arg mem_le_rconfirm,contw + call memcpy16 + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + jam LE_SC_STAT_PASSKEY_WAIT_CONFIRM,mem_le_secure_connect_state + rtn +endif + + +le_send_smp_pairing_confirm: +ifdef SECURE_CONNECTION + fetch 1,mem_le_pairing_mode + bbit1 LE_PAIRING_MODE_SECURE_CONNECT_BIT,le_send_smp_pairing_confirm_sc +endif + call generate_confirm + force 17,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_PAIRING_CONFIRM + istore 1,contw + branch store_aes_result + + +ifdef SECURE_CONNECTION +le_send_smp_pairing_confirm_sc: + arg mem_le_srand,contw + call generate_random + call function_f4_cb + force 17,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_PAIRING_CONFIRM + istore 1,contw + branch load_inverse_result + +endif + + +le_parse_smp_pairing_random: +ifdef SECURE_CONNECTION + copy contr,rega + fetch 1,mem_le_pairing_mode + bbit1 LE_PAIRING_MODE_SECURE_CONNECT_BIT,le_parse_smp_pairing_random_sc + copy rega,contr +endif + call authenticate_rconfirm + branch le_parse_smp_pairing_random_success,zero +le_send_pairing_confirm_value_failed: + jam PAIRING_FAILED_CONFIRM_VALUE_FAILED,mem_le_ll_pairing_fail_reason +le_send_pairing_failed: + force 2,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_PAIRING_FAILED + istore 1,contw + fetch 1,mem_le_ll_pairing_fail_reason + istore 1,contw +le_parse_smp_pairing_failed: + force smp_pairing_timer,queue + call timer_stop + jam FLAG_LE_PAIRING_NULL,mem_le_pairing_state + jam BT_EVT_LE_PAIRING_FAIL,mem_fifo_temp + branch ui_ipc_send_event + +le_smp_pairing_fail_reason_not_support_pairing: + jam PAIRING_FAILED_PAIRING_NOT_SUPPORTED,mem_le_ll_pairing_fail_reason + branch le_send_pairing_failed + + +ifdef SECURE_CONNECTION +le_parse_smp_pairing_random_sc: + arg mem_le_mrand,contw + copy rega,contr + call memcpy16 + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY,le_parse_smp_pairing_random_sc_passkey + call function_g2 +// jam LE_SC_STAT_RECEIVE_RANDOM,mem_le_secure_connect_state +// jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + call le_send_smp_pairing_random + fetch 1,mem_le_pairing_mode + rtnne LE_PAIRING_MODE_SECURE_CONNECT_NUMERIC + jam BT_EVT_LE_GKEY_GENERATE,mem_fifo_temp + branch ui_ipc_send_event + +le_parse_smp_pairing_random_sc_passkey: + call function_f4_ca + arg mem_AES_CMAC_temp,contw + call load_inverse_result + arg mem_AES_CMAC_temp,rega + arg mem_le_rconfirm ,regb + arg 16,loopcnt + call string_compare + nbranch le_send_pairing_confirm_value_failed,zero + branch le_send_smp_pairing_random +endif + +le_parse_smp_pairing_random_success: + call generate_stk + jam BT_EVT_LE_PAIRING_SUCCESS,mem_fifo_temp + call ui_ipc_send_event + jam 1,mem_ltk_exists + jam FLAG_LE_PAIRING_AFTER_AUTH,mem_le_pairing_state + +le_send_smp_pairing_random: + force 17,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_PAIRING_RANDOM + istore 1,contw + arg mem_le_srand,contr + branch memcpy16 + +le_parse_smp_encryption_information: + arg mem_le_peer_ltk,contw + branch memcpy16 + +le_send_smp_encryption_information: + force 17,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_ENCRYPTION_INFORMATION + istore 1,contw + fetch 1,mem_le_configuration + bbit1 BIT_BLE_PAIRING_FIXED_LTK,le_send_fixed_ltk + arg mem_le_ltk,contr + branch memcpy16 + +le_send_fixed_ltk: + arg mem_le_fixed_ltk,contr + branch memcpy16 + + +le_send_smp_master_identification: + arg mem_le_ediv,contw + force 10,loopcnt + call generate_random_loop + force 11,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_MASTER_IDENTIFICATION + istore 1,contw + fetch 2,mem_le_ediv + istore 2,contw + fetch 8,mem_le_rand + istore 8,contw + rtn + +le_send_smp_identity_information: + force 17,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_IDENTITY_INFORMATION + istore 1,contw + setarg 0 + istore 8,contw + istore 8,contw + rtn + + +le_send_smp_identity_address_information: + force 8,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_IDENTITY_ADDRESS_INFORMATION + istore 1,contw + fetch 1,mem_le_conn_own_addr_type + istore 1,contw + fetch 6,mem_le_lap + istore 6,contw + rtn + + +le_send_pairing_fail_unspecified_reason: + jam PAIRING_FAILED_UNSPECIFIED_REASON,mem_le_ll_pairing_fail_reason + branch le_send_pairing_failed + +le_check_init_key_distribution: + fetch 1,mem_le_pres_init_key_distribution + fetcht 1,mem_le_pres_init_key_distribution + iand temp,pdata + rtn + +le_parse_smp_identity_information: + arg mem_le_irk,contw + call memcpy16 + call le_check_init_key_distribution + isolate0 LE_INITATOR_IRK_BIT,pdata + branch le_send_pairing_fail_unspecified_reason,true + fetch 1,mem_device_option + rtnne dvc_op_module + call le_check_master_addr_type + nrtn user + branch app_ble_store_reconn_info + +//output:user is enable ,random addr type +le_check_master_addr_type: + call disable_user + fetch 1,mem_le_conn_peer_addr_type + rtneq MASTER_PUBLIC_ADDR + fetch 1,mem_le_plap+5 + compare 0xc0,pdata,0xc0 + rtn true + branch enable_user + +le_parse_smp_identity_address_information: + call le_check_init_key_distribution + isolate0 LE_INITATOR_IRK_BIT,pdata + branch le_send_pairing_fail_unspecified_reason,true + rtn + +le_parse_smp_master_identification: +le_parse_smp_signing_information: +le_parse_smp_security_request: + rtn + +ifdef SECURE_CONNECTION +le_parse_smp_public_key: + arg mem_le_pubkey_remote_x_256,contw + call memcpy64 + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + jam LE_SC_STAT_RECEIVE_PUBLIC_KEY,mem_le_secure_connect_state + rtn + +le_parse_smp_dhkey_check: + arg mem_sp_confirm_remote,contw + call memcpy16 + jam LE_SC_STAT_RECEIVE_DHKEY,mem_le_secure_connect_state + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + rtn + +le_send_smp_pairing_public_key: + force 65,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_PAIRING_PUBLIC_KEY + istore 1,contw + arg mem_le_pubkey_local_x_256,contr + branch memcpy64 + +le_send_smp_pairing_dhkey_check: + call function_f6_eb + force 17,rega + call le_fifo_malloc_tx_l2cap_smp + setarg SMP_PAIRING_DHKEY_CHECK + istore 1,contw + branch load_inverse_result + +endif + +le_check_paring_time: + fetch 1,mem_le_pairing_state + rtneq FLAG_LE_PAIRING_END + arg FLAG_LE_PAIRING_RCV_PAIRING_REQ,temp + isub temp,null + nrtn positive + arg smp_pairing_timer,queue + call timer_check + nrtn blank + branch le_send_pairing_fail_unspecified_reason + +le_pairing_sm: + bpatchx patch26_3,mem_patch26 + fetch 1,mem_le_pairing_state + beq FLAG_LE_PAIRING_NULL,le_pairing_sm_null + beq FLAG_LE_PAIRING_START,le_pairing_sm_start + beq FLAG_LE_PAIRING_SEND_RECURITY_REQ,le_pairing_sm_send_sec_req + beq FLAG_LE_PAIRING_RCV_PAIRING_REQ,le_pairing_sm_rcv_pairing_req + beq FLAG_LE_PAIRING_AFTER_AUTH,le_pairing_sm_after_auth + beq FLAG_LE_PARING_SEND_ENC_INFORMATION,le_pairng_sm_send_enc_information + beq FLAG_LE_PARING_SEND_MASTER_IDENTIFICATION,le_pairng_sm_send_master_indentification + beq FLAG_LE_PARING_SEND_INDENTITY_INFORMATION,le_pairng_sm_send_indentity_information + rtn + +le_pairing_sm_null: +le_pairing_sm_send_sec_req: + fetch 1,mem_le_enc_state + rtnne FLAG_LE_SEND_START_ENC_RSP + jam FLAG_LE_ENC_END,mem_le_enc_state + jam FLAG_LE_PAIRING_END,mem_le_pairing_state + jam BT_EVT_LE_RECONNECT_COMPLETE ,mem_fifo_temp + branch ui_ipc_send_event + + +le_pairing_sm_start: + jam FLAG_LE_PAIRING_SEND_RECURITY_REQ,mem_le_pairing_state + branch le_send_smp_security_request + +le_pairing_sm_rcv_pairing_req: + jam FLAG_LE_PAIRING_AUTH,mem_le_pairing_state + setarg TIMER_SMP_PAIRING_TIMEOUT + arg smp_pairing_timer,queue + branch timer_init + +le_pairing_sm_after_auth: + fetch 1,mem_le_enc_state + beq FLAG_LE_SEND_START_ENC_RSP,le_pairing_sm_after_auth_start_enc + rtn + +le_pairing_sm_after_auth_start_enc: + jam FLAG_LE_PARING_SEND_ENC_INFORMATION,mem_le_pairing_state + jam BT_EVT_LE_ENC_INFO,mem_fifo_temp + call ui_ipc_send_event + call le_send_smp_encryption_information + fetch 1,mem_device_option + rtnne dvc_op_module + call le_check_master_addr_type + rtn user + branch app_ble_store_reconn_info + + +le_pairng_sm_send_enc_information: + jam FLAG_LE_PARING_SEND_MASTER_IDENTIFICATION,mem_le_pairing_state + branch le_send_smp_master_identification + +le_pairng_sm_send_master_indentification: + fetch 1,mem_le_preq_resp_key_distribution + fetcht 1,mem_le_pres_resp_key_distribution + iand temp,pdata + isolate0 LE_INITATOR_IRK_BIT,pdata + branch le_parse_start_enc_rsp_after_auth_end,true + jam FLAG_LE_PARING_SEND_INDENTITY_INFORMATION,mem_le_pairing_state + branch le_send_smp_identity_information + +le_pairng_sm_send_indentity_information: + call le_send_smp_identity_address_information + branch le_parse_start_enc_rsp_after_auth_end + + +le_parse_start_enc_rsp_after_auth_end: + force smp_pairing_timer,queue + call timer_stop + jam FLAG_LE_ENC_END,mem_le_enc_state + jam FLAG_LE_PAIRING_END,mem_le_pairing_state + jam BT_EVT_LE_PAIRING_COMPLETE ,mem_fifo_temp + branch ui_ipc_send_event + + +ifdef SECURE_CONNECTION + +le_secure_connect_sm: + bpatchx patch26_4,mem_patch26 + fetch 1,mem_le_pairing_mode + rtnbit0 LE_PAIRING_MODE_SECURE_CONNECT_BIT + fetch 1,mem_le_secure_connect_flag + rtnne LE_SP_FLAG_COMMIT_256 + jam SP_FLAG_STANDBY,mem_le_secure_connect_flag + fetch 1,mem_le_secure_connect_state + beq LE_SC_STAT_RECEIVE_PUBLIC_KEY,le_sc_sm_receive_public_key + beq LE_SC_STAT_WAIT_SEND_PUBLIC_KEY,le_sc_sm_wait_send_public_key + beq LE_SC_STAT_SEND_PUBLIC_KEY,le_sc_sm_send_public_key + beq LE_SC_STAT_RECEIVE_DHKEY,le_sc_sm_receive_dhkey + beq LE_SC_STAT_WAIT_CONFIRM_GKEY,le_sc_sm_wait_confirm_gkey + beq LE_SC_STAT_PASSKEY_WAIT_CONFIRM,le_sc_sm_passkey_wait_confirm + rtn + + +le_sc_sm_passkey_wait_confirm: + fetch 1,mem_authentication_passkey_times + copy pdata,queue + increase 1,pdata + store 1,mem_authentication_passkey_times + fetch 4,mem_le_tk + qisolate1 pdata + setarg 0x80 + setflag true,0,pdata + store 1,mem_passkey_1bit + branch le_sc_sm_ready_send_pairing_confirm + +le_sc_sm_wait_confirm_gkey: + fetch 1,mem_le_sc_confirm_gkey_flag + jam FLAG_LE_SC_CONFRIM_NULL,mem_le_sc_confirm_gkey_flag + beq FLAG_LE_SC_CONFRIM_GKEY_OK,le_sc_confirm_gkey_ok + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + rtn + +le_sc_confirm_gkey_ok: + jam BT_EVT_LE_PAIRING_SUCCESS,mem_fifo_temp + call ui_ipc_send_event + jam FLAG_LE_PAIRING_AFTER_AUTH,mem_le_pairing_state + branch le_send_smp_pairing_dhkey_check + +le_sc_sm_receive_dhkey: + fetch 1,mem_sp_dhkey_invalid + beq SP_KEY_VALID_256,le_dhkey_ready + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + rtn + +le_dhkey_ready: + call function_f5 +// arg mem_le_r,contw +// force 2,loopcnt +// call memset0 + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY ,le_dhkey_ready_common + call le_set_tk_0 +le_dhkey_ready_common: + call function_f6_ea + arg mem_AES_CMAC_temp,rega + arg mem_sp_confirm_remote ,regb + arg 16,loopcnt + call string_compare + branch le_dhkey_check_ok,zero +le_dhkey_check_fail: + jam PAIRING_FAILED_DHKEY_CHECK_FAILED,mem_le_ll_pairing_fail_reason + branch le_send_pairing_failed + + +le_dhkey_check_ok: + call sp_calc_check_publickey_256 + nbranch le_dhkey_check_fail,zero + jam 1,mem_ltk_exists + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_SECURE_CONNECT_JUSTWORK,le_sc_confirm_gkey_ok + beq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY ,le_sc_confirm_gkey_ok + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + jam LE_SC_STAT_WAIT_CONFIRM_GKEY,mem_le_secure_connect_state + rtn + +le_sc_sm_send_public_key: + fetch 1,mem_le_pairing_mode + beq LE_PAIRING_MODE_SECURE_CONNECT_PASSKEY,le_sc_sm_send_public_key_passkey + jam 0,mem_passkey_1bit +le_sc_sm_ready_send_pairing_confirm: + branch le_send_smp_pairing_confirm + +le_sc_sm_send_public_key_passkey: +// jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag +// jam LE_SC_STAT_PASSKEY_WAIT_CONFIRM,mem_le_secure_connect_state +// branch p_ng_event_le_get_passkey + jam 0,mem_authentication_passkey_times + branch le_parse_smp_pairing_req_passkey + + +le_sc_sm_receive_public_key: + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + fetch 1,mem_le_sc_local_key_invalid + beq SP_KEY_VALID_256,le_public_key_ready +// jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + rtn + +le_public_key_ready: + jam LE_SC_STAT_WAIT_SEND_PUBLIC_KEY,mem_le_secure_connect_state + jam SP_KEY_INVALID,mem_sp_dhkey_invalid + branch sp_dhkey_calc_256 + +le_sc_sm_wait_send_public_key: + jam LE_SP_FLAG_COMMIT_256,mem_le_secure_connect_flag + jam LE_SC_STAT_SEND_PUBLIC_KEY,mem_le_secure_connect_state + branch le_send_smp_pairing_public_key + +endif + + +le_fifo_malloc_tx_l2cap_smp: + force LE_L2CAP_CID_SMP,regb + branch le_fifo_malloc_tx_l2cap + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_ll.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_ll.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/le_ll.prog (working copy) @@ -0,0 +1,213 @@ + +le_parse_ll: + bpatchx patch26_5,mem_patch26 + fetch 1,mem_le_rxbuf+2 + beq LL_CONNECTION_UPDATE_REQ,le_parse_connection_update_req + beq LL_CHANNEL_MAP_REQ,le_parse_channel_map_req + beq LL_TERMINATE_IND,le_parse_terminate_ind + beq LL_ENC_REQ,le_parse_enc_req + beq LL_ENC_RSP,le_parse_enc_rsp + beq LL_START_ENC_REQ,le_parse_start_enc_req + beq LL_START_ENC_RSP,le_parse_start_enc_rsp + beq LL_UNKNOWN_RSP,le_parse_unknown_rsp + beq LL_FEATURE_REQ,le_parse_feature_req + beq LL_FEATURE_RSP,le_parse_feature_rsp + beq LL_PAUSE_ENC_REQ,le_parse_pause_enc_req + beq LL_PAUSE_ENC_RSP,le_parse_pause_enc_rsp + beq LL_VERSION_IND,le_parse_version_ind + beq LL_REJECT_IND,le_parse_reject_ind + beq LL_PING_REQ,le_parse_ping_req + beq LL_PING_RSP,le_parse_ping_rsp + arg 2,rega + arg LL_UNKNOWN_RSP,regb + call le_fifo_malloc_tx_ll + fetch 1,mem_le_rxbuf+2 + istore 1,contw + rtn + + +le_parse_connection_update_req: + ifetch 9,contr + store 9,mem_le_new_param + ifetch 2,contr + store 2,mem_le_instant + fetch 1,mem_le_state + set1 lestate_update_param,pdata + store 1,mem_le_state + rtn + +le_parse_channel_map_req: + ifetch 5,contr + store 5,mem_le_new_map + ifetch 2,contr + store 2,mem_le_instant + fetcht 2,mem_le_event_count + isub temp,null + nbranch le_parse_terminate_ind,positive + fetch 1,mem_le_state + set1 lestate_update_map,pdata + store 1,mem_le_state + rtn + + +le_parse_terminate_ind: + setarg 20 // 200ms + store 2,mem_le_superto + store 2,mem_le_init_superto + rtn + +le_send_terminate_ind_user_terminated: + arg ERROR_REMOTE_USER_TERMINATED_CONNECTION,regc + +//regc:The ErrorCode field shall be set to inform the remote device why the connection is about to be terminated. +le_send_terminate_ind: + arg 2,rega + arg LL_TERMINATE_IND,regb + call le_fifo_malloc_tx_ll + copy regc,pdata + istore 1,contw + rtn + +le_parse_feature_req: + +le_send_feature_rsp: + arg 9,rega + arg LL_FEATURE_RSP,regb + call le_fifo_malloc_tx_ll + setarg param_le_features + istore 8,contw + rtn + + +le_parse_version_ind: + rtn master +le_send_version_ind: + arg 6,rega + arg LL_VERSION_IND,regb + call le_fifo_malloc_tx_ll + fetch 5,mem_lmp_version + istore 5,contw + rtn + + +le_parse_ping_req: + arg LL_PING_RSP,regb + branch le_send_ll_one_lenth + +//regb:ll opcode +le_send_ll_one_lenth: + arg 1,rega + branch le_fifo_malloc_tx_ll + + +le_parse_enc_req: + ifetch 8,contr + store 8,mem_le_rand + ifetch 2,contr + store 2,mem_le_ediv + ifetch 8,contr + store 8,mem_le_skdm + ifetch 4,contr + store 4,mem_le_ivm + call le_send_enc_rsp + bpatchx patch26_6,mem_patch26 + fetch 1,mem_le_pairing_state + beq FLAG_LE_PAIRING_AFTER_AUTH,le_parse_enc_req_after_auth + fetch 1,mem_le_configuration + bbit1 BIT_BLE_PAIRING_FIXED_LTK,le_parse_enc_req_fixed_ltk + fetch 1,mem_nv_data_number + ncall load_device_list_mode_4,blank + fetch 1,mem_ltk_exists + beq 0,le_ltk_lost +le_parse_enc_req_after_auth: + jam FLAG_LE_RCV_ENC_START,mem_le_enc_state + call le_send_start_enc_req + branch generate_sk + +le_parse_enc_req_fixed_ltk: + jam 1,mem_ltk_exists + arg mem_le_fixed_ltk,contr + arg mem_le_ltk,contw + call memcpy16 + branch le_parse_enc_req_after_auth + + +le_ltk_lost: + bpatchx patch26_7,mem_patch26 + jam FLAG_LE_ENC_NULL,mem_le_enc_state + jam FLAG_LE_ENC_NULL,mem_le_pairing_state + jam BT_EVT_LE_LTK_LOST,mem_fifo_temp + branch ui_ipc_send_event + +le_send_reject_ind: + arg 2,rega + arg LL_REJECT_IND,regb + call le_fifo_malloc_tx_ll + setarg LE_ERR_PIN_OR_KEY_MISSING + istore 1,contw + rtn + +le_send_enc_rsp: + arg mem_le_skds,contw + force 8,loopcnt + call generate_random_loop + arg mem_le_ivs,contw + force 4,loopcnt + call generate_random_loop + arg 13,rega + arg LL_ENC_RSP,regb + call le_fifo_malloc_tx_ll + fetch 8,mem_le_skds + istore 8,contw + fetch 4,mem_le_ivs + istore 4,contw + rtn + +le_send_start_enc_req: + arg LL_START_ENC_REQ,regb + branch le_send_ll_one_lenth + +le_send_start_enc_rsp: + arg LL_START_ENC_RSP,regb + branch le_send_ll_one_lenth + + +le_parse_enc_rsp: + ifetch 8,contr + store 8,mem_le_skds + ifetch 4,contr + store 4,mem_le_ivs + branch generate_sk + +le_parse_start_enc_req: + fetch 1,mem_le_state + set1 lestate_encryption,pdata + store 1,mem_le_state + rtn + +le_parse_start_enc_rsp: + rtn master + jam BT_EVT_LE_START_ENC,mem_fifo_temp + call ui_ipc_send_event + jam FLAG_LE_SEND_START_ENC_RSP,mem_le_enc_state + branch le_send_start_enc_rsp + +le_parse_pause_enc_req: + jam FLAG_LE_ENC_PAUSE,mem_le_enc_state + call le_send_pause_enc_rsp + jam BT_EVT_LE_PAUSE_ENC,mem_fifo_temp + branch ui_ipc_send_event + +le_send_pause_enc_rsp: + arg LL_PAUSE_ENC_RSP,regb + branch le_send_ll_one_lenth + + +le_parse_feature_rsp: +le_parse_unknown_rsp: +le_parse_pause_enc_rsp: +le_parse_reject_ind: +le_parse_ping_rsp: + rtn + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/lmp.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/lmp.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/lmp.prog (working copy) @@ -0,0 +1,2522 @@ + +/******************************************/ +/************* LMP Parse **************/ +/******************************************/ +init_lmp: + rtn wake +init_lmp_work: + bpatchx patch27_0,mem_patch27 + setarg 0 + store 1,mem_lmp_to_send + store 1,mem_conn_sm + store 1,mem_lmo_opcode1 + store 1,mem_lmo_opcode2 + store 1,mem_esco_addr + store 1,mem_auth_enable + store 1,mem_connection_options + store 1,mem_pairing_auth + jam SWITCH_FLAG_INIT,mem_switch_flag + jam 0,mem_switch_fail_master_count + jam NULL_ENCRYP,mem_wait_encryption +init_lmp_reinit: + jam 0,mem_pairing_auth + jam 0,mem_sp_localsm + jam 0,mem_lmp_conn_state + //fall through +parse_rx_done: + rtn + +parse_lmp: + bpatchx patch27_1,mem_patch27 + call setlocalsm_master,master //use this flag in hci + ncall setlocalsm_slave,master + call lmo_fifo_check + nrtn blank + fetch 1,mem_state_map + rtnbit0 smap_rxlmp + set0 smap_rxlmp,pdata + set0 mark_rxbuf_inuse,mark + store 1,mem_state_map + fetch 1,mem_rxbuf + fetcht 1,mem_state_map + isolate1 smap_lmptidinit,pdata + setflag true,smap_lmptid,temp + storet 1,mem_state_map + and_into 0x2,temp //smap_lmptid only + storet 1,mem_lmo_tid2 + fetcht 1,mem_state_map + rshift pdata,pdata /* align lmp_opcode */ + store 1,mem_lmi_opcode2 + bpatchx patch27_2,mem_patch27 + fetch 1,mem_lmi_opcode2 + beq LMP_ESCAPE,parse_lmp_escape//multi + beq LMP_ACCEPTED,parse_lmp_accepted//multi + beq LMP_NOT_ACCEPTED,parse_lmp_not_accepted//multi + beq LMP_SET_AFH, parse_lmp_set_afh + beq LMP_CLKOFFSET_REQ, parse_lmp_clkoffset_req + beq LMP_ENCRYPTION_MODE_REQ, parse_lmp_encryption_mode_req + beq LMP_ENCRYPTION_KEY_SIZE_REQ,parse_lmp_crypt_key + beq LMP_AUTO_RATE,parse_lmp_auto_rate + beq LMP_TEST_CONTROL,parse_lmp_test_control//multi + beq LMP_TEST_ACTIVATE,parse_lmp_test_activate + beq LMP_SETUP_COMPLETE,parse_lmp_setup_complete + beq LMP_SUPERVISION_TIMEOUT,parse_lmp_supervision_timeout + beq LMP_FEATURES_REQ,parse_lmp_features_req + beq LMP_HOST_CONNECTION_REQ,parse_lmp_conn_req + beq LMP_VERSION_REQ,parse_lmp_version_req + beq LMP_VERSION_RES,parse_lmp_version_res + beq LMP_DETACH,parse_lmp_detach + beq LMP_MAX_SLOT,parse_lmp_max_slot + beq LMP_MAX_SLOT_REQ,parse_lmp_max_slot_req + beq LMP_NAME_REQ,parse_lmp_name_req + beq LMP_NAME_RES,parse_lmp_name_res + beq LMP_FEATURES_RES,parse_lmp_features_res + beq LMP_COMB_KEY,parse_lmp_comb_key + beq LMP_AU_RAND, parse_lmp_au_rand + beq LMP_IN_RAND,parse_lmp_in_rand + beq LMP_SRES,parse_lmp_sres + beq LMP_INCR_POWER_REQ,parse_lmp_incr_power + beq LMP_DECR_POWER_REQ,parse_lmp_decr_power + beq LMP_MAX_POWER, parse_lmp_max_power + beq LMP_MIN_POWER, parse_lmp_min_power + beq LMP_PAGE_MODE_REQ, parse_lmp_page_mode_req + beq LMP_PAGE_SCAN_MODE_REQ, parse_lmp_page_scan_mode_req + beq LMP_PREFERRED_RATE, parse_lmp_preferred_rate + beq LMP_SLOT_OFFSET, parse_lmp_slot_offset + beq LMP_SNIFF_REQ, parse_lmp_sniff_req + beq LMP_START_ENCRYPTION_REQ, parse_lmp_start_encryption_req + beq LMP_STOP_ENCRYPTION_REQ, parse_lmp_stop_encryption_req + beq LMP_SWITCH_REQ, parse_lmp_switch_req + beq LMP_TEMP_RAND, parse_lmp_temp_rand + beq LMP_TEMP_KEY, parse_lmp_temp_key + beq LMP_TIMING_ACCURACY_REQ, parse_lmp_timing_accuracy_req + beq LMP_TIMING_ACCURACY_RES, parse_lmp_timing_accuracy_res + beq LMP_UNIT_KEY, parse_lmp_unit_key + beq LMP_UNSNIFF_REQ, parse_lmp_unsniff_req + beq LMP_USE_SEMI_PERMANENT_KEY, parse_lmp_use_semi_permanend_key + beq LMP_ENCAPSULATED_HEADER,parse_lmp_encapsulated_header + beq LMP_ENCAPSULATED_PAYLOAD,parse_lmp_encapsulated_payload + beq LMP_SIMPLE_PAIRING_CONFIRM,parse_simple_pairing_confirm + beq LMP_SIMPLE_PAIRING_NUMBER,parse_lmp_simple_pairing_number + beq LMP_DHKEY_CHECK,parse_dhkey_check + beq LMP_CLKOFFSET_RES, parse_lmp_clkoffset_res + beq LMP_ENC_KEY_SIZE_MASK_REQ,parse_enc_key_size_mask_req +/* lmp is not recognized, check to see if we respond to all messages */ +/* rejecting the unrecognized message with PDU not recognized */ +reject_unknown_packet: + jam UNKNOWN_LMP_PDU,mem_lmo_reason2 +reject_lmp_packet: + jam LMP_NOT_ACCEPTED,mem_lmo_opcode2 + rtn + +parse_lmp_clkoffset_req: + jam LMP_CLKOFFSET_RES,mem_lmo_opcode2 + rtn + +parse_enc_key_size_mask_req: + jam LMP_ENC_KEY_SIZE_MASK_RES,mem_lmo_opcode2 + rtn + +parse_lmp_set_afh: + fetch 4,mem_rxbuf+1 + lshift pdata,pdata + store 4,mem_afh_instant + fetch 1,mem_rxbuf+5 + store 1,mem_afh_new_mod + fetch 5,mem_rxbuf+6 + store 5,mem_afh_map_new + fetch 5,mem_rxbuf+11 + istore 5,contw + fetch 1,mem_mode + set1 afh_change,pdata + store 1,mem_mode + rtn +parse_lmp_escape: + bpatchx patch27_3,mem_patch27 + fetch 1,mem_rxbuf+1 + set1 7,pdata + store 1,mem_lmi_opcode2 + beq LMP_EXT_ACCEPTED,parse_lmpext_accepted + beq LMP_NOT_ACCEPTED_EXT,parse_lmpext_not_accepted + beq LMP_SNIFF_SUBRATING_REQ, parse_lmp_sniff_subrating_req + beq LMP_SNIFF_SUBRATING_RES, parse_lmp_sniff_subrating_res + beq LMP_PACKET_TYPE_TABLE_REQ,parse_lmpext_packet_type_table_req + beq LMP_EXT_FEATURES_REQ,parse_lmpext_features_req + beq LMP_EXT_FEATURES_RES,parse_lmpext_features_res + beq LMP_EXT_CHN_CLASSIFICATION_REQ,parse_lmpext_chn_classification_req + beq LMP_PAUSE_ENCRYPTION_REQ,parse_lmpext_pause_encrypt + beq LMP_RESUME_ENCRYPTION_REQ,parse_lmpext_resume_encrypt + beq LMP_IO_CAP_REQ,parse_lmpext_iocap_req + beq LMP_IO_CAP_RES,parse_lmpext_iocap_res + rtneq LMP_EXT_FEATURES_RES + + +reject_unknown_ext_packet: + jam LMP_NOT_ACCEPTED_EXT,mem_lmo_opcode2 + jam UNKNOWN_LMP_PDU,mem_lmo_reason2 + + rtn +parse_lmpext_chn_classification_req: + jam LMP_NOT_ACCEPTED_EXT,mem_lmo_opcode2 + jam NOT_SUPPORT_CHN_CLASSIFICATION,mem_lmo_reason2 + rtn + +parse_lmpext_iocap_req: + call iocap_lmpext_load + jam LMP_IO_CAP_RES,mem_lmo_opcode2 + rtn + +parse_lmpext_iocap_res: + call iocap_lmpext_load + branch iocap_lmpext_common + +iocap_lmpext_load: + arg mem_sp_iocap_remote,contw + fetch 3, mem_rxbuf+2 + istore 3,contw + rtn + +iocap_lmpext_common: +ifdef SIMPLE_PAIRING + branch master_set_mem_master_sp_flag,true//is un very ok to use master flag,but we have to add many codes if wo don't +endif + rtn +parse_lmpext_accepted: + fetch 1,mem_rxbuf+3 + set1 7,pdata + store 1,mem_lmi_accepted_opcode + beq LMP_PACKET_TYPE_TABLE_REQ,parse_lmpext_accepted_ptt + rtn + + +parse_lmpext_not_accepted: + fetch 1,mem_rxbuf+3 + set1 7,pdata + store 1,mem_lmi_accepted_opcode + beq LMP_PACKET_TYPE_TABLE_REQ,parse_lmpext_not_accepted_ptt + rtn + +parse_lmpext_accepted_ptt: + fetch 1,mem_ptt + fetcht 1,mem_state_map + nsetflag blank,smap_edr,temp + storet 1,mem_state_map +parse_lmpext_not_accepted_ptt: + fetch 1,mem_state + rtnbit0 state_init_seq + set0 state_init_seq,pdata + store 1,mem_state + fetch 1,mem_auth_enable + nrtn blank + jam LMP_SETUP_COMPLETE,mem_lmo_opcode2 + rtn + +parse_lmpext_pause_encrypt: + nbranch parse_lmpext_pause_encrypt_slave, master + jam LMP_STOP_ENCRYPTION_REQ,mem_lmo_opcode2 + branch tid_reply + +parse_lmpext_pause_encrypt_slave: + jam LMP_PAUSE_ENCRYPTION_REQ, mem_lmo_opcode2 + rtn + +parse_lmpext_resume_encrypt: +//trans file to pc may cause pause/resume encrypt +//if ms is conn_sm_wait_end the controllor won't send ack after recieved start_encypt_accept + call tid_reply + branch lmp_start_encryption + +parse_lmpext_features_req: + jam LMP_EXT_FEATURES_RES,mem_lmo_opcode2 + rtn + +parse_lmpext_features_res: + fetcht 1,mem_rxbuf+4 + and temp,0x1,temp + storet 1,mem_remote_sppcap + fetch 1,mem_hci_cmd + bne hci_cmd_wait_remote_ext_feature,parse_lmpext_features_res_not_hci + jam 0,mem_hci_cmd +parse_lmpext_features_res_not_hci: + fetch 1,mem_conn_sm + rtnne CONN_SM_WAIT_FEATURES_EXT + jam CONN_SM_SEND_CONN_REQ,mem_conn_sm + branch process_conn_sm + +parse_lmp_accepted: + bpatchx patch27_4,mem_patch27 + fetch 1,mem_rxbuf+1 + store 1,mem_lmi_accepted_opcode + beq LMP_HOST_CONNECTION_REQ,parse_lmp_accepted_hostconn//ok + beq LMP_IN_RAND,parse_lmp_accepted_inrand//ok + beq LMP_ENCRYPTION_MODE_REQ,parse_lmp_accepted_enc_mode//ok + beq LMP_ENCRYPTION_KEY_SIZE_REQ,parse_lmp_accepted_enc_keysize//ok + beq LMP_START_ENCRYPTION_REQ,parse_lmp_accepted_start_enc//ok + beq LMP_STOP_ENCRYPTION_REQ,parse_lmp_accepted_stop_enc//ok + beq LMP_UNSNIFF_REQ,parse_lmp_accepted_unsniff_req//ok + beq LMP_SNIFF_REQ,parse_lmp_accepted_sniff_req//ok + beq LMP_SWITCH_REQ,parse_lmp_accepted_switch + // simple pairing + beq LMP_ENCAPSULATED_HEADER,parse_lmp_accepted_encapsulated_header//ok + beq LMP_ENCAPSULATED_PAYLOAD,parse_lmp_accepted_encapsulated_payload//ok + beq LMP_SIMPLE_PAIRING_NUMBER,parse_lmp_accepted_simple_pairing_number//ok + beq LMP_DHKEY_CHECK,parse_lmp_accepted_dhkey_check//ok + rtn + +parse_lmp_not_accepted: + bpatchx patch27_5,mem_patch27 + fetch 1,mem_rxbuf+1 + store 1,mem_lmi_accepted_opcode + beq LMP_NAME_REQ,parse_lmp_not_accepted_name_req//ok + beq LMP_HOST_CONNECTION_REQ,parse_lmp_not_accepted_hostconn//ok + beq LMP_AU_RAND,parse_lmp_not_accepted_aurand//ok + beq LMP_IN_RAND,parse_lmp_not_accepted_inrand//ok + beq LMP_SWITCH_REQ,parse_lmp_not_accepted_switch//ok + /* simple pairing support */ + beq LMP_SIMPLE_PAIRING_NUMBER,parse_lmp_not_accepted_simple_pairing_number//ok + beq LMP_DHKEY_CHECK,parse_lmp_not_accepted_dhkey_check//ok + beq LMP_UNSNIFF_REQ,parse_lmp_not_accepted_unsniff_req + beq LMP_SNIFF_REQ,parse_lmp_not_acdcept_sniff_req + rtn + +parse_lmp_accepted_switch: + jam BT_EVT_SWITCH_ACCEPT,mem_fifo_temp + call ui_ipc_send_event + branch role_switch_prepare0 +parse_lmp_not_accepted_switch: + jam BT_EVT_SWITCH_NOT_ACCEPT,mem_fifo_temp + call ui_ipc_send_event + jam SWITCH_FLAG_NOT_ACCEPT,mem_switch_flag + setarg TIMER_SWITCH_WAITE + arg switch_wait_timer,queue + branch timer_init + + +parse_lmp_accepted_hostconn: + //fetch 1,mem_state + //rtnbit0 state_init_seq + fetch 1,mem_lmp_conn_state + set1 RECEIVED_CONN_REQ,pdata + store 1,mem_lmp_conn_state + jam BT_EVT_BB_CONNECTED,mem_fifo_temp + call ui_ipc_send_event + jam LMP_PACKET_TYPE_TABLE_REQ,mem_lmo_opcode2 + //nbranch parse_lmp_accepted_hostconn_ctn,master +parse_lmp_accepted_hostconn_ctn: + /* checking to see if we requested host connection */ + fetch 1,mem_conn_sm + bne CONN_SM_WAIT_CONN_ACCEPT, parse_rx_done + //branch parse_lmp_accepted_hostconn_master,master + /* continuing on with host connection state machine */ + jam CONN_SM_AUTH_PAIR,mem_conn_sm + rtn + //branch host_create_conn_auth_pair + + /* we need to move fast and send au_rand...jumping to next part of state machine for conn */ +//parse_lmp_accepted_hostconn_master: + //jam CONN_SM_AUTH_PAIR ,mem_conn_sm +// rtn + +parse_lmp_not_accepted_hostconn: + jam ACL_CONNECTION_ALREADY_EXISTS,mem_disconn_reason_send + jam LMP_DETACH,mem_lmo_opcode2 + /* clearing connection state machine */ + jam CONN_SM_STANDBY,mem_conn_sm + /* sending error message to host */ + branch parse_rx_done,true + rtn + +parse_lmp_accepted_inrand: + fetch 1,mem_link_key_exists + nrtn blank + call clear_linkkey + call lmp_generate_key + rtn master + set1 mark_slave_in_rand_accepted,mark + rtn + +parse_lmp_accepted_enc_mode: + nrtn master + jam LMP_ENCRYPTION_KEY_SIZE_REQ,mem_lmo_opcode2 + fetch 1,mem_state_map + rtnbit0 smap_encryption + jam LMP_STOP_ENCRYPTION_REQ,mem_lmo_opcode2 + rtn + +parse_lmp_accepted_enc_keysize: + branch lmp_start_encryption + +parse_lmp_accepted_start_enc: + call send_create_conn_start_l2cap_timer_sm + fetch 1,mem_state + rtnbit1 state_conn_comp + jam LMP_SETUP_COMPLETE,mem_lmo_opcode2 + fetch 1,mem_conn_sm + rtnne CONN_SM_ENCRYPT_WAIT + jam CONN_SM_ENCRYPT_WAIT_CLEAR,mem_conn_sm + rtn + +parse_lmp_accepted_stop_enc: + /* again this won't work with multipoint. keep track of anyone else encrypting */ + //jam HOST_STOP_ENCRYPTION,message_queue_B0 + //jam 1,message_queue_B1 + //jam HOST_RETURN_SUCCESS,message_queue_B2 + //fetch 1,mem_lmp_state2 + //set1 MESSAGE_QUEUE,pdata + //store 1,mem_lmp_state2 + rtn + +parse_lmp_not_accepted_aurand: +parse_lmp_not_accepted_aurand_send_detach: + jam LMP_DETACH,mem_lmo_opcode2 + jam OTHER_END_TERMINATED,mem_disconn_reason_send + rtn +/*in pair remote cancel the pair*/ +parse_lmp_not_accepted_inrand: + fetch 1,mem_rxbuf+2 + beq KEY_MISSING,parse_lmp_inrand_key_missing + rtnne PAIRING_NOT_ALLOWED + jam PAIRING_NOT_ALLOWED,mem_disconn_reason_send + jam LMP_DETACH,mem_lmo_opcode2 + rtn +parse_lmp_inrand_key_missing: + jam KEY_MISSING,mem_disconn_reason_send + jam LMP_DETACH,mem_lmo_opcode2 + rtn + +parse_lmp_not_accepted_name_req: + rtn + +parse_lmp_not_accepted_simple_pairing_number: + jam SP_STAT_NULL,mem_sp_state + jam LMP_DETACH,mem_lmo_opcode2 + branch parse_rx_done + +parse_lmp_not_accepted_dhkey_check: +ifdef LMP_DBG + call ice_break +endif + jam SP_STAT_NULL,mem_sp_state + jam LMP_DETACH,mem_lmo_opcode2 + branch parse_rx_done +parse_lmp_not_accepted_unsniff_req: + jam BT_EVT_UNSNIFF_NOT_ACCEPT,mem_fifo_temp + branch ui_ipc_send_event + +parse_lmp_accepted_unsniff_req: + jam BT_EVT_UNSNIFF_ACCEPT,mem_fifo_temp + call ui_ipc_send_event + branch sniff_exit + +parse_lmp_accepted_sniff_req: + jam BT_EVT_SNIFF_ACCEPT,mem_fifo_temp + call ui_ipc_send_event + setarg 0 + store 2,mem_dsniff + fetch 2,mem_sniff_param_interval + lshift pdata,pdata + store 2,mem_tsniff + fetch 1,mem_sniff_param_attempt + store 1,mem_sniff_attempt + fetch 1,mem_sniff_param_timeout + store 1,mem_sniff_timeout + branch sniff_init + +parse_lmp_not_acdcept_sniff_req: + jam BT_EVT_SNIFF_NOT_ACCEPT,mem_fifo_temp + branch ui_ipc_send_event + +parse_lmp_crypt_key: + fetcht 1,mem_rxbuf+1 + storet 1,mem_key_size + branch accept_lmp_msg + +parse_lmp_setup_complete: + fetch 1,mem_lmp_conn_state + set1 RECEIVED_SETUP_COMPLETE,pdata + store 1,mem_lmp_conn_state + rtnbit1 SENT_SETUP_COMPLETE + jam LMP_SETUP_COMPLETE,mem_lmo_opcode2 + branch parse_rx_done + +parse_lmp_max_slot: + //jam LMP_MAX_SLOT,mem_lmi_opcode2 + //branch accept_lmp_msg + rtn + +parse_lmp_max_slot_req: + fetch 1,mem_max_slot + fetcht 1,mem_rxbuf+1 + isub temp,null + //jam LMP_MAX_SLOT_REQ,mem_lmi_opcode2 + branch accept_lmp_msg,positive + jam LMP_NOT_ACCEPTED,mem_lmo_opcode2 + jam UNSPECIFIED_ERROR,mem_lmo_reason2 + jam LMP_MAX_SLOT_REQ,mem_lmi_opcode2 + rtn + +parse_lmp_detach: + call prepare_disconnect + branch accept_lmp_msg + +accept_lmp_msg: + jam LMP_ACCEPTED,mem_lmo_opcode2 + rtn + +parse_lmp_incr_power: + jam LMP_MAX_POWER,mem_lmo_opcode2 + rtn + +parse_lmp_decr_power: + jam LMP_MIN_POWER,mem_lmo_opcode2 + rtn + +parse_lmp_version_res: + fetch 1,mem_conn_sm + rtneq CONN_SM_WAIT_VERSION + /* continuing on with host connection state machine */ + jam CONN_SM_SEND_FEATURES ,mem_conn_sm + /* we need to move fast and send au_rand...jumping to next part of state machine for conn */ + rtn + + +parse_lmp_auto_rate: + rtn + +parse_lmp_in_rand: + call lmp_copy_rand + jam pincode_state_wait_pincode,mem_pincode_state + jam BT_EVT_PINCODE_REQ,mem_fifo_temp + call ui_ipc_send_event + + call tid_check + nbranch lmp_accept_inrand,true + //fetch 1,mem_auth_enable + nbranch parse_lmp_inrand_res,master // ignore this because of not ssp temporary + jam LMP_NOT_ACCEPTED,mem_lmo_opcode2 + jam LMP_IN_RAND,mem_lmi_opcode2 + jam TRANSACTION_COLLISION,mem_lmo_reason2 + rtn +parse_lmp_inrand_res: + fetch 1,mem_op + set1 op_inrand_req,pdata + store 1,mem_op + rtn + +//store current tid +pop_tid_follow: + fetcht 1,mem_state_map + nsetflag blank,smap_lmptid,temp + storet 1,mem_state_map + rtn + +//restore current tid +push_tid_follow: + fetch 1,mem_lmo_tid2 + rshift pdata,pdata + and_into 1,pdata + rtn + +parse_lmp_au_rand_moudle: + fetch 1,mem_nv_data_number + rtn blank + fetch 1,mem_pairing_auth + call load_device_list,blank + rtn + +parse_lmp_au_rand: + call parse_lmp_au_rand_moudle + call push_tid_follow + store 1,mem_sres_tid + call lmp_copy_rand + jam LMP_SRES,mem_lmo_opcode2 + fetch 1,mem_link_key_exists + nrtn blank + fetch 1,mem_state + rtnbit1 state_combkey /* we have comb key, but not verified */ + jam KEY_MISSING,mem_lmo_reason2 + branch reject_lmp_packet + +parse_lmp_sres: + arg mem_plap,rega + call function_e1 + fetch 4,mem_rxbuf+1 + fetcht 4,mem_input_store + isub temp,null + branch authentication_ok,zero + jam LMP_DETACH,mem_lmo_opcode2 + jam AUTHENTICATION_FAILURE_ERROR,mem_disconn_reason_send + rtn +authentication_ok: + call authentication_ok_common + fetch 1,mem_ssp_enable + branch pairing_success,blank + rtn + + +authentication_ok_common: + call copy_aco + call linkkey_ready///save link key + fetch 1,mem_op + isolate1 op_auth_req,pdata + set0 op_auth_req,pdata + store 1,mem_op + fetch 1,mem_conn_sm + beq CONN_SM_AUTH_WAIT,authentication_ok_conn_sm + beq CONN_SM_PAIRING_WAIT,authentication_ok_conn_sm + rtn +authentication_ok_conn_sm: + fetch 1,mem_pairing_auth + rtnne DEFALT_PAIRING_AUTH + fetch 1,mem_state_map + rtnbit1 smap_encryption + branch host_create_conn_encrypt + +parse_lmp_comb_key: + arg mem_rxbuf+1,rega + arg mem_kinit,regb + arg mem_random_number,contw + call xor16 + arg mem_plap,rega + call generate_linkkey + jam LMP_AU_RAND,mem_lmo_opcode2 + fetch 1,mem_state + bbit0 state_combkey,lmp_generate_key + rtn + +parse_lmp_name_res: + fetch 2,mem_len + add pdata,-3,loopcnt //for remote name length error + fetcht 1,mem_rxbuf+1 + setarg mem_tmp_buffer + iadd temp,contw + arg mem_rxbuf+3,contr + call memcpy + fetcht 1,mem_name_offset + fetch 1,mem_rxbuf+2 + isub temp,pdata + sub pdata,14,null + branch parse_lmp_name_res_end,positive + add temp,14,pdata + store 1,mem_name_offset + jam LMP_NAME_REQ,mem_lmo_opcode2 + rtn +parse_lmp_name_res_end: + fetch 1,mem_state_map + set1 smap_name_res,pdata + store 1,mem_state_map + bbit1 smap_name_req,lmp_disconnect + rtn +parse_lmp_name_req: + fetch 1,mem_rxbuf+1 + store 1,mem_lmi_opcode2 //offset + jam LMP_NAME_RES,mem_lmo_opcode2 + rtn + +parse_lmp_conn_req: + branch accept_lmp_msg + +parse_lmp_timing_accuracy_req: + jam LMP_TIMING_ACCURACY_RES,mem_lmo_opcode2 + rtn + +parse_lmp_features_req: + jam LMP_FEATURES_RES,mem_lmo_opcode2 + rtn + +parse_lmp_version_req: + jam LMP_VERSION_RES,mem_lmo_opcode2 + rtn + +parse_lmp_supervision_timeout: +// fetch 2,mem_rxbuf+1 +// store 2,mem_supervision_to + rtn + + + +parse_lmp_sniff_subrating_req: + fetch 2,mem_tsniff + iforce temp + fetch 1,mem_rxbuf+2 + store 1,mem_subsniff_rate + imul32 temp,temp + fetch 2,mem_rxbuf+3 + lshift pdata,pdata + store 2,mem_subsniff_tcmax + fetch 4,mem_rxbuf+5 + lshift pdata,pdata + store 4,mem_subsniff_instant + //product pdata + deposit temp + store 2,mem_subsniff_tsniff + rtn +parse_lmpext_packet_type_table_req: + fetcht 1,mem_ptt + fetch 1,mem_rxbuf+2 + ixor temp,null + nbranch reject_unknown_ext_packet,zero + isolate1 0,pdata + fetch 1,mem_state_map + setflag true,smap_edr,pdata + store 1,mem_state_map + jam LMP_EXT_ACCEPTED,mem_lmo_opcode2 + jam LMP_PACKET_TYPE_TABLE_REQ,mem_lmi_opcode2 + rtn + + +parse_lmp_sniff_subrating_res: +parse_lmp_preferred_rate: +parse_lmp_max_power: +parse_lmp_min_power: + rtn +parse_lmp_page_mode_req: + //jam LMP_PAGE_MODE_REQ,mem_lmi_opcode2 + branch accept_lmp_msg +parse_lmp_page_scan_mode_req: + //this can influence connection. need accepted + //jam LMP_PAGE_SCAN_MODE_REQ,mem_lmi_opcode2 + branch accept_lmp_msg + + + +parse_lmp_slot_offset: + fetch 2,mem_rxbuf+1 + store 2,mem_slot_offset + rtn + +parse_lmp_sniff_req_check_sniff_para: + fetch 2,mem_rxbuf+4 /* tsniff */ + fetcht 1,mem_lpm_mult + imul32 temp,pdata + arg 0x640,temp + isub temp,null +// branch lmp_reject_sniff,positive + rtn + +parse_lmp_sniff_req: + branch lmp_reject_sniff + fetch 2,mem_rxbuf+6 + branch lmp_reject_sniff,blank + call parse_lmp_sniff_req_check_sniff_para + branch lmp_reject_sniff,positive + fetch 1,mem_device_option + sub pdata,dvc_op_module,null + call module_set_lpm_mult_2,zero + fetch 1,mem_state + bbit1 state_insniff,lmp_reject_sniff + fetch 2,mem_rxbuf+2 /* dsniff */ + lshift pdata,pdata + store 2,mem_dsniff + fetch 2,mem_rxbuf+4 /* tsniff */ + lshift pdata,pdata + store 2,mem_tsniff + fetch 2,mem_rxbuf+6 /* sniff attempt */ + store 1,mem_sniff_attempt + iforce temp + fetch 2,mem_rxbuf+8 /* sniff timeout */ + store 1,mem_sniff_timeout + isub temp,null + nbranch set_big_value_to_attempt,positive + store 1,mem_sniff_attempt +set_big_value_to_attempt: + //call sniff_init + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_SNIFF_REQ,mem_lmi_opcode2 + rtn + +lmp_reject_sniff: + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + branch reject_lmp_packet + +parse_lmp_start_encryption_req: + call accept_lmp_msg + call lmp_copy_rand + call function_e3 + branch start_encryption + +parse_lmp_stop_encryption_req: + call accept_lmp_msg + branch stop_encryption + + +parse_lmp_switch_req: + fetch 4,mem_rxbuf+1 + lshift pdata,pdata + //branch parse_lmp_switch_req_not_accept + branch parse_lmp_switch_accept,master + fetcht 1,mem_link_key_exists + nbranch parse_lmp_switch_req_clear_mark,blank +parse_lmp_switch_req_not_accept: + jam LMP_NOT_ACCEPTED,mem_lmo_opcode2 + jam LMP_SWITCH_REQ,mem_lmi_opcode2 + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + rtn +parse_lmp_switch_req_clear_mark: + jam LMP_SLOT_OFFSET,mem_lmo_opcode2 + jam 0,mem_conn_sm + branch role_switch_prepare + +parse_lmp_switch_accept: + call role_switch_prepare + set1 mark_reconn_recieve_switch,mark + fetch 1,mem_connection_options + set0 CONNECTION_SWITCH,pdata + store 1,mem_connection_options + branch accept_lmp_msg + + + +parse_lmp_temp_rand: +parse_lmp_temp_key: +parse_lmp_timing_accuracy_res: +parse_lmp_unit_key: +parse_lmp_use_semi_permanend_key: + rtn + + +parse_lmp_unsniff_req: + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_UNSNIFF_REQ,mem_lmi_opcode2 + jam BT_EVT_REMOTE_UNSNIFF,mem_fifo_temp + call ui_ipc_send_event + branch sniff_exit + +parse_lmp_encapsulated_header: + fetch 1,mem_rxbuf+1 + bne ENCAPSULATED_MAJOR_TYPE_P192,parse_lmp_encapsulated_header_reject + fetch 1,mem_rxbuf+2 + bne ENCAPSULATED_MINOR_TYPE_P192,parse_lmp_encapsulated_header_reject + fetch 1,mem_rxbuf+3 + bne ENCAPSULATED_LEN_P192,parse_lmp_encapsulated_header_reject + call check_localsm + branch parse_lmp_encapsulated_header_master,true + jam SP_STAT_KEY_RECV,mem_sp_state +parse_lmp_encapsulated_header_master: + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_ENCAPSULATED_HEADER,mem_lmi_opcode2 + branch parse_rx_done + +parse_lmp_encapsulated_header_reject: + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + branch reject_lmp_packet + +parse_lmp_accepted_encapsulated_header: + //jam LMP_ENCAPSULATED_PAYLOAD,mem_lmi_opcode2 + //branch accept_lmp_msg + jam LMP_ENCAPSULATED_PAYLOAD,mem_lmo_opcode2 + // branch accept_lmp_msg + rtn +parse_lmp_accepted_simple_pairing_number: + fetch 1,mem_ssp_mode_flag + beq SSP_MODE_SSP_PIN_FLAG,parse_lmp_accepted_simple_pairing_number_ssp_pin + beq SSP_MODE_PASSKEY_ENTRY_FLAG,parse_lmp_accepted_simple_pairing_number_passkey +parse_lmp_accepted_simple_pairing_number_common: + call check_localsm + rtn true + jam SP_STAT_CONFIRM_RECV,mem_sp_state + rtn + +parse_lmp_accepted_simple_pairing_number_ssp_pin: + call g_noninit_number_confirm + jam BT_EVT_BT_GKEY_GENERATE,mem_fifo_temp + call ui_ipc_send_event + branch parse_lmp_accepted_simple_pairing_number_common + + +parse_lmp_accepted_simple_pairing_number_passkey: + call check_localsm + rtn true + fetch 1,mem_authentication_passkey_times + beq 19,authentication_passkey_end + increase 1,pdata + store 1,mem_authentication_passkey_times +// branch p_authentication_passkey + +authentication_passkey: + jam SP_FLAG_COMMIT,mem_sp_flag + jam SP_STAT_COMMIT_CALC,mem_sp_state + fetch 1,mem_authentication_passkey_times + copy pdata,queue + fetch 6,mem_pin + qisolate1 pdata + setarg 0x80 + setflag true,0,pdata + store 1,mem_passkey_1bit + rtn + +authentication_passkey_end: + jam SP_STAT_CONFIRM_RECV,mem_sp_state + rtn + +parse_lmp_accepted_dhkey_check: + call parse_lmp_accepted_dhkey_check_common +pairing_success: + fetch 1,mem_flag_pairing_state + rtn blank + jam FLAG_PAIRING_STATE_NOT_PAIRING,mem_flag_pairing_state + jam BT_EVT_BT_PAIRING_SUCCESS,mem_fifo_temp + branch ui_ipc_send_event + + +parse_lmp_accepted_dhkey_check_common: + //here must be change*** shyd + call check_localsm +ifdef SIMPLE_PAIRING + ncall g_noninit,true //when be master call g_init + call g_init,true +endif + call check_localsm + rtn true + jam SP_STAT_LINK_KEY_CALC,mem_sp_state + jam SP_FLAG_COMMIT,mem_sp_flag + rtn + +parse_simple_pairing_confirm: + arg mem_sp_confirm_remote,contw + arg mem_rxbuf+1,contr + call memcpy16 + fetch 1,mem_ssp_mode_flag + rtneq SSP_MODE_PASSKEY_ENTRY_FLAG +ifdef SIMPLE_PAIRING + branch master_set_mem_master_sp_flag +endif + +parse_lmp_encapsulated_payload: + fetch 1,mem_master_sp_state + beq SP_STAT_RANDOM_SEND,parse_encapsulated_payload_master + fetch 1,mem_sp_state + bne SP_STAT_KEY_RECV,parse_lmp_encapsulated_payload_reject +parse_encapsulated_payload_master: + fetch 1,mem_sp_remote_key_recv_count + sub pdata,0x20,contw + nbranch parse_lmp_encapsulated_payload_reject,positive + arg mem_sp_pubkey_remote,contw + iadd contw,contw + fetch 8,mem_rxbuf+1 + istore 8,contw + fetch 8,mem_rxbuf+9 + istore 8,contw + fetch 1,mem_sp_remote_key_recv_count + increase 16,pdata + store 1,mem_sp_remote_key_recv_count + bne ENCAPSULATED_LEN_P192,accept_lmp_msg +parse_lmp_encapsulated_payload_completed: + call check_localsm + branch accept_lmp_msg,true + jam SP_KEY_VALID,mem_sp_remote_key_invalid + jam SP_STAT_KEY_GENERATE,mem_sp_state + jam SP_FLAG_COMMIT,mem_sp_flag + branch accept_lmp_msg +parse_lmp_encapsulated_payload_reject: + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + branch reject_lmp_packet +parse_lmp_accepted_encapsulated_payload: + fetch 1,mem_sp_local_key_send_count + beq ENCAPSULATED_LEN_P192,parse_lmp_encapsulated_payload_all_accepted + jam LMP_ENCAPSULATED_PAYLOAD,mem_lmo_opcode2 + branch parse_rx_done + +parse_lmp_encapsulated_payload_all_accepted: + call check_localsm + branch parse_lmp_encapsulated_payload_all_accepted_master,true + fetch 1,mem_ssp_mode_flag + beq SSP_MODE_PASSKEY_ENTRY_FLAG,parse_lmp_encapsulated_payload_all_accepted_get_passkey + jam SP_FLAG_COMMIT,mem_sp_flag + jam SP_STAT_COMMIT_CALC,mem_sp_state + branch parse_rx_done + +parse_lmp_encapsulated_payload_all_accepted_get_passkey: + jam BT_EVT_BT_GET_PASSKEY,mem_fifo_temp + branch ui_ipc_send_event + + +parse_lmp_encapsulated_payload_all_accepted_master: + //call sp_master_generate_local_key + branch parse_rx_done + +parse_lmp_simple_pairing_number: + fetch 1,mem_master_sp_state + beq SP_STAT_RANDOM_SEND,parse_lmp_simple_pairing_number_master + fetch 1,mem_sp_state + bne SP_STAT_RANDOM_RECV,parse_lmp_simple_pairing_number_reject +parse_lmp_simple_pairing_number_master: + arg mem_sp_random_remote,contw + fetch 8,mem_rxbuf+1 + istore 8,contw + fetch 8,mem_rxbuf+9 + istore 8,contw + call check_localsm + branch parse_lmp_simple_pairing_number_master0,true + jam SP_STAT_RANDOM_SEND,mem_sp_state + jam SP_FLAG_COMMIT,mem_sp_flag + branch accept_lmp_msg +parse_lmp_simple_pairing_number_master0: + jam SP_STAT_COMMIT_CALC,mem_master_sp_state +ifdef SIMPLE_PAIRING + branch master_set_mem_master_sp_flag +endif + //jam LMP_SIMPLE_PAIRING_NUMBER,mem_lmi_opcode2 + //branch accept_lmp_msg +parse_lmp_simple_pairing_number_reject: + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + branch reject_lmp_packet + +parse_dhkey_check: + fetch 1,mem_master_sp_state + beq SP_STAT_CONFIRM_SEND,parse_dhkey_check_master + fetch 1,mem_sp_state + bne SP_STAT_CONFIRM_RECV,parse_lmp_dhkey_check_reject +parse_dhkey_check_master: + arg mem_sp_check_result,contw + arg mem_rxbuf+1,contr + call memcpy16 + call check_localsm + branch parse_dhkey_check_master0,true + fetch 1,mem_ssp_mode_flag + beq SSP_MODE_SSP_PIN_FLAG,number_comparison_mode +number_comparison_successed: + jam 0,mem_flag_mode_ssp_pin + jam SP_STAT_CONFIRM_CHECK,mem_sp_state + jam SP_FLAG_COMMIT,mem_sp_flag + jam LMP_DHKey_Check,mem_lmi_opcode2 + branch parse_rx_done + +parse_dhkey_check_master0: + jam SP_STAT_CONFIRM_CHECK,mem_master_sp_state + jam SP_FLAG_COMMIT,mem_master_sp_flag + branch parse_rx_done +parse_lmp_dhkey_check_reject: + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + branch reject_lmp_packet + +number_comparison_mode: + fetch 1,mem_flag_mode_ssp_pin + bbit1 FLAG_MODE_SSP_PIN_REVICEVE_COMPARISON_BIT ,comparison_result + set1 FLAG_MODE_SSP_PIN_RECIEVE_DHKEY_BIT,pdata + store 1,mem_flag_mode_ssp_pin + rtn + +comparison_result: + bbit1 FLAG_MODE_SSP_PIN_COMPARISON_RESULT_BIT,number_comparison_successed + jam 0,mem_flag_mode_ssp_pin + branch parse_lmp_dhkey_check_reject + + +parse_lmp_clkoffset_res: + branch parse_rx_done + +parse_lmp_encryption_mode_req: + fetch 1,mem_connection_options + set0 CONNECTION_ENCRYPT + store 1,mem_connection_options + call accept_lmp_msg + nrtn master /* do sth only if we're master */ + fetch 1,mem_rxbuf+1 + fetcht 1,mem_op + setflag blank,op_stop_enc,temp + nsetflag blank,op_start_enc,temp + storet 1,mem_op + rtn + +parse_lmp_features_res: + fetcht 8,mem_rxbuf+1 /*fix bcp(baoshijie) err*/ +parse_lmp_features_res_not_hci: + fetch 1,mem_conn_sm + rtnne CONN_SM_WAIT_FEATURES_RES + + fetch 1,mem_connection_options + bbit0 CONNECTION_FEATURE_EXT,parse_lmp_send_conn + + jam CONN_SM_SEND_FEATURES_EXT,mem_conn_sm + rtn +parse_lmp_send_conn: + jam CONN_SM_SEND_CONN_REQ,mem_conn_sm + rtn +parse_lmp_test_activate: + fetch 1,mem_debug_config + store 1,mem_test_mode_old_debug_config + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_TEST_ACTIVATE,mem_lmi_opcode2 + rtn +parse_lmp_test_control: + /* the 9 test control parameters are XORed with 0x55 */ + /* doing the XOR here and storing in mem_temp_payload */ + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_TEST_CONTROL,mem_lmi_opcode2 + force 9,loopcnt + arg mem_rxbuf+1,contr + arg mem_temp_payload,contw +parse_lmp_test_xor: + ifetch 1,contr + xor_into 0x55,pdata + istore 1,contw + loop parse_lmp_test_xor + fetch 1,test_mode_scenario + fetcht 1,mem_tester_emulate + set0 tester_no_whitening,temp + set0 tester_pattern_test,temp + beq EXIT_TEST_MODE, parse_lmp_test_control_exit + beq PAUSE_TEST_MODE, parse_lmp_test_control_pause + beq CLOSED_LOOP_BACK_ACL, parse_lmp_test_control_loopback + beq ACL_WITHOUT_WHITENING, parse_lmp_test_control_loopback_nowhite + beq CLOSED_LOOP_BACK_SCO, parse_lmp_test_control_loopback + beq SCO_WITHOUT_WHITENING, parse_lmp_test_control_loopback_nowhite + beq ZERO_PATTERN, parse_lmp_test_control_pattern + beq ONE_PATTERN, parse_lmp_test_control_pattern + beq ALT_PATTERN, parse_lmp_test_control_pattern + beq ALT2_PATTERN, parse_lmp_test_control_pattern + beq PSEUDORANDOM, parse_lmp_test_control_pattern + rtn +parse_lmp_test_control_exit: + /* restoring old parameters */ + fetch 1,mem_tester_emulate + set1 tester_exit,pdata + set1 tester_change,pdata + store 1,mem_tester_emulate + rtn +parse_lmp_test_control_pattern: + set1 tester_pattern_test,temp + jam 5,mem_lch_code + fetch 2,test_mode_data_length + iforce loopcnt + store 2,mem_len + arg mem_rxbuf,contw + call pn9 +parse_lmp_test_control_loopback_nowhite: + set1 tester_no_whitening,temp +parse_lmp_test_control_loopback: + set1 tester_change,temp + force 0,pdata + store 1,mem_slave_rcvcnt + store 2,mem_tst_pktcnt_crc + store 2,mem_tst_pktcnt_dmh + store 2,mem_tst_pktcnt_hec + store 2,mem_tst_pktcnt_sync + fetch 1,test_mode_hopping_mode + compare FIXED_FREQ,pdata,0xff + setflag true,tester_fixed_freq,temp + storet 1,mem_tester_emulate + rtn + +parse_lmp_test_control_pause: + set0 mark_testmode,mark + jam 0,mem_tester_emulate + fetch 1,mem_debug_config + set0 debug_tx_pattern,pdata + store 1,mem_debug_config + rtn + + + + + +lmp_copy_rand: + arg mem_rxbuf+1,contr + arg mem_random_number,contw + branch memcpy16 + +lmp_generate_key: + jam LMP_COMB_KEY,mem_lmo_opcode2 + rtn + +lmp_start_encryption: + nrtn master + jam LMP_START_ENCRYPTION_REQ,mem_lmo_opcode2 + rtn + +lmp_accept_inrand: + arg mem_lap,rega + call generate_kinit + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_IN_RAND,mem_lmi_opcode2 + rtn + +lmp_disconnect: + jam 10,mem_conn_timer + jam LMP_DETACH,mem_lmo_opcode2 + jam LOCAL_HOST,mem_disconn_reason_send + rtn + +/*********************************/ +/*********lmp send*************/ +/********************************/ + /* enable user if a lmp packet is to send */ +send_lmp: + bpatchx patch27_6,mem_patch27 + disable user + call lmo_fifo_process + fetch 1,mem_lmp_to_send + rtn blank +/* lmp message to be processed. this will either be because host??? */ +/* wants to send a lmp message or because one resulted from the LMP */ +/* processing section */ +/********* outgoing lmp lookup table *************/ + bbit1 7,send_lmp_escape +send_lmp0: + beq LMP_NAME_REQ, send_lmp_name_req + beq LMP_NAME_RES, send_lmp_name_res + beq LMP_ACCEPTED, send_lmp_accepted + beq LMP_NOT_ACCEPTED, send_lmp_not_accepted + beq LMP_FEATURES_REQ, send_lmp_features_req + beq LMP_FEATURES_RES, send_lmp_features_res + beq LMP_TIMING_ACCURACY_RES, send_lmp_timing_accuracy_res + beq LMP_VERSION_REQ, send_lmp_version_req + beq LMP_VERSION_RES, send_lmp_version_res + beq LMP_SETUP_COMPLETE, send_lmp_setup_complete + beq LMP_SUPERVISION_TIMEOUT, send_lmp_superto + beq LMP_HOST_CONNECTION_REQ,send_lmp_no_payload + beq LMP_IN_RAND,send_lmp_inrand + beq LMP_COMB_KEY,send_lmp_comb_key + beq LMP_AU_RAND,send_lmp_aurand + beq LMP_SRES,send_lmp_sres + beq LMP_ENCRYPTION_MODE_REQ,send_lmp_encryption_mode_req + beq LMP_ENCRYPTION_KEY_SIZE_REQ,send_lmp_encryption_key_size_req + beq LMP_START_ENCRYPTION_REQ,send_lmp_start_encryption + beq LMP_DETACH,send_lmp_detach + beq LMP_QUALITY_OF_SERVICE_REQ, send_lmp_quality_of_service_req + beq LMP_UNIT_KEY,send_lmp_unit_key + //Optional (O) + beq LMP_INCR_POWER_REQ,send_lmp_inc_power + beq LMP_CLKOFFSET_RES, send_lmp_clkoffset_res + beq LMP_MAX_POWER,send_lmp_nopayload_reply + beq LMP_MAX_SLOT, send_lmp_max_slot + beq LMP_MAX_SLOT_REQ, send_lmp_max_slot_req + beq LMP_MIN_POWER,send_lmp_nopayload_reply + beq LMP_SLOT_OFFSET, send_lmp_slot_offset + beq LMP_SWITCH_REQ, send_lmp_switch_req + beq LMP_SNIFF_REQ, send_lmp_sniff_req + beq LMP_STOP_ENCRYPTION_REQ, send_lmp_stop_encryption_req + beq LMP_TIMING_ACCURACY_REQ, send_lmp_timing_accuracy_req + beq LMP_UNSNIFF_REQ, send_lmp_unsniff_req + beq LMP_ENCAPSULATED_HEADER,send_lmp_encapsulated_header + beq LMP_ENCAPSULATED_PAYLOAD,send_lmp_encapsulated_payload + beq LMP_SIMPLE_PAIRING_CONFIRM,send_lmp_simple_pairing_comfirm + beq LMP_SIMPLE_PAIRING_NUMBER,send_lmp_simple_pairing_number + beq LMP_DHKEY_CHECK,send_lmp_dhkey_check + beq LMP_AUTO_RATE,send_lmp_auto_rate + beq LMP_ENC_KEY_SIZE_MASK_RES,send_lmp_enc_key_size_mask_res + //master only must(M) + beq LMP_CLKOFFSET_REQ, send_lmp_clkoffset_req + beq LMP_QUALITY_OF_SERVICE, send_lmp_quality_of_service + beq LMP_TEST_ACTIVATE, send_lmp_test_activate + beq LMP_TEST_CONTROL, send_lmp_test_control +send_lmp_error: + branch assert + rtn +send_lmp_escape: + beq LMP_EXT_ACCEPTED,send_lmpext_accepted + beq LMP_EXT_FEATURES_RES,send_lmpext_features_res + beq LMP_NOT_ACCEPTED_EXT,send_lmpext_not_accepted + beq LMP_EXT_FEATURES_REQ,send_lmpext_features_req + beq LMP_PACKET_TYPE_TABLE_REQ,send_lmpext_packet_type_table_req + beq LMP_PAUSE_ENCRYPTION_REQ,send_lmpext_pause_encryption_req + beq LMP_IO_CAP_REQ,send_lmp_io_cap_req + beq LMP_IO_CAP_RES,send_lmpext_io_cap_res + beq LMP_SNIFF_SUBRATING_REQ,send_lmpext_sniff_subrating_req + beq LMP_SNIFF_SUBRATING_RES,send_lmpext_sniff_subrating_res + branch assert + + +/******** LMP follow messages **********/ +/****** TID follow received packet *******/ + +send_lmp_accepted: + force 2,pdata + call msg_send_lmp + fetch 1,mem_lmi_opcode + istore 1,contw + call send_lmp_follow + bpatchx patch27_7,mem_patch27 + fetch 1,mem_lmi_opcode + beq LMP_IN_RAND,send_lmp_accepted_inrand + beq LMP_ENCRYPTION_MODE_REQ,send_lmp_accepted_enc_mode + beq LMP_ENCRYPTION_KEY_SIZE_REQ,send_lmp_accepted_enc_key + beq LMP_SNIFF_REQ,send_lmp_accept_sniff_req + beq LMP_HOST_CONNECTION_REQ,send_lmp_accepted_connection + beq LMP_DHKEY_CHECK,send_lmp_accept_dhkey_check + beq LMP_START_ENCRYPTION_REQ,send_create_conn_start_l2cap_timer_sm + rtn + +send_create_conn_start_l2cap_timer_sm: + fetch 1,mem_conn_sm + rtn blank + jam CONN_SM_WAIT_DONE,mem_conn_sm + setarg TIMER_ENPT_WAITE + arg enpt_delay_timer,queue + branch timer_init + +send_lmp_accept_sniff_req: + branch sniff_init +send_lmp_not_accepted: + force 3,pdata + call msg_send_lmp + fetch 1,mem_lmi_opcode + beq LMP_AU_RAND,send_not_accept_aurand + istore 1,contw + fetch 1,mem_lmo_reason + istore 1,contw + branch send_lmp_follow + +send_not_accept_aurand: + istore 1,contw + fetch 1,mem_lmo_reason + istore 1,contw + arg mem_sres_tid,temp + branch special_tid_store + +send_lmpext_accepted: + force 4,queue + call send_lmpext + setarg LMP_ESCAPE + istore 1,contw + fetch 1,mem_lmi_opcode + set0 7,pdata + istore 1,contw + fetch 1,mem_lmi_opcode + branch send_lmp_follow + +send_lmpext_not_accepted: + force 5,queue + call send_lmpext + setarg LMP_ESCAPE + istore 1,contw + fetch 1,mem_lmi_opcode + set0 7,pdata + istore 1,contw + fetch 1,mem_lmo_reason + istore 1,contw + branch send_lmp_follow + + +send_lmp_accepted_inrand: + call clear_linkkey + call tid_check + rtn true + branch lmp_generate_key + +send_lmp_accepted_enc_mode: + fetch 1,mem_op + bbit1 op_start_enc,send_lmp_accepted_enc_start + rtnbit0 op_stop_enc + jam LMP_STOP_ENCRYPTION_REQ,mem_lmo_opcode2 + set0 op_stop_enc,pdata + call tid_reply + branch send_lmp_accepted_enc_exit +send_lmp_accepted_enc_start: + jam LMP_ENCRYPTION_KEY_SIZE_REQ,mem_lmo_opcode2 + set0 op_start_enc,pdata +send_lmp_accepted_enc_exit: + store 1,mem_op + rtn + +send_lmp_accepted_enc_key: + call check_localsm + branch lmp_start_encryption,true + rtn + +send_lmp_accepted_connection: + jam LMP_PACKET_TYPE_TABLE_REQ,mem_lmo_opcode2 + //jam LMP_SETUP_COMPLETE,mem_lmo_opcode2 + fetch 1,mem_lmp_conn_state + set1 RECEIVED_CONN_REQ,pdata + store 1,mem_lmp_conn_state + jam BT_EVT_BB_CONNECTED,mem_fifo_temp + branch ui_ipc_send_event + + +send_lmp_accept_dhkey_check: + rtn +/******** LMP reply messages **********/ +/****** TID always set to remote *******/ + +send_lmpext_features_res: + force 12,queue + call send_lmpext + setarg 0x01 + istore 1,contw + fetch 2,mem_lmpext_ssp_enable + istore 2,contw + setarg 0 + istore 3,contw + setarg 0x00 + istore 4,contw + branch send_lmp_reply +send_lmpext_io_cap_res: + force 5,queue + call send_lmpext + fetch 3,mem_sp_iocap_local + istore 3,contw + call send_lmp_reply + jam FLAG_PAIRING_STATE_PAIRING,mem_flag_pairing_state + fetch 1,mem_sp_iocap_local + beq DISPLAY_YESNO,responder_iocap_display_yesno + beq KEYBOARD_ONLY,responder_iocap_keyboard_only + beq NO_INPUT_NO_OUTPUT,responder_iocap_no_input_no_output + rtn + +responder_iocap_keyboard_only: + fetch 1,mem_sp_iocap_remote + beq DISPLAY_ONLY,responder_iocap_keyboard_only_initiator_iocap_display_only + beq DISPLAY_YESNO,responder_iocap_keyboard_only_initiator_iocap_display_yesno + beq KEYBOARD_ONLY,responder_iocap_keyboard_only_initiator_iocap_keyboard_only + beq NO_INPUT_NO_OUTPUT,responder_iocap_keyboard_only_initiator_iocap_no_input_no_output + rtn + + +responder_iocap_display_yesno: + fetch 1,mem_sp_iocap_remote + beq DISPLAY_ONLY,responder_iocap_display_yesno_initiator_iocap_display_only + beq DISPLAY_YESNO,responder_iocap_display_yesno_initiator_iocap_display_yesno + beq KEYBOARD_ONLY,responder_iocap_display_yesno_initiator_iocap_keyboard_only + beq NO_INPUT_NO_OUTPUT,responder_iocap_display_yesno_initiator_iocap_no_input_no_output + rtn + + +responder_iocap_no_input_no_output: + fetch 1,mem_sp_iocap_remote + beq DISPLAY_ONLY,responder_iocap_no_input_no_output_initiator_iocap_display_only + beq DISPLAY_YESNO,responder_iocap_no_input_no_output_initiator_iocap_display_yesno + beq KEYBOARD_ONLY,responder_iocap_no_input_no_output_initiator_iocap_keyboard_only + beq NO_INPUT_NO_OUTPUT,responder_iocap_no_input_no_output_initiator_iocap_no_input_no_output + rtn + +responder_iocap_keyboard_only_initiator_iocap_no_input_no_output: +responder_iocap_display_yesno_initiator_iocap_no_input_no_output: +responder_iocap_display_yesno_initiator_iocap_display_only: +responder_iocap_no_input_no_output_initiator_iocap_display_only: +responder_iocap_no_input_no_output_initiator_iocap_display_yesno: +responder_iocap_no_input_no_output_initiator_iocap_keyboard_only: +responder_iocap_no_input_no_output_initiator_iocap_no_input_no_output: +set_ssp_mode_justwork: + jam SSP_MODE_JUST_WORK_FLAG,mem_ssp_mode_flag + fetch 1,mem_classic_bt_flag + bbit1 FLAG_SSP_REJECT_JUSTWORK,app_bt_disconnect + rtn + +responder_iocap_display_yesno_initiator_iocap_display_yesno: +set_ssp_mode_numeric_comparison: + jam SSP_MODE_SSP_PIN_FLAG,mem_ssp_mode_flag + rtn + +responder_iocap_keyboard_only_initiator_iocap_display_yesno: +responder_iocap_keyboard_only_initiator_iocap_keyboard_only: +responder_iocap_keyboard_only_initiator_iocap_display_only: +responder_iocap_display_yesno_initiator_iocap_keyboard_only: +set_ssp_mode_passkey: + jam SSP_MODE_PASSKEY_ENTRY_FLAG,mem_ssp_mode_flag + rtn + + +classic_bt_set_reject_justwork_flag: + arg FLAG_SSP_REJECT_JUSTWORK,queue + branch classic_bluetooth_set_flag + +classic_bt_clr_reject_justwork_flag: + arg FLAG_SSP_REJECT_JUSTWORK,queue + branch classic_bluetooth_clr_flag + +classic_bluetooth_set_flag: + fetch 1,mem_classic_bt_flag + qset1 pdata + store 1,mem_classic_bt_flag + rtn + +classic_bluetooth_clr_flag: + fetch 1,mem_classic_bt_flag + qset0 pdata + store 1,mem_classic_bt_flag + rtn + + +send_lmp_io_cap_req: + force 5,queue + call send_lmpext + fetch 3,mem_sp_iocap_local + istore 3,contw + branch send_lmp_request + + +send_lmpext_sniff_subrating_req: + + rtn +send_lmpext_sniff_subrating_res: + force 9,queue + call send_lmpext + fetch 1,mem_subsniff_rate + istore 1,contw + fetch 2,mem_subsniff_tcmax + istore 2,contw + fetch 4,mem_subsniff_instant + istore 4,contw + branch send_lmp_reply + +send_lmp_name_res: + force 17,pdata + call msg_send_lmp + fetch 1,mem_lmi_opcode /* loading name offset */ + copy pdata,temp + beq 0x00,send_lmp_name_res_offset_ok + beq 0x0e,send_lmp_name_res_offset_ok + beq 0x1c,send_lmp_name_res_offset_ok + rtn +send_lmp_name_res_offset_ok: + istore 1,contw /* writing name offset */ + fetch 1,mem_local_name_length + istore 1,contw /* writing name length */ + arg 14,loopcnt + setarg mem_local_name + iadd temp,contr /* setting read location */ + call memcpy + branch send_lmp_reply + + +send_lmp_timing_accuracy_res: + force 3,pdata + call msg_send_lmp + setarg 0x0114 + istore 2,contw + branch send_lmp_reply + +send_lmp_clkoffset_res: + // dopod s505 must wait for this res + force 3,pdata + call msg_send_lmp + fetch 4,mem_clke_bt + isub clkn_bt,pdata + branch send_lmp_clkoffset_res_master,master + sub pdata,0,pdata /* our role is slave */ +send_lmp_clkoffset_res_master: + // bit 16-2 of clkslave-clkmaster + rshift2 pdata,pdata + set0 15,pdata + istore 2,contw + branch send_lmp_reply + +send_lmp_version_res: + force 6,pdata + call msg_send_lmp + fetch 5,mem_lmp_version + istore 5,contw + branch send_lmp_reply + +send_lmp_features_res: + force 9,pdata + call msg_send_lmp + fetch 8,mem_features + istore 8,contw + branch send_lmp_reply + + +/******** LMP request messages **********/ +/****** TID always set to local initiated *******/ + + +send_lmpext_features_req: + force 12,queue + call send_lmpext + setarg 0x01 + istore 1,contw + fetch 2,mem_lmpext_ssp_enable + istore 2,contw + setarg 0 + istore 3,contw + setarg 0x00 + istore 4,contw + branch send_lmp_request + +send_lmpext_packet_type_table_req: + force 3,queue + call send_lmpext + fetch 1,mem_ptt + istore 1,contw + disable user + call send_lmp_request + nrtn user + nrtn master + fetch 1,mem_afh_cfg + rtnbit0 AFH_CFG_ON + call afh_init + branch afh_open_all_channels + +//default:featrue is enable,extfeature is disable +ssp_enable: + bpatchx patch28_0,mem_patch28 + fetch 1,mem_features+6 + set1 param_featrue_ssp,pdata + store 1,mem_features+6 + setarg param_lmpext_ssp_enable + store 2,mem_lmpext_ssp_enable + rtn + +ssp_disable: + bpatchx patch28_1,mem_patch28 + fetch 1,mem_features+6 + set0 param_featrue_ssp,pdata + store 1,mem_features+6 + setarg 0 + store 2,mem_lmpext_ssp_enable + rtn + +afh_init: + jam 0x3,mem_afh_cfg + setarg 0 + store 4,mem_afh_timer + arg mem_afh_map_lo,contw + call afh_reset_map + arg mem_afh_map_new,contw + call afh_reset_map + arg mem_afh_classify_channel_map,contw + call afh_reset_map + branch afh_clear_error_counter +afh_open_all_channels: + arg mem_afh_map_new,contw + call afh_reset_map + call afh_clear_error_counter + branch afh_set_send_flag + + +afh_reset_map: + setarg 0xffffff + istore 3,contw + istore 3,contw + istore 3,contw + setarg 0x7f + istore 1,contw + rtn +afh_clear_error_counter: + setarg 0 + store 2,mem_afh_error_total + rtn +afh_set_send_flag: + fetch 1,mem_afh_cfg + set1 send_lmp_set_afh,pdata + store 1,mem_afh_cfg + rtn + + +send_lmpext_pause_encryption_req: + force 2,queue + call send_lmpext + nbranch send_lmp_reply,master + // assume slave will not send pause req firstly??? + branch send_lmp_request + + + +send_lmp_detach: + force 2,pdata + call msg_send_lmp + fetch 1,mem_disconn_reason_send + istore 1,contw + call send_lmp_request +prepare_disconnect: + fetch 1,mem_op + set1 op_disconn,pdata + store 1,mem_op + jam 50,mem_conn_timer + rtn + + +send_lmp_no_payload: + force 1,pdata + call msg_send_lmp + branch send_lmp_request +send_lmp_nopayload_reply: + force 1,pdata + call msg_send_lmp + branch send_lmp_reply + + +send_lmp_encryption_mode_req: + force 2,pdata + call msg_send_lmp + fetch 1,mem_state_map + isolate0 smap_encryption,pdata + setflag true,0,pdata + and_into 1,pdata + istore 1,contw + branch send_lmp_request + + +send_lmp_superto: + force 3,pdata + call msg_send_lmp + fetch 2,mem_supervision_to + istore 2,contw + branch send_lmp_request + +send_lmp_name_req: + jam 250,mem_conn_timer + force 2,pdata + call msg_send_lmp + fetch 1,mem_name_offset + istore 1,contw + branch send_lmp_request + +send_lmp_test_control: + force 10,pdata + call msg_send_lmp + arg mem_temp_payload,contr + force 9,loopcnt +send_lmp_test_control_loop: + ifetch 1,contr + xor_into 0x55,pdata + istore 1,contw + loop send_lmp_test_control_loop + branch send_lmp_request + +send_lmp_quality_of_service_req: + branch send_lmp_request +send_lmp_unit_key: + branch send_lmp_request + +send_lmp_slot_offset: + rtn master + call calc_slot_offset + force 9,pdata + call msg_send_lmp + fetch 2,mem_slot_offset + istore 2,contw + fetch 3,mem_lap + istore 3,contw + fetch 1,mem_uap + istore 1,contw + fetch 2,mem_nap + istore 2,contw + bmark0 mark_switch_initiated,send_lmp_slot_offset_reply + set0 mark_switch_initiated,mark + call send_lmp_request + jam LMP_SWITCH_REQ,mem_lmo_opcode2 + rtn +send_lmp_slot_offset_reply: + call send_lmp_reply + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam LMP_SWITCH_REQ,mem_lmi_opcode2 + rtn + +send_lmp_switch_req: + arg 0x200,temp + branch switch_on_native,master + deposit clke_bt + branch switch_slack +switch_on_native: + deposit clkn_bt +switch_slack: + deposit bt_clk + iadd temp,pdata + and_into 0x1fc,pdata + store 4,mem_sniff_anchor + force 5,pdata + call msg_send_lmp + fetch 4,mem_sniff_anchor /* reused as switch instant */ + rshift pdata,pdata + istore 4,contw + branch send_lmp_request + +send_lmp_sniff_req: + force 10,pdata + call msg_send_lmp + arg mem_sniff_payload,contr + ifetch 9,contr + istore 9,contw + branch send_lmp_request + + +send_lmp_timing_accuracy_req: +/* default to TID_NORM_SEND */ + force 3,pdata + call msg_send_lmp + setarg 0x0114 + istore 2,contw + branch send_lmp_request + +send_lmp_unsniff_req: +//--------------------need to completa + force 1,pdata + call msg_send_lmp + //fetch 1,mem_unsniff_pending + //nbranch send_msg_done,blank + //jam 1,mem_unsniff_pending + //fetch 2,mem_sniff_attempt + //fetch 2,mem_nsniff_attempt + //lshift3 pdata,pdata + //lshift pdata,pdata + //store 1,mem_unsniff_cnt + branch send_lmp_request + + +send_lmp_max_slot: + force 2,pdata + call msg_send_lmp + fetch 1,mem_max_slot + istore 1,contw + branch send_lmp_request + + +send_lmp_max_slot_req: + force 2,pdata + call msg_send_lmp + setarg 0x05 /*5 slot*/ + istore 1,contw + branch send_lmp_request + + +send_lmp_inc_power: + force 2,pdata + call msg_send_lmp + setarg 0x00 /*5 slot*/ + istore 1,contw + branch send_lmp_request + + +send_lmp_setup_complete_by_module: + jam LMP_MAX_SLOT_REQ,mem_lmo_opcode2 + rtn +send_lmp_setup_complete: + fetch 1,mem_device_option + sub pdata,dvc_op_module,null + call send_lmp_setup_complete_by_module,zero + fetch 1,mem_state + set1 state_conn_comp,pdata + store 1,mem_state + copy clkn_bt,pdata + store 4,mem_aurand_send_delay_time + fetch 1,mem_lmp_conn_state + bbit1 SENT_SETUP_COMPLETE,send_lmp_setup_complete_has_sent + set1 SENT_SETUP_COMPLETE,pdata + store 1,mem_lmp_conn_state + jam BT_EVT_SETUP_COMPLETE,mem_fifo_temp + call ui_ipc_send_event + force 1,pdata + call msg_send_lmp + branch send_lmp_request +send_lmp_setup_complete_has_sent: + jam 0,mem_lmp_to_send + rtn + +send_lmp_version_req: + force 6,pdata + call msg_send_lmp + fetch 5,mem_lmp_version + istore 5,contw + branch send_lmp_request + +send_lmp_features_req: + force 9,pdata + call msg_send_lmp + fetch 8,mem_features + istore 8,contw + branch send_lmp_request + +sp_master_send_io_cap_get: + jam SP_FLAG_COMMIT,mem_master_sp_flag + fetch 1,mem_sp_local_key_invalid + rtnne SP_KEY_VALID + jam SP_MASTER_STAT_START_DONE,mem_master_sp_state + rtn + +sp_master_send_io_cap_send: + call tid_initiate + jam LMP_IO_CAP_REQ,mem_lmo_opcode2 + jam SP_STAT_KEY_SEND,mem_master_sp_state + rtn + + +sp_master_send_LMP_ENCAPSULATED_HEADER: + call tid_initiate + jam LMP_ENCAPSULATED_HEADER,mem_lmo_opcode2 + jam SP_STAT_RANDOM_SEND,mem_master_sp_state + rtn + +sp_master_commitment_compare: + arg mem_sp_calc_result_high,rega + arg mem_sp_confirm_remote,regb + arg 16,loopcnt + call string_compare + branch sp_master_commitment_compare_success,zero + jam SP_STAT_NULL,mem_master_sp_state +ifdef SIMPLE_PAIRING + call master_clear_mem_master_sp_flag +endif + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + jam LMP_SIMPLE_PAIRING_NUMBER,mem_lmi_opcode2 +ifdef LMP_DBG + call ice_break +endif + branch reject_lmp_packet +sp_master_commitment_compare_success: + jam SP_STAT_CONFIRM_CALC,mem_master_sp_state +ifdef SIMPLE_PAIRING + call master_set_mem_master_sp_flag +endif + jam LMP_SIMPLE_PAIRING_NUMBER,mem_lmi_opcode2 + branch accept_lmp_msg + + + +sp_master_send_lmp_simple_pairing_number: + jam LMP_SIMPLE_PAIRING_NUMBER,mem_lmo_opcode2 + rtn + + + +sp_send_lmp_encapsulated_header: + // calculate the private & public key here + //jam LMP_ENCAPSULATED_HEADER,mem_lmp_to_send + jam LMP_ENCAPSULATED_HEADER,mem_lmo_opcode2 + //jam TID_PAIRING,mem_lmp_tid + rtn + //fetch 1,mem_tid_table + //set1 TID_PAIRING,pdata + //store 1,mem_tid_table + + +send_lmp_encapsulated_header: + jam 0,mem_sp_local_key_send_count + force 4,pdata + call msg_send_lmp + force ENCAPSULATED_MAJOR_TYPE_P192,pdata + istore 1,contw + force ENCAPSULATED_MINOR_TYPE_P192,pdata + istore 1,contw + force ENCAPSULATED_LEN_P192,pdata + istore 1,contw + call check_localsm + branch send_lmp_request,true + branch send_lmp_reply + +send_lmp_encapsulated_payload: + //jam TID_PAIRING,mem_lmp_tid + force 17,pdata + call msg_send_lmp + fetch 1,mem_sp_local_key_send_count + arg mem_sp_pubkey_local,contr + iadd contr,contr + ifetch 8,contr + istore 8,contw + ifetch 8,contr + istore 8,contw + fetch 1,mem_sp_local_key_send_count + increase 16,pdata + store 1,mem_sp_local_key_send_count + call check_localsm + branch send_lmp_request,true + branch send_lmp_reply + //branch send_lmp_request + +sp_send_lmp_simple_pairing_comfirm: + jam SP_STAT_RANDOM_RECV,mem_sp_state + jam LMP_SIMPLE_PAIRING_CONFIRM,mem_lmo_opcode2 + rtn +send_lmp_simple_pairing_comfirm: + //jam SP_STAT_RANDOM_RECV,mem_sp_state + //jam TID_PAIRING,mem_lmp_tid + force 17,pdata + call msg_send_lmp + arg mem_sp_calc_result_high,contr + ifetch 8,contr + istore 8,contw + ifetch 8,contr + istore 8,contw + branch send_lmp_reply + +sp_send_lmp_simple_pairing_number: + jam LMP_SIMPLE_PAIRING_NUMBER,mem_lmo_opcode2 + rtn + +send_lmp_simple_pairing_number: + //jam TID_PAIRING,mem_lmp_tid + call check_localsm +ifdef SIMPLE_PAIRING + call sp_local_random_key_generator,true +endif + force 17,pdata + call msg_send_lmp + arg mem_sp_random_local,contr + ifetch 8,contr + istore 8,contw + ifetch 8,contr + istore 8,contw + call check_localsm + nbranch send_lmp_reply,true + branch send_lmp_request,true + +master_sp_sm_end: + //jam DEFAULT_STATEMACHINE,mem_sp_localsm + jam SP_STAT_DONE,mem_master_sp_state +sp_aurand_send: + call tid_initiate + jam LMP_AU_RAND,mem_lmo_opcode2 + call check_localsm_master +ifdef SIMPLE_PAIRING + branch sp_master_key_prarm_push,true + branch sp_link_key_prarm_push +endif +master_sp_send_lmp_dhkey_check: + call tid_reply +sp_send_lmp_dhkey_check: + jam LMP_DHKEY_CHECK,mem_lmo_opcode2 + rtn +send_lmp_dhkey_check: + //jam TID_PAIRING,mem_lmp_tid + force 17,pdata + call msg_send_lmp + arg mem_sp_calc_result_high,contr + ifetch 8,contr + istore 8,contw + ifetch 8,contr + istore 8,contw + call check_localsm + nbranch send_lmp_reply,true + branch send_lmp_request,true + +send_lmp_enc_key_size_mask_res: + force 3,pdata + call msg_send_lmp + setarg 0xfffe //enc key size mask + istore 2,contw + branch send_lmp_reply + +send_lmp_auto_rate: + branch send_lmp_request +send_lmp_clkoffset_req: + branch send_lmp_request +send_lmp_quality_of_service: + branch send_lmp_request +send_lmp_test_activate: + branch send_lmp_request + +/******** LMP request/reply messages **********/ +/****** TID transaction specific *******/ + +send_lmp_comb_key: + call generate_random_number + arg mem_lap,rega + call generate_linkkey + force 17,pdata + call msg_send_lmp + arg mem_kinit,rega + arg mem_random_number,regb + call xor16 + nbranch send_lmp_follow,master + branch send_lmp_tid + +send_lmp_inrand: + call generate_random_number + arg mem_plap,rega + call generate_kinit +send_lmp_rand: /* used by in_rand,au_rand,start_encrypt */ + force 17,pdata + call msg_send_lmp + arg mem_random_number,contr + call memcpy16 + fetch 1,mem_conn_sm + beq CONN_SM_AUTH_WAIT,send_lmp_request + beq CONN_SM_PAIRING_WAIT,send_lmp_request + branch send_lmp_tid + +send_lmp_aurand: + fetch 1,mem_pairing_auth + branch send_lmp_aurand_notpairing,blank + call check_localsm + call tid_initiate,true + ncall tid_reply,true + branch send_lmp_aurand_common +send_lmp_aurand_notpairing: + call tid_initiate +send_lmp_aurand_common: + call generate_random_number + branch send_lmp_rand + +send_lmp_sres: + arg mem_lap,rega + call function_e1 + force 5,pdata + call msg_send_lmp + fetch 4,mem_input_store + istore 4,contw + arg mem_sres_tid,temp + call special_tid_store + call copy_aco + call check_localsm + branch send_lmp_sres_master,true + jam DONE_ENCRYP,mem_wait_encryption + fetch 1,mem_pairing_auth + rtn blank + jam LMP_AU_RAND,mem_lmo_opcode2 +send_lmp_sres_master: + fetch 1,mem_link_key_exists + rtn blank +send_lmp_sres_startenc: + call check_localsm + nbranch send_lmp_sres_startenc_slave,true + fetch 1,mem_auth_enable + rtn blank + jam LMP_ENCRYPTION_MODE_REQ, mem_lmo_opcode2 + rtn +send_lmp_sres_startenc_slave: + rtnmark0 mark_slave_in_rand_accepted + set0 mark_slave_in_rand_accepted,mark + jam LMP_ENCRYPTION_MODE_REQ, mem_lmo_opcode2 + rtn + + + +send_lmp_start_encryption: + call generate_random_number + call function_e3 + force 17,pdata + call msg_send_lmp + arg mem_random_number,contr + call memcpy16 + branch send_lmp_tid + +send_lmp_stop_encryption_req: + force 1,pdata + call msg_send_lmp + branch send_lmp_tid + +send_lmp_encryption_key_size_req: + force 2,pdata + call msg_send_lmp + force 16,pdata + istore 1,contw + store 1,mem_key_size + branch send_lmp_tid + +msg_send_lmp: +/* FLOW is set high and LMP is indicated */ + lshift3 pdata,pdata + or_into 0x07,pdata + store 1,mem_lmo_header_length + arg 17,loopcnt + arg mem_lmo_payload,contw + call clear_mem + arg mem_lmo_payload,contw + rtn + +send_lmpext: + and pdata,0x7f,rega + jam LMP_ESCAPE,mem_lmp_to_send + deposit queue + call msg_send_lmp + deposit rega + istore 1,contw + rtn + +send_lmp_follow: + fetch 1,mem_lmp_to_send + lshift pdata,pdata + fetcht 1,mem_state_map + isolate1 smap_lmptid,temp + setflag true,0,pdata + branch send_lmp_exit + + +send_lmp_tid: + fetcht 1,mem_state_map + and_into 1,temp + branch send_lmp_end + +send_lmp_reply: + force 0,temp + branch send_lmp_end + +send_lmp_request: + force 1,temp +send_lmp_end: + fetch 1,mem_lmp_to_send + lshift pdata,pdata + setflag master,0,pdata + ixor temp,pdata +send_lmp_exit: + store 1,mem_lmo_header_opcode + jam 0,mem_lmp_to_send + call lmo_fifo_process_lmo0empty + enable user + rtn + +//blank : not full +lmo_fifo_check: + fetch 1,mem_lmo_opcode2 + rtn blank + call lmo_fifo_process + fetch 1,mem_lmo_opcode2 + rtn + +lmo_fifo_process: + bpatchx patch28_2,mem_patch28 + fetch 1,mem_lmp_to_send + branch lmo_fifo_process_lmo0empty,blank + fetch 1,mem_lmo_opcode1 + nrtn blank + branch lmo_fifo_process_lmo2to1 +lmo_fifo_process_lmo0empty: + fetch 1,mem_lmo_opcode1 + branch lmo_fifo_process_lmo1_empty,blank + fetch 3,mem_lmo_opcode1 + store 3,mem_lmp_to_send//1=>0 + fetcht 1,mem_lmo_tid1 + fetch 1,mem_state_map + set0 smap_lmptid,pdata + ior temp,pdata + store 1,mem_state_map + jam 0,mem_lmo_opcode1 +lmo_fifo_process_lmo2to1: + fetch 1,mem_lmo_opcode2 + rtn blank + fetch 4,mem_lmo_opcode2 + store 4,mem_lmo_opcode1//2=>1 + jam 0,mem_lmo_opcode2 + rtn +lmo_fifo_process_lmo1_empty: + fetch 1,mem_lmo_opcode2 + rtn blank + fetch 3,mem_lmo_opcode2 + store 3,mem_lmp_to_send//2=>0 + fetcht 1,mem_lmo_tid2 + fetch 1,mem_state_map + set0 smap_lmptid,pdata + ior temp,pdata + store 1,mem_state_map + jam 0,mem_lmo_opcode2 + rtn + +//input:temp +special_tid_store: + bpatchx patch28_3,mem_patch28 + fetch 1,mem_state_map + copy pdata,regc + ifetch 1,temp + call pop_tid_follow + call send_lmp_follow + copy regc,pdata + store 1,mem_state_map + rtn + +tid_reply: + fetcht 1,mem_state_map + set0 smap_lmptidinit,temp + storet 1,mem_state_map + rtn + +tid_initiate: + fetcht 1,mem_state_map + set1 smap_lmptidinit,temp + storet 1,mem_state_map + rtn + + /* true if transaction from remote */ +tid_check: + nsetflag master,smap_lmptid,pdata //it is ok + fetcht 1,mem_state_map + ixor temp,pdata + isolate1 smap_lmptid,pdata + rtn + + /* set to remote */ +tid_set_reply: + fetch 1,mem_state_map + setflag master,smap_lmptid,pdata //it is ok + store 1,mem_state_map + rtn + + /*rtn true when we lead lmp*/ +check_localsm: + fetch 1,mem_sp_localsm + compare LOCAL_STATEMACHINE,pdata,0x7f + rtn +setlocalsm_master: + fetch 1,mem_sp_localsm + set1 7,pdata + store 1,mem_sp_localsm + rtn +setlocalsm_slave: + fetch 1,mem_sp_localsm + set0 7,pdata + store 1,mem_sp_localsm + rtn +check_localsm_master: + fetch 1,mem_sp_localsm + isolate1 7,pdata + store 1,mem_sp_localsm + rtn + +generate_random_number: + /* generating a 16 byte random number,storing in ape_random_number */ + arg mem_random_number,contw +generate_random: + force 16,loopcnt +generate_random_another: +generate_random_loop: + random pdata + istore 1,contw + loop generate_random_another + rtn + +generate_linkkey: + call function_e21 + arg mem_link_key,rega + arg mem_input_store,regb + ifetch 8,rega /* check if already got comb key */ + fetcht 1,mem_state + nsetflag blank,state_combkey,temp + storet 1,mem_state + copy rega,contw + call xor16 + branch generate_linkkey_continue + +/*********************************/ +/*********lmp send*************/ +/********************************/ + +process_conn_sm: + //nrtn master + bpatchx patch28_4,mem_patch28 + + call lmo_fifo_check + nrtn blank +process_conn_sm_continue: + fetch 1,mem_conn_sm + rtn blank + /* state machine begins in standby */ + //beq CONN_SM_STANDBY, host_create_conn_begin + //beq CONN_SM_WAIT_PAGE, host_create_conn_wait_page + beq CONN_SM_SEND_CONN_REQ, host_create_conn_send_conn_req + beq CONN_SM_WAIT_CONN_ACCEPT, host_create_conn_wait_accept + beq CONN_SM_SEND_FEATURES, host_create_conn_send_features + beq CONN_SM_WAIT_FEATURES_RES, host_create_conn_waiting + beq CONN_SM_SEND_SWITCH,host_create_conn_send_switch + beq CONN_SM_AUTH_PAIR, host_create_conn_auth_pair + beq CONN_SM_AUTH_PAIR_WAIT, host_create_conn_auth_pair_wait + beq CONN_SM_ENCRYPT, host_create_conn_encrypt + beq CONN_SM_ENCRYPT_WAIT, host_create_conn_encrypt_wait + beq CONN_SM_ENCRYPT_WAIT_CLEAR, host_create_conn_encrypt_wait_clear + beq CONN_SM_SEND_SETUP_COMPLETE, host_create_conn_send_setup_complete + beq CONN_SM_WAIT_SETUP_COMPLETE, host_create_conn_wait_setup_complete + beq CONN_SM_DETACH_DELAY,host_create_conn_master_detach + beq CONN_SM_SEND_VERSION, host_create_conn_send_version + beq CONN_SM_WAIT_VERSION, host_create_conn_waiting + beq CONN_SM_WAIT_SWITCH_AFTER_HOST_CONNECTION, host_creat_conn_wait_switch + beq CONN_SM_SEND_FEATURES_EXT,host_creat_conn_send_feat_ext + beq CONN_SM_WAIT_FEATURES_EXT,host_create_conn_waiting + beq CONN_SM_PAIRING,host_create_conn_pairing + beq CONN_SM_PAIRING_WAIT,host_create_conn_pairing_wait + beq CONN_SM_AUTH,host_create_conn_auth + beq CONN_SM_AUTH_WAIT,host_create_conn_auth_wait + beq CONN_SM_DONE,host_create_conn_done + beq CONN_SM_WAIT_DONE,host_create_conn_done_wait + jam CONN_SM_STANDBY,mem_conn_sm + /* sending error message to host */ + rtn +host_create_conn_done: + fetch 1,mem_lmp_conn_state + rtnbit0 RECEIVED_SETUP_COMPLETE + rtnbit0 SENT_SETUP_COMPLETE + jam CONN_SM_STANDBY,mem_conn_sm + call host_conn_judge_encrypt + branch scheduler_start_upper_sm + +host_conn_judge_encrypt: + fetch 1,mem_connection_options + rtnbit0 CONNECTION_ENCRYPT + jam CONN_SM_ENCRYPT_WAIT,mem_conn_sm + rtn + +host_create_conn_done_wait: + arg enpt_delay_timer,queue + call timer_check + nrtn blank + jam CONN_SM_DONE,mem_conn_sm + rtn + +host_create_conn_auth: + fetch 1,mem_connection_options + set0 CONNECTION_AUTH,pdata + store 1,mem_connection_options + jam CONN_SM_AUTH_WAIT,mem_conn_sm + jam LMP_AU_RAND,mem_lmo_opcode2 + rtn +host_create_conn_auth_wait: + rtn +host_create_conn_pairing: + fetch 1,mem_pincode_state + rtnne pincode_state_pincode_ready //wait for pincode + call host_auth + jam CONN_SM_PAIRING_WAIT,mem_conn_sm + rtn + +host_create_conn_pairing_wait: + rtn +host_creat_conn_send_feat_ext: + jam CONN_SM_WAIT_FEATURES_EXT,mem_conn_sm + jam LMP_EXT_FEATURES_REQ,mem_lmo_opcode2 + rtn +host_create_conn_send_version: + jam CONN_SM_WAIT_VERSION,mem_conn_sm + jam LMP_VERSION_REQ,mem_lmo_opcode2 + rtn + +host_creat_conn_wait_switch: + fetch 1,mem_switch_flag + rtneq SWITCH_FLAG_INIT + beq SWITCH_FLAG_ACCEPT,host_create_conn_switch_accept + arg switch_wait_timer,queue + call timer_check + nrtn blank + jam SWITCH_FLAG_INIT,mem_switch_flag + branch host_create_conn_switch +host_create_conn_switch_accept: + rtn master + branch host_create_conn_auth_pair + +host_create_conn_send_features: + jam CONN_SM_WAIT_FEATURES_RES,mem_conn_sm + jam LMP_FEATURES_REQ,mem_lmo_opcode2 + rtn +host_create_conn_send_switch: + jam LMP_SWITCH_REQ,mem_lmo_opcode2 + set1 mark_switch_initiated,mark + jam CONN_SM_WAIT_CONN_ACCEPT,mem_conn_sm + setarg 0x1ff + store 2, mem_soft_timer + rtn +host_create_conn_send_conn_req: + jam CONN_SM_WAIT_CONN_ACCEPT,mem_conn_sm + jam 0xff,mem_soft_timer + set0 mark_reconn_recieve_switch,mark + jam LMP_HOST_CONNECTION_REQ,mem_lmo_opcode2 + branch init_lmp_reinit +host_create_conn_wait_accept: + rtnmark1 mark_reconn_recieve_switch + fetch 2,mem_soft_timer + sub pdata,1,pdata + branch host_create_conn_resend,zero + store 2, mem_soft_timer + rtn +host_create_conn_resend: + jam CONN_SM_SEND_SWITCH,mem_conn_sm + rtn +host_create_conn_waiting: + /* we will exit waiting for connection request accepted, features res, or other commands to finish */ + rtn + +host_create_conn_switch: + fetch 1,mem_lmp_conn_state + rtnbit0 SENT_SETUP_COMPLETE + rtnbit0 RECEIVED_SETUP_COMPLETE + fetch 1,mem_connection_options + set0 CONNECTION_SWITCH,pdata + store 1,mem_connection_options + jam LMP_SWITCH_REQ,mem_lmo_opcode2 + jam CONN_SM_WAIT_SWITCH_AFTER_HOST_CONNECTION,mem_conn_sm + rtn + +host_create_conn_send_setup_complete: + jam CONN_SM_WAIT_SETUP_COMPLETE,mem_conn_sm + jam LMP_SETUP_COMPLETE,mem_lmo_opcode2 + rtn + +host_create_conn_wait_setup_complete: + fetch 1,mem_lmp_conn_state + rtnbit0 RECEIVED_SETUP_COMPLETE + jam CONN_SM_STANDBY,mem_conn_sm + + rtn +host_create_conn_wait_setup_complete_rtn: + jam CONN_SM_AUTH_PAIR ,mem_conn_sm + rtn + +host_create_conn_master_detach: + fetch 1, mem_soft_timer + increase -1,pdata + branch host_create_conn_send_detach,blank//detach + store 1, mem_soft_timer + rtn +host_create_conn_send_detach: + jam LMP_DETACH,mem_lmo_opcode2 + jam LOCAL_HOST,mem_disconn_reason_send + jam 0,mem_conn_sm + rtn +host_create_conn_auth_pair: + /* checking whether or not to do m/s switch */ + fetch 1,mem_connection_options + bbit1 CONNECTION_SWITCH,host_create_conn_switch + bbit1 CONNECTION_AUTH,host_create_conn_auth_pair_true +host_create_conn_sm_done: + jam CONN_SM_DONE,mem_conn_sm + rtn +host_create_conn_auth_pair_true: + fetch 1,mem_link_key_exists + branch host_create_conn_auth_pair_nokey,blank + fetch 1,mem_lmp_conn_state + rtnbit0 SENT_SETUP_COMPLETE + rtnbit0 RECEIVED_SETUP_COMPLETE + fetch 4,mem_aurand_send_delay_time + arg 100,temp + iadd temp,temp + copy clkn_bt,pdata + isub temp,null + nrtn positive + branch host_create_conn_auth + + + +host_create_conn_auth_pair_nokey: + jam CONN_SM_PAIRING,mem_conn_sm + jam 4,mem_pin_length + setarg 0x3030 + store 2,mem_pin + istore 2,contw + jam pincode_state_pincode_ready,mem_pincode_state + branch host_create_conn_pairing + +host_create_conn_auth_pair_wait: + rtn +host_create_conn_encrypt: + fetch 1,mem_connection_options + bbit1 CONNECTION_ENCRYPT,host_create_conn_encrypt_start + jam CONN_SM_DONE,mem_conn_sm + rtn + +host_create_conn_encrypt_start: + fetch 1,mem_connection_options + set0 CONNECTION_ENCRYPT,pdata + store 1,mem_connection_options + jam LMP_ENCRYPTION_MODE_REQ,mem_lmo_opcode2 + rtn + +host_create_conn_encrypt_wait: + fetch 1, mem_wait_encryption + rtn blank + jam CONN_SM_STANDBY,mem_conn_sm + branch host_create_conn_encrypt_start + +host_create_conn_encrypt_wait_clear: + jam CONN_SM_SEND_SETUP_COMPLETE,mem_conn_sm + rtn + +host_auth: + fetch 1,mem_op + bbit1 op_inrand_req,remote_auth + call tid_initiate + jam LMP_IN_RAND,mem_lmo_opcode2 + branch cmd_exit +remote_auth: + fetch 1,mem_op + set0 op_inrand_req,pdata + store 1,mem_op + call lmp_accept_inrand + call tid_set_reply + branch cmd_exit + +pincode_reinit: + setarg 4 + store 1,mem_pin_length + setarg 0x3030 + istore 2,contw + istore 2,contw + rtn + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/patch.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/patch.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/patch.prog (working copy) @@ -0,0 +1,2930 @@ + + +/******************************************/ +/************** Start *****************/ +/******************************************/ + +p_start: + bbit1 8,pf_patch_ext + beq patch00_0,p_soft_reset0 + //page patch + beq patch02_1,p_master_page_no_interval + //lpm exen patch + beq patch00_1,p_soft_reset + beq patch10_5,p_shutdown_radio + beq patch11_1,p_set_freq_tx + //lpm patch + beq patch12_4,p_ahead_window + beq patch14_2,p_init_param + beq patch14_3,p_lpm_adjust_clk + beq patch15_4,p_lpm_unconn_nossp + beq patch17_0,p_module_init + beq patch17_3,p_module_hci_cmd_control + beq patch17_4,p_module_hci_cmd_transmit_le_notify + beq patch1d_3,p_le_init_conn + //context patch + beq patch00_5,p_connection_incontext + beq patch05_4,p_context_new + beq patch05_6,p_context_search + beq patch0d_7,p_sniff_check_window + beq patch14_6,p_lpm_recover_clk + beq patch14_7,p_lpm_dispatch + beq patch15_3,p_lpm_dispatch_unconn + // + beq patch07_3,p_sconn_successful + //hfp patch + beq patch17_7,p_l2cap_init_wake + //role switch patch + beq patch04_6,p_role_switch_master + beq patch05_0,p_roles_replyto_fhs + branch assert + + +pf_patch_ext: + beq patch20_3,p_le_receive_skip + beq patch20_5,p_le_transmit_receive_sifs + beq patch20_6,p_le_transmit + beq patch20_7,p_le_transmit0 + beq patch21_0,p_le_send_adv_ind + beq patch21_3,p_le_send_scan_response + beq patch22_3,p_le_acknowledge + beq patch22_4,p_le_check_wak + beq patch23_4,p_le_prepare_tx + beq patch23_6,p_le_send_packet + beq patch23_7,p_le_parse + beq patch24_1,p_le_parse_l2cap + beq patch26_0,p_le_modified_name + beq patch26_2,p_le_lpm_set_mult + beq patch27_2,p_parse_lmp + beq patch27_6,p_send_lmp + beq patch28_1,p_ssp_disable + beq patch29_1,p_uartd_send + beq patch2a_2,p_parse_dlci0_rp + beq patch2a_5,p_parse_DLCI0_reconn + beq patch31_5,p_le_encrypt + beq patch33_1,p_sp_initialize_256 + //sdp patch + beq patch2d_2,p_process_upper_sm_reconn + beq patch2f_2,p_sdp_process + //esco patch +// beq patch27_3,p_parse_lmp_escape + //hfp patch + beq patch2a_1,p_rfcomm_rx_process + beq patch2a_4,p_parse_uih_rp_spp + beq patch2b_0,p_rfcomm_send_param_neg_cmd + beq patch2c_3,p_scheduler_process + branch assert + + +p_soft_reset0: + fetch 6,mem_gpio_wakeup_backup + store 6,mem_gpio_wakeup + deposit auxcnt + branch p_soft_rest1,blank // if auxcnt is 0 ,blank set1 , BT normal periodic wake + call p_wake_m0 // if auxcnt is 1 ,blank set0 , BT not periodic wake + branch soft_reset+1 + +p_wake_m0: + jam 0x00,mem_lpm_mode + call p_enable_chgpump + branch wake_up_m0 + +p_enable_chgpump: + hfetch 1,rfen_chgpump + set1 6,pdata + hstore 1,rfen_chgpump + rtn + +p_soft_rest1: + fetch 1,core_lpm_switch // bit0 = 1 low wake up bit1 = 0 high wake up + bbit1 0,p_gpio_low_wake_up +p_gpio_high_wake_up: + fetch 6,mem_gpio_wakeup + fetcht 6,core_gpio_in +// storet 6,0x4fe0 + iand temp,pdata +// jam 0x02,0x4fec + ncall p_wake_m0,blank + + branch soft_reset+1 + +p_gpio_low_wake_up: + call p_check_io_wakeup + branch soft_reset+1 + +p_check_io_wakeup: + setarg 0xffffff + fetcht 3,core_gpio_in + ixor temp,pdata + fetcht 3,mem_gpio_wakeup + iand temp,pdata +// jam 0x03,0x4fec + nbranch p_wake_m0,blank + + setarg 0xffffff + fetcht 3,core_gpio_in+3 //core_gpio_wakeup+3 + ixor temp,pdata + fetcht 3,mem_gpio_wakeup+3 //core_gpio_in+3 + iand temp,pdata +// jam 0x04,0x4fec + nbranch p_wake_m0,blank + rtn + + + + + + +/* + Đ¾Æ¬¹«¹²bugfix +*/ + +/* + YC 3121 LPM bugfix +*/ +p_ahead_window: + copy temp,pdata + call clk2bt + lshift16 bt_clk,pdata + set1 44,pdata + call clk_diff + set0 44,pdata + call get_clk + call clk_diff + rtn user + call p_clk2rt + branch ahead_window+12 + +p_lpm_adjust_clk: + deposit clke + call p_clk_diff_rt + branch lpm_adjust_clk+3 + + +p_clk_diff_rt: + call clk_diff +p_clk2rt: + iforce contr + set0 16,contr + branch clk2rt+1 + +/* + YC3121 Ă»ÓĐexen GPIO + ̀ø¹ưdisable exen +*/ +p_soft_reset: + jam 0,mem_credit_flag + call rfcomm_init + call init_lmp + call p_ui_init + branch soft_reset + 9 + +p_ui_init: + rtn wake + branch ui_timer_init + + +/* + YC3121 shutdown radio bugfix + rfen_adc bug ̀ƠÆäÎÄ̀í¼Ó +*/ +p_shutdown_radio: + branch p_shutdown_radio0,is_rx + hjam 0xd4, 0x955 + nop 4 + hjam 0xd2, 0x955 + nop 4 + hjam 0xd1, 0x955 + nop 4 + fetch 1,mem_tx_power + beq TX_POWER_0DB,p_shutdown_radio_0db + beq TX_POWER_3DB,p_shutdown_radio_3db + beq TX_POWER_5DB,p_shutdown_radio_5db + beq TX_POWER_f3DB,p_shutdown_radio_f3db + beq TX_POWER_f5DB,p_shutdown_radio_f5db + beq TX_POWER_PAIR,p_shutdown_radio_pair +p_shutdown_radio_5db: +p_shutdown_radio_0db: + hjam 0xd0, 0x955 + hjam 0xe0, 0x956 +p_shutdown_radio0: + force 0x08,radio_ctrl + force 0,radio_ctrl + disable is_rx + disable is_tx + pulse packet_end + hjam 0x0,rfen_mdm + hjam 0x0,rfen_tx + hjam 0x0,rfen_rx + hjam 0,rfen_sn + hjam 0x70,rfen_msc + fetch 1,rfen_adc + set1 0,pdata + store 1,rfen_adc + rtn + +p_shutdown_radio_pair: +p_shutdown_radio_f5db: +p_shutdown_radio_f3db: +p_shutdown_radio_3db: + hjam 0xd0,0x955 + hjam 0xc0,0x956 + branch p_shutdown_radio0 + +p_set_freq_tx: + storet 1,mem_last_freq + call set_freq_tx_offset + call rf_write_freq + setarg param_pll_setup + call sleep +p_txon: + fetch 1,rfen_adc + set1 0,pdata + store 1,rfen_adc + branch txon+1 + +p_init_param: + hjam 0x7c,rfen_adc + rtn wake + setarg 0 + store 2,mem_tx_len + rshift clkn_bt,pdata + store 4,mem_last_clkn + rtn + +/* + ¹Ø±Ơ¹ă²¥²»ÄÜĐƯĂßµÄÎỀâ +*/ +p_lpm_unconn_nossp: + branch lpm_unconn_cont //BT/BLE discover don't infect lpm + + +p_module_init: + + setarg p_module_process_bb_event + store 2,mem_cb_bb_event_process + + setarg p_module_bb_event_timer + store 2,mem_cb_event_timer + + setarg p_module_le_receive_data + store 2,mem_cb_att_write + + setarg p_module_lpm_lock + store 2,mem_cb_check_wakelock + + setarg p_module_bt_conn_process + store 2,mem_cb_bt_process + + call module_lpm_uart_init + call module_gpio_init + call check_module_disabled + call module_hci_event_enter_standby_mode + + branch p_hfp_clear_parms + + +p_module_process_bb_event: + copy regc,pdata + beq BT_EVT_BB_CONNECTED,p_module_process_bb_conn + beq BT_EVT_SPP_DISCONNECTED,p_module_process_spp_disconnected + beq BT_EVT_BB_DISCONNECTED,p_module_process_bb_event_disconned + beq BT_EVT_SETUP_COMPLETE,p_module_process_setup_complete + beq BT_EVT_RECONN_FAILED,p_module_process_reconn_fail + beq BT_EVT_RECONN_PAGE_TIMEOUT,p_module_process_page_time_out + beq BT_EVT_LINKKEY_GENERATE,p_module_process_linkkey_generate + beq BT_EVT_HFP_CONNECTED,p_module_process_hfp_connected + beq BT_EVT_HFP_START_DIALING,p_module_process_hfp_start_dialing + beq BT_EVT_HFP_STOP_DIALING,p_module_process_hfp_stop_dialing + + beq BT_EVT_LE_CONNECTED,p_module_process_le_conn + beq BT_EVT_LE_DISCONNECTED,p_module_process_bb_even_le_disconn + + beq BT_EVT_STORE_NVRAM,p_module_hci_event_store_device + branch module_process_bb_event+1 + +p_module_process_bb_conn: + jam 0,mem_module_rfcomm_reconnect_count + call app_bt_stop_discovery + call app_bt_reconnect_cancel + branch module_process_bb_conn + + +p_module_process_bb_event_disconned: + call p_hfp_clear_parms + jam 0,mem_module_rfcomm_disconnect_count + call module_spp_clear_last_transmite_clock + fetch 1,mem_flag_pairing_state + ncall module_hci_event_bt_pairing_fail,blank + call p_module_start_discovery +// fetch 2,mem_ui_state_map +// rtnbit0 UI_STATE_BT_SPP_CONN +// branch module_spp_disconnected + fetch 2,mem_ui_state_map + bbit0 UI_STATE_BT_SPP_CONN,p_set_rfcomm_reconnect_count +// rtnbit0 UI_STATE_BT_SPP_CONN + set0 UI_STATE_BT_SPP_CONN ,pdata + store 2,mem_ui_state_map + branch module_hci_event_spp_disconnect + +p_set_rfcomm_reconnect_count: + jam 20,mem_module_rfcomm_reconnect_count + rtn + + +p_module_process_spp_disconnected: + fetch 1,mem_rfcomm_lmp_dis_flag + ncall p_set_rfcomm_disconnect_count,blank +// jam 6,mem_module_rfcomm_disconnect_count +// branch module_process_spp_disconnected + rtn +p_set_rfcomm_disconnect_count: + jam 6,mem_module_rfcomm_disconnect_count + rtn + +p_module_process_setup_complete: + call module_spp_clear_last_transmite_clock + branch p_module_stop_discovery + +p_module_process_page_time_out: +p_module_process_reconn_fail: + call p_module_start_discovery + branch p_module_hci_event_bt_reconn_fail + + +//event opcode 0xb1 +p_module_hci_event_bt_reconn_fail: + jam HCI_EVENT_BT_RECONNECT_FAIL,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +p_module_process_hfp_connected: + jam HCI_EVENT_HFP_CONNECTED,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + +p_module_process_hfp_start_dialing: + jam HCI_EVENT_HFP_START_DIALING,mem_module_uart_opcode + fetch 1,mem_phone_num_len + call module_hci_prepare_tx + fetchr loopcnt,1,mem_phone_num_len + arg mem_phone_number,contru + call copy_tx_bytes + branch uartd_send + +p_module_process_hfp_stop_dialing: + jam HCI_EVENT_HFP_STOP_DIALING,mem_module_uart_opcode + branch module_hci_event_enter_standby_mode_len0 + + +p_module_process_le_conn: + call module_clear_recv_confirm_flag + call p_module_stop_adv + fetch 1,mem_module_le_lpm_mult + store 1,mem_lpm_mult + branch module_hci_event_le_connect + +p_module_stop_adv: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BLE_BIT,pdata + call app_ble_stop_adv,true + rtn + +p_module_stop_discovery: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BT_BIT,pdata + call app_bt_stop_discovery,true + rtn + +p_module_start_discovery: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BT_BIT,pdata + call app_bt_start_discovery,true + rtn + +p_module_process_bb_even_le_disconn: + call le_clr_config_more_data + call moudle_start_adv_by_command + branch module_hci_event_le_disconnect + + + +//event opcode 0x0d +p_module_hci_event_store_device: + rtn + +p_module_process_linkkey_generate: +p_module_hci_event_linkkey_generate: + jam HCI_EVENT_BT_ENC_INFO,mem_module_uart_opcode + setarg 28 + call module_hci_prepare_tx + fetch 6,mem_lap + istore 6,contwu + fetch 6,mem_plap + istore 6,contwu + arg mem_link_key,contr + arg 16,loopcnt + call uart_copy_tx_bytes + branch uartd_send + + + + + +p_module_bb_event_timer: + call p_module_mcu_set_bt_wake_timer + call p_module_rfcomm_disconnect_timer + call p_module_rfcomm_reconnect_timer + branch module_bb_event_timer + +p_module_rfcomm_reconnect_timer: + arg mem_module_rfcomm_reconnect_count,regc + arg app_bt_start_reconnect,regb + branch timer_single_step + +p_module_rfcomm_disconnect_timer: + fetch 1,mem_module_rfcomm_disconnect_count + rtn blank + increase -1,pdata + store 1,mem_module_rfcomm_disconnect_count + nrtn blank + fetch 2,mem_ui_state_map + bbit1 UI_STATE_BT_CONNECTED,app_bt_disconnect + rtn + +p_module_mcu_set_bt_wake_timer: + fetch 4,mem_mcu_set_bt_wake_timer + rtn blank + increase -1,pdata + store 4,mem_mcu_set_bt_wake_timer + nrtn blank +// jam 0x05,0x4fec + branch p_wake_m0 + + +p_module_le_receive_data: + call p_module_check_ble_encrypt_state + rtn user + copy rega,pdata + store 2,mem_module_le_rx_data_address + call p_check_ble_40_or_42 +// copy loopcnt,pdata + store 1,mem_module_le_rx_data_len + fetcht 2,mem_le_att_handle + storet 2,mem_module_le_rx_data_handle + + call le_att_get_handle_info + nbranch assert,blank + fetch 1,mem_le_cur_uuid_length // uuid length + bne 0x02,module_hci_event_receive_le_data +// ifetcht 2,contr +// setarg CLIENT_CHARACTERTIC_CONFIGURATION +// isub temp,null +// rtn zero //filter ccc handle data +// branch p_module_hci_event_receive_le_data_notify,zero + branch module_hci_event_receive_le_data + +p_check_ble_40_or_42: + fetch 1,mem_ble_dle_enable + nbranch p_check_ble_40,blank +p_check_ble_42: + copy loopcnt,pdata + rtn +p_check_ble_40: + copy regb,pdata + rtn + + +p_module_lpm_lock: + call p_le_check_complete_packet + nbranch p_app_get_lpm_wake_lock,user + +// fetch 1,mem_wakeup_gpio +// copy pdata,queue +// hfetch 6,core_gpio_in +// qisolate1 pdata +// branch p_app_get_lpm_wake_lock,true + +// fetch 1,mem_wake_by_m0 +// nbranch p_app_get_lpm_wake_lock,blank + + fetch 1,IPC_HOLD_BT + beq 1,p_app_get_lpm_wake_lock + fetch 1,mem_le_pairing_state + bne FLAG_LE_PAIRING_NULL,p_module_lpm_lock_check_pairing + branch app_put_lpm_wake_lock +p_module_lpm_lock_check_pairing: + beq FLAG_LE_PAIRING_END,app_put_lpm_wake_lock + branch p_app_get_lpm_wake_lock + +p_app_get_lpm_wake_lock: +// jam 0x00,mem_lpm_mode + call p_enable_chgpump + call wake_up_m0 + branch app_get_lpm_wake_lock + +p_module_bt_conn_process: + call p_module_spp_enter_sniff + branch module_control_air_flow + +p_module_spp_enter_sniff: +// branch module_spp_enter_sniff+1 + branch module_spp_enter_sniff + +p_module_hci_cmd_control: + fetch 1,mem_module_uart_opcode + beq HCI_CMD_SLEEP,p_module_hci_cmd_enter_sleep + beq HCI_CMD_SET_PAIRING_REQ,p_module_hci_cmd_set_pairing_mode + beq HCI_CMD_DELETE_CUSTOMIZE_SERVICE,module_hci_cmd_delete_customize_service + beq HCI_CMD_ADD_SERVICE_UUID,module_hci_cmd_add_service_uuid + beq HCI_CMD_ADD_CHARACTERISTIC_UUID,module_hci_cmd_add_characteristic_uuid + beq HCI_CMD_SET_COD,module_hci_cmd_le_set_adv_data_set_cod + beq HCI_CMD_SET_WAKE_GPIO,module_hci_cmd_set_wake_gpio + beq HCI_TEST_CMD_CLOSE_LPM,p_module_hci_test_cmde_close_lpm + beq HCI_CMD_MCU_SET_BT_WAKE_TIMER,p_module_hci_mcu_set_bt_wake_timer + + beq HCI_CMD_CREAT_BT_RECONNECT,p_moudle_hci_cmd_creat_bt_reconnect + beq HCI_CMD_SET_VISIBILITY_REQ,p_module_hci_cmd_set_visibility + branch module_hci_cmd_control + 2 + + + +p_module_hci_cmd_set_visibility: + fetch 1,mem_module_uart_len + bne 1,module_hci_event_receive_invalid_cmd + copy rega,contru + call module_hci_event_receive_valid_cmd + ifetcht 1,contru + storet 1,mem_module_bluetooth_stauts_by_command +// fetch 2,mem_ui_state_map +// rtnbit1 UI_STATE_BLE_CONNECTED +// rtnbit1 UI_STATE_BT_CONNECTED +p_module_start_adv_discovery_by_command: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BT_BIT,pdata + nbranch p_moudle_start_adv_by_command,true + fetch 2,mem_ui_state_map + bbit1 UI_STATE_BT_CONNECTED,p_moudle_start_adv_by_command + + fetcht 1,mem_module_bluetooth_stauts_by_command + and temp,0x03,pdata + store 1,mem_scan_mode +p_moudle_start_adv_by_command: + fetch 1,mem_module_state + isolate1 MOUDLE_STATE_BLE_BIT,pdata + nrtn true + fetch 2,mem_ui_state_map + rtnbit1 UI_STATE_BLE_CONNECTED + fetcht 1,mem_module_bluetooth_stauts_by_command + isolate1 2,temp + branch app_ble_start_adv,true + branch app_ble_stop_adv + + +p_module_hci_test_cmde_close_lpm: +// jam 0,mem_wake_by_m0 + ifetch 1,contru + store 1,mem_lpm_mode +// store 1,0x4fed +// jam 3,0x4fee + rtn + + +p_module_hci_cmd_set_pairing_mode: + copy rega,contru + ifetch 1,contru + beq PAIRING_PINCODE,module_hci_pairing_pincode_mode + beq PAIRING_JUSTWORK,module_hci_pairing_just_work_mode + beq PAIRING_PASSKEY,module_hci_pairing_passkey + beq PAIRING_CONFIRM,p_module_hci_pairing_numeric_comparison + branch module_hci_event_receive_invalid_cmd + +p_module_hci_pairing_numeric_comparison: + setarg 0x000001 + branch module_hci_sspairing_mode + +module_hci_cmd_delete_customize_service: + arg 0x000C,temp + call le_att_get_handle_ptr2 + add contr,-2,contw + setarg 0x0000 + istore 2,contw + branch module_hci_event_receive_valid_cmd + +module_hci_cmd_add_service_uuid: + call module_hci_cmd_add_service_uuid_set_uuid + call uart_copy_rx_bytes_len_data + setarg 0x0000 + istore 2,contw + branch module_hci_event_uuid_handle + +module_hci_cmd_add_characteristic_uuid: + ifetch 1,contru //Characteristic + call module_hci_cmd_add_characteristic_uuid_set_handle + call module_hci_cmd_add_characteristic_uuid_set_uuid + branch module_hci_event_uuid_handle + +module_hci_cmd_add_service_uuid_set_uuid: + call le_att_creat_new_handle + setarg 0x280002 + istore 3,contw + rtn + +module_hci_cmd_add_characteristic_uuid_set_handle: + store 1,mem_pdatatemp + call le_att_creat_new_handle + setarg 0x01280302 + istore 4,contw + fetch 1,mem_pdatatemp + istore 3,contw + rtn + +module_hci_cmd_add_characteristic_uuid_set_uuid: + call le_att_creat_new_handle + call uart_copy_rx_bytes_len_data //uuid + call uart_copy_rx_bytes_len_data //data + setarg 0 + istore 2,contw + increase -1,temp + call le_att_get_handle_ptr2 + add contr,4,contr + ifetch 1,contr //characteristic data + bbit1 BIT_CHARACTERISTIC_NOTIFY,module_hci_cmd_add_characteristic_uuid_set_ccc_uuid + bbit1 BIT_CHARACTERISTIC_INDICATE,module_hci_cmd_add_characteristic_uuid_set_ccc_uuid + increase 1,temp + rtn + +module_hci_cmd_add_characteristic_uuid_set_ccc_uuid: + call le_att_creat_new_handle + setarg 0x02290202 + istore 8,contw + increase -1,temp + rtn + + +uart_copy_rx_bytes_len_data: + ifetch 1,contru + copy pdata,loopcnt + istore 1,contw + branch uart_copy_rx_bytes + + +le_att_creat_new_handle: + call le_att_get_last_handle + istoret 2,contw + rtn + +//output:temp:new handle num +//contr:address write data +le_att_get_last_handle: + fetch 2,mem_ui_le_uuid_table + iforce contr +le_att_get_last_handle_loop: + ifetch 2,contr + rtn blank + add pdata,1,temp + ifetch 1,contr + iadd contr,contr + ifetch 1,contr // length + iadd contr,contr + copy contr,contw + branch le_att_get_last_handle_loop + + +//input:temp uuid number +module_hci_event_uuid_handle: + storet 2,mem_temp + jam HCI_EVENT_UUID_HANDLE,mem_module_uart_opcode + setarg 2 + call module_hci_prepare_tx + fetcht 2,mem_temp + istoret 2,contwu + branch uartd_send + +module_hci_cmd_le_set_adv_data_set_cod: + ifetch 3,contru + store 3,mem_class + branch module_hci_event_receive_valid_cmd + + +p_module_hci_cmd_enter_sleep: +// call module_hci_event_receive_valid_cmd + branch app_enter_hibernate + +module_hci_cmd_set_wake_gpio: + ifetch 1,contru + + //lpm + fetcht 4,mem_lpm_xtalcnt + setflag blank,16,temp //pdata:0 set 0x8126 0bit set1 pdata:1 set 0x8126 0bit set0 + setflag blank,24,temp + storet 4,mem_lpm_xtalcnt + + //hibernate + fetcht 1,mem_lpm_hibernate_switch + setflag blank,0,temp + storet 1,mem_lpm_hibernate_switch + + ifetch 6,contru + store 6,mem_gpio_wakeup + store 6,mem_gpio_wakeup_backup + call lpm_write_gpio_wakeup + + branch module_hci_event_receive_valid_cmd + +p_module_hci_mcu_set_bt_wake_timer: + ifetch 4,contru + store 4,mem_mcu_set_bt_wake_timer + branch module_hci_event_receive_valid_cmd + + +p_moudle_hci_cmd_creat_bt_reconnect: + ifetch 6,contru + store 6,mem_lap + ifetch 6,contru + store 6,mem_hci_plap + arg mem_link_key,contw + arg 16,loopcnt + call uart_copy_rx_bytes + call check_link_key_load +// call app_bt_stop_discovery +// call app_ble_stop_adv + call app_bt_start_reconnect + branch module_hci_event_receive_valid_cmd + + + +p_module_hci_cmd_transmit_le_notify: + fetch 1,mem_module_flag + bbit1 MODULE_RECEIVE_COMPLETE_PREPARE_WRITE_REQ,p_le_send_att_prepare_write_response + fetch 1,mem_module_flag + rtnbit1 MODULE_RECV_CONFIRM + fetch 2,mem_le_local_mtu + call not_greater_than + copy pdata,temp + add temp,-3,pdata //sub handle and opcode + arg 200,temp + call not_greater_than + fetcht 1,mem_module_hci_notify_len + call not_greater_than + copy pdata,rega + copy temp,pdata + isub rega,pdata + store 1,mem_module_hci_notify_len + fetcht 2,mem_module_hci_notify_handle + increase -1,temp + call le_att_get_handle_ptr2 + branch p_module_hci_cmd_transmit_handle_error,blank + ifetcht 4,contr //flag + setarg 0x01280302 + isub temp,null + nbranch p_module_hci_cmd_transmit_handle_error,zero + ifetch 1,contr //Characteristic + bbit1 BIT_CHARACTERISTIC_INDICATE,p_module_hci_cmd_transmit_le_indicate + bbit1 BIT_CHARACTERISTIC_NOTIFY,module_hci_cmd_transmit_le_notify + 13 + branch p_module_hci_cmd_transmit_handle_error + +p_module_hci_cmd_transmit_le_indicate: + call module_set_recv_confirm_flag + fetcht 2,mem_module_hci_notify_handle + call le_att_malloc_tx_indication + branch module_hci_cmd_transmit_le_notify+15 + +p_module_hci_cmd_transmit_handle_error: + jam 0,mem_module_hci_notify_len + jam HCI_DISCARD_PACKET,mem_module_temp_nl_discard_packet + call module_clear_le_tx_data_flag + branch module_hci_event_receive_invalid_cmd + +p_le_init_conn: + fetch 1,mem_ble_dle_enable + nbranch le_init_conn+1,blank + + call le_init_conn+1 + jam 1,mem_le_txheader_temp + jam 0,mem_le_txlen_temp + setarg 0 + store 8,mem_le_buff_len + setarg 27 + store 2,mem_module_master_rx_max + rtn +/* + ble ²ăbugfix +*/ + +p_le_receive_skip: + call save_rssi + enable enable_white + enable enable_crc + parse demod,bucket,8 + rshift3 pwindow,pdata + store 1,mem_le_rxbuf + parse demod,bucket,8 + rshift3 pwindow,pdata + istore 1,contw + copy pdata,loopcnt + branch lerx_nopayload,blank + branch lerx_loop + +/* + ¹ă²¥²ăÊƠ·¢µÈ´ư100us×óÓ̉ +*/ +p_le_transmit_receive_sifs: + call le_transmit + call set_sync_on + fetcht 1,mem_last_freq + call set_freq_rx + nop 1500 + call rf_rx_enable + enable swfine + arg 5500,timeup + branch le_receive_rxon + +p_le_transmit: + call le_prep + call p_letx_setfreq + branch le_transmit0 + +p_letx_setfreq: + branch p_txon,match + branch letx_setfreq+1 + +p_le_transmit0: + fetch 1,mem_ble_dle_enable + nbranch le_transmit0+12,blank + + fetch 1,mem_le_txheader_temp + inject mod,8 + ifetch 1,contr + copy pdata,loopcnt + inject mod,8 + branch letr_nopayload,zero + branch letr_loop + +p_le_send_adv_ind: + fetch 1,mem_ble_dle_enable + nbranch le_send_adv_ind+1,blank + + fetch 1,mem_le_adv_type + beq ADV_DIRECT_IND,le_send_adv_direct_ind + fetch 1,mem_le_adv_own_addr_type + lshift4 pdata,pdata + lshift2 pdata,pdata + store 1,mem_le_txheader_temp + fetcht 1,mem_le_adv_data_len + add temp,6,pdata + store 1,mem_le_txlen_temp + fetch 6,mem_le_lap + store 6,mem_le_txpayload_temp + copy temp,loopcnt + arg mem_le_adv_data,contr + call memcpy_fast + branch le_send_adv_transmit + + +p_le_send_scan_response: + fetch 1,mem_ble_dle_enable + nbranch le_send_scan_response+1,blank + + arg SCAN_RSP,temp + fetch 1,mem_le_adv_own_addr_type + nsetflag blank,LE_SENDER_ADDR_BIT,temp + storet 1,mem_le_txheader_temp + fetcht 1,mem_le_scan_data_len + add temp,6,pdata + store 1,mem_le_txlen_temp + fetch 6,mem_le_lap + store 6,mem_le_txpayload_temp + arg mem_le_scan_data,contr + copy temp,loopcnt + call memcpy_fast + call le_transmit_norx + branch le_adv_not_match + + +/* + ½âĂÜ´íÎó²»½âÎöµÄÎỀâ +*/ +p_le_acknowledge: + call le_supervision_flush + call le_check_wak + fetch 1,mem_le_rxbuf + isolate1 md,pdata + setflag true,mark_ble_rx_md,mark + rshift pdata,pdata + ixor temp,pdata + isolate1 nesn,pdata + setflag true,mark_old_packet,mark /* retransmit */ + rtnmark1 mark_old_packet + fetch 1,mem_le_rxbuf+1 + branch p_le_ack_unenc,blank /* empty packet, no decryption */ + fetch 1,mem_le_state + bbit0 lestate_encryption,p_le_ack_unenc + call load_sk + call le_decrypt + nsetflag blank,mark_old_packet,mark + nrtn blank +p_le_ack_unenc: + fetcht 1,mem_le_arq + setflip nesn,temp + storet 1,mem_le_arq + + fetch 1,mem_ble_dle_enable + nrtn blank + + branch p_le_parse_writing_attribute + +p_le_parse_writing_attribute: + fetch 1,mem_le_rxbuf+1 + rtn blank //empty packet + fetch 1,mem_le_rxbuf + compare 1,pdata,3 + branch p_le_parse_writing_attribute_continue,true //ACL-U continue + compare 2,pdata,3 + branch p_le_parse_writing_attribute_start,true + rtn + +p_le_parse_writing_attribute_start: + fetch 2,mem_le_rxbuf+4//CID + rtnne LE_L2CAP_CID_ATT + ifetch 3,contr + store 3,mem_le_att_opcode + set1 mark_old_packet,mark + beq ATTOP_WRITE_REQUEST,p_le_parse_att_write_request + beq ATTOP_WRITE_COMMAND,p_le_parse_att_write_command + beq ATTOP_PREPARE_WRITE_REQUEST,p_le_parse_att_prepare_write_request + beq ATTOP_EXECUTE_WRITE_REQUEST,le_parse_att_execute_write_request + beq ATTOP_EXCHANGE_MTU_REQUEST,p_le_parse_att_exchange_mtu_request + beq ATTOP_HANDLE_VALUE_CONFIRMATION,p_le_parse_handle_value_confirmation + set0 mark_old_packet,mark + rtn + +p_le_parse_att_prepare_write_request: + setarg mem_module_prepare_write_request_packet + store 2,mem_module_prepare_write_request_contw + call p_le_long_packet_patch + increase -2,loopcnt //attribute value offset + arg mem_le_rxbuf+11,rega + call le_writeatt_cb + branch p_le_parse_att_prepare_write_request_finish + + +p_le_parse_att_write_request: + call p_le_parse_att_write_command + branch p_le_send_att_write_response_check_auth + + +p_le_parse_att_write_command: + call p_le_long_packet_patch + arg mem_le_rxbuf+9,rega + branch le_writeatt_cb + + +p_le_long_packet_patch: + fetch 1,mem_le_rxbuf+1 + add pdata,-7,loopcnt + increase -4,pdata + store 2,mem_le_buff_len //payload length + ifetcht 2,contr //l2cap length + storet 2,mem_le_buff_len_all + rtn + + +p_le_parse_writing_attribute_continue: + set1 mark_old_packet,mark + call p_parse_l2cap_continue_common + fetch 1,mem_le_att_opcode + beq ATTOP_WRITE_REQUEST,p_parse_l2cap_continue_write_request + beq ATTOP_PREPARE_WRITE_REQUEST,p_parse_l2cap_continue_prepare_write_request + rtneq ATTOP_WRITE_COMMAND + set0 mark_old_packet,mark + rtn + +p_parse_l2cap_continue_write_common: +p_parse_l2cap_continue_common: + fetch 1,mem_le_rxbuf+1 + fetcht 2,mem_le_buff_len + iadd temp,temp + storet 2,mem_le_buff_len + copy pdata,loopcnt + arg mem_le_rxbuf+2,rega + branch le_writeatt_cb + +p_parse_l2cap_continue_prepare_write_request: + branch p_le_parse_att_prepare_write_request_finish + +p_parse_l2cap_continue_write_request: +p_le_send_att_write_response_check_auth: + call p_le_check_complete_packet + nrtn user + branch p_le_send_att_write_response_check_auth0 + +//enable user,recevie complete packet +p_le_check_complete_packet: + call disable_user + fetch 2,mem_le_buff_len_all + fetcht 2,mem_le_buff_len + isub temp,null + nrtn zero + branch enable_user + +p_le_parse_att_prepare_write_request_finish: + fetch 2,mem_module_prepare_write_request_contw + copy pdata,contw + + fetch 1,mem_le_rxbuf+1 //payload length + copy pdata,loopcnt + call memcpy + copy contw,pdata + store 2,mem_module_prepare_write_request_contw + + call p_le_check_complete_packet + nrtn user + arg MODULE_RECEIVE_COMPLETE_PREPARE_WRITE_REQ,queue + call module_set_state + branch p_le_send_att_prepare_write_response + + +p_le_send_att_prepare_write_response: + call le_fifo_check_empty + nrtn blank + jam ATTOP_PREPARE_WRITE_RESPONSE,mem_module_prepare_write_request_opcode + setarg mem_module_prepare_write_request_packet + store 2,mem_module_prepare_write_request_contr + fetcht 2,mem_module_prepare_write_request_PDU_length + increase 4,temp + setarg LE_BASEBAND_MAX_BUFFER + call not_greater_than + add pdata,-4,regb + force LLID_START,type +p_le_send_att_prepare_write_response_continue: + copy pdata,rega + call le_fifo_malloc_tx + 2 + fetch 2,mem_module_prepare_write_request_contr + copy pdata,contr + copy rega,loopcnt + call memcpy_fast + copy contr,pdata + store 2,mem_module_prepare_write_request_contr + fetch 2,mem_module_prepare_write_request_PDU_length + isub regb,pdata + store 2,mem_module_prepare_write_request_PDU_length + branch p_le_send_att_prepare_write_response_ending,blank + arg LE_BASEBAND_MAX_BUFFER,temp + call not_greater_than + copy pdata,regb + force LLID_CONTINUE,type + branch p_le_send_att_prepare_write_response_continue + +p_le_send_att_prepare_write_response_ending: + setarg 0 + store 2,mem_module_prepare_write_request_contw + arg MODULE_RECEIVE_COMPLETE_PREPARE_WRITE_REQ,queue + branch module_clr_state + + +p_le_check_wak: + fetch 1,mem_ble_dle_enable + nbranch le_check_wak+1,blank + + fetcht 1,mem_le_arq + isolate0 wak,temp + rtn true + fetch 1,mem_le_rxbuf + lshift pdata,pdata + ixor temp,pdata + rtnbit0 sn /* received NESN is same as SN, NAK */ + set0 wak,temp + setflip sn,temp + storet 1,mem_le_arq + compare 3,temp,3 + nrtn true + fetch 1,mem_le_txpayload_temp + beq LL_START_ENC_REQ,le_set_enc + fetch 1,mem_le_enc_state + beq FLAG_LE_ENC_PAUSE,le_clear_enc + rtn + +p_le_prepare_tx: + fetch 1,mem_ble_dle_enable + nbranch le_prepare_tx+1,blank + + fetch 1,mem_le_arq + rtnbit1 wak + call le_check_tx_md + call le_fifo_get_first_tx_ptr //no packet to send + branch le_send_empty,blank + ifetch 1,contr + ifetcht 1,contr + copy temp,rega + isub rega,pdata + call p_le_get_master_rx_max + call not_greater_than + copy pdata,temp + ifetch 1,contr + copy pdata,type + copy rega,pdata + iadd contr,contr + arg mem_le_txpayload_temp,contw + copy temp,loopcnt + call memcpy_fast + call le_update_tx_type + call le_send_packet + + call le_fifo_get_first_tx_ptr + ifetch 1,contr + copy pdata,rega + copy contr,regc + ifetcht 1,contr + copy temp,regb + isub regb,pdata + call p_le_get_master_rx_max + call not_greater_than + iadd regb,pdata + istore 1,regc + isub rega,null + nrtn zero + branch le_fifo_release_first_node + + +p_le_get_master_rx_max: + copy contr,contw + fetcht 2,mem_module_master_rx_max + copy contw,contr + rtn + +p_le_send_packet: + fetch 1,mem_ble_dle_enable + nbranch le_send_packet+1,blank + + storet 1,mem_le_txlen_temp + fetcht 1,mem_le_arq + set1 wak,temp + and temp,0xfc,pdata + ior type,pdata + store 1,mem_le_arq + and_into 0x1f,pdata + isolate1 mark_ble_tx_md,mark + setflag true,md,pdata + store 1,mem_le_txheader_temp + + fetch 1,mem_le_txheader_temp + compare 1,type,3 + nbranch p_le_send_no_txlen,true + fetch 1,mem_le_txlen_temp + rtn blank +p_le_send_no_txlen: + fetch 1,mem_le_state + rtnbit0 lestate_encryption + call load_sk + branch le_encrypt + +p_le_encrypt: + fetch 1,mem_ble_dle_enable + nbranch le_encrypt+1,blank + + arg mem_le_txheader_temp,regc + fetcht 5,mem_le_pcnt_tx + call generate_mic + force regidx_xor,regext_index + iforce regext + force 0,rega /* rega is block counter */ + call first_block_data + call aes_init // 1021s -> do_aes_ctr + arg mem_le_txpayload_temp,regc + fetch 1,mem_le_txlen_temp + add pdata,-1,regb + iadd regc,contw + force regidx_result,regext_index + deposit regext + istore 4,contw + call aes_crypt_data + fetch 1,mem_le_txlen_temp + increase 4,pdata + store 1,mem_le_txlen_temp + fetcht 5,mem_le_pcnt_tx + increase 1,temp + storet 5,mem_le_pcnt_tx + rtn + + +/* + l2cap ×é°üµÄÎỀâ +*/ +p_le_parse: + rtnmark1 mark_old_packet + call le_fifo_check_full + nrtn blank + fetch 1,mem_le_rxbuf + and pdata,0x3,pdata + store 1,mem_le_packet_llid + ifetch 1,contr + store 1,mem_le_packet_size + rtn blank //empty rtn + copy contr,pdata + store 2,mem_le_payload_ptr + fetch 1,mem_le_packet_llid + beq LLID_LE_LL,p_le_parse_ll + call le_check_l2cap_complete + arg wake_lock_ble_rx_patch,queue + nbranch lpm_get_wake_lock,user + call lpm_put_wake_lock + branch le_parse_l2cap + 3 + +p_le_parse_ll: + fetch 1,mem_ble_dle_enable + nbranch le_parse_ll,blank + fetch 1,mem_le_rxbuf+2 + beq LL_FEATURE_REQ,p_le_parse_feature_req + beq LL_LENGTH_REQ,p_le_parse_length_request + branch le_parse_ll+1 + +p_le_parse_feature_req: +p_le_send_feature_rsp: + arg 9,rega + arg LL_FEATURE_RSP,regb + call le_fifo_malloc_tx_ll + //bit0 LE encryption + //bit5 LE Data packet Length extension + setarg 0x21 + istore 8,contw + call p_check_ble_dle_enable + rtn +p_check_ble_dle_enable: + fetch 1,mem_le_rxbuf+3 + and pdata,0x20,pdata + branch p_set_ble_dle_disable,blank + rtn +p_set_ble_dle_disable: + jam DLE_DISABLE,mem_ble_dle_enable + rtn + +p_le_parse_length_request: + ifetch 2,contr + store 2,mem_module_master_rx_max + branch p_le_send_length_res + +p_le_send_length_res: + arg 9,rega + arg LL_LENGTH_RSP,regb + call le_fifo_malloc_tx_ll + //MaxRxOctets >=27B <=251 + setarg 251 + istore 2,contw + //MaxRxTime >=328ms <=2120 + setarg 2120 + istore 2,contw + //MaxTxOctets >=27B + setarg 251 + istore 2,contw + //MaxTxTime >=328ms + setarg 2120 + istore 2,contw + rtn + + +p_le_parse_l2cap: + ifetch 2,contr + beq LE_L2CAP_CID_ATT,p_le_parse_att + beq LE_L2CAP_CID_SMP,le_parse_smp + beq LE_L2CAP_CID_SIGNAL,le_parse_signaling + rtn + +p_le_parse_att: + ifetch 3,contr + store 3,mem_le_att_opcode +// beq ATTOP_HANDLE_VALUE_CONFIRMATION,p_le_parse_handle_value_confirmation + beq ATTOP_READ_REQUEST,p_le_parse_att_read_request + beq ATTOP_WRITE_REQUEST,p_le_parse_att_write_request0 + branch le_parse_att+2 + +p_le_parse_handle_value_confirmation: +module_clear_recv_confirm_flag: + arg MODULE_RECV_CONFIRM,queue + branch module_clr_state + +module_set_recv_confirm_flag: + arg MODULE_RECV_CONFIRM,queue + branch module_set_state + +p_le_parse_att_exchange_mtu_request: + call le_parse_att_exchange_mtu_response + store 2,mem_le_local_mtu + branch le_send_att_exchange_mtu_response + + +p_le_modified_name: + call le_modified_name_att_list +p_le_modified_name_adv: + arg mem_le_scan_data_len+32,regc + arg mem_le_scan_data,rega + branch le_modified_name_adv_and_scan + + +p_le_lpm_set_mult: + fetch 1,mem_ble_dle_enable + nbranch le_lpm_set_mult+1,blank + + disable wake + branch p_le_lpm_set_mult_attempt,attempt + nbranch le_lpm_lost,match +p_le_lpm_set_mult_attempt: + call lpm_match + fetch 2,mem_rx_window_sniff + store 2,mem_le_receive_window + + nbranch lpm_mult_short,match + bmark1 mark_old_packet,lpm_mult_short + + fetch 1,mem_le_packet_size + nbranch lpm_mult_short,blank // rx not empty, short interval + fetch 1,mem_le_txlen_temp + nbranch lpm_mult_short,blank // tx not empty, short interval + + fetch 1,mem_le_configuration + bbit1 BIT_BLE_SHORT_MULT,lpm_mult_short //check flag,if flag is 1,always short mult + + fetch 1,mem_le_state + bbit1 lestate_update_param,lpm_mult_short + branch lpm_mult_wait_timeout + + +p_parse_lmp: + fetch 1,mem_lmi_opcode2 + beq LMP_ENCRYPTION_KEY_SIZE_REQ,p_parse_lmp_crypt_key + beq LMP_SNIFF_REQ, p_parse_lmp_sniff_req + branch parse_lmp+21 + +p_parse_lmp_crypt_key: + fetcht 1,mem_rxbuf+1 + sub temp,6,null + branch reject_lmp_packet_pdu_not_allowed,positive + branch parse_lmp_crypt_key + 1 + +reject_lmp_packet_pdu_not_allowed: + jam PDU_NOT_ALLOWED,mem_lmo_reason2 + branch reject_lmp_packet + +p_parse_lmp_sniff_req: + branch parse_lmp_sniff_req+1 + +p_send_lmp: + disable user + call lmo_fifo_process + fetch 1,mem_lmp_to_send + rtn blank + bbit1 7,p_send_lmp_escape + branch send_lmp0 + +p_send_lmp_escape: + beq LMP_EXT_FEATURES_RES,p_send_lmpext_features_res + beq LMP_EXT_FEATURES_REQ,p_send_lmpext_features_req +// beq LMP_EXT_ACCEPTED,p_send_lmpext_accepted + branch send_lmp_escape + +p_send_lmpext_features_res: + call p_check_ssp_enable + fetch 1,mem_lmp_to_send + branch send_lmpext_features_res +p_send_lmpext_features_req: + call p_check_ssp_enable + fetch 1,mem_lmp_to_send + branch send_lmpext_features_req + +p_check_ssp_enable: + fetch 1,mem_ssp_enable + branch ssp_disable, blank + branch ssp_enable + +p_ssp_disable: + fetch 1,mem_features+6 + set0 param_featrue_ssp,pdata + store 1,mem_features+6 + setarg 0x1 + store 2,mem_lmpext_ssp_enable + rtn + +p_uartd_send: + copy contwu,pdata + store 2,IPC_BT2M0_WRITE_PTR +// jam 0xcc,0x4fee + jam 0x00,mem_lpm_mode + call p_enable_chgpump +//wake_up_m0: + fetch 1,core_config + rtnbit1 7 + set1 7,pdata + store 1,core_config + rtn + +p_parse_dlci0_rp: + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_UIH,p_parse_DLCI0_rp_uih + branch parse_dlci0_rp+2 +p_parse_DLCI0_rp_uih: + fetch 2,mem_rfcomm_uih_payload_ptr + copy pdata,contr + call get_rfcomm_uih_head_struct + fetch 1,mem_uih_cmd_type + beq UIH_MODEM_STATUS_RES,p_parse_DLCI0_rp_uih_ms_res + branch parse_DLCI0_rp_uih+4 + +p_parse_DLCI0_rp_uih_ms_res: + jam BT_EVT_SPP_CONNECTED,mem_fifo_temp + call ui_ipc_send_event + call get_rfcomm_param_modem_status + branch parse_DLCI0_rp_uih_ms_res_spp + + +p_parse_DLCI0_reconn: + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_UIH,p_parse_DLCI0_reconn_uih + branch parse_DLCI0_reconn+2 +p_parse_DLCI0_reconn_uih: + fetch 2,mem_rfcomm_uih_payload_ptr + copy pdata,contr + call get_rfcomm_uih_head_struct + fetch 1,mem_uih_cmd_type + beq UIH_MODEM_STATUS_RES,p_parse_DLCI0_reconn_uih_ms_res + branch parse_DLCI0_reconn_uih+4 + +p_parse_DLCI0_reconn_uih_ms_res: + jam BT_EVT_SPP_CONNECTED,mem_fifo_temp + call ui_ipc_send_event + call get_rfcomm_param_modem_status + branch parse_DLCI0_reconn_uih_ms_res_spp + + + +p_sp_initialize_256: + fetch 1,mem_le_secure_connect_enable + branch le_secure_connection_disable,blank +// call le_secure_connection_enable + call sp_clear_flags + branch sp_pubkey_calc_256 + + + +/**********************************context patch**********************************************/ + +p_connection_incontext: + call context_search_insniff + nbranch p_connection_nosniff,zero + call context_load + add rega,coffset_mode,contr + ifetch 1,contr + bbit1 mode_le,le_conn_dispatch + bbit1 mode_master, master_dispatch + branch slave_dispatch +p_connection_nosniff: + call p_context_get_next + branch connection_nosniff+1 + +p_context_get_next: + arg context_num_new,loopcnt + fetcht 1,mem_current_context +p_context_get_next_loop: + increase 1,temp + compare context_num_new,temp,0xff + nbranch p_context_get_next_cont,true + arg 0,temp +p_context_get_next_cont: + storet 1,mem_current_context + mul32 temp,context_size,pdata + arg mem_context_new,rega + iadd rega,rega + ifetch 1,rega + bbit1 state_insniff,p_context_get_next_sniff + rtnbit1 state_inconn + rtnbit1 state_inpage +p_context_get_next_sniff: + loop p_context_get_next_loop + rtn + + +p_context_new: + arg p_context_search_empty,regc + branch context_new+2 +p_context_search_empty: + bbit1 state_inconn,context_search_next +// bbit1 state_inpage,context_search_next + force 0,null + rtn + + +p_context_search: + arg mem_context_new,rega + arg context_num_new,loopcnt + branch context_search_loop + + +p_sconn_successful: + fetch 1,mem_state + set0 state_inpage,pdata + store 1,mem_state + jam 0,memui_reconnect_mode + branch sconn_successful+1 + + +//p_context_check_page: +// arg p_context_check_inpage,regc +// branch context_search + +//p_context_check_inpage: +// bbit0 state_inpage,context_search_next +// force 0,null // found +// rtn + + +p_sniff_check_window: + disable swfine + copy temp,stop_watch + call p_context_search_sniff_window + disable user + nrtn zero + force 0,stop_watch + enable user + rtn + +p_context_search_sniff_window: + arg p_context_search_window,regc + branch context_search + +p_context_search_window: + //½â¾öÏÈÁ¬½Óble,µ¼ÖẬ̉sniff window²»ÔÙinquiry_scanºÍpage_scan + /*****************************************/ + copy pdata,temp + add rega,coffset_mode,contr + ifetch 1,contr + copy rega,contr + bbit1 mode_le,context_search_next + copy temp,pdata + /*****************************************/ + branch context_search_window + + + +p_lpm_recover_clk: + setarg 0 + copy auxcnt,null + branch p_lpm_recover_timeout,zero + hfetch 1,core_lpm_xtalcnt + hfetcht 1,core_lpm_buckcnt + isub temp,null + branch p_lpm_recover_xtal,positive + deposit temp +p_lpm_recover_xtal: + isub auxcnt,pdata + increase 1,pdata +p_lpm_recover_timeout: + increase 8,pdata + until null,lpo_edge + iadd lpo_time,pdata + fetcht 4,mem_sleep_counter + iadd temp,pdata + fetcht 3,mem_clks_per_lpo + imul32 temp,pdata + rshift8 pdata,pdata + rshift4 pdata,pdata + increase param_lpm_fix,pdata + arg 3750,temp + idiv temp + call wait_div_end + quotient pdata + lshift16 pdata,pdata + remainder temp + ior temp,pdata + fetcht 6,mem_sleep_clkn + call clk_add + copy temp,clkn + fetch 6,mem_context_new + coffset_clk_offset + call calc_clke2 + rtn + + +p_lpm_dispatch: + call lpo_calibration + fetch 3,mem_clks_per_lpo + rtn blank + fetch 1,mem_lpm_mode + rtn blank + fetch 1,mem_ssp_enable + branch p_lpm_dispatch_next,blank + fetch 1,mem_sp_local_key_invalid // simple pairing is not ready + rtn blank +p_lpm_dispatch_next: + fetch 1,mem_le_sc_calc + nrtn blank + call lpm_check_wake_lock + nrtn blank + fetch 1,mem_context_new + compare 3,pdata,0x7 /* sco won't sleep */ + nbranch lpm_dispatch_unconn,true + fetch 2,mem_context_new + coffset_tsniff + rtn blank /* role switch */ + rtn wake + fetcht 1,mem_lpm_current_mult + fetch 2,mem_context_new + coffset_tsniff + imul32 temp,pdata + rshift4 temp,temp + rshift2 temp,temp + isub temp,pdata + fetcht 4,mem_context_new + coffset_sniff_anchor + iadd temp,pdata + fetcht 1,mem_lpm_overhead + isub temp,pdata + lshift16 pdata,alarm + fetch 2,mem_context_new + coffset_rx_window + rshift pdata,pdata + call clk2bt + deposit alarm + call clk_diff + copy clke,temp + call p_clk_diff_rt + rtn user + branch lpm_dispatch_sleep + + +p_lpm_dispatch_unconn: + fetch 1,mem_context_new + branch lpm_dispatch_unconn+2 + + +p_le_check_encrypt_state: + call disable_user + fetch 1,mem_le_pairing_mode + rtneq LE_PAIRING_MODE_NONE + fetch 1,mem_context_new + rtnbit1 lestate_encryption + branch enable_user + +p_module_check_ble_encrypt_state: + fetch 1,mem_module_flag + bbit1 MODULE_FLAG_BLE_DATA_ENCRYPT,p_le_check_encrypt_state + branch disable_user + +p_le_parse_att_read_request: + fetcht 2,mem_le_att_handle + fetch 1,mem_le_configuration + bbit1 BIT_BLE_READ_AUTH,p_le_send_att_read_response_check_auth + branch le_send_att_read_response + +p_le_send_att_read_response_check_auth: + fetch 2,mem_le_pairing_handle + isub temp,null + nbranch le_send_att_read_response,zero +//le_send_att_read_response_error_insufficient_auth: + call p_le_check_encrypt_state + nbranch le_send_att_read_response,user + jam ATT_ERR_INSUFFICIENT_AUTHENTICATION,mem_le_err_code + branch le_send_att_error_response + +p_le_parse_att_write_request0: + copy contr,rega + fetch 2,mem_le_l2cap_size + add pdata,-3,regb + call le_writeatt_cb +p_le_send_att_write_response_check_auth0: + fetch 1,mem_le_configuration + bbit0 BIT_BLE_WRITE_AUTH,le_send_att_write_response + + fetcht 2,mem_le_att_handle + fetch 2,mem_le_pairing_handle + isub temp,null + nbranch le_send_att_write_response,zero + call p_le_check_encrypt_state + nbranch le_send_att_write_response,user + jam ATT_ERR_INSUFFICIENT_AUTHENTICATION,mem_le_err_code + branch le_send_att_error_response + + +/**********************************context patch**********************************************/ + +/**********************************esco patch**********************************************/ +/* +p_parse_lmp_escape: + fetch 1,mem_rxbuf+1 + set1 7,pdata + store 1,mem_lmi_opcode2 + beq LMP_EXT_REMOVE_ESCO_REQ,p_parse_lmpext_remove_esco_req + beq LMP_EXT_ESCO_LINK_REQ,p_parse_lmpext_esco_link_req + branch parse_lmp_escape+4 + +p_parse_lmpext_remove_esco_req: + jam LMP_EXT_ACCEPTED,mem_lmo_opcode2 + rtn + +p_parse_lmpext_esco_link_req: + jam LMP_EXT_ACCEPTED,mem_lmo_opcode2 + rtn + +p_send_lmpext_accepted: + call send_lmpext_accepted + fetch 1,mem_lmi_opcode + beq LMP_EXT_ESCO_LINK_REQ,p_send_lmpext_accept_esco_link + beq LMP_EXT_REMOVE_ESCO_REQ,p_send_remove_esco_link + rtn + +p_send_lmpext_accept_esco_link: +// set1 mark_esco,mark + rtn + +p_send_remove_esco_link: + rtn +*/ +/**********************************esco patch**********************************************/ + + +/**********************************rolw switch patch**********************************************/ + +p_role_switch_master: + call role_switch_check + nrtn user + disable user + jam param_newconnto,mem_newconnto_counter + set0 mark_fhs_already_good,mark + set0 mark_role_switch_receive_fhs,mark +p_roles_waitfhs_loop: + call rf_setup_time_master_slot + call master_recv_packet + bmark1 mark_fhs_already_good,p_roles_replyto_fhs + call new_conn_timeout + nbranch p_roles_waitfhs_loop,blank + bmark1 mark_role_switch_receive_fhs,p_roles_replyto_fhs_rcvd + branch role_switch_fail_master + +p_roles_replyto_fhs: + call rf_setup_time_slave_slot + arg type_id,type + call master_send_packet + set1 mark_role_switch_receive_fhs,mark + set0 mark_fhs_already_good,mark + fetch 1,mem_amaddr + iforce am_addr //use current LT_ADDR + jam 2,mem_newconnto_counter + branch p_roles_waitfhs_loop + +p_roles_replyto_fhs_rcvd: + fetch 4,mem_clke_bt //wait for 2 fhs,need 2.5ms + pincrease 8 + store 4,mem_clke_bt + branch roles_replyto_fhs+4 + + +/**********************************rolw switch patch**********************************************/ + + +/**********************************hfp patch**********************************************/ + +p_l2cap_init_wake: + call l2cap_init_wake+1 + jam RECIEVE_SS_REASULT_HF,mem_message_to_uppersm + rtn + +p_scheduler_process: + call p_hfp_hsp_process + branch scheduler_process+5 + + +p_rfcomm_send_param_neg_cmd: + setarg 0x15ef + istore 2,contw + setarg 0x1183 + istore 2,contw + copy temp,pdata //DLCI in temp + istore 1,contw + setarg 0x0000f0 + istore 3,contw + fetch 2,mem_rfcomm_max_frame_size + istore 2,contw + setarg 0 + istore 1,contw + fetch 1,mem_rfcomm_credit_init_data + istore 1,contw + call rfcomm_calculate_FCS_dlci0 + istore 1,contw + jam 0x10,mem_credit_given + rtn + + +p_rfcomm_rx_process: + fetch 1,memui_reconnect_mode + beq NO_RECONNECTION,rfcomm_rx_process_remote_page +p_rfcomm_rx_process_reconn: + fetch 2,mem_l2cap_payload_ptr + copy pdata,contr + call get_rfcomm_head_struct + fetch 1,mem_current_channel + beq 0,parse_DLCI0_reconn + branch p_parse_uih_reconn + +p_parse_uih_reconn: +p_parse_uih_reconn_spp: + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_UIH,p_parse_uih_spp_uih + beq RFCOMM_FRAME_TYPE_UIH_CREDITS,p_parse_uih_spp_uih_credits + beq RFCOMM_FRAME_TYPE_DISCONN,p_parse_uih_reconn_spp_disconn + branch parse_uih_reconn_spp+1 + +p_parse_uih_reconn_spp_disconn: + branch parse_uih_rp_spp_disconn_send_event + +p_parse_uih_rp_spp: + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_UIH,p_parse_uih_spp_uih + beq RFCOMM_FRAME_TYPE_UIH_CREDITS,p_parse_uih_spp_uih_credits + branch parse_uih_rp_spp+2 + +p_parse_uih_spp_uih_credits: + fetch 2,mem_rfcomm_uih_payload_ptr + copy pdata,contr + increase 1,pdata + store 2,mem_rfcomm_uih_payload_ptr + ifetch 1,contr //remote credits + fetcht 1,mem_remote_credits + iadd temp,pdata + store 1,mem_remote_credits +p_parse_uih_spp_uih: + call rfcomm_increase_credit_given + fetch 2,mem_rfcomm_uih_payload_ptr + store 2,mem_at_payload_ptr + fetchr queue,1, mem_current_length + branch p_hfp_process_rfcomm_packet + +p_hfp_process_rfcomm_packet: + deposit queue + rtn zero + + fetcht 2,mem_at_payload_ptr + copy temp,contr + call p_hfp_check_result_code_start + nrtn user + copy contr,pdata + store 2,mem_at_command_ptr + + call p_hfp_check_result_code_end + nrtn user + //store the next AT result code header point + copy contr,pdata + store 2,mem_at_payload_ptr + + call p_hfp_handle_at_result_code + branch p_hfp_process_rfcomm_packet + +//if search cr/lr,return user,or not user +//input: +// queue +// contr +//output: +// user +p_hfp_check_result_code_start: +p_hfp_check_result_code_end: + disable user +p_hfp_check_result_code: + copy queue,pdata + increase -2,pdata + nrtn positive + increase -1,queue + ifetch 1,contr + bne 0x0D,p_hfp_check_result_code + increase -1,queue + ifetch 1,contr + bne 0x0A,p_hfp_check_result_code + enable user + rtn + + +p_hfp_clear_parms: + jam HF_STATE_WAITING_RFCOMM_CONN,mem_hf_state + jam HFP_NONO,mem_hf_call_state + jam HF_CMD_IDLE,mem_hf_command + jam HFP_DEFAULT_MIC_VLM,mem_hf_vlm_mic + jam HFP_DEFAULT_SPEAKER,mem_hf_vlm_speaker + jam HFP_DIALING_STATE_NO,mem_telephone_dialing_state +// call HFP_clear_sco_params +// setarg 0 +// store 2,mem_rfc_server_state + setarg mem_xmem_hf_state_end + arg mem_xmem_hf_state_start,contw + isub contw,loopcnt + branch clear_mem + +p_hfp_hsp_process: + call l2cap_malloc_is_fifo_empty + nrtn blank + fetch 1,mem_hf_state + beq HF_STATE_HF_SEND_RECEIVE_INFO,p_hfp_send_receive_info + rtneq HF_STATE_WAITING_AG_INFO + beq HF_STATE_HF_SEND_AT_CLIP,p_hfp_send_enable_clip + rtneq HF_STATE_WAITING_AT_CLIP + beq HF_STATE_HF_SEND_AT_CCWA,p_hfp_send_enable_call_waiting + rtneq HF_STATE_WAITING_AT_CCWA + beq HF_STATE_WAITING_RFCOMM_CONN,p_hfp_waiting_rfcomm + beq HF_STATE_HF_SEND_FEATURE,p_hfp_send_feature + rtneq HF_STATE_WAITING_AG_FEATURE_OK + beq HF_STATE_HF_SEND_INDICATORS,p_hfp_send_indicators + rtneq HF_STATE_WAITING_AG_INDICATORS_OK + beq HF_STATE_HF_SEND_CURR_STATUS,p_hfp_send_curr_status + rtneq HF_STATE_WAITING_AG_STATUS_OK + beq HF_STATE_HF_SEND_UPDATE_STATUS,p_hfp_send_update_status + rtneq HF_STATE_WAITING_AG_UPDATE_STATUS_OK + beq HF_STATE_CONNECTED,p_hfp_connected + rtn + + +p_hfp_connected: + rtn + +p_hfp_waiting_rfcomm: + fetch 1,mem_spp_state + beq 0xef,p_hfp_send_feature_enable + beq 0xff,p_hfp_send_feature_enable + rtn +p_hfp_send_feature_enable: + jam HF_STATE_HF_SEND_FEATURE,mem_hf_state //start the hands free process + rtn + + +p_hfp_send_AT_common: + store 2,mem_current_packet_length + setarg mem_at_command_data + store 2, mem_at_rfcomm_data_ptr + icopy contw + setarg 0x2B5441 //AT+ + istore 3,contw + rtn + + +p_hfp_send_feature: + fetch 1,mem_remote_credits + rtn blank + call p_hfp_send_credit_return + jam HF_STATE_WAITING_AG_FEATURE_OK, mem_hf_state +p_hfp_send_AT_BRSF: //send AT_BRSF=29 + setarg 0x0a + call p_hfp_send_AT_common + setarg 0x535242 + istore 3,contw + setarg 0x3D46 + istore 2,contw + fetch 1,mem_UI_HF_brsf_feature + istore 1,contw + setarg 0x0D + istore 1,contw + branch p_hfp_tx_rfcomm_without_credit + + +p_hfp_send_receive_info: + call p_hfp_send_credit_return + jam HF_STATE_WAITING_AG_INFO, mem_hf_state +p_hfp_send_AT_CHLD: //AT+CHLD=? + setarg 0x0a + call p_hfp_send_AT_common + setarg 0x4843 + istore 2,contw + setarg 0x3d444c + istore 3,contw + setarg 0x0d3f + istore 2,contw + branch p_hfp_tx_rfcomm_without_credit /* check FC then send out AT+CKPD */ + + +p_hfp_send_enable_clip: + call p_hfp_send_credit_return + jam HF_STATE_WAITING_AT_CLIP,mem_hf_state +p_hfp_send_AT_clip: //AT+CLIP=1 + setarg 0x0a + call p_hfp_send_AT_common + setarg 0x4c43 + istore 2,contw + setarg 0x3d5049 + istore 3,contw + setarg 0x0d31 + istore 2,contw + branch p_hfp_tx_rfcomm_without_credit /* check FC then send out AT+CKPD */ + +p_hfp_send_enable_call_waiting: + call p_hfp_send_credit_return + jam HF_STATE_WAITING_AT_CCWA, mem_hf_state +p_hfp_send_AT_CCWA: //AT+CCWA=1 + setarg 0x0a + call p_hfp_send_AT_common + setarg 0x4343 + istore 2,contw + setarg 0x3d4157 + istore 3,contw + setarg 0x0d31 + istore 2,contw + branch p_hfp_tx_rfcomm_without_credit /* check FC then send out AT+CKPD */ + + +p_hfp_send_indicators: + call p_hfp_send_credit_return + jam HF_STATE_WAITING_AG_INDICATORS_OK, mem_hf_state +p_hfp_send_AT_CIND: //send AT+CIND=? + setarg 0x0a + call p_hfp_send_AT_common + setarg 0x4e4943 + istore 3,contw + setarg 0x3f3D44 + istore 3,contw + setarg 0x0D + istore 1,contw + branch p_hfp_tx_rfcomm_without_credit + +p_hfp_send_curr_status: + call p_hfp_send_credit_return + jam HF_STATE_WAITING_AG_STATUS_OK, mem_hf_state +p_hfp_send_AT_CIND2: //send AT+CIND? + setarg 0x09 + call p_hfp_send_AT_common + setarg 0x4e4943 + istore 3,contw + setarg 0x0d3f44 + istore 3,contw + branch p_hfp_tx_rfcomm_without_credit + +p_hfp_send_update_status: + call p_hfp_send_credit_return + jam HF_STATE_WAITING_AG_UPDATE_STATUS_OK, mem_hf_state +p_hfp_send_AT_CMER: //AT+CMER=3,0,0,1 + setarg 0x10 + call p_hfp_send_AT_common + setarg 0x454d43 + istore 3,contw + setarg 0x333d52 + istore 3,contw + setarg 0x2c302c + istore 3,contw + setarg 0x312c30 + istore 3,contw + setarg 0x0d + istore 1, contw + branch p_hfp_tx_rfcomm_without_credit /* check FC then send out AT+CKPD */ + + +//p_hfp_send_update_status: +// call p_hfp_send_credit_return +p_hfp_send_AT_CLCC: + setarg 0x08 + call p_hfp_send_AT_common + setarg 0x434C43 + istore 3,contw + setarg 0x0D43 + istore 2,contw + branch p_hfp_tx_rfcomm_without_credit + + + +p_hfp_handle_at_result_code: + disable user + call p_hfp_is_result_ok + rtn user + call p_hfp_is_result_error + rtn user + storer queue,2,mem_temp + call p_hfp_send_credit_return + fetchr queue,2,mem_temp + call p_hfp_is_result_brsf + rtn user + call p_hfp_is_result_ciev + rtn user + call p_hfp_is_result_ring + rtn user + call p_hfp_is_result_cind + rtn user + call p_hfp_is_result_chld + rtn user + call p_hfp_is_result_vgm_vgs + rtn user + call p_hfp_is_result_clip + rtn user + call p_hfp_is_result_ccwa + rtn user + call p_hfp_is_result_clcc + rtn user + fetch 2,mem_cb_hfp_result_code + branch callback_func + +p_hfp_is_result_ok: + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x4F + ifetch 1,contr + rtnne 0x4B + enable user + call p_hfp_result_ok_cmd +p_hfp_result_ok_handle: + fetch 1,mem_hf_state + beq HF_STATE_WAITING_AG_UPDATE_STATUS_OK,p_hfp_ag_update_status_ok + beq HF_STATE_WAITING_AG_INFO,p_hfp_ag_receive_info_ok + beq HF_STATE_WAITING_AT_CLIP,p_hfp_ag_enable_clip_ok + beq HF_STATE_WAITING_AT_CCWA,p_hfp_ag_enable_call_waiting_ok + beq HF_STATE_WAITING_AG_FEATURE_OK,p_hfp_ag_feature_ok + beq HF_STATE_WAITING_AG_INDICATORS_OK,p_hfp_ag_indicators_ok + beq HF_STATE_WAITING_AG_STATUS_OK,p_hfp_ag_status_ok + rtn + +p_hfp_result_ok_cmd: + fetch 1,mem_hf_command + beq HF_WAIT_ACCEPT_CALL_OK,p_hfp_acceptcall + beq HF_WAIT_HANGUP_OK,p_hfp_hangup + beq HF_WAIT_VGS_OK,p_hfp_vgs_ok + beq HF_WAIT_VGM_OK,p_hfp_vgm_ok + rtn + +p_hfp_acceptcall: +p_hfp_hangup: +p_hfp_vgm_ok: + jam HF_CMD_IDLE,mem_hf_command + rtn +p_hfp_vgs_ok: + jam HF_CMD_IDLE,mem_hf_command + rtn + + +p_hfp_ag_feature_ok: + jam HF_STATE_HF_SEND_INDICATORS,mem_hf_state + rtn +p_hfp_ag_indicators_ok: + jam HF_STATE_HF_SEND_CURR_STATUS,mem_hf_state + rtn +p_hfp_ag_status_ok: + jam HF_STATE_HF_SEND_UPDATE_STATUS,mem_hf_state + rtn +p_hfp_ag_update_status_ok: + jam HF_STATE_HF_SEND_RECEIVE_INFO,mem_hf_state + rtn +p_hfp_ag_receive_info_ok: + jam HF_STATE_HF_SEND_AT_CLIP,mem_hf_state + rtn +p_hfp_ag_enable_clip_ok: + jam HF_STATE_HF_SEND_AT_CCWA,mem_hf_state + rtn + +p_hfp_ag_enable_call_waiting_ok: + //call send_AT_vgs// + jam HF_STATE_CONNECTED, mem_hf_state + jam BT_EVT_HFP_CONNECTED,mem_fifo_temp + branch ui_ipc_send_event + +p_hfp_is_result_error: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x45 + ifetch 1,contr + rtnne 0x52 + ifetch 1,contr + rtnne 0x52 + ifetch 1,contr + rtnne 0x4F + ifetch 1,contr + rtnne 0x52 + enable user + branch p_hfp_result_ok_cmd + +p_hfp_is_result_ring: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x52 + ifetch 1,contr + rtnne 0x49 + ifetch 1,contr + rtnne 0x4e + ifetch 1,contr + rtnne 0x47 + enable user + rtn + + +p_hfp_is_result_ciev: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x49 + ifetch 1,contr + rtnne 0x45 + ifetch 1,contr + rtnne 0x56 + enable user + call p_hfp_translate_ascii_to_hex + increase 2,rega //temp + setarg mem_AG_indicator_map + iadd temp,temp + increase -1,temp + ifetch 1,temp + arg mem_AG_indicator,temp + iadd temp,pdata + store 2,mem_at_command_ptr //temporary store the addr point + copy rega,contr + call p_hfp_FindComma + call p_hfp_translate_ascii_to_hex + fetch 2, mem_at_command_ptr + istoret 1,pdata +p_hfp_evt_update_state: + setarg HFP_CIEVIND_CALL + call p_hfp_get_indicator_value + beq CIEV_CALL_NO,p_hfp_update_state_nocallActive + beq CIEV_CALL_ACT,p_hfp_update_state_callActived + rtn + +//input : +// pdata indicator index +//output: +// pdata value +p_hfp_get_indicator_value: + arg mem_AG_indicator,contr + iadd contr,contr + ifetch 1,contr + rtn + +p_hfp_update_state_nocallActive: + setarg HFP_CIEVIND_CALLSETTUP + call p_hfp_get_indicator_value + beq CIEV_CALLST_IMG,p_hfp_update_incomming + beq CIEV_CALLST_OUG,p_hfp_update_outgoing + beq CIEV_CALLST_RE_ALTD,p_hfp_update_outgoing + fetch 1,mem_hf_call_state + rtneq HFP_NONO + jam HFP_NONO,mem_hf_call_state + fetch 1,mem_telephone_dialing_state + sub pdata,HFP_DIALING_STATE_START,null + call p_hfp_evt_nono,zero + branch p_hfp_dialing_clear + +p_hfp_evt_nono: + jam BT_EVT_HFP_STOP_DIALING,mem_fifo_temp + branch ui_ipc_send_event + +p_hfp_update_incomming: + call p_hfp_send_AT_CLCC + fetch 1,mem_hf_call_state + rtneq HFP_INCOMMING + jam HFP_INCOMMING,mem_hf_call_state +p_hfp_evt_incomming: + jam BT_EVT_HFP_INCOMMING,mem_fifo_temp + branch ui_ipc_send_event + +p_hfp_evt_outgoing: + jam BT_EVT_HFP_OUTGOING,mem_fifo_temp + branch ui_ipc_send_event +p_hfp_evt_callactive: + jam BT_EVT_HFP_CALLACTIVE,mem_fifo_temp + branch ui_ipc_send_event +p_hfp_evt_callimg: + jam BT_EVT_HFP_CALLIMG,mem_fifo_temp + branch ui_ipc_send_event +p_hfp_evt_callogg: + jam BT_EVT_HFP_CALLOGG,mem_fifo_temp + branch ui_ipc_send_event +p_hfp_evt_calmulty: + jam BT_EVT_HFP_CALMULTY,mem_fifo_temp + branch ui_ipc_send_event + +p_hfp_update_outgoing: + fetch 1,mem_hf_call_state + rtneq HFP_OUTGOING + jam HFP_OUTGOING,mem_hf_call_state + branch p_hfp_evt_outgoing + +p_hfp_update_state_callActived: + setarg HFP_CIEVIND_CALLHELD + call p_hfp_get_indicator_value + beq CIEV_HELD_NO,p_hfp_update_state_nocallheld + fetch 1,mem_hf_call_state + rtneq HFP_CALMULTY + jam HFP_CALMULTY,mem_hf_call_state + branch p_hfp_evt_calmulty + +p_hfp_update_callincomming: + fetch 1,mem_hf_call_state + rtneq HFP_CALLIMG + jam HFP_CALLIMG,mem_hf_call_state + branch p_hfp_evt_callimg + +p_hfp_update_calloutgoing: + fetch 1,mem_hf_call_state + rtneq HFP_CALLOGG + jam HFP_CALLOGG,mem_hf_call_state + branch p_hfp_evt_callogg + +p_hfp_update_state_nocallheld: + setarg HFP_CIEVIND_CALLSETTUP + call p_hfp_get_indicator_value + beq CIEV_CALLST_IMG,p_hfp_update_callincomming + beq CIEV_CALLST_OUG,p_hfp_update_calloutgoing + beq CIEV_CALLST_RE_ALTD,p_hfp_update_calloutgoing + fetch 1,mem_hf_call_state + rtneq HFP_CALLACTIVE + jam HFP_CALLACTIVE,mem_hf_call_state + call p_hfp_evt_callactive + +p_hfp_dialing_stop: +// jam 0,mem_telephone_dialing_timer + jam HFP_DIALING_STATE_STOP,mem_telephone_dialing_state + rtn + +p_hfp_dialing_clear: +// jam 0,mem_telephone_dialing_timer + jam HFP_DIALING_STATE_NO,mem_telephone_dialing_state + rtn + +p_hfp_dialing_start: + jam BT_EVT_HFP_START_DIALING,mem_fifo_temp + call ui_ipc_send_event + jam HFP_DIALING_STATE_START,mem_telephone_dialing_state +// jam 0,mem_phone_num_count +// jam 1,mem_telephone_dialing_timer + rtn + + + +p_hfp_is_result_cind: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x49 + ifetch 1,contr + rtnne 0x4e + ifetch 1,contr + rtnne 0x44 + enable user + increase 2,contr + ifetch 1,contr + beq 0x28,p_hfp_is_result_cind0 //'(',return if cind=? + branch p_hfp_is_result_cind1 + +//input: +//contr -- payload addr point +p_hfp_is_result_cind1: + force 7,loopcnt + storer contr,2,mem_at_command_ptr +p_hfp_is_result_cind1_loopcnt: + fetch 2,mem_at_command_ptr + icopy contr + call p_hfp_translate_ascii_to_hex + increase 2,rega + copy rega,contr + call p_hfp_FindComma + copy contr,pdata + store 2,mem_at_command_ptr + copy temp,rega //indicator value + copy loopcnt,temp + sub temp,7,temp + call p_hfp_get_indicator_index + arg mem_AG_indicator,temp + iadd temp,temp + copy rega,pdata + istore 1,temp + loop p_hfp_is_result_cind1_loopcnt + branch p_hfp_evt_update_state + +//input: +// temp -- indicator map index +//output: +// pdata -- indicator index +p_hfp_get_indicator_index: + setarg mem_AG_indicator_map + iadd temp,temp + ifetch 1,temp + rtn + +p_hfp_find_double_quote: + ifetch 1,contr + rtneq 0x22 //'"' + branch p_hfp_find_double_quote + +p_hfp_is_result_cind0: + force 7,loopcnt +p_hfp_is_result_cind0_loopcnt: + call p_hfp_find_double_quote //first '"' + storer contr,2,mem_at_command_ptr + call p_hfp_indicator_service + branch p_hfp_is_result_cind0_loopcnt_end,user2 + call p_hfp_indicator_call_callheld_callsetup + branch p_hfp_is_result_cind0_loopcnt_end,user2 + call p_hfp_indicator_signal + branch p_hfp_is_result_cind0_loopcnt_end,user2 + call p_hfp_indicator_roam + branch p_hfp_is_result_cind0_loopcnt_end,user2 + call p_hfp_indicator_battchg +p_hfp_is_result_cind0_loopcnt_end: + call p_hfp_find_double_quote //second '"' + loop p_hfp_is_result_cind0_loopcnt + rtn + + +p_hfp_indicator_service: + disable user2 + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x73 //'s' + ifetch 1,contr + rtnne 0x65 //'e' + ifetch 1,contr + rtnne 0x72 //'r' + ifetch 1,contr + rtnne 0x76 //'v' + enable user2 + force HFP_CIEVIND_SERVICE,rega + branch p_hfp_indicator_store + + +p_hfp_indicator_battchg: + disable user2 + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x62 //'b' + ifetch 1,contr + rtnne 0x61 //'a' + ifetch 1,contr + rtnne 0x74 //'t' + ifetch 1,contr + rtnne 0x74 //'t' + ifetch 1,contr + rtnne 0x63 //'c' + enable user2 + force HFP_CIEVIND_BATTCHA,rega + branch p_hfp_indicator_store + +p_hfp_indicator_call_callheld_callsetup: + disable user2 + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x63 //'c' + ifetch 1,contr + rtnne 0x61 //'a' + ifetch 1,contr + rtnne 0x6c //'l' + ifetch 1,contr + rtnne 0x6c //'l' + ifetch 1,contr + enable user2 + beq 0x68,p_hfp_indicator_callheld //'h' + beq 0x22,p_hfp_indicator_call + beq 0x73,p_hfp_indicator_callsetup + rtn + +p_hfp_indicator_callsetup: + force HFP_CIEVIND_CALLSETTUP,rega + branch p_hfp_indicator_store +p_hfp_indicator_call: + increase -1,contr + force HFP_CIEVIND_CALL,rega + branch p_hfp_indicator_store +p_hfp_indicator_callheld: + force HFP_CIEVIND_CALLHELD,rega +p_hfp_indicator_store: + copy loopcnt,pdata + sub pdata,7,pdata + arg mem_AG_indicator_map,temp + iadd temp,temp + copy rega,pdata + istore 1,temp + rtn + + +p_hfp_indicator_roam: + disable user2 + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x72 //'r' + ifetch 1,contr + rtnne 0x6f //'o' + ifetch 1,contr + rtnne 0x61 //'a' + ifetch 1,contr + rtnne 0x6d //'m' + enable user2 + force HFP_CIEVIND_ROAM,rega + branch p_hfp_indicator_store + + +p_hfp_indicator_signal: + disable user2 + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x73 //'s' + ifetch 1,contr + rtnne 0x69 //'i' + ifetch 1,contr + rtnne 0x67 //'g' + ifetch 1,contr + rtnne 0x6e //'n' + enable user2 + force HFP_CIEVIND_SIGNAL,rega + branch p_hfp_indicator_store + +p_hfp_is_result_brsf: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x42 + ifetch 1,contr + rtnne 0x52 + ifetch 1,contr + rtnne 0x53 + ifetch 1,contr + rtnne 0x46 + enable user + call p_hfp_translate_ascii_to_hex + storet 2,mem_agoption + rtn + +p_hfp_is_result_chld: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x48 + ifetch 1,contr + rtnne 0x4c + ifetch 1,contr + rtnne 0x44 + enable user + rtn + + +p_hfp_is_result_vgm_vgs: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x56 + ifetch 1,contr + rtnne 0x47 + ifetch 1,contr + enable user + beq 0x4d,p_hfp_vgm_changed + beq 0x53,p_hfp_vgs_changed + rtn + +p_hfp_vgs_changed: + call p_hfp_translate_ascii_to_hex + storet 1,mem_hf_vlm_speaker + rtn + +p_hfp_vgm_changed: + call p_hfp_translate_ascii_to_hex + storet 1,mem_hf_vlm_mic + rtn + + +p_hfp_is_result_ccwa: + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x57 + ifetch 1,contr + rtnne 0x41 + enable user + branch p_hfp_is_result_clip_loop + +p_hfp_is_result_clip: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x4c + ifetch 1,contr + rtnne 0x49 + ifetch 1,contr + rtnne 0x50 + enable user + call p_hfp_is_result_clip_loop + fetch 1,mem_telephone_dialing_state + rtnne HFP_DIALING_STATE_NO + branch p_hfp_dialing_start + + +p_hfp_is_result_clip_loop: + ifetch 1,contr + bne 0x22,p_hfp_is_result_clip_loop + force 0,rega + force 0x30,regb + arg mem_phone_number,contw +p_hfp_is_result_clip_phone_num: + ifetch 1, contr + beq 0x22,p_hfp_is_result_clip_end + increase 1,rega + isub regb,pdata + istore 1,contw + branch p_hfp_is_result_clip_phone_num +p_hfp_is_result_clip_end: + deposit rega + store 1,mem_phone_num_len + rtn + + +p_hfp_is_result_clcc: + //disable user + fetch 2,mem_at_command_ptr + icopy contr + ifetch 1,contr + rtnne 0x2b + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x4c + ifetch 1,contr + rtnne 0x43 + ifetch 1,contr + rtnne 0x43 + enable user + call p_hfp_is_result_clip_loop + fetch 1,mem_telephone_dialing_state + rtnne HFP_DIALING_STATE_NO + branch p_hfp_dialing_start + + +//input: +// contr +//output: +// temp +//modify: +// rega,regb,contr +p_hfp_translate_ascii_to_hex: + call p_hfp_FindComma + increase -2,contr + copy contr,rega + force 1,regb + force 0,temp +p_hfp_translate_calculate: + ifetch 1,rega + increase -1,rega + rtneq 0x3d //'=' + rtneq 0x3a //':' + rtneq 0x2c //',' + beq 0x20,p_hfp_translate_calculate + pincrease -48 + imul32 regb,pdata //pdata = pdata*regb + iadd temp,temp + mul32 regb,10,regb + branch p_hfp_translate_calculate + +p_hfp_FindComma: + ifetch 1,contr + rtneq 0x0d //at_cr + rtneq 0x2c //',' + branch p_hfp_FindComma + +p_hfp_send_credit_return: + call get_rfcomm_snd_adss + branch rfcomm_send_uih_without_payload + +p_hfp_tx_rfcomm_without_credit: + fetch 1,mem_remote_credits + rtn blank + increase -1,pdata + store 1,mem_remote_credits + fetch 1,mem_HIUfcs_SPP + store 1,mem_rfcomm_send_fcs + setarg RSP_TX_UIH + store 1,mem_rfcomm_send_frame_type + call get_rfcomm_snd_adss + fetch 2,mem_current_packet_length + increase 4,pdata //fcs + rfcommhead + l2caphead == 8 + icopy rega + call p_l2cap_malloc_rfcomm_channel + fetch 1,mem_rfcomm_send_adss + istore 1,contw + fetch 1,mem_rfcomm_send_frame_type + istore 1,contw + call p_rfc_tx_write_length + fetch 2,mem_current_packet_length + copy pdata,loopcnt + fetch 2, mem_at_rfcomm_data_ptr + copy pdata,contr + call memcpy + fetch 1,mem_rfcomm_send_fcs + istore 1,contw + setarg 0 + store 2,mem_current_packet_length + rtn + +p_rfc_tx_write_length: + fetch 2,mem_current_packet_length + lshift pdata,pdata + set1 0,pdata + istore 1,contw + rtn + +//regd:ptr to l2cap context +p_l2cap_malloc_rfcomm_channel: + call l2cap_malloc_rfcomm_channel + call l2cap_get_rfcomm_tx_buff + copy rega,pdata + istore 2,contw + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + rtn + +/**********************************hfp patch**********************************************/ + + + + +/**********************************sdp patch**********************************************/ + +p_sdp_process: + copy contr,temp + arg 4,loopcnt + arg mem_sdp_handle_list,contw + call memset0 + copy temp,contr + deposit regb /* PDUID */ + beq SDP_SEARCH_RES,p_sdp_process_ss_res + beq SDP_ATTRIBUTE_RES,p_sdp_process_sa_res + branch sdp_process+19 + +p_sdp_process_ss_res: + ifetch 2,contr + ifetch 2,contr + byteswap pdata,pdata + bne 1,assert + ifetch 4,contr + store 4,mem_sdp_record_handle + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_RECV_SEARCH_RES,pdata + store 1,mem_sdp_state + rtn + +p_sdp_process_sa_res: + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_RECV_ATTRIB_RES,pdata + store 1,mem_sdp_state + copy temp,contr + ifetch 2,contr + call search_rfcomm_cn + store 1,mem_remote_spp_channel + rtn + + +p_process_upper_sm_reconn: + fetch 1,mem_upper_sm_reconn + rtn blank + beq UPPERSM_RECONN_SDP_CFG_WAIT,p_process_upper_sm_reconn_sdp_cfg_wait + beq UPPERSM_RECONN_SEARCH_SERVICE,p_process_upper_sm_reconn_search_service + beq UPPERSM_RECONN_SEARCH_SERVICE_WAIT,p_process_upper_sm_reconn_search_service_wait + beq UPPERSM_RECONN_SEARCH_ATTRIB,p_process_upper_sm_reconn_search_attrib + beq UPPERSM_RECONN_SEARCH_ATTRIB_WAIT,p_process_upper_sm_reconn_search_attrib_wait + branch process_upper_sm_reconn+3 + +p_process_upper_sm_reconn_sdp_cfg_wait: + fetch 1,mem_sdp_state + rtnne L2CAP_CHANNEL_SETUP_COMPLETE + jam UPPERSM_RECONN_SEARCH_SERVICE,mem_upper_sm_reconn + branch process_upper_sm_reconn + +p_process_upper_sm_reconn_search_service: + jam UPPERSM_RECONN_SEARCH_SERVICE_WAIT,mem_upper_sm_reconn + arg 13,rega + setarg SDP_UUID_HS_AUDIO_GATEWAY + store 2,mem_search_uuid + branch p_sdp_send_search_req + +p_process_upper_sm_reconn_search_service_wait: + fetch 1,mem_sdp_state + rtnbit0 L2CAP_CHANNEL_STATE_RECV_SEARCH_RES + fetch 4,mem_sdp_record_handle + branch app_bt_disconnect,blank + jam UPPERSM_RECONN_SEARCH_ATTRIB,mem_upper_sm_reconn + branch process_upper_sm_reconn + +p_process_upper_sm_reconn_search_attrib: + jam UPPERSM_RECONN_SEARCH_ATTRIB_WAIT,mem_upper_sm_reconn + arg 19,rega + branch p_sdp_send_attribute_req + +p_process_upper_sm_reconn_search_attrib_wait: + fetch 1,mem_sdp_state + rtnbit0 L2CAP_CHANNEL_STATE_RECV_ATTRIB_RES + jam UPPERSM_RECONN_SS_SPP,mem_upper_sm_reconn + branch process_upper_sm_reconn_ss_spp_wait + + + +//rega:l2cap len ,mem_search_uuid:uuid to search +p_sdp_send_search_req: + call p_l2cap_malloc_sdp_req + setarg SDP_SEARCH_REQ + istore 1,contw + fetch 2,mem_sdp_transactionid_local + byteswap pdata,pdata + istore 2,contw + increase -5,rega + byteswap rega,rega + copy rega,pdata + istore 2,contw + setarg 0x0335 + istore 2,contw + setarg 0x19 + istore 1,contw + fetch 2,mem_search_uuid + istore 2,contw + setarg 0x0008 + istore 2,contw + setarg 0 + istore 1,contw + rtn + +//rega:l2cap len +p_sdp_send_attribute_req: + call p_l2cap_malloc_sdp_req + setarg SDP_ATTRIBUTE_REQ + istore 1,contw + fetch 2,mem_sdp_transactionid_local + byteswap pdata,pdata + istore 2,contw + increase -5,rega + byteswap rega,rega + copy rega,pdata + istore 2,contw + fetch 4,mem_sdp_record_handle + istore 4,contw + setarg 0x2c01 + istore 2,contw + setarg 0x0535 + istore 2,contw + setarg 0x0a + istore 1,contw + setarg 0 + istore 2,contw + setarg -1 + istore 2,contw + setarg 0 + istore 1,contw + rtn + +p_l2cap_malloc_sdp_req: + fetch 2,mem_sdp_transactionid_local + increase 1,pdata + store 2,mem_sdp_transactionid_local +p_l2cap_malloc_server_channel: + call push_stack_rega_b_c + call l2cap_malloc_sdp_channel + call pop_stack_rega_b_c + call l2cap_get_sdp_tx_buff + istorer rega,2,pdata + fetch 2,mem_sdp_remote_cid + istore 2,contw + rtn + + + +/**********************************sdp patch**********************************************/ + + +/**********************************page patch**********************************************/ +/* + YC 3121 page always +*/ + +p_master_page_no_interval: + fetcht 2,mem_page_window + force 40,queue + call sniff_check_window + branch page_exit,user + branch page_start + +/**********************************page patch**********************************************/ + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/peripherals.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/peripherals.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/peripherals.prog (working copy) @@ -0,0 +1,387 @@ + +/* ===================== SPI dma ======================= */ + +/***************************************************************************** +*soft reset chip +*****************************************************************************/ +soft_reset_chip: + hjam 1,core_reset + rtn + +/* ===================== uart dma ======================= */ +uartd_prepare_tx: + bpatchx patch29_0,mem_patch29 + fetch 2,IPC_BT2M0_WRITE_PTR + copy pdata,contwu + rtn + +uartd_send: + bpatchx patch29_1,mem_patch29 + copy contwu,pdata + store 2,IPC_BT2M0_WRITE_PTR +wake_up_m0: + fetch 1,core_config + rtnbit1 7 + set1 7,pdata + store 1,core_config + rtn + + +uart_copy_tx_bytes_fast: + deposit loopcnt + rtn blank +uart_copy_tx_bytes_fast_loop: + increase -8,loopcnt + call uart_tx_8_bytes,positive + rtn zero + branch uart_copy_tx_bytes_fast_loop,positive + increase 8,loopcnt +uart_copy_tx_bytes_fast_loop_four: + increase -4,loopcnt + call uart_tx_4_bytes,positive + rtn zero + branch uart_copy_tx_bytes_fast_loop_four,positive + increase 4,loopcnt + branch uart_copy_tx_bytes + +uart_tx_8_bytes: + ifetch 8,contr + istore 8,contwu + rtn + +uart_tx_4_bytes: + ifetch 4,contr + istore 4,contwu + rtn + +uart_copy_tx_bytes: + deposit loopcnt + rtn blank +uart_copy_tx_bytes_loop: + ifetch 1,contr + istore 1,contwu + loop uart_copy_tx_bytes_loop + rtn + +uart_copy_rx_bytes_fast: + deposit loopcnt + rtn blank +uart_copy_rx_bytes_fast_loop: + increase -8,loopcnt + call uart_rx_8_bytes,positive + rtn zero + branch uart_copy_rx_bytes_fast_loop,positive + increase 8,loopcnt +uart_copy_rx_bytes_fast_loop_four: + increase -4,loopcnt + call uart_rx_4_bytes,positive + rtn zero + branch uart_copy_rx_bytes_fast_loop_four,positive + increase 4,loopcnt + branch uart_copy_rx_bytes + +uart_rx_8_bytes: + ifetch 8,contru + istore 8,contw + rtn + +uart_rx_4_bytes: + ifetch 4,contru + istore 4,contw + rtn + + +uart_copy_rx_bytes: + deposit loopcnt + rtn blank +uart_copy_rx_bytes_loop: + ifetch 1,contru + istore 1,contw + loop uart_copy_rx_bytes_loop + rtn + +uartd_rxdone: + bpatchx patch29_2,mem_patch29 + copy contru,pdata + store 2,IPC_M02BT_READ_PTR + rtn + +uartd_prepare_rx: + bpatchx patch29_3,mem_patch29 + fetch 2,IPC_M02BT_READ_PTR + copy pdata,contru + rtn + +/* ===================== eeprom data ======================= */ + +app_store_nvram_event: + jam BT_EVT_STORE_NVRAM,mem_fifo_temp + branch ui_ipc_send_event + +eeprom_store_le_reconn_info: +eeprom_store_bd_reconn_info: +check_51cmd_store_reconn_info: +check_51cmd_update_device_record: + bpatchx patch29_4,mem_patch29 + fetch 1,mem_nv_data_number + rtn blank // not nv data + call check_nvram + call init_device_list,zero + call nvram_find_addr_from_bd_list +write_device_record: + fetch 1,mem_nv_data_number + icopy regc + fetcht 2,mem_nv_data_ptr + storet 2,mem_list_item_ptr +write_device_loop_find: + copy regc,pdata + branch app_store_nvram_event,blank //EEPROM + increase -1,regc + copy temp,rega + ifetch 1,rega + fetcht 1,mem_select_list_item + isub temp,null + call set_index_finded_device,zero + branch write_device_loop_find0,positive + ifetch 1,rega + increase 1,pdata + istore 1,rega +write_device_loop_find0: + fetcht 2,mem_list_item_ptr + increase NV_DATA_LEN,temp + storet 2,mem_list_item_ptr + branch write_device_loop_find + +set_index_finded_device: + setarg 0 + istore 1,rega + fetch 1,mem_temp_reconn_record + istore 1,contw + bne REC_3_MODE,set_index_finded_device_ble_mode + arg mem_link_key,regb +set_index_find_device_MASTER_ADDR: + ifetch 6,contr + istore 8,contw + setarg 0 + istore 8,contw + copy regb,contr +store_rec_data_common: + call memcpy16 + force 1,null + rtn + +set_index_finded_device_ble_mode: + beq REC_4_MODE_RANDOM_RESOLVABLE_PRIVATE_ADDRESS,set_index_finded_device_IRK + beq REC_4_MODE_RANDOM_NON_RESOLVABLE_PRIVATE_ADDRESS,set_index_finded_device_EDIV + arg mem_le_ltk,regb + branch set_index_find_device_MASTER_ADDR + +set_index_finded_device_IRK: + arg mem_le_irk,contr + call memcpy16 +store_ble_rec_data_common: + arg mem_le_ltk,contr + branch store_rec_data_common + +set_index_finded_device_EDIV: + arg mem_le_rand,contr + call memcpy16 + branch store_ble_rec_data_common + + +nvram_find_addr_from_bd_list: + call disable_user + fetch 1,mem_nv_data_number + rtn blank // not nv data + fetch 2,mem_ui_state_map + bbit1 UI_STATE_BT_CONNECTED,find_addr_from_bd_list_SPP_mode +find_addr_from_bd_list_ble_mode: + bpatchx patch29_5,mem_patch29 + fetch 1,mem_le_conn_peer_addr_type + beq MASTER_PUBLIC_ADDR,find_addr_from_bd_list_static_addr + fetch 1,mem_le_plap+5 + compare 0xc0,pdata,0xc0 + branch find_addr_from_bd_list_static_addr,true + compare 0x40,pdata,0xc0 + branch find_addr_from_bd_list_random_addr,true + compare 0x00,pdata,0xc0 + branch find_addr_from_bd_list_random_non_resolvable_private_address,true +find_addr_from_bd_list_static_addr: + jam REC_4_MODE_STATIC_ADDRESS,mem_temp_reconn_record + fetch 6,mem_le_plap + branch find_addr_from_bd_list_common + +find_addr_from_bd_list_random_non_resolvable_private_address: + jam REC_4_MODE_RANDOM_NON_RESOLVABLE_PRIVATE_ADDRESS,mem_temp_reconn_record + branch find_addr_from_bd_list_common + +//input :pdata EDIV and rands +find_addr_from_bd_list_random_addr: + jam REC_4_MODE_RANDOM_RESOLVABLE_PRIVATE_ADDRESS,mem_temp_reconn_record + branch find_addr_from_bd_list_common + +//input :pdata EDIV and rands +find_addr_from_bd_list_SPP_mode: + bpatchx patch29_6,mem_patch29 + jam REC_3_MODE,mem_temp_reconn_record + fetch 6,mem_plap +find_addr_from_bd_list_common: + store 6,mem_temp_reconn_record+1 + fetch 2,mem_nv_data_ptr + ifetcht 1,pdata + pincrease 1 + store 2,mem_list_item_ptr + storet 1,mem_select_list_item + fetch 1,mem_nv_data_number + icopy regc +nvram_find_addr_from_list: + fetch 2,mem_list_item_ptr + copy pdata,rega + call nvram_find_addr_from_list_compare + rtn user + fetcht 2,mem_list_item_ptr + increase NV_DATA_LEN,temp + storet 2,mem_list_item_ptr + increase -1,temp + ifetch 1,temp + store 1,mem_select_list_item + increase -1,regc + nbranch nvram_find_addr_from_list,zero + fetch 1,mem_nv_data_number + pincrease DECREASED_ONE + store 1,mem_select_list_item + rtn +nvram_find_addr_from_list_compare: + fetch 1,mem_temp_reconn_record + bne REC_3_MODE,find_addr_from_list_compare_ble_mode +find_master_addr_from_list_compare: + arg mem_temp_reconn_record,regb + arg 7,loopcnt + call string_compare + branch enable_user,zero + rtn + +find_addr_from_list_compare_ble_mode: + beq REC_4_MODE_RANDOM_RESOLVABLE_PRIVATE_ADDRESS,find_irk_form_list_compare + beq REC_4_MODE_RANDOM_NON_RESOLVABLE_PRIVATE_ADDRESS,find_ediv_form_list_compare + branch find_master_addr_from_list_compare + +find_irk_form_list_compare: + ifetcht 1,rega + isub temp,null + nrtn zero + arg mem_le_prand,contw + arg 16,loopcnt + call clear_mem + fetch 3,mem_le_plap+3 + store 3,mem_le_prand + call genernate_master_MacAddress + fetch 2,mem_le_aes_128+13 + byteswap pdata,pdata + lshift8 pdata,temp + ifetch 1,contr + iadd temp,pdata + fetcht 3,mem_le_plap + isub temp,null + branch enable_user,zero + rtn + + +genernate_master_MacAddress: + arg mem_le_prand ,contr + call load_data128 +// arg mem_le_irk,contr + ifetch 1,rega + call load_key128 + force aes_big_endian | aes_load,aes_ctrl + force 0,aes_ctrl // change result to little endian + call wait_aes + arg mem_le_aes_128,contw + branch store_aes_result + +find_ediv_form_list_compare: + ifetcht 1,rega + isub temp,null + nrtn zero + copy contr,rega + add contr,8,regc + arg mem_le_rand,regb + arg 8,loopcnt + call string_compare + branch enable_user,zero + copy regc,rega + arg mem_le_irk,regb + arg 8,loopcnt + call string_compare + branch enable_user,zero + rtn + +check_nvram: + fetch 2,mem_nv_data_ptr + ifetcht 1,pdata + pincrease NV_DATA_LEN + ifetch 1,pdata + isub temp,null + rtn + +init_device_list: + fetch 1,mem_nv_data_number + icopy loopcnt + fetcht 2,mem_nv_data_ptr + setarg 0 +init_device_list_loop: + istore 1,temp + increase NV_DATA_LEN,temp + pincrease 1 + loop init_device_list_loop + rtn + +load_device_list: + bpatchx patch29_7,mem_patch29 + call nvram_find_addr_from_bd_list + fetch 1,mem_state + setflag user,state_combkey,pdata /* we have link key */ + store 1,mem_state + nbranch clear_key_exists,user + add rega,10,contr +// copy rega,contr + arg mem_link_key,contw + call memcpy16 + branch check_link_key_load +clear_key_exists: + jam 0,mem_link_key_exists + rtn + +load_device_list_mode_4: + fetch 9,mem_le_ediv + branch clear_ltk_exists,blank + call nvram_find_addr_from_bd_list + nbranch clear_ltk_exists,user + fetch 2,mem_list_item_ptr + add pdata,1,contr + arg mem_le_irk,contw + call memcpy16 + arg mem_le_ltk,contw + call memcpy16 + jam 1,mem_ltk_exists + rtn + +clear_ltk_exists: + jam 0,mem_ltk_exists + rtn + + + + +check_link_key_load: + fetch 8,mem_link_key + fetcht 8,mem_link_key+8 + ior temp,pdata + rtn blank + jam 1,mem_link_key_exists + rtn + + +/* =============== GPIO CONTROL ================= */ + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/rfcomm.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/rfcomm.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/rfcomm.prog (working copy) @@ -0,0 +1,960 @@ + +ifdef COMPILE_RFCOMM +rfcomm_init: + rtn wake + jam 0,mem_rfcomm_send_more_pkt + jam BITS9600,memRemoteRPNBitRate + jam DATABITS8,memRemotePRNDataBits + jam 0x11,memRemotePRNXon + jam 0x13,memRemotePRNXoff + setarg 0 + store 3,memRemotePRNStopBit + store 1,mem_spp_state + jam 0,memui_reconnect_mode + //branch rfcomm_init_spp +rfcomm_init_spp: + bpatchx patch2a_0,mem_patch2a + setarg 0 + store 1,mem_spp_state + store 1,mem_remote_spp_channel + store 1,mem_pn_dlci + fetch 1,mem_credit_flag + beq CREDIT_ENABLE,rfcomm_init_spp_with_credit + jam 0x50,mem_credit_given + rtn + +rfcomm_init_spp_with_credit: + jam 0x00,mem_credit_given + rtn + +set_CR_bit: + or_into 0x02,temp + rtn + + +/*below added by koufan*/ + +/*rfcomm_send */ + + + + /*rfcomm_calculate_FCS_sabm*/ + /*input: address in temp*/ + /*output: FCS in pdata */ +rfcomm_calculate_FCS_sabm: + copy temp,pdata + reverse pdata,pdata //address + store 1,memFCStemp3 + force INI_TX_SABM,pdata + reverse pdata,pdata + store 1,memFCStemp2 + force 0x01,pdata + reverse pdata,pdata + store 1,memFCStemp1 + call caculate_fcs + copy temp,pdata + rtn +rfcomm_calculate_FCS_ua: + reverse pdata,pdata //address + store 1,memFCStemp3 + force RSP_TX_UA, pdata + reverse pdata, pdata + store 1, memFCStemp2 + force 0x01, pdata + reverse pdata, pdata + store 1, memFCStemp1 + branch caculate_fcs + /* FCS return from temp */ +rfcomm_calculate_FCS_dlci0: + fetch 1,mem_rfcomm_initiator + branch rfcomm_calculate_FCS_dlci0_res,blank + setarg 0x70 //FCS of initiator + rtn +rfcomm_calculate_FCS_dlci0_res: + setarg 0xaa//FCS of responder + rtn + +rfcomm_save_FCS_uih: + reverse pdata, pdata //address + store 1,memFCStemp3 /* contw distroided */ + force RSP_RX_UIH,pdata + call caculate_UIHdata_fcs + fetcht 2,mem_contw_temp + copy temp,contw + istore 1,contw /* save FCS for later use */ + copy contw,temp + storet 2,mem_contw_temp + force RSP_RX_UIH_WDATA,pdata /* P/F =1 + RSP_RX_UIH */ + call caculate_UIHdata_fcs + fetcht 2,mem_contw_temp + copy temp,contw + istore 1,contw /* save FCS for later use */ + rtn +/**********************************************************************/ +/* This subroutine caculates the FCS for UIH data */ +/* Input: */ +/* the address byte at memFCStemp3(bit reversed), control byte */ +/* at pdata (not bit reversed) */ +/* Output: */ +/* pdata: the FCS */ +/**********************************************************************/ +caculate_UIHdata_fcs: + reverse pdata,pdata + store 1,memFCStemp2 + fetch 2, memFCStemp2 + lshift8 pdata,pdata + store 3,mem_mod2div_temp + arg 0x107,regA + arg 0xf,regB + call mod2div + xor_into 0xd7, pdata + invert pdata,pdata + reverse pdata,pdata + rtn + +/**********************************************************************/ +/* This subroutine caculates the FCS */ +/* Input: */ +/* the address byte at memFCStemp3, control byte at memFCStemp2*/ +/* lenght at memFCStemp1 (all above data are bit reversed) */ +/* Output: */ +/* temp: the FCS */ +/**********************************************************************/ +caculate_fcs: + fetch 3, memFCStemp1 /* load 3 bytes start at memFCStemp1 */ + store 3,mem_mod2div_temp + arg 0x107,regA + arg 0xf,regB //24bit(memFCStemp1+..+memFCStemp3) - 9bit(regA) = 15bit + call mod2div + lshift8 pdata,pdata + arg 0x7, regB //16bit(lshift8 pdata,pdata ) - 9bit(regA) = 7bit + call mod2div + xor_into 0x2b, pdata //0x3d + invert pdata, pdata + reverse pdata, pdata /* FCS at pdata */ + copy pdata, temp + rtn + +mod2div: + arg 0,regC + copy regB,loopcnt + call right_shift_n // right shift pdata (regB)bit + icopy temp +mod2div_loop: + //jam 1,0x1fff +//mod2div_loop1: + //fetch 1,0x1fff + //nbranch mod2div_loop1,blank + copy temp,pdata + lshift regC,regC//quotient + bbit0 8, mod2div_not_enough_reduction//the high bit of 0x107 + ixor regA,temp// temp----remainer + increase 1,regC// quotient +mod2div_not_enough_reduction: //Minuend smaller than Subtrahend + lshift temp,temp + fetch 3,mem_mod2div_temp + increase -1,regB + compare 0xff,regB,0xff + branch mod2div_end,true + copy regB,loopcnt + call right_shift_n // right shift pdata (regB)bit + isolate1 0,pdata + setflag true,0,temp //move a new bit from Dividend(queue) into Minuend(pdata) + branch mod2div_loop +mod2div_end: + //output:remainer in pdata + rshift temp,pdata + rtn + +get_rfcomm_snd_adss: + fetcht 1,mem_pn_dlci +dlci_to_address_cmd: + //input DLCI from temp + lshift2 temp,temp + set1 RFCOMM_ADDRESS_EXT_LEN,temp + fetch 1,mem_rfcomm_initiator + ncall set_CR_bit,blank + storet 1,mem_rfcomm_send_adss + rtn + +channel_to_dlci: + //input channel from temp + lshift temp,temp + fetch 1,mem_rfcomm_initiator + setflag blank,0,temp //direction in dlci + //output dlci to temp + rtn +rfcomm_rx_process_DLCI0_sabm: + fetcht 1,mem_current_channel //address + jam 0xd7,mem_current_fcs //FCS + call rfcomm_send_ua + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_RFCOMM_ONLY_SABM,pdata + set1 L2CAP_CHANNEL_RFCOMM_ONLY_UA,pdata + store 1,mem_rfcomm_state + jam 0,mem_rfcomm_initiator + branch rfcomm_rx_process_end +rfcomm_rx_process_DLCI0_ua: + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_RFCOMM_ONLY_UA,pdata + store 1,mem_rfcomm_state + branch rfcomm_rx_process_end + + +rfcomm_rx_process: + bpatchx patch2a_1,mem_patch2a + fetch 1,memui_reconnect_mode + beq NO_RECONNECTION,rfcomm_rx_process_remote_page + branch rfcomm_rx_process_reconn + +rfcomm_rx_process_remote_page: + fetch 2,mem_l2cap_payload_ptr + copy pdata,contr + call get_rfcomm_head_struct + fetch 1,mem_current_channel + beq 0,parse_dlci0_rp + branch parse_uih_rp +parse_dlci0_rp: + bpatchx patch2a_2,mem_patch2a + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_SABM,rfcomm_rx_process_DLCI0_sabm + beq RFCOMM_FRAME_TYPE_UA,rfcomm_rx_process_DLCI0_ua + beq RFCOMM_FRAME_TYPE_UIH,parse_DLCI0_rp_uih + beq RFCOMM_FRAME_TYPE_DISCONN,parse_uih_rp_spp_disconn_send_event + rtn + + +parse_DLCI0_rp_uih: + fetch 2,mem_rfcomm_uih_payload_ptr + copy pdata,contr + call get_rfcomm_uih_head_struct + fetch 1,mem_uih_cmd_type + beq UIH_PARAM_NEG_CMD,parse_DLCI0_rp_uih_pn_cmd + beq UIH_PARAM_NEG_RES,parse_DLCI0_rp_uih_pn_res + beq UIH_MODEM_STATUS_CMD,parse_DLCI0_rp_uih_ms_cmd + beq UIH_MODEM_STATUS_RES,parse_DLCI0_rp_uih_ms_res + beq UIH_PARAM_CMD_REMOVE_PORT,parse_DLCI0_rp_uih_cmd_port + branch rfcomm_rx_process_end + +parse_DLCI0_rp_uih_pn_cmd: + call parse_DLCI0_rp_uih_pn_res_common + + branch parse_DLCI0_rp_uih_pn_cmd_spp + +parse_DLCI0_rp_uih_pn_cmd_spp: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_PN_CMD,pdata + set1 RFCOMM_CHANNEL_STATE_PN_RES,pdata + store 1,mem_spp_state + call rfcomm_send_param_neg_res + branch rfcomm_rx_process_end + +parse_DLCI0_rp_uih_pn_res: + call parse_DLCI0_rp_uih_pn_res_common + branch rfcomm_rx_process_end + +parse_DLCI0_rp_uih_pn_res_common: + call get_param_payload_ptr + branch get_rfcomm_prarmer_negotiation + +get_rfcomm_param_modem_status: + call get_param_payload_ptr + ifetch 1,contr + rshift3 pdata,pdata + store 1,mem_ms_channel + ifetch 1,contr + store 1,mem_ms_param + rtn + + +get_rfcomm_head_struct: + ifetch 1,contr + store 1,mem_current_adss + rshift3 pdata,pdata + store 1,mem_current_channel + ifetch 1,contr + store 1,mem_current_frame_type +get_rfcomm_current_length: + call get_rfcomm_length_common + storet 2,mem_current_length + copy contr,pdata + store 2,mem_rfcomm_uih_payload_ptr + rtn + +get_rfcomm_uih_head_struct: + ifetch 1,contr + rshift pdata,pdata + store 1,mem_uih_cmd_type + call get_rfcomm_length_common + storet 2,mem_uih_length + copy contr,pdata + store 2,mem_param_payload_ptr + rtn + + +get_param_payload_ptr: + fetch 2,mem_param_payload_ptr + copy pdata,contr + rtn + +get_rfcomm_length_common: + ifetch 1,contr + copy pdata,temp + rshift temp,temp + rtnbit1 0 + ifetch 1,contr + lshift3 pdata,pdata + lshift4 pdata,pdata + iadd temp,temp + rtn + +get_rfcomm_prarmer_negotiation: + ifetch 1,contr + store 1,mem_pn_dlci + ifetch 1,contr + store 1,mem_pn_credit_flow_type_info + ifetch 1,contr + store 1,mem_pn_priority + ifetch 1,contr + store 1,mem_pn_acknowledg_timer + ifetch 2,contr + store 2,mem_pn_max_frame_size + ifetch 1,contr + store 1,mem_pn_max_retrans + ifetch 1,contr + store 1,mem_remote_credits + rtn + + +parse_DLCI0_rp_uih_ms_cmd: + call get_rfcomm_param_modem_status + + branch parse_DLCI0_rp_uih_ms_cmd_spp + +parse_DLCI0_rp_uih_ms_cmd_spp: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_RCV_MS_CMD,pdata + set1 RFCOMM_CHANNEL_STATE_SND_MS_RES,pdata + store 1,mem_spp_state + fetcht 1,mem_pn_dlci + lshift2 temp,temp + or_into 3,temp + call rfcomm_send_modem_status_res + jam MORE_PKT_MSC_CMD_SPP,mem_rfcomm_send_more_pkt + branch rfcomm_rx_process_end + +parse_DLCI0_rp_uih_ms_res: + jam BT_EVT_SPP_CONNECTED,mem_fifo_temp + call ui_ipc_send_event + call get_rfcomm_param_modem_status + fetch 1,mem_ms_channel + sub pdata,1,null + branch parse_DLCI0_rp_uih_MS_RES_spp,zero + branch assert +parse_DLCI0_rp_uih_ms_res_spp: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_RCV_MS_RES,pdata + store 1,mem_spp_state + branch rfcomm_rx_process_end + +parse_DLCI0_rp_uih_cmd_port: + call get_param_payload_ptr + ifetch 1,contr + store 1,mem_rpn_dlci + call l2cap_malloc_rfcomm_channel + call l2cap_get_rfcomm_tx_buff + setarg 0x000e + istore 2,contw //l2cap len + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + fetch 1,mem_rfcomm_initiator + //setarg 5 + lshift pdata,pdata + set1 0,pdata //ext len + istore 1,contw //DLCI0 address + bpatchx patch2a_3,mem_patch2a + setarg 0x15ef + istore 2,contw + setarg 0x1191 + istore 2,contw + //fetch 1,mem_pn_dlci + //setarg 0x0b + fetch 1,mem_rpn_dlci + istore 1,contw //DLCI + setarg 0x000007 + istore 5,contw +// setarg 0 //max frame size +// istore 2,contw + setarg 0x01 //max retrans + istore 2,contw +// setarg 0x00 +// istore 1,contw // init credits + call rfcomm_calculate_FCS_dlci0 + istore 1,contw + rtn + + + +parse_uih_rp: + branch parse_uih_rp_spp + +parse_uih_rp_spp: + bpatchx patch2a_4,mem_patch2a + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_UA,parse_uih_rp_spp_ua + beq RFCOMM_FRAME_TYPE_SABM,parse_uih_rp_spp_sabm + beq RFCOMM_FRAME_TYPE_UIH,parse_uih_spp_uih + beq RFCOMM_FRAME_TYPE_UIH_CREDITS,parse_uih_spp_uih_credits + beq RFCOMM_FRAME_TYPE_DISCONN,parse_uih_rp_spp_disconn + rtn +parse_uih_rp_spp_ua: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_UA,pdata + store 1,mem_spp_state + branch rfcomm_rx_process_end +parse_uih_rp_spp_sabm: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_UA,pdata + set1 RFCOMM_CHANNEL_STATE_SABM,pdata + store 1,mem_spp_state + fetch 1,mem_current_adss + call rfcomm_calculate_FCS_ua + store 1,mem_current_fcs + call rfcomm_send_ua + fetch 1,mem_current_adss + rshift2 pdata,pdata + store 1,mem_pn_dlci + lshift2 pdata,pdata + set0 RFCOMM_ADDRESS_CR,pdata + set1 RFCOMM_ADDRESS_EXT_LEN,pdata + arg mem_HIUfcs_spp,temp // mem_HIUfcs_HF_WCredits in regB++ + storet 2,mem_contw_temp + call rfcomm_save_FCS_uih + branch rfcomm_rx_process_end + +parse_uih_spp_uih_credits: + fetch 2,mem_rfcomm_uih_payload_ptr + copy pdata,contr + increase 1,pdata + store 2,mem_rfcomm_uih_payload_ptr + ifetch 1,contr //remote credits + fetcht 1,mem_remote_credits + iadd temp,pdata + store 1,mem_remote_credits +parse_uih_spp_uih: + call rfcomm_increase_credit_given +parse_uih_spp_uih_cont: + call get_rfcomm_snd_adss + call rfcomm_send_uih_without_payload + call spp_process_rx_data + branch rfcomm_rx_process_end + +parse_uih_rp_spp_disconn_send_event: + jam BT_EVT_SPP_DISCONNECTED,mem_fifo_temp + call ui_ipc_send_event +parse_uih_rp_spp_disconn: + call rfcomm_init_spp + fetch 1,mem_current_adss + call rfcomm_calculate_FCS_ua + store 1,mem_current_fcs + call rfcomm_send_ua + branch rfcomm_rx_process_end + +/////////////////////////////////////////// +/////////////////////////////////////////// +/////////////////////////////////////////// +rfcomm_rx_process_reconn: + fetch 2,mem_l2cap_payload_ptr + copy pdata,contr + call get_rfcomm_head_struct + fetch 1,mem_current_channel + beq 0,parse_DLCI0_reconn + branch parse_uih_reconn + +parse_DLCI0_reconn: + bpatchx patch2a_5,mem_patch2a + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_SABM,rfcomm_rx_process_DLCI0_sabm + beq RFCOMM_FRAME_TYPE_UA,rfcomm_rx_process_DLCI0_ua + beq RFCOMM_FRAME_TYPE_UIH,parse_DLCI0_reconn_uih + branch rfcomm_rx_process_end +parse_DLCI0_reconn_uih: + fetch 2,mem_rfcomm_uih_payload_ptr + copy pdata,contr + call get_rfcomm_uih_head_struct + fetch 1,mem_uih_cmd_type + beq UIH_PARAM_NEG_CMD,parse_DLCI0_reconn_uih_pn_cmd + beq UIH_PARAM_NEG_RES,parse_DLCI0_reconn_uih_pn_cmd + beq UIH_MODEM_STATUS_CMD,parse_DLCI0_reconn_uih_ms_cmd + beq UIH_MODEM_STATUS_RES,parse_DLCI0_reconn_uih_ms_res + branch rfcomm_rx_process_end + +parse_DLCI0_reconn_uih_pn_cmd: + call parse_DLCI0_rp_uih_pn_res_common + fetch 1,mem_pn_dlci + rshift pdata,pdata + fetcht 1,mem_remote_spp_channel + isub temp,null + branch parse_DLCI0_reconn_uih_pn_cmd_spp,zero + branch assert +parse_DLCI0_reconn_uih_pn_cmd_spp: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_PN_RES,pdata + store 1,mem_spp_state + branch rfcomm_rx_process_end + +parse_DLCI0_reconn_uih_ms_cmd: + call get_rfcomm_param_modem_status + fetch 1,mem_ms_channel + fetcht 1,mem_remote_spp_channel + isub temp,null + branch parse_DLCI0_reconn_uih_ms_cmd_spp,zero + branch assert + branch rfcomm_rx_process_end +parse_DLCI0_reconn_uih_ms_cmd_spp: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_RCV_MS_CMD,pdata + set1 RFCOMM_CHANNEL_STATE_SND_MS_RES,pdata + store 1,mem_spp_state + fetcht 1,mem_pn_dlci + lshift2 temp,temp + or_into 3,temp + call rfcomm_send_modem_status_res + branch rfcomm_rx_process_end + +parse_DLCI0_reconn_uih_ms_res: + call get_rfcomm_param_modem_status + fetch 1,mem_ms_channel + fetcht 1,mem_remote_spp_channel + isub temp,null + branch parse_DLCI0_reconn_uih_ms_res_spp,zero + branch assert +parse_DLCI0_reconn_uih_ms_res_spp: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_RCV_MS_RES,pdata + store 1,mem_spp_state + branch rfcomm_rx_process_end + +parse_uih_reconn: + fetch 1,mem_current_channel + fetcht 1,mem_remote_spp_channel + isub temp,null + branch parse_uih_reconn_spp,zero + branch assert + branch rfcomm_rx_process_end + +parse_uih_reconn_spp: + fetch 1,mem_current_frame_type + beq RFCOMM_FRAME_TYPE_UA,parse_uih_reconn_spp_ua + beq RFCOMM_FRAME_TYPE_UIH,parse_uih_spp_uih + beq RFCOMM_FRAME_TYPE_UIH_CREDITS,parse_uih_spp_uih_credits + beq RFCOMM_FRAME_TYPE_DISCONN,parse_uih_reconn_spp_disconn +parse_uih_reconn_spp_ua: + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_UA,pdata + store 1,mem_spp_state + branch rfcomm_rx_process_end +parse_uih_reconn_spp_sabm: + branch parse_uih_reconn_spp_sabm//loop +parse_uih_reconn_spp_disconn: + branch parse_uih_rp_spp_disconn +rfcomm_rx_process_end: + rtn + +rfcomm_send_more_pkt: + fetch 1,mem_rfcomm_send_more_pkt + rtn blank + beq MORE_PKT_MSC_CMD_SPP,rfcomm_send_more_pkt_msc_cmd_spp + branch assert + +rfcomm_send_more_pkt_msc_cmd_spp: + jam 0,mem_rfcomm_send_more_pkt + call l2cap_malloc_rfcomm_channel + arg SPP_SLAVE_CHANNEL,temp + fetcht 1,mem_pn_dlci + lshift2 temp,temp +rfcomm_send_more_pkt_msc_cmd_spp0: + or_into 0x03,temp + arg 0xaa,regA + call rfcomm_send_modem_status_cmd + call l2cap_get_rfcomm_tx_buff + copy contw,contr + ifetch 2, contr + branch assert,blank + rtn + +rfcomm_send_sabm: + call l2cap_get_rfcomm_tx_buff + setarg 0x0004 + istore 2,contw //l2cap len + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + fetch 1,mem_current_adss + istore 1,contw //address + bpatchx patch2a_6,mem_patch2a + setarg 0x013f + istore 2,contw + fetch 1,mem_current_fcs + istore 1,contw + rtn +rfcomm_send_ua: + call l2cap_malloc_rfcomm_channel + call l2cap_get_rfcomm_tx_buff + setarg 0x0004 + istore 2,contw //l2cap len + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + fetch 1,mem_current_adss + istore 1,contw //address + bpatchx patch2a_7,mem_patch2a + setarg 0x0173 + istore 2,contw + fetch 1,mem_current_fcs + istore 1,contw + rtn +rfcomm_send_param_neg_cmd: + call l2cap_get_rfcomm_tx_buff + setarg 0x000e + istore 2,contw //l2cap len + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + fetch 1,mem_rfcomm_initiator + lshift pdata,pdata + set1 0,pdata //ext len + istore 1,contw //DLCI0 address + bpatchx patch2b_0,mem_patch2b + setarg 0x15ef + istore 2,contw + setarg 0x1183 + istore 2,contw + copy temp,pdata //DLCI in temp + istore 1,contw + setarg 0x0000f0 + istore 3,contw + setarg RFCOMM_MAX_FRAME_SIZE + istore 2,contw + setarg 0 + istore 1,contw + setarg 0x01 //change here later + istore 1,contw + call rfcomm_calculate_FCS_dlci0 + istore 1,contw + jam 0x10,mem_credit_given + rtn +rfcomm_send_param_neg_res: + call l2cap_malloc_rfcomm_channel + call l2cap_get_rfcomm_tx_buff + setarg 0x000e + istore 2,contw //l2cap len + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + fetch 1,mem_rfcomm_initiator + lshift pdata,pdata + set1 0,pdata //ext len + istore 1,contw //DLCI0 address + bpatchx patch2b_1,mem_patch2b + setarg 0x15ef + istore 2,contw + setarg 0x1181 + istore 2,contw + fetch 1,mem_pn_dlci + istore 1,contw //DLCI + setarg 0x0000e0 + istore 3,contw + fetch 2,mem_rfcomm_max_frame_size + istore 2,contw + setarg 0x00 //max retrans + istore 1,contw + fetch 1,mem_rfcomm_credit_init_data + istore 1,contw // init credits + call rfcomm_calculate_FCS_dlci0 + istore 1,contw + rtn +rfcomm_send_modem_status_cmd: + call l2cap_get_rfcomm_tx_buff + setarg 0x0008 + istore 2,contw //l2cap len + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + fetch 1,mem_rfcomm_initiator + lshift pdata,pdata + set1 0,pdata //ext len + istore 1,contw //DLCI0 address + bpatchx patch2b_2,mem_patch2b + setarg 0x09ef + istore 2,contw + setarg 0x05e3 + istore 2,contw + copy temp,pdata //DLCI adress + istore 1,contw + setarg 0x8d + istore 1,contw + call rfcomm_calculate_FCS_dlci0 + istore 1,contw + rtn + +rfcomm_send_modem_status_res: + call l2cap_malloc_rfcomm_channel + call l2cap_get_rfcomm_tx_buff + setarg 0x0008 + istore 2,contw //l2cap len + fetch 2,mem_rfcomm_remote_cid + istore 2,contw//cid + copy temp,timeup + fetch 1,mem_rfcomm_initiator + lshift pdata,pdata + set1 0,pdata //ext len + istore 1,contw //DLCI0 address + bpatchx patch2b_3,mem_patch2b + setarg 0x09ef + istore 2,contw + setarg 0x05e1 + istore 2,contw + copy timeup,pdata //DLCI address in temp + istore 1,contw + setarg 0x8d + istore 1,contw + call rfcomm_calculate_FCS_dlci0 + istore 1,contw + rtn + +rfcomm_send_uih_without_payload: + bpatchx patch2b_4,mem_patch2b + fetch 1,mem_credit_given + rtn blank +// hfetch 2,core_uart_rxitems +// nrtn blank + copy rega,pdata + store 1,mem_pdatatemp+1 + storet 1,mem_pdatatemp + call l2cap_malloc_is_fifo_full + nrtn blank + call l2cap_malloc_rfcomm_channel + call l2cap_get_rfcomm_tx_buff + setarg 0x05 + istore 2,contw + fetch 2,mem_RFCOMM_remote_CID + istore 2,contw + fetch 1,mem_rfcomm_send_adss + istore 1,contw + setarg 0x01ff + istore 2,contw + fetch 1,mem_credit_given + istore 1,contw + fetch 1,mem_HIUfcs_SPP_WCredits + istore 1,contw + jam 0,mem_credit_given + rtn + +rfcomm_increase_credit_given: + bpatchx patch2b_5,mem_patch2b + fetch 1,mem_credit_flag + rtneq CREDIT_ENABLE + fetch 2,mem_current_length + rtn blank + fetch 1,mem_credit_given + increase 1,pdata + store 1,mem_credit_given + rtn + +spp_process_rx_data: + fetch 2,mem_cb_receive_spp_data + branch callback_func + +spp_tx_rfcomm_packet: + bpatchx patch2b_6,mem_patch2b + //credit + fetch 1,mem_remote_credits + rtn blank + increase -1,pdata + store 1,mem_remote_credits + fetch 2,mem_pn_max_frame_size + fetcht 2,mem_current_packet_length + isub temp,null + branch ssp_tx_rfcomm_from_uart,positive + store 2,mem_current_packet_length +ssp_tx_rfcomm_from_uart: + fetch 1,mem_credit_given + branch ssp_tx_rfcomm_from_uart_without_credit,blank + jam 1,mem_rfcomm_send_offset + fetch 1,mem_HIUfcs_SPP_WCredits + store 1,mem_rfcomm_send_fcs + setarg RSP_RX_UIH_WDATA + store 1,mem_rfcomm_send_frame_type + branch ssp_tx_rfcomm_from_uart_common +ssp_tx_rfcomm_from_uart_without_credit: + jam 0,mem_rfcomm_send_offset + fetch 1,mem_HIUfcs_SPP + store 1,mem_rfcomm_send_fcs + setarg RSP_TX_UIH + store 1,mem_rfcomm_send_frame_type +ssp_tx_rfcomm_from_uart_common: + bpatchx patch2b_7,mem_patch2b + fetch 2,mem_current_packet_length + sub pdata,127,null + branch ssp_tx_rfcomm_from_uart_common0,positive + fetch 1,mem_rfcomm_send_offset + increase 1,pdata + store 1,mem_rfcomm_send_offset +ssp_tx_rfcomm_from_uart_common0: + call get_rfcomm_snd_adss + fetch 2,mem_current_packet_length + increase 8,pdata //fcs + rfcommhead + l2caphead == 8 + fetcht 1,mem_rfcomm_send_offset + iadd temp,rega + //rfcomm payload + call l2cap_malloc + store 2,mem_rfcomm_tx_buff_ptr + increase 4,pdata + store 2,mem_rfcomm_tx_payload_ptr + copy pdata,contw + fetch 1,mem_rfcomm_send_adss + istore 1,contw + fetch 1,mem_rfcomm_send_frame_type + istore 1,contw + call ssp_tx_write_length + call ssp_tx_write_given_credit + bpatchx patch2c_0,mem_patch2c + fetch 2,mem_nl_rx_data_src //src + copy pdata,contru + fetch 2,mem_current_packet_length + copy pdata,loopcnt + call uart_copy_rx_bytes_fast + copy contw,temp + copy contru,pdata + store 2,mem_nl_rx_data_src + copy temp,contw + fetch 1,mem_rfcomm_send_fcs + istore 1,contw + fetch 2,mem_rfcomm_tx_buff_ptr + copy pdata,contw + fetch 2,mem_current_packet_length + fetcht 1,mem_rfcomm_send_offset + iadd temp,pdata + increase 4,pdata + istore 2,contw + fetch 2,mem_rfcomm_remote_cid + istore 2,contw + jam 0,mem_credit_given //whatever mem_credit_given is set to 0 + fetch 2,mem_nl_rx_len_all + beq 0,module_hci_command_tx_spp_tx_complete + jam HCI_NOT_DISCARD_PACKET,mem_module_temp_nl_discard_packet + rtn + +ssp_tx_write_length: + bpatchx patch2c_1,mem_patch2c + fetch 2,mem_current_packet_length + sub pdata,0x7f,null + nbranch ssp_tx_write_long_packet,positive + lshift pdata,pdata + set1 0,pdata + istore 1,contw + rtn +ssp_tx_write_long_packet: + fetch 2,mem_current_packet_length + rshift3 pdata,pdata + rshift4 pdata,temp + and_into 0x7f,pdata + lshift pdata,pdata + set0 0,pdata + istore 1,contw + istoret 1,contw + rtn +ssp_tx_write_given_credit: + fetch 1,mem_credit_given + rtn blank + istore 1,contw + rtn + + + + +else + +rfcomm_init: + rtn +rfcomm_init_spp: +set_CR_bit: +rfcomm_calculate_FCS_sabm: +rfcomm_calculate_FCS_ua: +rfcomm_calculate_FCS_dlci0: +rfcomm_calculate_FCS_dlci0_res: +rfcomm_save_FCS_uih: +caculate_UIHdata_fcs: +caculate_fcs: +mod2div: +mod2div_loop: +mod2div_not_enough_reduction: +mod2div_end: +get_rfcomm_snd_adss: +dlci_to_address_cmd: +dlci_to_address_res: +channel_to_dlci: +rfcomm_rx_process_DLCI0_sabm: +rfcomm_rx_process_DLCI0_ua: +rfcomm_rx_process: +rfcomm_rx_process_remote_page: +parse_dlci0_rp: +parse_DLCI0_rp_uih: +parse_DLCI0_rp_uih_pn_cmd: +parse_DLCI0_rp_uih_pn_cmd_spp: +parse_DLCI0_rp_uih_pn_res: +parse_DLCI0_rp_uih_pn_res_common: +get_rfcomm_param_modem_status: +get_rfcomm_head_struct: +get_rfcomm_current_length: +get_rfcomm_uih_head_struct: +get_param_payload_ptr: +get_rfcomm_param_length_common: +get_rfcomm_length_common: +get_rfcomm_prarmer_negotiation: +parse_DLCI0_rp_uih_ms_cmd: +parse_DLCI0_rp_uih_ms_cmd_spp: +parse_DLCI0_rp_uih_ms_res: +parse_DLCI0_rp_uih_ms_res_spp: +parse_uih_rp: +parse_uih_rp_spp: +parse_uih_rp_spp_ua: +parse_uih_rp_spp_sabm: +parse_uih_spp_uih_credits: +parse_uih_spp_uih: +parse_uih_spp_uih_cont: +parse_uih_rp_spp_disconn: +rfcomm_rx_process_reconn: + branch assert +parse_DLCI0_reconn: +parse_DLCI0_reconn_uih: +parse_DLCI0_reconn_uih_pn_cmd: +parse_DLCI0_reconn_uih_pn_cmd_spp: +parse_DLCI0_reconn_uih_ms_cmd: +parse_DLCI0_reconn_uih_ms_cmd_spp: +parse_DLCI0_reconn_uih_ms_res: +parse_DLCI0_reconn_uih_ms_res_noext: +parse_DLCI0_reconn_uih_ms_res_spp: +parse_uih_reconn: +parse_uih_reconn_spp: +parse_uih_reconn_spp_ua: +parse_uih_reconn_spp_sabm: +parse_uih_reconn_spp_disconn: +rfcomm_rx_process_end: +rfcomm_send_more_pkt: +rfcomm_send_more_pkt_msc_cmd_spp: +rfcomm_send_sabm: +rfcomm_send_ua: +rfcomm_send_param_neg_cmd: +rfcomm_send_param_neg_res: +rfcomm_send_modem_status_cmd: +rfcomm_send_modem_status_res: +rfcomm_send_uih_without_payload: +rfcomm_increase_credit_given: +spp_process_rx_data: +spp_tx_rfcomm_packet: +ssp_tx_rfcomm_from_uart: +ssp_tx_rfcomm_from_uart_without_credit: +ssp_tx_rfcomm_from_uart_common: +ssp_tx_rfcomm_from_uart_common0: +ssp_tx_write_length: +ssp_tx_write_long_packet: +ssp_tx_write_given_credit: + branch assert +endif Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/scheduler.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/scheduler.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/scheduler.prog (working copy) @@ -0,0 +1,461 @@ +scheduler_process: + bpatchx patch2c_2,mem_patch2c + call check_51cmd + call app_process_bb_event + call process_conn_sm +/* check the connection state sequence byte */ + bpatchx patch2c_3,mem_patch2c +ifdef SIMPLE_PAIRING + call sp_calc_sequence + call simple_pairing_sequence + call master_simple_paring_sequence +endif +//return if it is hci mode. 'cause the following is host part. +//notify BB to tx a l2cap packet + call l2cap_malloc_is_fifo_full + nrtn blank + //for conn to MTK + call l2cap_call_proc_sigal_pending + call l2cap_malloc_is_fifo_full + nrtn blank + bpatchx patch2c_4,mem_patch2c +//to generat a new l2cap packet + call process_upper_sm + call l2cap_send_config_req +ifdef COMPILE_RFCOMM + call rfcomm_send_more_pkt//use this function to send msc_cmd after msc_rep sent +endif +scheduler_process0: + call scheduler_tx_disconnect_hid //may not used + bpatchx patch2c_5,mem_patch2c +// call l2cap_malloc_is_fifo_full +// nrtn blank + branch app_process_bt + +scheduler_tx_disconnect_hid: + fetch 1,mem_CONTROL_tasks + bbit1 L2CAP_DISCONNECT_INTERRUPT,L2CAP_disconnect_interrupt_req + bbit1 L2CAP_DISCONNECT_CONTROL,L2CAP_disconnect_control_req + rtn + +scheduler_tx_l2cap_pkt: + bpatchx patch2c_6,mem_patch2c + call l2cap_malloc_is_fifo_empty + rtn blank //empty + fetch 1,mem_op + rtnbit1 op_txl2cap + call l2cap_malloc_fifo_out + store 2,mem_txptr + copy pdata,contr + ifetch 2,contr + increase 4,pdata + store 2,mem_tx_len + jam 6,mem_tx_lch//start pkt + bpatchx patch2c_7,mem_patch2c + fetch 2,mem_l2cap_tx_multi_offset + branch scheduler_tx_l2cap_start_pkt,blank + fetch 1,mem_op + rtnbit0 op_pkt_comp + set0 op_pkt_comp,pdata + store 1,mem_op + jam 5,mem_tx_lch//continue pkt + fetcht 2,mem_l2cap_tx_multi_offset + fetch 2,mem_txptr + iadd temp,pdata + store 2,mem_txptr + fetch 2,mem_tx_len + isub temp,pdata + store 2,mem_tx_len +scheduler_tx_l2cap_start_pkt: + bpatchx patch2d_0,mem_patch2d + fetch 2,mem_tx_len + branch assert,blank + arg l2cap_max_pkt_len,temp //max len of dh3 pkt + isub temp,pdata + nbranch scheduler_Tx_l2cap_last_pkt,positive + bpatchx patch2d_1,mem_patch2d + storet 2,mem_tx_len //l2cap_max_pkt_len + fetch 2,mem_l2cap_tx_multi_offset + iadd temp,pdata + store 2,mem_l2cap_tx_multi_offset + branch scheduler_Tx_l2cap_pkt_end +scheduler_Tx_l2cap_last_pkt: + setarg 0 + store 2,mem_l2cap_tx_multi_offset +scheduler_Tx_l2cap_pkt_end: + fetch 1,mem_op + set1 op_txl2cap,pdata + store 1,mem_op + rtn + +scheduler_start_upper_sm: + fetch 1,mem_ui_profile_supported + bbit1 support_HID,scheduler_start_upper_sm_hid + jam UPPERSM_RECONN_SDP_CONN,mem_upper_sm_reconn + rtn +scheduler_start_upper_sm_hid: + jam UPPERSM_RECONN_HID_CTRL_CONN,mem_upper_sm_reconn + rtn + +process_upper_sm: + fetch 1,memui_reconnect_mode + nbranch process_upper_sm_reconn,blank +process_upper_sm_remote_page: + fetch 1,mem_upper_sm_remote_page + //beq UPPERSM_RP_IDLE,process_upper_sm_rp_idle + rtn blank + //nothing to do when remote page to create a connection. + jam 0,mem_upper_sm_remote_page +process_upper_sm_rp_wait: + rtn + + +process_upper_sm_reconn: + bpatchx patch2d_2,mem_patch2d + fetch 1,mem_upper_sm_reconn + rtn blank + beq UPPERSM_RECONN_SDP_CONN,process_upper_sm_reconn_sdp_conn + beq UPPERSM_RECONN_SDP_CONN_WAIT,process_upper_sm_reconn_sdp_conn_wait + beq UPPERSM_RECONN_SDP_CFG,process_upper_sm_reconn_sdp_cfg + beq UPPERSM_RECONN_SDP_CFG_WAIT,process_upper_sm_reconn_sdp_cfg_wait + beq UPPERSM_RECONN_SS_SPP,process_upper_sm_reconn_ss_spp + beq UPPERSM_RECONN_SS_SPP_WAIT,process_upper_sm_reconn_ss_spp_wait + beq UPPERSM_RECONN_SDP_DISCONN,process_upper_sm_reconn_sdp_disconn + beq UPPERSM_RECONN_SDP_DISCONN_WAIT,process_upper_sm_reconn_sdp_disconn_wait + beq UPPERSM_RECONN_HID_CTRL_CONN,process_upper_sm_reconn_hid_ctrl_conn + beq UPPERSM_RECONN_HID_CTRL_CONN_WAIT,process_upper_sm_reconn_hid_ctrl_conn_wait + beq UPPERSM_RECONN_HID_CTRL_CFG,process_upper_sm_reconn_hid_ctrl_cfg + beq UPPERSM_RECONN_HID_CTRL_CFG_WAIT,process_upper_sm_reconn_hid_ctrl_cfg_wait + beq UPPERSM_RECONN_HID_INT_CONN,process_upper_sm_reconn_hid_int_conn + beq UPPERSM_RECONN_HID_INT_CONN_WAIT,process_upper_sm_reconn_hid_int_conn_wait + beq UPPERSM_RECONN_HID_INT_CFG,process_upper_sm_reconn_hid_int_cfg + beq UPPERSM_RECONN_HID_INT_CFG_WAIT,process_upper_sm_reconn_hid_int_cfg_wait + beq UPPERSM_RECONN_RFCOMM_CONN,process_upper_sm_reconn_rfcomm_conn + beq UPPERSM_RECONN_RFCOMM_CONN_WAIT,process_upper_sm_reconn_rfcomm_conn_wait + beq UPPERSM_RECONN_RFCOMM_CFG,process_upper_sm_reconn_rfcomm_cfg + beq UPPERSM_RECONN_RFCOMM_CFG_WAIT,process_upper_sm_reconn_rfcomm_cfg_wait + beq UPPERSM_RECONN_RFCOMM_SABM,process_upper_sm_reconn_rfcomm_sabm + beq UPPERSM_RECONN_RFCOMM_SABM_WAIT,process_upper_sm_reconn_rfcomm_sabm_wait + beq UPPERSM_RECONN_SPP_CMD_PN,process_upper_sm_reconn_spp_cmd_pn + beq UPPERSM_RECONN_SPP_CMD_PN_WAIT,process_upper_sm_reconn_spp_cmd_pn_wait + beq UPPERSM_RECONN_SPP_SABM,process_upper_sm_reconn_spp_sabm + beq UPPERSM_RECONN_SPP_SABM_WAIT,process_upper_sm_reconn_spp_sabm_wait + beq UPPERSM_RECONN_SPP_CMD_MS,process_upper_sm_reconn_spp_cmd_ms + beq UPPERSM_RECONN_SPP_CMD_MS_WAIT,process_upper_sm_reconn_spp_cmd_ms_wait +process_upper_sm_reconn_wait: + rtn +process_upper_sm_reconn_sdp_conn: + call upper_sm_send_sdp_conn //return n-user if sending failed + jam UPPERSM_RECONN_SDP_CONN_WAIT,mem_upper_sm_reconn + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + store 1,mem_sdp_state + rtn +process_upper_sm_reconn_sdp_cfg: + jam UPPERSM_RECONN_SDP_CFG_WAIT,mem_upper_sm_reconn + fetch 1,mem_sdp_state + rtnbit1 L2CAP_CHANNEL_STATE_SND_CFG_REQ + jam UPPERSM_RECONN_SDP_CFG,mem_upper_sm_reconn + call upper_sm_send_sdp_cfg //return n-user if sending failed + jam UPPERSM_RECONN_SDP_CFG_WAIT,mem_upper_sm_reconn + fetch 1,mem_sdp_state + set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_sdp_state + rtn +process_upper_sm_reconn_ss_spp: + call l2cap_malloc_is_fifo_empty + nrtn blank + call upper_sm_send_ss_spp + jam UPPERSM_RECONN_SS_SPP_WAIT,mem_upper_sm_reconn + rtn +process_upper_sm_reconn_sdp_disconn: + call upper_sm_send_sdp_disconn + jam UPPERSM_RECONN_SDP_DISCONN_WAIT,mem_upper_sm_reconn + rtn +process_upper_sm_reconn_hid_ctrl_conn: + call upper_sm_send_hid_ctrl_conn + jam UPPERSM_RECONN_HID_CTRL_CONN_WAIT,mem_upper_sm_reconn + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + store 1,mem_hid_control_state + rtn +process_upper_sm_reconn_hid_ctrl_cfg: + call upper_sm_send_hid_ctrl_cfg + jam UPPERSM_RECONN_HID_CTRL_CFG_WAIT,mem_upper_sm_reconn + fetch 1,mem_hid_control_state + set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_hid_control_state + rtn +process_upper_sm_reconn_hid_int_conn: + call upper_sm_send_hid_int_conn + jam UPPERSM_RECONN_HID_INT_CONN_WAIT,mem_upper_sm_reconn + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + store 1,mem_hid_interrupt_state + rtn +process_upper_sm_reconn_hid_int_cfg: + call upper_sm_send_hid_int_cfg + jam UPPERSM_RECONN_HID_INT_CFG_WAIT,mem_upper_sm_reconn + fetch 1,mem_hid_interrupt_state + set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_hid_interrupt_state + rtn +process_upper_sm_reconn_rfcomm_conn: + call upper_sm_send_rfcomm_conn + jam UPPERSM_RECONN_RFCOMM_CONN_WAIT,mem_upper_sm_reconn + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_CONN_REQ,pdata + store 1,mem_rfcomm_state + rtn +process_upper_sm_reconn_rfcomm_cfg: + call upper_sm_send_rfcomm_cfg + jam UPPERSM_RECONN_RFCOMM_CFG_WAIT,mem_upper_sm_reconn + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_STATE_SND_CFG_REQ,pdata + store 1,mem_rfcomm_state + rtn +process_upper_sm_reconn_rfcomm_sabm: + call upper_sm_send_rfcomm_sabm + jam UPPERSM_RECONN_RFCOMM_SABM_WAIT,mem_upper_sm_reconn + fetch 1,mem_rfcomm_state + set1 L2CAP_CHANNEL_RFCOMM_ONLY_SABM,pdata + store 1,mem_rfcomm_state + rtn +process_upper_sm_reconn_spp_cmd_pn: + call upper_sm_send_spp_cmd_pn + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_PN_CMD + store 1,mem_spp_state + jam UPPERSM_RECONN_SPP_CMD_PN_WAIT,mem_upper_sm_reconn + rtn +process_upper_sm_reconn_spp_sabm: + call upper_sm_send_spp_sabm + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_SABM + store 1,mem_spp_state + jam UPPERSM_RECONN_SPP_SABM_WAIT,mem_upper_sm_reconn + fetch 1,mem_remote_spp_channel //address in pdata + lshift3 pdata,pdata + or_into 3,pdata + arg mem_HIUfcs_SPP,temp // mem_HIUfcs_spp_WCredits in regB++ + storet 2,mem_contw_temp + branch rfcomm_save_FCS_uih +process_upper_sm_reconn_spp_cmd_ms: + call upper_sm_send_spp_cmd_ms + fetch 1,mem_spp_state + set1 RFCOMM_CHANNEL_STATE_SND_MS_CMD + store 1,mem_spp_state + jam UPPERSM_RECONN_SPP_CMD_MS_WAIT,mem_upper_sm_reconn + rtn + +process_upper_sm_reconn_sdp_conn_wait: + fetch 1,mem_sdp_state + rtnbit0 L2CAP_CHANNEL_STATE_CONN_RES + jam UPPERSM_RECONN_SDP_CFG,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_sdp_cfg_wait: + fetch 1,mem_sdp_state + rtnne L2CAP_CHANNEL_SETUP_COMPLETE + jam UPPERSM_RECONN_SS_SPP ,mem_upper_sm_reconn +process_upper_sm_reconn_ss_spp_wait: + fetch 1,mem_message_to_uppersm + rtnne RECIEVE_SS_REASULT_HF + jam 0,mem_message_to_uppersm + jam UPPERSM_RECONN_SDP_DISCONN,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_sdp_disconn_wait: + fetch 1,mem_sdp_state + nrtn blank + fetch 1,mem_ui_profile_supported + bbit1 support_HID,process_upper_sm_reconn_setup_hid + bbit1 support_SPP,process_upper_sm_reconn_setup_rfcomm + branch process_upper_sm_reconn_termination +process_upper_sm_reconn_hid_ctrl_conn_wait: + fetch 1,mem_hid_control_state + rtnbit0 L2CAP_CHANNEL_STATE_CONN_RES + jam UPPERSM_RECONN_HID_CTRL_CFG,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_hid_ctrl_cfg_wait: + fetch 1,mem_hid_control_state + rtnne L2CAP_CHANNEL_SETUP_COMPLETE + jam UPPERSM_RECONN_HID_INT_CONN,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_hid_int_conn_wait: + fetch 1,mem_hid_interrupt_state + rtnbit0 L2CAP_CHANNEL_STATE_CONN_RES + jam UPPERSM_RECONN_HID_INT_CFG,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_hid_int_cfg_wait: + fetch 1,mem_hid_interrupt_state + rtnne L2CAP_CHANNEL_SETUP_COMPLETE + fetch 1,mem_ui_profile_supported + bbit1 support_SPP,process_upper_sm_reconn_setup_rfcomm + branch process_upper_sm_reconn_termination +process_upper_sm_reconn_rfcomm_conn_wait: + fetch 1,mem_rfcomm_state + rtnbit0 L2CAP_CHANNEL_STATE_CONN_RES + jam UPPERSM_RECONN_RFCOMM_CFG,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_rfcomm_cfg_wait: + fetch 1,mem_rfcomm_state + rtnne L2CAP_CHANNEL_SETUP_COMPLETE + jam UPPERSM_RECONN_RFCOMM_SABM,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_rfcomm_sabm_wait: + fetch 1,mem_rfcomm_state + rtnne L2CAP_CHANNEL_RFCOMM_DLCI0_OPENED + fetch 1,mem_ui_profile_supported + bbit1 support_SPP,process_upper_sm_reconn_setup_spp + branch process_upper_sm_reconn_termination +process_upper_sm_reconn_spp_cmd_pn_wait: + fetch 1,mem_spp_state + rtnbit0 RFCOMM_CHANNEL_STATE_PN_RES + jam UPPERSM_RECONN_SPP_SABM,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_spp_sabm_wait: + fetch 1,mem_spp_state + rtnbit0 RFCOMM_CHANNEL_STATE_UA + jam UPPERSM_RECONN_SPP_CMD_MS ,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_spp_cmd_ms_wait: + fetch 1,mem_spp_state + rtnne RFCOMM_CHANNEL_SETUP_COMPLETE + branch process_upper_sm_reconn_termination + +process_upper_sm_reconn_setup_hid: + jam UPPERSM_RECONN_HID_CTRL_CONN,mem_upper_sm_reconn + branch process_upper_sm_reconn + +process_upper_sm_reconn_setup_rfcomm: + jam UPPERSM_RECONN_RFCOMM_CONN,mem_upper_sm_reconn + branch process_upper_sm_reconn +process_upper_sm_reconn_setup_spp: + jam UPPERSM_RECONN_SPP_CMD_PN,mem_upper_sm_reconn + branch process_upper_sm_reconn + + + +process_upper_sm_reconn_termination: + jam 0,mem_upper_sm_reconn + rtn +upper_sm_send_sdp_conn: + bpatchx patch2d_3,mem_patch2d + call l2cap_malloc_signal_channel + setarg PSM_SDP + copy pdata,temp + setarg L2CAP_SDP_channel + copy pdata,timeup + branch ML2CAP_send_signal_connect_req + +upper_sm_send_sdp_cfg: + bpatchx patch2d_4,mem_patch2d + call l2cap_malloc_signal_channel + fetch 2,mem_SDP_remote_CID + copy pdata,temp + branch ML2CAP_send_signal_config_req + +upper_sm_send_sdp_disconn: + bpatchx patch2d_5,mem_patch2d + call l2cap_malloc_signal_channel + fetch 2,mem_SDP_remote_CID + copy pdata,temp + arg L2CAP_SDP_channel,timeup + call ML2CAP_send_signal_disconn_req + fetch 1,mem_sdp_state + set0 L2CAP_CHANNEL_STATE_RCV_CFG_RES ,pdata + store 1,mem_sdp_state + rtn +//service search +upper_sm_send_ss_spp: + bpatchx patch2d_6,mem_patch2d + call l2cap_malloc_sdp_channel + call sdp_send_spp_request + branch MSDP_send_req_done + +upper_sm_send_rfcomm_conn: + bpatchx patch2d_7,mem_patch2d + call l2cap_malloc_signal_channel + setarg PSM_RFCOMM + copy pdata,temp + setarg L2CAP_RFCOMM_channel + copy pdata,timeup + branch ML2CAP_send_signal_connect_req + +upper_sm_send_rfcomm_cfg: + bpatchx patch2e_0,mem_patch2e + call l2cap_malloc_signal_channel + fetch 2,mem_rfcomm_remote_cid + copy pdata,temp + branch ML2CAP_send_signal_config_req + +upper_sm_send_hid_ctrl_conn: + bpatchx patch2e_1,mem_patch2e + call l2cap_malloc_signal_channel + setarg PSM_HID_control + copy pdata,temp + setarg L2CAP_HID_Control_channel + copy pdata,timeup + branch ML2CAP_send_signal_connect_req + +upper_sm_send_hid_ctrl_cfg: + bpatchx patch2e_2,mem_patch2e + call l2cap_malloc_signal_channel + fetch 2,mem_hid_ctrl_remote_cid + copy pdata,temp + branch ML2CAP_send_signal_config_req + +upper_sm_send_hid_int_conn: + bpatchx patch2e_3,mem_patch2e + call l2cap_malloc_signal_channel + setarg PSM_HID_interrupt + copy pdata,temp + setarg L2CAP_HID_interrupt_channel + copy pdata,timeup + branch ML2CAP_send_signal_connect_req + +upper_sm_send_hid_int_cfg: + bpatchx patch2e_4,mem_patch2e + call l2cap_malloc_signal_channel + fetch 2,mem_hid_int_remote_cid + copy pdata,temp + branch ML2CAP_send_signal_config_req + +upper_sm_send_rfcomm_sabm: + bpatchx patch2e_5,mem_patch2e + call l2cap_malloc_rfcomm_channel + //force 3,temp //address + jam 3,mem_current_adss + jam 0x1c,mem_current_fcs + call rfcomm_send_sabm + jam 1,mem_rfcomm_initiator + rtn + +upper_sm_send_spp_cmd_pn: + bpatchx patch2e_6,mem_patch2e + call l2cap_malloc_rfcomm_channel + fetcht 1,mem_remote_spp_channel + call channel_to_dlci + storet 1,mem_pn_dlci + branch rfcomm_send_param_neg_cmd + +upper_sm_send_spp_sabm: + bpatchx patch2e_7,mem_patch2e + call l2cap_malloc_rfcomm_channel + fetcht 1,mem_pn_dlci + call dlci_to_address_cmd + call rfcomm_calculate_FCS_sabm //sabm fcs use once only,not need to save + store 1,mem_current_fcs + fetcht 1,mem_pn_dlci + call dlci_to_address_cmd + storet 1,mem_current_adss + branch rfcomm_send_sabm + +upper_sm_send_spp_cmd_ms: + bpatchx patch2f_0,mem_patch2f + call l2cap_malloc_rfcomm_channel + fetcht 1,mem_pn_dlci + call dlci_to_address_cmd //address in temp + branch rfcomm_send_modem_status_cmd + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/sdp.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/sdp.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/sdp.prog (working copy) @@ -0,0 +1,1206 @@ +/**********************************************************************/ +/* Subroutine: sdp_process */ +/* Process Service Discovery Request */ +/* Called from L2CAP, check PDUID, branch to different req processings*/ +/* */ +/* Input: mem_L2CAP_Rx_payload */ +/* Output: mem_SDP_Tx_payload, mem_SDP_Tx_pkt_length */ +/* */ +/**********************************************************************/ +sdp_process: + bpatchx patch2f_1,mem_patch2f + fetch 2,mem_l2cap_payload_ptr + iforce contr +// ifetchr regb,1,contr /* PDUID */ +// storer regb,1,mem_sdp_pduid + ifetch 1,contr + copy pdata,regb + store 1,mem_sdp_pduid + ifetch 2,contr + store 2,mem_sdp_transactionid /* save transaction id */ + ifetch 1,contr /* higher byte of parameter length */ + lshift8 pdata,timeup + ifetch 1,contr /* lower byte of parameter length */ + iadd timeup,timeup /* parameter length stored in "timeup" */ + bpatchx patch2f_2,mem_patch2f + copy contr,temp + arg 4,loopcnt + arg mem_sdp_handle_list,contw + call memset0 + copy temp,contr + deposit regb /* PDUID */ + beq SDP_ERROR_RES,sdp_process_error_res + beq SDP_SEARCH_REQ,sdp_process_ss_req + beq SDP_SEARCH_RES,sdp_process_ss_res + beq SDP_ATTRIBUTE_REQ,sdp_process_sa_req + beq SDP_ATTRIBUTE_RES,sdp_process_sa_res + beq SDP_SEARCHATTRIB_REQ,sdp_process_ssa_req + beq SDP_SEARCHATTRIB_RES,sdp_process_ssa_res + branch sdp_insufficient_resource + +/**********************************************************************/ +/* ss_req */ +/* Processing Service Search Request */ +/* Call: ask_serviceclassid, empty_response */ +/* */ +/* Input: mem_L2CAP_Rx_payload pointer in contr */ +/* Output: mem_SDP_Tx_payload, mem_SDP_Tx_pkt_length */ +/* */ +/**********************************************************************/ +sdp_process_ss_req: + bpatchx patch2f_3,mem_patch2f + call ask_serviceclassid + compare 1,temp,0xff + branch ss_empty_rsp,true + compare 0xff,temp,0xff + branch sdp_invalid_request_syntax,true + + ifetch 2,contr /* max aservice record count */ + store 2,mem_sdp_record_maxcnt + increase -2,timeup + + increase -1,timeup /* continuation state 1 byte (0) */ + nbranch sdp_invalid_pdu_size,zero /* invalid pdu size */ + arg mem_sdp_uuid_search_ptr,timeup + ifetch 2,timeup + rtn blank + call search_all_uuid + call l2cap_get_sdp_tx_payload /* put the pointer to Tx buffer */ + force 3,pdata /* PDUID 3, Service Search Response */ + istore 1,contw + fetch 2,mem_sdp_transactionid /* write transaction id */ + istore 2,contw + lshift2 queue,pdata + add pdata,5,pdata + add pdata,5,regc + byteswap pdata,pdata + istore 2,contw /* write parLength */ + deposit queue + byteswap pdata,pdata + istore 2,contw /* write TotSrvRecCount */ + istore 2,contw /* write CurSrvRecCount */ + arg mem_sdp_handle_list,contr + copy queue,loopcnt + branch ss_req_blank,zero +ss_req_loop: + ifetch 4,contr + istore 4,contw + loop ss_req_loop +ss_req_blank: + force 0,pdata + istore 1,contw /* continuation state */ + deposit regc + store 2,mem_sdp_tx_pkt_length +// branch assert,blank + rtn + +/**********************************************************************/ +/* sa_req */ +/* Processing Service Attribute Request */ +/* Call: ask_attributeid, empty_response (if 3 stored attr. */ +/* not asked) or answer_attributelist */ +/* Input: mem_L2CAP_Rx_payload pointer in contr */ +/* Output: mem_SDP_Tx_payload, mem_SDP_Tx_pkt_length */ +/* */ +/**********************************************************************/ +sdp_process_sa_req: + bpatchx patch2f_4,mem_patch2f + ifetch 4,contr /* service record handle */ + store 4,mem_sdp_record_handle + increase -4,timeup + call sdp_store_maxbyte + store 2,mem_sdp_attribute_maxbyte + increase -2,timeup + call dataelementtype6 /* result: data size stored in rega */ + branch sdp_invalid_request_syntax,zero + compare 5,rega,0xff // length + //branch sa_req_all,true + branch sa_judge_wholerange,true +sa_isnot_wholerange: + arg mem_sdp_attrib_list,contw + force 0,queue + branch sa_req_loop +sa_judge_wholerange: + ifetch 1,contr + bne SDP_ATTRIBUTE_RANGE,sdp_invalid_request_syntax + ifetch 2,contr + nbranch sa_judge_wholerange_false1,blank + ifetch 1,contr + bne 0xff,sa_judge_wholerange_false2 + ifetch 1,contr + bne 0xff,sa_judge_wholerange_false3 //also exist potential bug because mem_sdp_attrib_list length is only 7f + branch sa_req_all +sa_judge_wholerange_false3: + increase -5,contr + branch sa_isnot_wholerange +sa_judge_wholerange_false2: + increase -4,contr + branch sa_isnot_wholerange +sa_judge_wholerange_false1: + increase -3,contr + branch sa_isnot_wholerange +sa_req_loop: + ifetch 1,contr + beq SDP_ATTRIBUTE_ID, sa_req_one_id + beq SDP_ATTRIBUTE_RANGE, sa_req_range +sa_req_range: + ifetch 2, contr + istore 2, contw + increase 1,queue + byteswap pdata,regb + ifetch 2, contr + byteswap pdata,pdata +sa_req_range_id_increase: + increase 1, regb + isub regb, null + nbranch sa_req_range_id_finish,positive + copy pdata, regc + byteswap regb,pdata + istore 2, contw + increase 1,queue + copy regc, pdata + branch sa_req_range_id_increase +sa_req_range_id_finish: + increase -5,timeup + increase -5,rega + branch sa_req_check_next_id +sa_req_one_id: + ifetch 2,contr + istore 2,contw //save the attribute id in mem_sdp_attrib_list + increase 1,queue + increase -3,timeup + increase -3,rega +sa_req_check_next_id: + nbranch sdp_invalid_request_syntax,positive + nbranch sa_req_loop,zero //another attribute + increase -1,timeup + nbranch sdp_invalid_request_syntax,zero + + call l2cap_get_sdp_tx_payload + increase 10,contw + arg mem_sdp_attrib_list,rega +sa_req_handle_attributelist_next: + copy queue,pdata + branch sa_req_handle_attributelist_end,blank + ifetch 2,rega + branch sa_req_handle_attributelist_end,blank + iforce regb /* regb is the attribute ID */ + fetch 4,mem_sdp_record_handle + iforce temp + call search_handle_attrib + copy contr,pdata + branch sa_req_handle_attributelist_notfound,blank + increase -3,contr + ifetch 3,contr + istore 3,contw + call sdp_data_len + iforce loopcnt + call memcpy +sa_req_handle_attributelist_notfound: + increase 2,rega + increase -1, queue + branch sa_req_handle_attributelist_next + +sa_req_handle_attributelist_end: + arg SDP_ATTRIBUTE_RES,rega + call ssa_req_range_lastfreg_common + fetch 2,mem_sdp_tx_pkt_length + beq 11,sa_empty_rsp + branch ssa_req_range_attrbutes_length_no_continue + + +sdp_store_continue_common: + ifetch 1, contr + beq 0, sdp_store_continue_0byte + beq 1,sdp_store_continue_1byte + beq 2, sdp_store_continue_2byte +sdp_store_continue_0byte: + increase -1,timeup /* continuation state byte (0) */ + branch sdp_store_continue_end +sdp_store_continue_1byte: + ifetch 1, contr + increase -2,timeup /* continuation state byte (1) */ + branch sdp_store_continue_end +sdp_store_continue_2byte: + ifetch 2, contr + byteswap pdata,pdata + increase -3,timeup /* continuation state byte (2) */ +sdp_store_continue_end: + store 2, mem_sdp_continue_byte + rtn + +sa_req_all: + increase -5,timeup + call sdp_store_continue_common + nbranch sdp_invalid_pdu_size,zero + fetcht 4,mem_sdp_record_handle + call search_handle + nbranch sdp_invalid_service_record_handle,zero + copy contr,rega + call l2cap_get_sdp_tx_payload + copy rega,contr + increase 3,contw//arg mem_SDP_Tx_payload+3,contw + copy contr,timeup //sdp start pointer + call sdp_get_data + copy pdata, rega //sdp total length +// fetchr regb,2,mem_sdp_continue_byte + fetch 2,mem_sdp_continue_byte + copy pdata,regb + copy rega,pdata + isub regb,regb //total_length - continue_byte in regb + fetch 2, mem_sdp_attribute_maxbyte + isub regb, null + nbranch sa_req_all_fragment_sdp, positive + // the last fragment + disable user + fetch 2, mem_sdp_continue_byte + branch sa_req_all_fisrt_fragment,blank + iadd timeup, contr //set the read pointer + increase 3,regb //include the total length field, 3 bytes + copy regb, loopcnt + copy loopcnt, pdata + increase 3, pdata + byteswap pdata,pdata + istore 2, contw + copy loopcnt, pdata + byteswap pdata,pdata + istore 2, contw + branch sa_req_all_answer_attributelist_full_loop +sa_req_all_fisrt_fragment: + add rega,6,loopcnt + branch sa_req_all_parlength_continue_byte, user + byteswap loopcnt,pdata + branch sa_req_all_parlength_continue_byte_end +sa_req_all_parlength_continue_byte: + copy loopcnt, pdata + increase 2, pdata + byteswap pdata,pdata +sa_req_all_parlength_continue_byte_end: + istore 2,contw /* ParLength */ + increase -3,loopcnt + byteswap loopcnt,pdata + istore 2,contw /* AttrListByteCount */ + copy timeup,contr + branch sa_req_all_answer_attributelist_full_loop +sa_req_all_fragment_sdp: + enable user +// fetchr rega,2,mem_sdp_attribute_maxbyte + fetch 2,mem_sdp_attribute_maxbyte + copy pdata,rega + copy rega,loopcnt + fetch 2, mem_sdp_continue_byte + branch sa_req_all_fisrt_fragment,blank + iadd timeup, contr + copy rega,pdata + increase 5,pdata + byteswap pdata,pdata + istore 2, contw + copy rega,pdata + byteswap pdata,pdata + istore 2, contw +sa_req_all_answer_attributelist_full_loop: + call memcpy + nbranch sa_req_all_last_frag_continue, user + force 2,pdata + istore 1,contw + copy contr, pdata + isub timeup, pdata + byteswap pdata,pdata + istore 2, contw // continuation length + branch sa_req_all_frag_end +sa_req_all_last_frag_continue: + force 0,pdata + istore 1,contw +sa_req_all_frag_end: + arg SDP_ATTRIBUTE_RES,rega + branch ssa_req_range_common + +/**********************************************************************/ +/* ssa_req */ +/* Processing Service Search Attribute Request */ +/* Call: ask_serviceclassid, ask_attributeid, empty_response */ +/* or answer_attributelist */ +/* Input: contr */ +/* Output: mem_SDP_Tx_payload, mem_SDP_Tx_pkt_length */ +/* */ +/**********************************************************************/ +sdp_process_ssa_req: + bpatchx patch2f_5,mem_patch2f + call ask_serviceclassid + compare 0xff,temp,0xff + branch sdp_invalid_request_syntax,true + call sdp_store_maxbyte + store 2,mem_sdp_attribute_maxbyte + increase -2,timeup + call dataelementtype6 + arg mem_sdp_attrib_list,contw + force 0,queue +ssa_req_loop: + ifetch 1,contr + beq SDP_ATTRIBUTE_RANGE,ssa_req_range + ifetch 2,contr + istore 2,contw //save the attribute id in mem_sdp_attrib_list + increase 1,queue + increase -3,timeup + increase -3,rega + nbranch sdp_invalid_request_syntax,positive + nbranch ssa_req_loop,zero + increase -1,timeup + nbranch sdp_invalid_request_syntax,zero + call l2cap_get_sdp_tx_payload + increase 13,contw//arg mem_SDP_Tx_payload+13,contw + fetch 2,mem_sdp_uuid_search_ptr + iforce regc + arg mem_sdp_attrib_list,rega +ssa_req_attributelist_next: + ifetch 2,rega + branch ssa_req_attributelist_end,blank + iforce regb /* regb is the attribute ID */ + call search_attrib + branch ssa_req_attributelist_notfound,blank + increase -3,contr + ifetch 3,contr + istore 3,contw + call sdp_data_len + iforce loopcnt + call memcpy +ssa_req_attributelist_notfound: + increase 2,rega + branch ssa_req_attributelist_next + +ssa_req_attributelist_end: + call ssa_req_range_lastfreg + fetch 2,mem_sdp_tx_pkt_length + beq 14,ssa_empty_rsp + call ssa_req_range_attrbutes_length_no_continue + branch ssa_req_range_attrbutes_length_no_continue + + +sdp_store_maxbyte: + ifetch 2,contr + byteswap pdata,pdata + increase -3,pdata + arg 200,temp + isub temp,null + nrtn positive + setarg 200 + rtn + + +ssa_req_range: + increase 4,contr + increase -5,timeup + increase -5,rega + nbranch sdp_invalid_request_syntax,zero + call sdp_store_continue_common + nbranch sdp_invalid_pdu_size,zero + arg mem_sdp_uuid_search_ptr,timeup + call search_all_uuid + deposit queue + branch ssa_empty_rsp,blank + store 1,mem_handle_humber +// storer regb,2,mem_sdp_all_length + copy regb,pdata + store 2,mem_sdp_all_length + arg 0,queue + arg 0,rega + call l2cap_get_sdp_tx_payload + increase 10,contw +ssa_req_range_find_handle: + call ssa_req_range_get_length + nbranch assert,user + copy contr,timeup + copy pdata,regc + iadd rega,rega +// copy pdata,rega +// fetch 2,mem_sdp_all_length + fetch 2,mem_sdp_continue_byte + copy pdata,regb + branch ssa_req_range_first_freg,blank +ssa_req_range_later_freg_with_continue: + copy rega,pdata + isub regb,regb //total_length - continue_byte in rega + branch ssa_req_range_next_handle,zero + nbranch ssa_req_range_next_handle,positive + fetch 2, mem_sdp_attribute_maxbyte + isub regb, null + branch ssa_req_range_maxbyte_with_continue,zero + nbranch ssa_req_range_maxbyte_with_continue, positive + + // data length < =maxbyte +ssa_req_range_send_not_maxbyte: + copy regb,loopcnt + call ssa_req_range_maxbyte_with_continue_cpy + fetch 1,mem_handle_humber + increase 1,queue + isub queue,null + branch ssa_req_range_lastfreg,zero + branch ssa_req_range_freg_with_continue + +ssa_req_range_maxbyte_with_continue: + copy pdata,loopcnt + call ssa_req_range_maxbyte_with_continue_cpy + branch ssa_req_range_freg_with_continue + +ssa_req_range_maxbyte_with_continue_cpy: + increase -3,contw + copy loopcnt,temp + copy regc,pdata + isub regb,pdata + iadd timeup,contr + branch memcpy + +ssa_req_range_next_handle: + fetch 1,mem_handle_humber + increase 1,queue + isub queue,null + rtn zero // + branch ssa_req_range_find_handle + +ssa_req_range_get_length: + call disable_user + arg mem_sdp_handle_list,contr + lshift2 queue,pdata + iadd contr,contr + ifetcht 4, contr + call search_handle + nrtn zero + call sdp_data_len + branch enable_user + +ssa_req_range_first_freg: + fetch 2, mem_sdp_attribute_maxbyte + isub rega, null + nbranch ssa_req_range_firstfreg_maxbyte_with_continue,positive + copy rega,loopcnt + copy loopcnt,temp + copy timeup,contr + call memcpy + fetch 2,mem_sdp_all_length + isub rega,null + branch ssa_req_range_freg_no_continue,zero +ssa_req_range_firstfreg_not_maxbyte_with_continue: + call ssa_req_range_freg_with_continue + branch ssa_req_range_attrbutes_length + +ssa_req_range_freg_no_continue: + call ssa_req_range_lastfreg + branch ssa_req_range_attrbutes_length + +ssa_req_range_lastfreg: + arg SDP_SEARCHATTRIB_RES,rega //PUD ID +ssa_req_range_lastfreg_common: + force 0,pdata + istore 1,contw + call ssa_req_range_common + fetcht 2,mem_sdp_tx_pkt_length + increase -5,temp + byteswap temp,pdata + istore 2, contw + increase -3,temp + byteswap temp,pdata + istore 2, contw //attribute length + rtn + +ssa_req_range_firstfreg_maxbyte_with_continue: + copy pdata,loopcnt + copy loopcnt,temp + copy timeup,contr + call memcpy + call ssa_req_range_freg_with_continue +ssa_req_range_attrbutes_length: + setarg 0x36 + istore 1,contw + fetch 2,mem_sdp_all_length + byteswap pdata,pdata + istore 2, contw + rtn + +ssa_req_range_attrbutes_length_no_continue: + setarg 0x36 + istore 1,contw + increase -3,temp + byteswap temp,pdata + istore 2, contw + rtn + +ssa_req_range_freg_with_continue: + arg SDP_SEARCHATTRIB_RES,rega //PUD ID + setarg 2 + istore 1,contw + fetch 2,mem_sdp_continue_byte + iadd temp,temp + byteswap temp,pdata + istore 2,contw + call ssa_req_range_common + fetcht 2,mem_sdp_tx_pkt_length + increase -5,temp + byteswap temp,pdata + istore 2, contw + increase -5,temp + byteswap temp,pdata + istore 2, contw + rtn + +ssa_req_range_common: + fetch 2,mem_sdp_tx_payload_ptr + isub contw,pdata + sub pdata,0,pdata + store 2,mem_sdp_tx_pkt_length + call l2cap_get_sdp_tx_payload + copy rega,pdata //PUD ID + istore 1,contw + fetch 2,mem_sdp_transactionid + istore 2,contw + rtn + + + + +/**********************************************************************/ +/* ssa_res */ +/* Processing Service Search Attribute Response */ +/* Call: dataelementtype6, attribute_reading */ +/* Input: contr */ +/* Output: mem_sdp_record_handle,mem_sdp_search_failed */ +/* */ +/**********************************************************************/ +sdp_process_ssa_res: +sdp_process_ss_res: +sdp_process_sa_res: +sdp_process_error_res: + rtn +/* +sdp_process_ss_res: + bpatchx patch2f_6,mem_patch2f + ifetch 2,contr + ifetch 2,contr + byteswap pdata,pdata + bne 1,assert + ifetch 4,contr + store 4,mem_sdp_record_handle + fetchr regc,2,mem_sdp_l2capch_ptr + add regc,offset_lc_state,regc + ifetch 1,regc + set1 L2CAP_CHANNEL_STATE_RECV_SEARCH_RES,pdata + istore 1,regc + rtn + +sdp_process_sa_res: + bpatchx patch2f_7,mem_patch2f + fetchr regc,2,mem_sdp_l2capch_ptr + add regc,offset_lc_state,regc + ifetch 1,regc + set1 L2CAP_CHANNEL_STATE_RECV_ATTRIB_RES,pdata + istore 1,regc + copy temp,contr + ifetch 2,contr + call search_rfcomm_cn + store 1,mem_profile_channel + rtn +*/ + + + +sdp_invalid_service_record_handle: + setarg 0x0200 + store 2,mem_sdp_error_code + branch sdp_error_response +sdp_invalid_pdu_size: + setarg 0x0400 + store 2,mem_sdp_error_code + branch sdp_error_response +sdp_insufficient_resource: + setarg 0x0600 + store 2,mem_sdp_error_code + branch sdp_error_response +sdp_invalid_request_syntax: + setarg 0x0300 + store 2,mem_sdp_error_code +sdp_error_response: + call l2cap_get_sdp_tx_payload + istore 1,contw + fetch 2,mem_sdp_transactionid + istore 2,contw + setarg 0x0200 + istore 2,contw + fetch 2,mem_sdp_error_code + istore 2,contw + jam 7,mem_sdp_tx_pkt_length + rtn + + +//store uuid in mem_sdp_uuid_search_ptr, +//return temp 0xff if wrong +ask_serviceclassid: + arg 0,regb + force 0,temp /* use "temp" to mark syntax error or to mark 128 bit uuid */ + arg mem_sdp_uuid_search_ptr,contw + call dataelementtype6 + branch asksrv_error,zero +classidloop: + increase 1,regb + ifetch 1,contr + increase -1,rega + increase -1,timeup + compare 0x18,pdata,0xf8 /* 5 MSB: b00011: uuid */ + nbranch asksrv_error,true + compare 0x04,pdata,0x07 /* 3 LSB: b100 128 bits uuid */ + nbranch cmp032,true + force 1,temp /* mark it as 128 bit uuid */ +skip2bytes: + ifetch 1,contr + increase -1,rega + increase -1,timeup + bne 0x00, frstbwrong + ifetch 1,contr + increase -1,rega + increase -1,timeup + beq 0x00, cmpuuid + branch scndbwrong +frstbwrong: + increase 1,contr + increase -1,rega + increase -1,timeup +scndbwrong: + increase 2,contr /* skip 2 bytes, first 2 bytes already wrong */ + increase -2,rega + increase -2,timeup + compare 0x00,temp,0xff /* 128 bits or 32 bits ? */ + branch loopornot,true + increase 12,contr /* skip 12 bytes, first 2 bytes already wrong */ + increase -12,rega + increase -12,timeup + branch loopornot +cmp032: + compare 0x02,pdata,0x07 /* 3 LSB: b010 32 bits uuid */ + nbranch cmp016,true + branch skip2bytes +cmp016: + compare 0x01,pdata,0x07 /* 3 LSB: b001 16 bit uuid */ + nbranch asksrv_error,true +cmpuuid: + increase -2,rega + increase -2,timeup + ifetch 2,contr /* higher order byte */ + sub regb,4,null + branch uuidsize,zero //max store uuids =3 + istore 2,contw +uuidsize: + compare 0x00,temp,0xff /* is this 128 bits uuid */ + branch loopornot,true + copy contr,temp + ifetch 1,contr + bne 0x00, wrong12b + ifetch 1,contr + bne 0x00, wrong12b + ifetch 1,contr + bne 0x10, wrong12b + ifetch 1,contr + bne 0x00, wrong12b + ifetch 1,contr + bne 0x80, wrong12b + ifetch 1,contr + bne 0x00, wrong12b + ifetch 1,contr + bne 0x00, wrong12b + ifetch 1,contr + bne 0x80, wrong12b + ifetch 1,contr + bne 0x5f, wrong12b + ifetch 1,contr + bne 0x9b, wrong12b + ifetch 1,contr + bne 0x34, wrong12b + ifetch 1,contr + beq 0xfb, chck12dn +wrong12b: + copy temp,contr +wrong12b1: + increase 12,contr /* skip 12 bytes */ + force 0x00,queue + force 0x00,temp + branch chck12dn + +chck12dn: + increase -12,timeup + increase -12,rega +loopornot: + force 0x00,temp + compare 0x00,rega,0xff + nbranch classidloop,true + force 0,pdata + istore 2,contw /* end list with null */ + rtn +asksrv_error: + arg 0xff,temp + rtn + +/**********************************************************************/ +/* Subroutine: dataelementtype6 */ +/* Parse Data Element Sequence, obtain the data size */ +/* Input: SDP Rx Buf Pointer in contr, parameter count in timeup */ +/* Output: data length in rega, data pointer in contr */ +/* and parameter count in timeup, return with zero flag set: */ +/* syntax error */ +/**********************************************************************/ +dataelementtype6: + bpatchx patch30_0,mem_patch30 + ifetch 1,contr + increase -1,timeup + compare 0x30,pdata,0xf8 /* 5 MSB: b00110: type 6 */ + nbranch dsize_error,true + compare 0x07,pdata,0x07 /* 3 LSB: b111: 32 bits */ + branch dsize32,true + compare 0x06,pdata,0x07 /* 3 LSB: b110: 16 bits */ + branch dsize16,true + compare 0x05,pdata,0x07 /* 3 LSB: b101: 8 bits */ + nbranch dsize_error,true +// ifetchr rega,1,contr /* data length in reg A */ + ifetch 1,contr + copy pdata,rega + increase -1,timeup + branch dsize +dsize32: + increase 2,contr + increase -2,timeup +dsize16: + ifetch 2,contr + byteswap pdata,rega + increase -2,timeup +dsize: + force 0x01,pdata + rtn +dsize_error: + force 0x00,pdata + rtn + +/**********************************************************************/ +/* Subroutine: sa_empty_rsp */ +/* Send empty response */ +/* */ +/* Input: mem_sdp_pduid, mem_sdp_transactionid */ +/* Output: mem_SDP_Tx_payload, mem_SDP_Tx_pkt_length */ +/* */ +/**********************************************************************/ +ss_empty_rsp: + setarg SDP_SEARCH_RES + store 1, mem_sdp_pduid + branch empty_response +sa_empty_rsp: + setarg SDP_ATTRIBUTE_RES + store 1, mem_sdp_pduid + branch empty_response +ssa_empty_rsp: + setarg SDP_SEARCHATTRIB_RES + store 1, mem_sdp_pduid +empty_response: + call l2cap_get_sdp_tx_payload /* empty attribute list */ +// fetchr regb,1,mem_sdp_pduid /* PDUID */ +// istorer regb,1,contw + fetch 1,mem_sdp_pduid + copy pdata,regb + istore 1,contw + fetch 2,mem_sdp_transactionid /* copy back transaction id */ + istore 2,contw + setarg 0x0500 + istore 2, contw + compare SDP_ATTRIBUTE_RES,regb,0xff + branch fullsearch,true + compare SDP_SEARCHATTRIB_RES,regb,0xff + branch fullsearch,true + setarg 0x000000 + istore 5,contw + branch outempty + +fullsearch: /* pduid must be 5 or 7 */ + setarg 0x350200 + istore 5,contw +outempty: + jam 10,mem_sdp_tx_pkt_length + rtn + +//return length in pdata(whole element ,include header and data ), contr not change +sdp_data_len: + call store_contw + call store_contr + call sdp_get_data + call get_contw + call get_contr + copy temp,pdata + rtn + +//return data length in pdata, contr is data pionter,return length in temp(whole element ,include header and data ) +sdp_get_data: + ifetch 1,contr + and pdata,0x7,loopcnt + rshift3 pdata,pdata + bne 0,sdp_get_data_type_not0 +sdp_get_data_type0: + force 1,pdata + force 1,temp + rtn + +sdp_get_data_type_not0_sizeindex01234: + call left_shift_n + add pdata,1,temp //add header length + rtn +sdp_get_data_type_not0: + deposit loopcnt + sub pdata,4,null + branch sdp_get_data_type_not0_sizeindex01234,positive + beq 5,sdp_get_data_type_not0_sizeindex5 + beq 6,sdp_get_data_type_not0_sizeindex6 + beq 7,sdp_get_data_type_not0_sizeindex7 + rtn + +sdp_get_data_type_not0_sizeindex5: + ifetch 1,contr + add pdata,2,temp //add header length + rtn +sdp_get_data_type_not0_sizeindex6: + ifetch 2,contr + byteswap pdata,pdata + add pdata,3,temp //add header length + rtn +sdp_get_data_type_not0_sizeindex7: + ifetch 2,contr + byteswap pdata,pdata + ifetcht 2,contr + byteswap temp,temp + lshift16 temp,temp + iadd temp,pdata + add pdata,5,temp //add header length + rtn + +/* find with uuids +input uuids pionter in timeup +return handles in mem_sdp_handle_list; handles number in queue if found +return regb all length*/ +search_all_uuid: + bpatchx patch30_1,mem_patch30 + force 0,queue + arg 0,regb + arg mem_sdp_handle_list,contw +search_all_uuid_llop: + ifetch 2,timeup + rtn blank + call search_uuid + copy queue,pdata + rtneq SDP_MAX_HANDLE_NUMBER + increase 2,timeup + branch search_all_uuid_llop + +search_uuid: +// arg 0,regb + iforce regc +// force 0,queue + fetch 2, mem_ui_uuid_table + iforce contr +search_uuid_next: + copy queue,pdata + rtneq SDP_MAX_HANDLE_NUMBER + disable user + ifetch 1,contr + rtn blank + iforce loopcnt +search_uuid_loop: + ifetch 2,contr + isub regc,null + nbranch search_uuid_not_found,zero + enable user // uuid match +search_uuid_not_found: + loop search_uuid_loop + ifetcht 4,contr // get handle + copy contr,rega + nbranch search_uuid_nomatch,user + arg mem_sdp_handle_list,contr + arg SDP_MAX_HANDLE_NUMBER,loopcnt +search_uuid_check_same_handle: + ifetch 4,contr + branch search_uuid_store_handle,blank + isub temp,null + branch search_uuid_nomatch,zero + loop search_uuid_check_same_handle + rtn +search_uuid_store_handle: + istoret 4,contw + increase 1,queue + copy rega,contr + call sdp_data_len + iadd regb,regb + iadd contr,contr + branch search_uuid_next +search_uuid_nomatch: + copy rega,contr + call sdp_get_data + iadd contr,contr // next paragraph + branch search_uuid_next + +/* temp is handle, +return zero if found +return data pointer in contr +*/ +search_handle: + bpatchx patch30_2,mem_patch30 + fetch 2,mem_ui_uuid_table + iforce contr +search_handle_loop: + ifetch 1,contr + branch disable_zero,blank + lshift pdata,pdata + iadd contr,contr + ifetch 4,contr + isub temp,null + rtn zero + deposit contw + store 2,mem_contw + storet 8,mem_temp + call sdp_get_data + iadd contr,contr + copy contr,pdata + fetcht 2,mem_contw + copy temp,contw + fetcht 8,mem_temp + copy pdata,contr + branch search_handle_loop + +/** +* input regb and regc.regb is the attribute ID and regc is UUID. +* set contr if find attribute or 0 if not +*/ +search_attrib: + bpatchx patch30_3,mem_patch30 + fetch 2,mem_ui_uuid_table + iforce contr +search_attrib_next: + ifetch 1,contr + branch search_attrib_end, blank + iforce loopcnt +search_attrib_loop: + ifetch 2,contr + isub regc,null /* regc is UUID, compare it */ + branch search_attrib_found_uuid,zero + loop search_attrib_loop + increase 4,contr + call sdp_get_data + iadd contr,contr /* next paragraph */ + branch search_attrib_next +search_attrib_found_uuid: + increase -1,loopcnt + lshift loopcnt,pdata + iadd contr,contr + increase 4,contr + call sdp_get_data + iadd contr,timeup /* attribute list end */ +search_attrib_loop_attribs: + increase 1,contr + ifetch 2,contr + isub regb,null + //force 0x1,pdata,zero +// setflag zero, 0,pdata +// copy timeup, timeup + branch disable_blank,zero /* attribute found */ + call sdp_data_len + iadd contr,contr + deposit timeup + isub contr,null + branch search_attrib_end, zero /*attribute end, not found the attribute, return contr = 0*/ + branch search_attrib_loop_attribs +search_attrib_end: + force 0,contr + force 0,pdata + rtn + + +//search the attribute according the record handle +//record handle in temp, attribute in regb +//set the contr to zero if not found +search_handle_attrib: + bpatchx patch30_4,mem_patch30 + fetch 2,mem_ui_uuid_table + iforce contr +search_handle_attrib_next: + ifetch 1,contr + branch search_handle_attrib_end, blank + lshift pdata,pdata + iadd contr, contr + ifetch 4,contr + isub temp,null /* regc is UUID, compare it */ + branch search_handl_attrib_found_handle,zero + call sdp_get_data + iadd contr,contr /* next paragraph */ + branch search_handle_attrib_next +search_handl_attrib_found_handle: + call sdp_get_data + iadd contr,timeup /* attribute list end */ +search_handle_attrib_loop_attribs: + increase 1,contr + ifetch 2,contr + isub regb,null + rtn zero /* attribute found */ + call sdp_data_len + iadd contr,contr + deposit timeup + isub contr,null + branch search_handle_attrib_end, zero /*attribute end, not found the attribute, return contr = 0*/ + branch search_handle_attrib_loop_attribs +search_handle_attrib_end: + force 0,contr + rtn + + +//enable user if find rfcomm channel number, pdata is channel number +search_rfcomm_cn: + arg 0x0400,regb // attribute protocol edscriptor list + call search_handl_attrib_found_handle + arg 0x0300,regb // uuid rfcomm + call search_uuid_in_data + nrtn user + sub rega,3,null + branch disable_user,positive + ifetch 1,contr + bne 0x08,disable_user + ifetch 1,contr + rtn + + //input timeup is lenth + //input contr is data ptr + //return contr is end of uuid; enable user if found uuid +search_uuid_in_data: + bpatchx patch30_5,mem_patch30 + call sdp_get_data + copy pdata,rega +search_uuid_in_data_loop: + ifetch 1,contr + and pdata,0x7,loopcnt + rshift3 pdata,pdata + sub pdata,3,null + branch search_uuid_in_data_found_uuid,zero + copy loopcnt,pdata + beq 5,search_uuid_in_data_found_element_index5 + beq 6,search_uuid_in_data_found_element_index6 + beq 7,search_uuid_in_data_found_element_index7 + increase -1,contr + call sdp_get_data + iadd contr,contr + copy rega,pdata + isub temp,rega + branch disable_user,zero + branch search_uuid_in_data_loop + +search_uuid_in_data_found_element_index5: + increase -2,rega + increase 1,contr + branch search_uuid_in_data_loop +search_uuid_in_data_found_element_index6: + increase -3,rega + increase 2,contr + branch search_uuid_in_data_loop +search_uuid_in_data_found_element_index7: + increase -5,rega + increase 4,contr + branch search_uuid_in_data_loop + +search_uuid_in_data_found_uuid: + increase -1,rega + copy loopcnt,pdata + beq 1,search_uuid_in_data_type_uuid_16 + beq 2,search_uuid_in_data_type_uuid_32 + beq 4,search_uuid_in_data_type_uuid_128 + branch disable_user +search_uuid_in_data_type_uuid_128: + increase -12,rega +search_uuid_in_data_type_uuid_32: + ifetch 2,contr + increase -2,rega +search_uuid_in_data_type_uuid_16: + ifetch 2,contr + isub regb,null + branch enable_user,zero + increase -2,rega + branch disable_user,zero + branch search_uuid_in_data_loop + +/* +//rega:l2cap len ,mem_search_uuid:uuid to search +sdp_send_search_req: + call l2cap_malloc_sdp_req + setarg SDP_SEARCH_REQ + istore 1,contw + fetch 2,mem_sdp_transactionid_local + byteswap pdata,pdata + istore 2,contw + increase -5,rega + byteswap rega,rega + //istorer rega,2,contw + copy rega,pdata + istore 2,contw + setarg 0x0335 + istore 2,contw + setarg 0x19 + istore 1,contw + fetch 2,mem_search_uuid + istore 2,contw + setarg 0x0008 + istore 2,contw + setarg 0 + istore 1,contw + rtn + +//rega:l2cap len +sdp_send_attribute_req: + call l2cap_malloc_sdp_req + setarg SDP_ATTRIBUTE_REQ + istore 1,contw + fetch 2,mem_sdp_transactionid_local + byteswap pdata,pdata + istore 2,contw + increase -5,rega + byteswap rega,rega +// istorer rega,2,contw + copy rega,pdata + istore 2,contw + fetch 4,mem_sdp_record_handle + istore 4,contw + setarg 0x2c01 + istore 2,contw + setarg 0x0535 + istore 2,contw + setarg 0x0a + istore 1,contw + setarg 0 + istore 2,contw + setarg -1 + istore 2,contw + setarg 0 + istore 1,contw + rtn +*/ + + +sdp_send_spp_request: + call l2cap_get_sdp_tx_payload + copy pdata,contw + setarg 6//Search Attr Req + istore 1,contw + setarg sdp_tid_spp + istore 2,contw + setarg 0x0f00 //length15 + istore 2,contw + setarg 0x1a0535 + istore 3,contw + setarg 0x0111 + lshift16 pdata,pdata //UUID + istore 4,contw + setarg 0x2600 //max return len + istore 2,contw + setarg 0x0335 + istore 2,contw + setarg 0x0009 + istore 2,contw + setarg 0x0004 + istore 2,contw + jam 0x14,mem_sdp_tx_pkt_length + rtn + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/security.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/security.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/security.prog (working copy) @@ -0,0 +1,1642 @@ + +ifdef SECURE_CONNECTION + +function_g2: + bpatchx patch30_6,mem_patch30 + jam 80,mem_AES_CMAC_data_length + arg memdat,contw + arg mem_le_srand,contr + call memcpy16 + arg mem_le_pubkey_local_x_256,contr + call memcpy32 + arg mem_le_pubkey_remote_x_256,contr + call memcpy32 + call inverse_memdat + arg mem_le_mrand,contr + call store_inverse_k + call function_AES_CMAC + + arg mem_AES_CMAC_temp,contw + call load_inverse_result + setarg 1000000 + copy pdata,rega + fetch 4,mem_AES_CMAC_temp + idiv rega + call wait_div_end + remainder pdata + store 4,mem_gkey +//call ice_break + rtn + +function_f6_eb: + jam 65,mem_AES_CMAC_data_length + arg memdat,contw + call store_addr_common_a + call store_addr_common_b + fetch 3,mem_le_pres+1 + istore 3,contw +// arg mem_le_r,contr +// call memcpy16 + call get_r + + arg mem_le_mrand,contr + call memcpy16 + arg mem_le_srand,contr + call memcpy16 + call inverse_memdat + arg mem_le_mackey ,contr + arg mem_AES_CMAC_k,contw + call memcpy16 +// call p_store_inverse_k + branch function_AES_CMAC +// arg mem_AES_CMAC_temp,contw +// branch p_load_inverse_result + +get_r: + fetch 4,mem_le_tk + istore 4,contw + call memset0_4 + branch memset0_8 + +function_f6_ea: + bpatchx patch30_7,mem_patch30 + jam 65,mem_AES_CMAC_data_length + arg memdat,contw + call store_addr_common_b + call store_addr_common_a + fetch 3,mem_le_preq+1 + istore 3,contw +// arg mem_le_r,contr +// call memcpy16 + call get_r + arg mem_le_srand,contr + call memcpy16 + arg mem_le_mrand,contr + call memcpy16 + call inverse_memdat + arg mem_le_mackey ,contr + arg mem_AES_CMAC_k,contw + call memcpy16 +// call p_store_inverse_k + call function_AES_CMAC + arg mem_AES_CMAC_temp,contw + branch load_inverse_result + +function_f5: + jam 32,mem_AES_CMAC_data_length + arg mem_le_dhkey_256 ,contr + arg memdat,contw + call memcpy32 + call inverse_memdat + arg mem_le_slat,contr + call store_inverse_k + call function_AES_CMAC + arg mem_AES_CMAC_k,contw + call store_aes_result + arg 1,temp + call function_f5_common + arg mem_le_ltk,contw + call load_inverse_result + arg 0,temp + call function_f5_common + arg mem_le_mackey,contw +// branch p_load_inverse_result + branch store_aes_result + + +function_f5_common: + bpatchx patch31_0,mem_patch31 + jam 53,mem_AES_CMAC_data_length + setarg 0x100 + store 2,memdat + call store_addr_common_b + call store_addr_common_a + arg mem_le_srand,contr + call memcpy16 + arg mem_le_mrand,contr + call memcpy16 +// fetch 4,mem_le_keyid 0x62746c65 + setarg 0x6c65 + istore 2,contw + setarg 0x6274 + istore 2,contw + istoret 1,contw //counter + call inverse_memdat + branch function_AES_CMAC + +store_addr_common_b: + fetch 6,mem_le_lap + istore 6,contw + fetch 1,mem_le_conn_own_addr_type + istore 1,contw + rtn + +store_addr_common_a: + fetch 6,mem_le_plap + istore 6,contw +// setarg 0x2dcfc1 +// istore 3,contw +// setarg 0xa71370 +// istore 3,contw + fetch 1,mem_le_conn_peer_addr_type + istore 1,contw + rtn + +function_f4_ca: + jam 65,mem_AES_CMAC_data_length + fetch 1,mem_passkey_1bit + store 1,memdat + arg mem_le_pubkey_local_x_256,contr + call memcpy32 + arg mem_le_pubkey_remote_x_256,contr + call memcpy32 + call inverse_memdat + arg mem_le_mrand,contr + call store_inverse_k + branch function_AES_CMAC + + +function_f4_cb: + jam 65,mem_AES_CMAC_data_length + fetch 1,mem_passkey_1bit + store 1,memdat + arg mem_le_pubkey_remote_x_256,contr + call memcpy32 + arg mem_le_pubkey_local_x_256,contr + call memcpy32 + call inverse_memdat + arg mem_le_srand,contr + call store_inverse_k + branch function_AES_CMAC + +function_AES_CMAC: + bpatchx patch31_1,mem_patch31 + call function_AES_CMAC_Generate_Subkey +//call ice_break +// jam 65,mem_AES_CMAC_data_length +//call ice_break + fetch 1,mem_AES_CMAC_data_length + copy pdata,temp +function_ceil16: + increase 15,pdata + rshift4 pdata,pdata + copy pdata,regb + branch function_AES_CMAC_set_flag_0_balnk,blank + and temp,0x0f,pdata + nbranch function_AES_CMAC_set_flag_0,blank +// flag =1; + arg mem_AES_CMAC_k1,regc + arg memdat,pdata + increase -16,pdata +// iadd temp,pdata +// isub rega,rega + iadd temp,rega + arg mem_AES_CMAC_M_last,contw + arg 4,loopcnt + call xor_loop +//call ice_break +// arg mem_f4_k1,contr +// call load_key + branch function_AES_CMAC_aes + +function_AES_CMAC_set_flag_0_balnk: + arg 1,regb + arg 0,rega +// arg mem_f4_test_data,pdata + branch function_AES_CMAC_set_flag_0_common +//call ice_break + +function_AES_CMAC_set_flag_0: +// flag = 0; + and temp,0x0f,rega +function_AES_CMAC_set_flag_0_common: + arg memdat,pdata + iadd temp,pdata + isub rega,contr +//call ice_break + arg mem_AES_CMAC_temp,contw + call function_AES_CMAC_padding +//call ice_break + arg mem_AES_CMAC_k2,regc + arg mem_AES_CMAC_temp,rega + arg mem_AES_CMAC_M_last,contw + arg 4,loopcnt + call xor_loop +//call ice_break + +// arg mem_f4_k2,contr +// call load_key + +// branch p_function_f4_aes +function_AES_CMAC_aes: +// arg mem_f4_k,contr +// call load_key +// arg mem_AES_CMAC_xor,contr +// call load_data128 + call aes_clear_data + call aes_init +// arg mem_f4_k,contr +// call load_key + arg memdat,contr +function_AES_CMAC_aes_loop: +//generate_mic_loop: + increase -1,regb + deposit regb + branch function_AES_CMAC_aes_loop_end,blank + call load_data128 + call do_aes_cbc + branch function_AES_CMAC_aes_loop +//generate_mic_end: +function_AES_CMAC_aes_loop_end: + arg mem_AES_CMAC_temp,contw + call store_aes_result + arg mem_AES_CMAC_M_last,contr + call load_data128 + call aes_init + arg mem_AES_CMAC_temp,contr + call load_data128 + branch do_aes_cbc + + + +load_inverse_result: +// arg mem_AES_CMAC_temp,contw + copy contw,rega + call store_aes_result +// arg mem_AES_CMAC_temp,rega + arg 16,loopcnt + branch inverse_data + +store_inverse_k: + arg mem_AES_CMAC_k,contw + call memcpy16 +inverse_k: + arg 16,loopcnt + arg mem_AES_CMAC_k,rega + branch inverse_data + +inverse_memdat: + fetch 1,mem_AES_CMAC_data_length + copy pdata,loopcnt + arg memdat,rega + branch inverse_data + +bn_lshift_0_inverse: + ifetch 1,regA + lshift pdata,pdata + isolate1 0,regC + setflag true,0,pdata + isolate1 8,pdata + setflag true,0,regC + istore 1,rega + increase -1,rega + loop bn_lshift_0_inverse + rtn + +function_AES_CMAC_k1_inverse: + arg mem_AES_CMAC_k1,regA +function_AES_CMAC_inverse_common: + increase 15,rega + force 16,loopcnt + force 0,regC + branch bn_lshift_0_inverse + +function_AES_CMAC_k2_inverse: + arg mem_AES_CMAC_k2,regA + branch function_AES_CMAC_inverse_common + + +function_AES_CMAC_Generate_Subkey: + arg mem_AES_CMAC_k,contr + call load_key128 +// arg mem_AES_CMAC_xor,contr +// call aes_load_xor + force regidx_xor,regext_index + call aes_clear + call aes_clear_data + + call do_aes_ecb + +// force 0x38,aes_ctrl +// force 0x0,aes_ctrl +// call wait_aes + arg mem_AES_CMAC_k1,contw + call store_aes_result +function_AES_CMAC_k1: + bpatchx patch31_2,mem_patch31 + fetch 1,mem_AES_CMAC_k1 + isolate1 7,pdata + nbranch function_AES_CMAC_k1_0,true + call function_AES_CMAC_k1_inverse + +//p_function_f4_k1_xor: + arg mem_AES_CMAC_k1,regc +// arg mem_AES_CMAC_rb,rega + arg mem_AES_CMAC_k1,contw +// arg 3,loopcnt +// call xor_loop + call function_AES_CMAC_xor_rb + branch function_AES_CMAC_k2 +function_AES_CMAC_k1_0: + call function_AES_CMAC_k1_inverse +function_AES_CMAC_k2: +//call ice_break + arg mem_AES_CMAC_k1,contr + arg mem_AES_CMAC_k2,contw + call memcpy16 + fetch 1,mem_AES_CMAC_k2 + isolate1 7,pdata + nbranch function_AES_CMAC_k2_inverse,true + call function_AES_CMAC_k2_inverse +//p_function_f4_k2_xor: + arg mem_AES_CMAC_k2,regc +// arg mem_AES_CMAC_rb,rega + arg mem_AES_CMAC_k2,contw +// arg 3,loopcnt +// branch xor_loop + + +//rb:00 00 00 00 00 00 00 00 00 00 00 00 00 00 00 87 +function_AES_CMAC_xor_rb: + arg 3,loopcnt +function_AES_CMAC_xor_rb_loop: + arg 0,temp + call function_AES_CMAC_xor_loop_common + increase 4,regc + loop function_AES_CMAC_xor_rb_loop + arg 0x8700,temp + lshift16 temp,temp +function_AES_CMAC_xor_loop_common: + ifetch 4,regc + ixor temp,pdata + istore 4,contw + rtn + + + + +//input rega :length <16 contr,contw +function_AES_CMAC_padding: + bpatchx patch31_3,mem_patch31 + arg 16,loopcnt + arg 0,pdata +function_AES_CMAC_padding_loop: + isub rega,null + branch function_AES_CMAC_padding_beq_length,zero + branch function_AES_CMAC_padding_big_length,positive + ifetcht 1,contr + istoret 1,contw +function_AES_CMAC_padding_loop2: + increase 1,pdata + loop function_AES_CMAC_padding_loop + rtn +function_AES_CMAC_padding_beq_length: + arg 0x80,temp +function_AES_CMAC_padding_common: + istoret 1,contw + branch function_AES_CMAC_padding_loop2 + +function_AES_CMAC_padding_big_length: + arg 0,temp + branch function_AES_CMAC_padding_common + +endif + +generate_kinit: + call function_e22 + arg mem_input_store,contr + arg mem_kinit,contw /* Kinit is ready */ + branch memcpy16 + + +function_e21: /* rega pointers to bdaddr */ + disable user + call function_expand + arg mem_random_number,contr + arg mem_x,contw + force 15,loopcnt + call memcpy + ifetch 1,contr + xor_into 6,pdata + istore 1,contw + setarg mem_y + store 2,memp_ar_input + setarg mem_x + store 2,memp_ar_key + set1 mark_ar2,mark + branch function_ar + + + +function_e22: /* rega pointers to bdaddr */ + fetcht 1,mem_pin_length + force 16,regb /* total 16 bytes */ + add temp,6,regc /* regc is l' */ + sub regc,16,null + branch function_e22_pin_init,positive + force 16,regc +function_e22_pin_init: /* generate x from pin and bdaddr */ + arg mem_x,contw +function_e22_genx_pin: + arg mem_pin,contr + copy temp,loopcnt + disable user +function_e22_genx_loop: + ifetch 1,contr + istore 1,contw + increase -1,regb + branch function_e22_genx_end,zero + loop function_e22_genx_loop + branch function_e22_genx_pin,user + enable user + force 6,loopcnt + copy rega,contr + branch function_e22_genx_loop +function_e22_genx_end: + arg mem_random_number,contr + arg mem_y,contw + call memcpy16 + fetch 1,mem_y15 + ixor regc,pdata + store 1,mem_y15 /* inpy[15] = rand_num[15]^l'; */ + setarg mem_y + store 2,memp_ar_input + setarg mem_x + store 2,memp_ar_key + set1 mark_ar2,mark + branch function_ar + + + + +function_e1: /* rega pointers to bdaddr */ + disable user + call function_expand + branch function_hash + +function_e3: + arg mem_aco,rega + enable user + call function_expand + call function_hash + arg mem_input_store,contr + arg mem_kc,contw + branch memcpy16 + + /* costs 41769 clocks */ +function_hash: + setarg mem_random_number + store 2,memp_ar_input + setarg mem_link_key + store 2,memp_ar_key + set0 mark_ar2,mark + call function_ar + arg mem_input_store,rega + arg mem_random_number,regb + arg mem_x,contw + call xor16 + arg mem_x,rega + arg mem_y,regb + copy regb,contw + enable user + call add16 + call key_offset + setarg mem_y + store 2,memp_ar_input + setarg mem_x + store 2,memp_ar_key + set1 mark_ar2,mark + branch function_ar + + + /* totally costs 20700 clocks */ +function_ar: + jam 0,mem_ar_hround + fetch 2,memp_ar_key + iforce contr + arg mem_key_store,contw + call memcpy16 + fetch 2,memp_ar_input + iforce contr + arg mem_input_store,contw + call memcpy16 + +function_ar_loop: + call key_scheduling + disable user + bmark0 mark_ar2,function_ar_original + fetch 1,mem_ar_hround + bne 4,function_ar_original + fetchr regb,2,memp_ar_input + call xor_mod32_ar2 +function_ar_original: + call xor_mod32 + call el_boxes + fetch 1,mem_ar_hround + increase 1,pdata + store 1,mem_ar_hround + + call key_scheduling + enable user + call xor_mod32 + call pht + call permute + call pht + call permute + call pht + call permute + call pht + fetch 1,mem_ar_hround + increase 1,pdata + store 1,mem_ar_hround + bne 16,function_ar_loop + call key_scheduling + disable user + branch xor_mod32 + +/* input round number and temp key in mem_key_store, and output the next temp key in mem_key_store */ +/* round key is generated and store in mem_round_key */ +key_scheduling: + fetch 1,mem_ar_hround + arg mem_key_store,contr + branch key_sched_zero,blank + iforce regb /* regb is half round */ + force 17,loopcnt + copy contr,contw +key_rotateloop: + ifetch 1,contr + lshift3 pdata,temp + rshift2 pdata,pdata + rshift3 pdata,pdata + ior temp,pdata + istore 1,contw + loop key_rotateloop + setarg mem_key_store + iadd regb,contr + force 16,loopcnt + arg mem_round_key,contw +key_select_octet_loop: + ifetch 1,contr + istore 1,contw + compare mem_key_store_end,contr,0xff + nbranch key_select_octet_nwrap,true + increase -17,contr +key_select_octet_nwrap: + loop key_select_octet_loop + force 0,rega /* rega is index of octet within row */ + add regb,-1,regc /* this is the row index, half_round#1 is 0 */ + lshift2 regc,regc + lshift2 regc,regc + call enable_authrom + setarg mem_b_box + iadd regc,regc /* regc hold the starting address of the row */ + arg mem_round_key,contw + force 16,loopcnt +bias_round_key_loop: + ifetcht 1,regc + ifetch 1,contw + iadd temp,pdata + istore 1,contw + increase 1,regc + loop bias_round_key_loop + branch disable_authrom + +key_sched_zero: /* round 0, key1 */ + force 16,loopcnt + force 0,temp +create_byte_16_loop: + ifetch 1,contr + ixor temp,temp + loop create_byte_16_loop + deposit temp + istore 1,contr /* store the byte #16 */ + arg mem_key_store,contr + arg mem_round_key,contw + branch memcpy16 + +xor_mod32: /* xor on 0,3, add on 1,2. if user is set, invert. x in rega and y in regb, out in contw */ + arg mem_round_key,regb +xor_mod32_ar2: + force 16,loopcnt + arg mem_input_store,rega + copy rega,contw +xor_mod32_loop: + ifetcht 1,rega + ifetch 1,regb + ixor temp,alarm + and loopcnt,3,regc + nbranch xor_mod32_invert,user + xor_into 3,regc +xor_mod32_invert: + sub regc,1,regc + branch xor_even,positive + iadd temp,alarm +xor_even: + istorer alarm,1,contw + increase 1,rega + increase 1,regb + loop xor_mod32_loop + rtn + +el_boxes: + call enable_authrom + force 16,loopcnt + arg mem_input_store,rega +el_box_loop: + ifetch 1,rega + arg mem_e_box,contr + and loopcnt,3,regc + sub regc,1,null + branch e_boxes,positive + arg mem_l_box,contr +e_boxes: + iadd contr,contr + ifetch 1,contr + istore 1,rega + increase 1,rega + loop el_box_loop + branch disable_authrom + +pht: + force 8,loopcnt + arg mem_input_store,contr + copy contr,contw +pht_loop: + ifetchr rega,1,contr + ifetchr regb,1,contr + lshift rega,pdata + iadd regb,pdata + istore 1,contw + deposit rega + iadd regb,pdata + istore 1,contw + loop pht_loop + rtn + +/* 8 11 12 15 2 1 6 5 10 9 14 13 0 7 4 3 */ +permute: + setarg 0x8ae42c + iforce temp + force 7,loopcnt + call permute_exchange + setarg 0xd751b + iforce temp + force 5,loopcnt + call permute_exchange + fetchr rega,1,mem_input_store+15 + fetch 1,mem_input_store+3 + store 1,mem_input_store+15 + storer rega,1,mem_input_store+3 + rtn + +permute_exchange: + and temp,0xf,regb +permute_loop: + and temp,0xf,pdata + arg mem_input_store,contw + iadd contw,contw + ifetchr regc,1,contw + istorer rega,1,contw + copy regc,rega + rshift4 temp,temp + loop permute_loop + setarg mem_input_store + iadd regb,contw + istorer rega,1,contw + rtn + +add16: + enable user + branch xor_add16 + +xor16: + disable user +xor_add16: /* if user is set, do add, else do xor */ + force 16,loopcnt /* rega and regb pointers to src, contw is result */ +xoradd_loop: + ifetcht 1,rega + ifetch 1,regb + branch xoradd_add,user + ixor temp,pdata + branch xoradd_store +xoradd_add: + iadd temp,pdata +xoradd_store: + istore 1,contw + increase 1,rega + increase 1,regb + loop xoradd_loop + rtn + + +function_expand: /* rega pointers to bdaddr, or aco and user is set */ + arg mem_y,contw + ifetch 6,rega + istore 6,contw + branch expand_12,user + ifetch 6,rega + branch expand_cont +expand_12: + ifetch 6,contr +expand_cont: + istore 6,contw + ifetch 4,rega + istore 4,contw + rtn + +key_offset: + arg mem_link_key,contr + arg mem_x,contw + arg 0,temp + setarg 0x8395a7 + call concatenate_temp24 + setarg 0xb3c1df + call concatenate_temp24 + setarg 0xe5e9 + call concatenate_temp16 + copy temp,regab + disable user + call key_addxor + copy regab,temp + enable user + branch key_addxor + +key_addxor: + force 8,loopcnt +key_addxor_loop: + ifetch 1,contr + compare 1,loopcnt,1 + branch key_high,user + branch key_xor,true +key_add: + iadd temp,pdata + branch key_store +key_high: + branch key_add,true +key_xor: + ixor temp,pdata +key_store: + istore 1,contw + rshift8 temp,temp + loop key_addxor_loop + rtn + +copy_aco: + fetch 6,mem_input_store+4 + store 6,mem_aco + ifetch 6,contr + istore 6,contw + rtn + +concatenate_temp24: + lshift8 temp,temp +concatenate_temp16: + lshift16 temp,temp + ior temp,temp + rtn + +ifdef TESTING +test_security: + fetch 1,0xff + branch test_security,blank + + /* inrand */ + setarg 0x1BC683 + store 3,0x0 + setarg 0x122980 + istore 3,contw + setarg 0xD0DB17 + istore 3,contw + setarg 0x2B1D78 + istore 3,contw + setarg 0x2743A6 + istore 3,contw + setarg 0xD8 + istore 1,contw + + /* comb A */ + setarg 0xA6D0C9 + store 3,0x10 + setarg 0xA9E86C + istore 3,contw + setarg 0x9E89D5 + istore 3,contw + setarg 0xC61838 + istore 3,contw + setarg 0x6F0318 + istore 3,contw + setarg 0x9F + istore 1,contw + + /* comb B */ + setarg 0x7F6833 + store 3,0x20 + setarg 0xE62E1B + istore 3,contw + setarg 0x9F67FC + istore 3,contw + setarg 0x8D3712 + istore 3,contw + setarg 0x0B846C + istore 3,contw + setarg 0x4A + istore 1,contw + + /* auth rand A */ + setarg 0xFBB686 + store 3,0x30 + setarg 0x19FE7F + istore 3,contw + setarg 0x16A439 + istore 3,contw + setarg 0xF4F6A4 + istore 3,contw + setarg 0x10D61D + istore 3,contw + setarg 0xDE + istore 1,contw + + /* auth rand B */ + setarg 0x735B0C + store 3,0x40 + setarg 0xA7F06B + istore 3,contw + setarg 0x04625E + istore 3,contw + setarg 0x3463B0 + istore 3,contw + setarg 0xB8F17A + istore 3,contw + setarg 0x7C + istore 1,contw + + /* address A */ + setarg 0xf91330 + store 3,0xb0 + setarg 0x664c7d + istore 3,contw + + /* address B */ + setarg 0xdc7100 + store 3,0xb8 + setarg 0x2ea003 + istore 3,contw + + /* sres A */ + setarg 0x2EEE19 + store 3,0x50 + setarg 0x7E + istore 1,contw + + /* sres B */ + setarg 0x4231A4 + store 3,0x58 + setarg 0xD1 + istore 1,contw + + /* linkA */ + setarg 0xa6a026 + store 3,0x60 + setarg 0x2569d2 + istore 3,contw + setarg 0xab4a9d + istore 3,contw + setarg 0x5e87c0 + istore 3,contw + setarg 0x792aa9 + istore 3,contw + setarg 0x4b + istore 1,contw + + /* linkB */ + setarg 0xa1f07d + store 3,0x70 + setarg 0xec97a6 + istore 3,contw + setarg 0xae31eb + istore 3,contw + setarg 0x6fe3c4 + istore 3,contw + setarg 0xa1ae1a + istore 3,contw + setarg 0x3a + istore 1,contw + + /* linkkey */ + setarg 0x07505b + store 3,0x80 + setarg 0xc9fe74 + istore 3,contw + setarg 0x057b76 + istore 3,contw + setarg 0x316404 + istore 3,contw + setarg 0xd884b3 + istore 3,contw + setarg 0x71 + istore 1,contw + + /* K */ + setarg 0x0c333f + store 3,0x90 + setarg 0x41de70 + istore 3,contw + setarg 0x9b05a2 + istore 3,contw + setarg 0xb954a2 + istore 3,contw + setarg 0xb37516 + istore 3,contw + setarg 0x36 + istore 1,contw + + /* kinit */ + setarg 0x5ff91a + store 3,0xa0 + setarg 0x39b5a4 + istore 3,contw + setarg 0x258f2d + istore 3,contw + setarg 0x5d4a85 + istore 3,contw + setarg 0x656ad3 + istore 3,contw + setarg 0xab + istore 1,contw + + arg 0,contr + arg mem_random_number,contw + call memcpy16 + setarg 0x3131 + store 2,mem_pin + istore 2,contw + jam 4,mem_pin_length + arg 0xb8,rega + call function_e22 + arg mem_input_store,contr + arg mem_kinit,contw + call memcpy16 + arg 0x10,rega + arg mem_kinit,regb + arg mem_random_number,contw + call xor16 + arg 0xb0,rega + call function_e21 + arg 0x60,regb + call compare16 +error_lka: + nbranch error_lka,zero + arg mem_input_store,contr + arg mem_link_key,contw + call memcpy16 + arg 0x20,rega + arg mem_kinit,regb + arg mem_random_number,contw + call xor16 + arg 0xb8,rega + call function_e21 + arg 0x70,regb + call compare16 +error_lkb: + nbranch error_lkb,zero + arg mem_input_store,rega + arg mem_link_key,regb + arg mem_link_key,contw + call xor16 + arg 0x30,contr + arg mem_random_number,contw + call memcpy16 + arg 0xb8,rega + call function_e1 + arg 0x50,regb + force 4,loopcnt + call compare_key +error_sresa: + nbranch error_sresa,zero + arg 0x40,contr + arg mem_random_number,contw + call memcpy16 + arg 0xb0,rega + call function_e1 + arg 0x58,regb + force 4,loopcnt + call compare_key +error_sresb: + nbranch error_sresb,zero + branch loop1 + + arg 0,contr + arg mem_random_number,contw + call memcpy16 + force 12,loopcnt + call memcpy + arg 0x1c,contr + arg mem_link_key,contw + call memcpy16 + arg 0x10,rega + call function_e3 + branch loop1 + +compare16: + force 16,loopcnt +compare_key: + arg mem_input_store,rega +compare_loop: + ifetch 1,rega + ifetcht 1,regb + isub temp,null + nrtn zero + increase 1,rega + increase 1,regb + loop compare_loop + force 0,pdata + rtn + +endif + + +loop1: + branch loop1 + +/* ==================== LE security ================= */ + +generate_stk: + bpatchx patch31_4,mem_patch31 + call function_s1 + arg mem_le_ltk,contw + branch store_aes_result + + /* contr = rand pointer */ +authenticate_rconfirm: + arg mem_le_srand,contw + branch authenticate_mconfirm,master + arg mem_le_mrand,contw +authenticate_mconfirm: + copy contr,rega + call memcpy16 + call function_c1 + arg mem_le_rconfirm,contr + branch compare_res + +generate_confirm: + arg mem_le_mrand,rega + branch generate_mrand,master + arg mem_le_srand,rega +generate_mrand: + copy rega,contw + call generate_random + branch function_c1 + +generate_sk: + arg mem_le_skdm,contr + call load_data128 + arg mem_le_ltk,contr + call load_key128 + force aes_big_endian | aes_load,aes_ctrl + force 0,aes_ctrl // change result to little endian + call wait_aes + arg mem_le_sk,contw + branch store_aes_result + + /* temp=packet counter, rega = length or block counter*/ +first_block_counter: + force 0x49,pdata + branch first_block +first_block_data: + force 1,pdata +first_block: + force regidx_data,regext_index /* B0 */ + lshift8 temp,regext + ior regext,regext + increase 1,regext_index + rshift8 temp,regext + rshift16 regext,regext + fetch 2,mem_le_ivm + lshift16 pdata,pdata + ior regext,regext /* octet3&octet4 of counter and low 16 bit of IV */ + increase 1,regext_index + ifetch 4,contr /* IV2-IV5 */ + iforce regext + increase 1,regext_index + ifetch 2,contr /* IV6-IV7 */ + byteswap rega,regext + lshift16 regext,regext + ior regext,regext + increase 1,regext_index + rtn + + + /* temp=packet counter, regc pointers to header, return mic in regb */ +generate_mic: + add regc,1,contr + ifetchr rega,1,contr + call first_block_counter + call do_aes_ecb + + force regidx_data,regext_index /* B1 */ + ifetch 1,regc + and_into 0x3,pdata + lshift16 pdata,regext + set1 8,regext + call clear_hidata + call do_aes_cbc + + copy rega,loopcnt + add regc,2,contr + call padding_data +generate_mic_loop: + call aes_load_data + call do_aes_cbc + deposit loopcnt + branch generate_mic_end,blank + branch generate_mic_loop +generate_mic_end: + force regidx_result,regext_index + copy regext,regb + storer regb,4,mem_le_mic + rtn + +aes_crypt_data: + increase 1,rega + call first_block_data + call aes_init + copy regc,contr + call load_data128 + call do_aes_cfb + call store_enc_data + increase 16,regc + increase -16,regb + branch aes_crypt_data,positive + rtn + +le_encrypt: + bpatchx patch31_5,mem_patch31 + arg mem_le_txheader,regc + fetcht 5,mem_le_pcnt_tx + call generate_mic + force 0,rega + call first_block_data + call aes_init + force regidx_data,regext_index + copy regb,regext + call do_aes_cfb + arg mem_le_txpayload,regc + fetch 1,mem_le_txlen + add pdata,-1,regb + iadd regc,contw + force regidx_result,regext_index + istorer regext,4,contw + force 0,rega /* rega is block counter */ + call aes_crypt_data + fetch 1,mem_le_txlen + increase 4,pdata + store 1,mem_le_txlen + fetcht 5,mem_le_pcnt_tx + increase 1,temp + storet 5,mem_le_pcnt_tx + rtn + +le_decrypt: + fetcht 5,mem_le_pcnt_rx + force 0,rega + call first_block_data + call aes_init + fetch 1,mem_le_rxbuf+1 + arg mem_le_rxbuf+2,regc + add pdata,-1,regb + increase -4,pdata /* mic will be discarded */ + store 1,mem_le_rxbuf+1 + iadd regc,contr + force regidx_data,regext_index + ifetchr regext,4,contr + call do_aes_cfb + force regidx_result,regext_index + storer regext,4,mem_le_peer_mic + force 0,rega /* rega is block counter */ + call aes_crypt_data + arg mem_le_rxbuf,regc + call generate_mic + fetch 4,mem_le_peer_mic + isub regb,pdata /* MIC ok? */ + nrtn blank + fetch 4,mem_le_last_mic /* reduntdant packet? */ + isub regb,pdata + rtn blank + storet 4,mem_le_last_mic + fetch 5,mem_le_pcnt_rx + increase 1,pdata + store 5,mem_le_pcnt_rx + force 0,pdata + rtn + +wait_aes: + nbranch wait_aes,aes_ready + rtn + + +do_aes_ecb256: + force aes_load | aes_256,aes_ctrl + force aes_256,aes_ctrl + branch wait_aes + +do_aes_ecb192: + force aes_load | aes_192,aes_ctrl + force aes_192,aes_ctrl + branch wait_aes + +do_aes_ecb: + force aes_load,aes_ctrl + force 0,aes_ctrl + branch wait_aes + + +do_aes_cbc: + force aes_load | aes_cbc,aes_ctrl + force 0,aes_ctrl + branch wait_aes + +do_aes_cfb: + force aes_load | aes_cfb,aes_ctrl + force aes_cfb,aes_ctrl + branch wait_aes + +do_aes_ecb_be: + force aes_big_endian | aes_load,aes_ctrl + force aes_big_endian,aes_ctrl + branch wait_aes + +do_aes_cbc_be: + force aes_big_endian | aes_load | aes_cbc,aes_ctrl + force aes_big_endian,aes_ctrl + branch wait_aes + + +aes_init: + force aes_initialize,aes_ctrl + force 0,aes_ctrl + rtn + +function_s1: + force regidx_data,regext_index + fetch 4,mem_le_mrand + iforce regext + increase 1,regext_index + ifetch 4,contr + iforce regext + increase 1,regext_index + fetch 4,mem_le_srand + iforce regext + increase 1,regext_index + ifetch 4,contr + iforce regext + increase 1,regext_index + call aes_clear + increase -4,regext_index + fetch 4,mem_le_tk + copy pdata,regext + branch do_aes_ecb_be + + /* rega pointers to random number */ +function_c1: + copy rega,contr + call load_data128 // load r + force aes_big_endian | aes_initialize,aes_ctrl + force 0,aes_ctrl + fetch 1,mem_le_conn_peer_addr_type + fetcht 1,mem_le_adv_own_addr_type + nbranch function_c1_irat,master + fetch 1,mem_le_conn_own_addr_type + fetcht 1,mem_le_conn_peer_addr_type +function_c1_irat: + store 1,mem_le_iat + storet 1,mem_le_rat + arg mem_le_iat,contr + call load_data128 // load p1 + call aes_clear + increase -4,regext_index + fetch 4,mem_le_tk + copy pdata,regext + force aes_big_endian | aes_cbc | aes_load,aes_ctrl + force aes_big_endian,aes_ctrl + fetch 6,mem_le_lap + fetcht 6,mem_le_plap + branch function_c1_master,master + fetch 6,mem_le_plap + fetcht 6,mem_le_lap +function_c1_master: + force regidx_data,regext_index + copy temp,regext + increase 1,regext_index + rshift32 temp,regext + lshift16 pdata,pdata + ior regext,regext + increase 1,regext_index + rshift32 pdata,regext + increase 1,regext_index + force 0,regext /* p2 = ia || ra */ + branch do_aes_cbc_be + + +padding_data: + compare 0,loopcnt,3 + rtn true + deposit contr + iadd loopcnt,contw + force 0,pdata +padding_loop: + istore 1,contw + increase 1,loopcnt + compare 0,loopcnt,3 + rtn true + branch padding_loop + +aes_load_data: + force regidx_data,regext_index +load_data_loop: + deposit loopcnt + branch load_data_padding,blank + ifetch 4,contr + increase -4,loopcnt +load_data_padding: + iforce regext + increase 1,regext_index + compare regidx_key,regext_index,0xf + rtn true + branch load_data_loop + +load_key256: + force 8,loopcnt + branch load_key +load_key192: + force 6,loopcnt + branch load_key +load_key128: + force 4,loopcnt +load_key: + force regidx_key,regext_index + branch load_regext_loop +load_data128: + force regidx_data,regext_index + force 4,loopcnt +load_regext_loop: +// ifetchr regext,4,contr + ifetch 4,contr + icopy regext + increase 1,regext_index + loop load_regext_loop + rtn + + +load_sk: + arg mem_le_sk,contr + branch load_key128 + +clear_hidata: + force 4,loopcnt + branch clear_data_rest + +aes_clear_data: + force regidx_data,regext_index +aes_clear: + force 4,loopcnt +clear_loop: + force 0,regext +clear_data_rest: + increase 1,regext_index + loop clear_loop + rtn + +store_aes_result: + force regidx_result,regext_index + force 4,loopcnt +send_aes_result_loop: + deposit regext + istore 4,contw + increase 1,regext_index + loop send_aes_result_loop + rtn + +store_enc_data: + force regidx_result,regext_index + copy regc,contw + add regb,1,loopcnt + sub loopcnt,15,null + branch store_enc_loop,positive + force 16,loopcnt +store_enc_loop: + deposit regext + sub loopcnt,3,null + branch store_enc_byte,positive + istore 4,contw + increase -4,loopcnt + rtn zero + increase 1,regext_index + branch store_enc_loop +store_enc_byte: + istore 1,contw + rshift8 pdata,pdata + loop store_enc_byte + rtn + + /* contr pointers to value to be compared */ +compare_res: + force regidx_result,regext_index + force 4,loopcnt +compare_res_loop: + ifetch 4,contr + isub regext,null + nrtn zero + increase 1,regext_index + loop compare_res_loop + force 0,null + rtn + +enable_authrom: + fetch 1,core_config + set1 CLOCK_ON_AUTH_ROM,pdata + store 1,core_config + rtn + +disable_authrom: + fetch 1,core_config + set0 CLOCK_ON_AUTH_ROM,pdata + store 1,core_config + rtn + +init_memp: + arg mem_p,contw + setsect 0,0x3ffff + setsect 1,0x3ffff + setsect 2,0x3ffff + setsect 3,0x3fbff + istore 9,contw + setsect 0,0x3ffff + setsect 1,0x3ffff + setsect 2,0x3ffff + setsect 3,0x3ffff + istore 9,contw + setsect 0,0x3ffff + setsect 1,0x3ffff + setsect 2,0x3cfff + setsect 3,0x3ffff + istore 9,contw + setsect 0,0x3ffff + setsect 1,0x3ffff + setsect 2,0x3ffef + setsect 3,0x3ffff + istore 9,contw + setsect 0,0x3ffff + setsect 1,0x3ffff + setsect 2,0x3ffff + setsect 3,0x3ffff + istore 9,contw + setsect 0,0x3ffff + setsect 1,0x26c7f + setsect 2,0x146b + setsect 3,0x37bb3 + istore 9,contw + setsect 0,0x1feb8 + setsect 1,0x10c12 + setsect 2,0x2b722 + setsect 3,0x29fa6 + istore 9,contw + setsect 0,0xe70f + setsect 1,0x16720 + setsect 2,0x519e + setsect 3,0x19084 + istore 9,contw + setsect 0,0x31012 + setsect 1,0x360bf + setsect 2,0x3f0af + setsect 3,0x3d3 + istore 9,contw + setsect 0,0x3a188 + setsect 1,0x3ad0 + setsect 2,0x3cbf2 + setsect 3,0x243d9 + istore 9,contw + setsect 0,0x2b030 + setsect 1,0x36a03 + setsect 2,0x11188 + setsect 3,0x1e520 + istore 9,contw + setsect 0,0x3a11e + setsect 1,0xfe5d + setsect 2,0xdd57 + setsect 3,0x1ac93 + istore 9,contw + setsect 0,0x11ed + setsect 1,0x218c4 + setsect 2,0x8da7 + setsect 3,0x257ff + istore 9,contw + setsect 0,0x3192b + setsect 1,0x34641 + setsect 2,0x1be0c + setsect 3,0x366ad + istore 9,contw + setsect 0,0x1f83 + setsect 1,0x15a23 + setsect 2,0x3f9b0 + setsect 3,0x3949 + istore 9,contw + setsect 0,0x13a51 + setsect 1,0x153fd + setsect 2,0x3372a + setsect 3,0xf1bb + istore 9,contw + setsect 0,0x3ae85 + setsect 1,0x1eed9 + setsect 2,0x9e66 + setsect 3,0x1a8 + istore 8,contw + rtn + +ifdef SECURE_CONNECTION + + +init_memp_256: + arg mem_p_256,contw + setsect 0,0x3ffff + setsect 1,0x3ffff + setsect 2,0x3ffff + setsect 3,0x3ffff + istore 9,contw + setsect 0,0x3ffff + setsect 1,0x3f + setsect 2,0x0 + setsect 3,0x0 + istore 9,contw + setsect 0,0x0 + setsect 1,0x0 + setsect 2,0x1000 + setsect 3,0x0 + istore 9,contw + setsect 0,0x3ff00 + setsect 1,0x3ffff + setsect 2,0x3ffcf + setsect 3,0x3ffff + istore 9,contw + setsect 0,0x3ffff + setsect 1,0x3ffff + setsect 2,0x3ffff + setsect 3,0x3ff + istore 9,contw + setsect 0,0x0 + setsect 1,0x0 + setsect 2,0x0 + setsect 3,0x0 + istore 9,contw + setsect 0,0x10000 + setsect 1,0x0 + setsect 2,0x3f000 + setsect 3,0x3ffff + istore 9,contw + setsect 0,0x296ff + setsect 1,0x22630 + setsect 2,0x3945d + setsect 3,0x3d284 + istore 9,contw + setsect 0,0x333a0 + setsect 1,0x4b7a + setsect 2,0x37d8 + setsect 3,0x3c9dc + istore 9,contw + setsect 0,0x3a440 + setsect 1,0x1b958 + setsect 2,0x38bce + setsect 3,0x1091f + istore 9,contw + setsect 0,0x2e12c + setsect 1,0x1f47c + setsect 2,0x356b1 + setsect 3,0x2fd47 + istore 9,contw + setsect 0,0x6837 + setsect 1,0x2ed90 + setsect 2,0x1ecec + setsect 3,0x1acc5 + istore 9,contw + setsect 0,0x23357 + setsect 1,0x18af3 + setsect 2,0xf9e1 + setsect 3,0x129f0 + istore 9,contw + setsect 0,0x2e7eb + setsect 1,0x3e6e3 + setsect 2,0x3e1a7 + setsect 3,0x10b8b + istore 9,contw + setsect 0,0x24fe3 + setsect 1,0x20ef + setsect 2,0x1b5a6 + setsect 3,0xdc2f + istore 9,contw + setsect 0,0x13860 + setsect 1,0x2bd69 + setsect 2,0x391a + setsect 3,0x1b222 + istore 9,contw + rtn +endif + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/sim.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/sim.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/sim.prog (working copy) @@ -0,0 +1,222 @@ +simstart: +// call sim_qspi + force 8,radio_ctrl + force 0,radio_ctrl + jam 0xe0,0x8907 // set if_phase=7 for simulation environment + jam 0xe0,0x890a + jam 0x25,0x8912 + jam 0xff,rfen_ck + jam 0x5,core_clksel + setarg 0x100 + store 2,core_sec_readdr + arg 0x133,contru + ifetch 1,contru + fetch 1,core_config +// jam 5,core_clksel +// call sim_dac +// call sim_cvsd + branch sim_lpm +// branch sim_aes +// branch sim_clk + branch sim_ahb +// call sim_adcd +// branch sim_assert +// call sim_aes +// branch test_tx +// branch sim_le +// branch sim_250k +// branch sim_clk +// branch sim_c1 +// branch loop + branch sim_main + +sim_assert: + branch sim_assert + +sim_ahb: + call wait_sec_powerup + arg 0xf,addhi + setarg 0 + store 3,0x10 + store 1,0x18532 +testbus_loop: + arg 0xf,addhi + fetch 1,0x18532 + fetcht 1,0x10 + isub temp,null + nbranch assert,zero + increase 1,pdata + store 1,0x10 + store 1,0x18532 + arg 0x100,addhi + fetcht 3,0x10091 + setarg 0x584049 + isub temp,null + nbranch assert,zero + branch testbus_loop + + +sim_main: + call init_param + setarg 0xff00 + store 2,core_lpm_reg+2 + jam lpmreg_sel_ctrl2,core_lpm_wr + jam 4,core_config + fetch 1,0x87ff + beq 1,sim_slave + jam dvc_op_hci,mem_device_option + fetch 6,mem_lap + store 6,mem_hci_plap + setarg 0xbdbdbd + store 3,mem_lap + istore 3,contw + jam hci_cmd_create_conn,mem_hci_cmd + force 0x10,pdata + add pdata,-2,clkn_bt + store 4,mem_page_clk + rshift clkn_bt,pdata + store 4,mem_last_clkn + jam 0,mem_scan_mode +sim_loop: + call idle_dispatch + fetch 1,mem_context + bbit0 state_inconn,sim_skip + set1 mark_tx_l2cap,mark + fetch 1,mem_context + coffset_state_map + set1 smap_edr,pdata + store 1,mem_context + coffset_state_map + fetch 1,mem_context + coffset_op + set1 op_txl2cap,pdata + store 1,mem_context + coffset_op + jam 0,mem_context + coffset_lmp_to_send + jam 0,mem_lmo_opcode2 + setarg 700 + store 2,mem_tx_len + setarg mem_tmp_buffer + store 2,mem_txptr + jam 6,mem_tx_lch + jam 1,mem_hci_conn_handle +sim_skip: + call connection_dispatch + branch sim_loop + +sim_slave: + jam 2,mem_scan_mode + call page_scan_dispatch + branch sim_loop + + +sim_lpm: + jam 0x40,mem_gpio_wakeup + 5 + branch sim_lpm_sleep + branch lpm_doze + branch lpm_hibernate + jam 0x30,core_clksel + jam ccnt_start,core_dma_start +sim_lpm_wait: + call lpo_calibration + fetch 3,mem_clks_per_lpo + branch sim_lpm_wait,blank + call lpm_recover_clk,wake +sim_lpm_sleep: + arg 30,temp + branch lpm_sleep + + +ifdef NULL + +sim_250k: + call init_250k + fetch 1,1 + bbit1 7,sim_250k_rx + call tx_radio_freq + call start_transmitter /* get ready for that id packet */ + nop 600 + enable encode_fec0 + set1 TXGFSK,radio_ctrl + force 0,pdata + inject mod,9 + setarg 0xaa + inject mod,8 + preload access + inject mod,32 + setarg 0x1da861 + inject mod,24 + setarg 0x94445b + inject mod,24 + setarg 0x1275f + inject mod,24 + branch loop +sim_250k_rx: + call rx_radio_freq + call start_receiver /* wait for that id packet from master */ + enable decode_fec0 + correlate null,never + parse demod,bucket,72 + branch loop + + + +sim_clk: + add lpo_time,12,alarm + snooze +clock_loop: + nop 10 + random pdata + and_into 0x1f,pdata + store 1,core_clksel + branch clock_loop + jam 2,core_kick + nop 200 + jam 2,core_clksel + setarg 1500 + call sleep + jam 0x42,core_clksel + add lpo_time,200,alarm + snooze + branch 0x4000 + + + + +sim_aes: + arg mem_x,contw + setsect 0,0x17e2b + setsect 1,0x20585 + setsect 2,0x12ae2 + setsect 3,0x2ae9b + istore 9,contw + setsect 0,0x15f7 + setsect 1,0x3c262 + setsect 2,0x3c4fc + setsect 3,0x0 + istore 7,contw + setsect 0,0x2c16b + setsect 1,0x3b8af + setsect 2,0x1f402 + setsect 3,0x3a65a + istore 9,contw + setsect 0,0x17e3d + setsect 1,0xdcc4 + setsect 2,0x2a179 + setsect 3,0x0 + istore 7,contw + setsect 0,0x3d73a + setsect 1,0x36d1e + setsect 2,0x367a0 + setsect 3,0x2a180 + istore 9,contw + setsect 0,0x3ca9e + setsect 1,0x1893c + setsect 2,0x17ef6 + setsect 3,0x2 + istore 7,contw + arg mem_x,contr + call load_key128 + call load_data128 + call do_aes_ecb + call compare_res + branch loop,zero + branch sim_assert + +endif Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/simple_pairing.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/simple_pairing.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/simple_pairing.prog (working copy) @@ -0,0 +1,2362 @@ + +publickey_init: + fetch 1,mem_ssp_enable + nbranch sp_initialize,blank + branch sp_initialize_256 + +sp_calc_sequence_256_check: + bpatchx patch31_6,mem_patch31 + fetch 1,mem_ssp_enable + rtn blank + fetch 1,mem_sp_local_key_invalid + rtnne SP_KEY_VALID + fetch 1,mem_le_secure_connect_enable + rtn blank + fetch 1,mem_le_sc_local_key_invalid + rtneq SP_KEY_VALID_256 + fetch 2,mem_ui_state_map + bbit1 UI_STATE_BT_CONNECTED,stop_publickey_calc_256 + fetch 1,mem_le_sc_calc + beq SP_CALC_STANDBY,sp_initialize_256 + rtn +stop_publickey_calc_256: + jam SP_CALC_STANDBY,mem_le_sc_calc + rtn + +ifdef SIMPLE_PAIRING + +sp_initialize: + bpatchx patch31_7,mem_patch31 + fetch 1,mem_ssp_enable + branch ssp_disable, blank + call ssp_enable + call sp_clear_flags + branch sp_pubkey_calc + +sp_clear_flags: + setarg 0 + store 8,mem_sp_state_start + store 4,mem_sp_flag_start + store 7,mem_sp_iocap_remote + rtn + +sp_generate_local_key: + jam SP_FLAG_COMMIT,mem_sp_flag + branch sp_generate_local_key0 +sp_master_generate_local_key: + fetch 1,mem_sp_local_key_invalid + beq SP_KEY_VALID,sp_dhkey_calc + branch assert +sp_generate_local_key0: + fetch 1,mem_sp_local_key_invalid + beq SP_KEY_VALID,sp_start_send_pubkey + branch sp_pubkey_calc + +sp_start_send_pubkey: + call sp_dhkey_calc + fetch 1,mem_master_sp_state + nrtn blank + jam SP_STAT_KEY_SEND,mem_sp_state + rtn + + +sp_calc_check_publickey_256: + call sp_calc_b256 + arg mem_le_pubkey_remote_y_256,regA + arg mem_t7_256,contw + call bn_sqrmod_256 + arg mem_le_pubkey_remote_x_256,regA + arg mem_t2_256,contw + call bn_sqrmod_256 + arg mem_t2_256,regA + arg mem_le_pubkey_remote_x_256,regB + arg mem_t2_256,contw + call bn_mulmod_256 + arg mem_a_256,regA + arg mem_le_pubkey_remote_x_256,regB + arg mem_t3_256,contw + call bn_mulmod_256 + arg mem_t3_256,regA + arg mem_t2_256,regB + arg mem_t2_256,contw + call bn_addmod_256 + arg mem_t0_256,regA + arg mem_t2_256,regB + arg mem_t0_256,contw + call bn_addmod_256 + arg 32,loopcnt + arg mem_t7_256,regA + arg mem_t0_256,regB + branch string_compare + +sp_calc_b256: + arg mem_gy_256,regA + arg mem_t0_256,contw + call bn_sqrmod_256 + arg mem_gx_256,regA + arg mem_t2_256,contw + call bn_sqrmod_256 + arg mem_t2_256,regA + arg mem_gx_256,regB + arg mem_t2_256,contw + call bn_mulmod_256 + arg mem_a_256,regA + arg mem_gx_256,regB + arg mem_t3_256,contw + call bn_mulmod_256 + arg mem_t3_256,regA + arg mem_t2_256,regB + arg mem_t2_256,contw + call bn_addmod_256 + arg mem_t0_256,regA + arg mem_t2_256,regB + arg mem_t0_256,contw + branch bn_submod_256 + +sp_calc_check_publickey: + call sp_calc_b + arg mem_sp_pubkey_remote_y,regA + arg mem_t7_256,contw + call bn_sqrmod + arg mem_sp_pubkey_remote_x,regA + arg mem_t2_256,contw + call bn_sqrmod + arg mem_t2_256,regA + arg mem_sp_pubkey_remote_x,regB + arg mem_t2_256,contw + call bn_mulmod + arg mem_a,regA + arg mem_sp_pubkey_remote_x,regB + arg mem_t3_256,contw + call bn_mulmod + arg mem_t3_256,regA + arg mem_t2_256,regB + arg mem_t2_256,contw + call bn_addmod + arg mem_t0_256,regA + arg mem_t2_256,regB + arg mem_t0_256,contw + call bn_addmod + arg 24,loopcnt + arg mem_t7_256,regA + arg mem_t0_256,regB + branch string_compare + +sp_calc_b: + arg mem_gy,regA + arg mem_t0_256,contw + call bn_sqrmod + arg mem_gx,regA + arg mem_t2_256,contw + call bn_sqrmod + arg mem_t2_256,regA + arg mem_gx,regB + arg mem_t2_256,contw + call bn_mulmod + arg mem_a,regA + arg mem_gx,regB + arg mem_t3_256,contw + call bn_mulmod + arg mem_t3_256,regA + arg mem_t2_256,regB + arg mem_t2_256,contw + call bn_addmod + arg mem_t0_256,regA + arg mem_t2_256,regB + arg mem_t0_256,contw + branch bn_submod + + +sp_calculate_commitment: + fetch 1,mem_sp_calc + bne SP_CALC_STANDBY,sp_calculate_commitment_wait_dhkey_calc + call sp_local_random_key_generator + arg mem_sp_prarm_stack,contw + setarg mem_sp_random_local_end + istore 2,contw + setarg mem_sp_pubkey_local_x_end + istore 2,contw + setarg mem_sp_pubkey_remote_x_end + istore 2,contw + branch sp_calculate_commitment0 +master_sp_calculate_commitment: + arg mem_sp_prarm_stack,contw + setarg mem_sp_random_remote_end + istore 2,contw + setarg mem_sp_pubkey_remote_x_end + istore 2,contw + setarg mem_sp_pubkey_local_x_end + istore 2,contw +sp_calculate_commitment0: + call function_f1 + fetch 1,mem_master_sp_state + beq SP_STAT_COMMIT_CALC,master_sp_calculate_commitment0 + jam SP_FLAG_COMMIT,mem_sp_flag + jam SP_STAT_COMMIT_SEND,mem_sp_state + rtn +master_sp_calculate_commitment0: + jam SP_STAT_COMMITMENT_COMPARE,mem_master_sp_state + call sp_master_generate_local_key + branch master_set_mem_master_sp_flag + +sp_local_random_key_generator: + arg mem_sp_random_local,contw + force 8,queue + branch random_generator + +sp_calculate_commitment_wait_dhkey_calc: + jam SP_FLAG_COMMIT,mem_sp_flag + rtn + +sp_confirm_check: + /* calculate Ea here */ + bpatchx patch32_0,mem_patch32 + arg mem_addr_value,contw + fetch 6,mem_lap + istore 6,contw + fetch 6,mem_plap + istore 6,contw + fetch 3,mem_sp_iocap_remote + istore 3,contw + + call function_f3a + + arg mem_sp_calc_result_high,regA + arg mem_sp_check_result,regB + force 4,queue + call compare4 + nbranch sp_confirm_check_failed,true + + call sp_confirm_check_success + jam LMP_DHKey_Check,mem_lmi_opcode2 + branch tid_set_reply + +sp_confirm_check_success: + fetch 1,mem_master_sp_state + beq SP_STAT_CONFIRM_CHECK,sp_confirm_check_success_master + jam SP_STAT_CONFIRM_CALC,mem_sp_state + jam SP_FLAG_COMMIT,mem_sp_flag + jam LMP_ACCEPTED,mem_lmo_opcode2 + rtn +sp_confirm_check_success_master: + jam LMP_ACCEPTED,mem_lmo_opcode2 + jam SP_STATE_END,mem_master_sp_state + branch master_set_mem_master_sp_flag + //accept opcode? + +sp_confirm_check_failed: + fetch 1,mem_master_sp_state + beq SP_STAT_CONFIRM_CHECK,sp_confirm_check_failed_master + jam SP_STAT_NULL,mem_sp_state + jam LMP_NOT_ACCEPTED,mem_lmo_opcode2 + //accept opcode? + jam AUTHENTICATION_FAILURE_ERROR,mem_lmo_reason2 + rtn +sp_confirm_check_failed_master: + jam LMP_NOT_ACCEPTED,mem_lmo_opcode2 + jam SP_STAT_NULL,mem_master_sp_state + rtn + +sp_confirm_calc: + fetch 1,mem_sp_dh_ready + beq SP_FLAG_COMMIT, sp_confirm_calc_ready + jam SP_STAT_CONFIRM_CALC,mem_master_sp_state + branch master_set_mem_master_sp_flag +sp_confirm_calc_ready: + arg mem_addr_value,contw + fetch 6,mem_plap + istore 6,contw + fetch 6,mem_lap + istore 6,contw + fetch 3,mem_sp_iocap_local + istore 3,contw + + call function_f3b + fetch 1,mem_master_sp_state + beq SP_STAT_CONFIRM_CALC,sp_confirm_calc_master + jam SP_STAT_CONFIRM_SEND,mem_sp_state + jam SP_FLAG_COMMIT,mem_sp_flag + rtn +sp_confirm_calc_master: + jam SP_STAT_CONFIRM_SEND,mem_master_sp_state + jam SP_FLAG_COMMIT,mem_master_sp_flag + rtn + +sp_master_key_prarm_push: + arg mem_sp_prarm_stack,contw + fetch 6,mem_plap + istore 6,contw + fetch 6,mem_lap + istore 6,contw + setarg mem_sp_random_local_end + istore 2,contw + setarg mem_sp_random_remote_end + istore 2,contw + branch sp_link_key_calc +sp_link_key_prarm_push: + jam SP_STAT_DONE,mem_sp_state + arg mem_sp_prarm_stack,contw + fetch 6,mem_lap + istore 6,contw + fetch 6,mem_plap + istore 6,contw + setarg mem_sp_random_remote_end + istore 2,contw + setarg mem_sp_random_local_end + istore 2,contw +sp_link_key_calc: + /*calculate Link key here */ + arg mem_addr_value,contw + fetch 6,mem_sp_prarm_stack + istore 6,contw + fetch 6,mem_sp_prarm_stack+6 + istore 6,contw + + call function_f2 + + /*handle linkkey */ + jam 1,mem_link_key_exists + arg mem_link_key,contw + arg mem_sp_calc_result_high,contr + call memcpy16 + branch generate_linkkey_continue + + +sp_pubkey_calc: + bpatchx patch32_1,mem_patch32 + fetch 1,mem_sp_local_key_invalid + rtnne SP_KEY_INVALID + fetch 1,mem_sp_calc + rtnne SP_CALC_STANDBY + arg mem_sp_private_key,contw + force 11,queue + call random_generator + random pdata + rshift pdata,pdata + istore 2,contw +/* we don't need fixed private key,generate random key instead */ + arg mem_k,contw + arg mem_sp_private_key,contr + call memcpy24 //mem_sp_private_key=>mem_k 24BYTES + + arg mem_ax,contw + arg mem_gx,contr + call memcpy48 //mem_gx=>mem_ax 48bytes + + arg mem_az,contw + call bn_zero + jam 1,mem_az //0=>mem_az 24bytes + + call eckp_calc_init + jam SP_CALC_PUBKEY,mem_sp_calc + rtn + +sp_pubkey_generated: + arg mem_sp_pubkey_local,contw + arg mem_bx,contr + call memcpy48 + jam SP_KEY_VALID,mem_sp_local_key_invalid + jam SP_CALC_STANDBY,mem_sp_calc + rtn + +sp_dhkey_calc: + bpatchx patch32_2,mem_patch32 + fetch 1,mem_sp_dhkey_invalid + rtnne SP_KEY_INVALID + fetch 1,mem_sp_calc + rtnne SP_CALC_STANDBY + + arg mem_k,contw + arg mem_sp_private_key,contr + call memcpy24 + + arg mem_ax,contw + arg mem_sp_pubkey_remote,contr + call memcpy48 + + arg mem_az,contw + call bn_zero + jam 1,mem_az + + call eckp_calc_init + jam SP_CALC_DHKEY,mem_sp_calc + rtn + +sp_dhkey_generated: + jam SP_FLAG_COMMIT,mem_sp_dh_ready + arg mem_sp_dhkey,contw + arg mem_bx,contr + call memcpy24 + jam SP_KEY_VALID,mem_sp_dhkey_invalid + jam SP_CALC_STANDBY,mem_sp_calc + rtn + +random_generator: + increase -1,queue + nrtn positive + random pdata + istore 2,contw + branch random_generator +compare4: + increase -1,queue + nbranch compare4_success,positive + ifetch 4,regA + copy pdata,temp + ifetch 4,regB + iflip temp,pdata + nbranch compare4_failed,zero + increase 4,regA + increase 4,regB + branch compare4 +compare4_failed: + disable true + rtn +compare4_success: + enable true + rtn + +/*************************************************/ +/** Message state machine routines ***************/ +/*************************************************/ +// simple pairing support + +simple_pairing_sequence: + bpatchx patch32_3,mem_patch32 + fetch 1,mem_sp_flag + rtn blank + call lmo_fifo_check + nrtn blank + jam SP_FLAG_STANDBY,mem_sp_flag + fetch 1,mem_sp_state + beq SP_STAT_KEY_SEND,sp_send_LMP_ENCAPSULATED_HEADER + beq SP_STAT_COMMIT_SEND,sp_send_LMP_SIMPLE_PAIRING_COMFIRM + beq SP_STAT_RANDOM_SEND,sp_send_LMP_SIMPLE_PAIRING_NUMBER + beq SP_STAT_CONFIRM_SEND,sp_send_LMP_DHKEY_CHECK + beq SP_STAT_KEY_GENERATE,sp_generate_local_key + beq SP_STAT_COMMIT_CALC,sp_calculate_commitment + beq SP_STAT_CONFIRM_CHECK,sp_confirm_check + beq SP_STAT_CONFIRM_CALC,sp_confirm_calc + beq SP_STAT_LINK_KEY_CALC,sp_link_key_prarm_push + //beq SP_STAT_FEATURE_EXT_SEND,send_LMP_FEATURES_REQ_EXT + rtn + +master_simple_paring_sequence: + bpatchx patch32_4,mem_patch32 + fetch 1,mem_master_sp_flag + rtn blank + call lmo_fifo_check + nrtn blank + jam SP_FLAG_STANDBY,mem_master_sp_flag + fetch 1,mem_master_sp_state + beq SP_MASTER_STAT_START_SKIP,sp_master_send_io_cap_get + beq SP_MASTER_STAT_START_DONE,sp_master_send_io_cap_send + beq SP_STAT_KEY_SEND,sp_master_send_LMP_ENCAPSULATED_HEADER + beq SP_STAT_COMMIT_CALC,master_sp_calculate_commitment + beq SP_STAT_COMMITMENT_COMPARE,sp_master_commitment_compare + beq SP_STAT_RANDOM_SEND,sp_master_send_LMP_SIMPLE_PAIRING_NUMBER + beq SP_STAT_CONFIRM_CALC,sp_confirm_calc + beq SP_STAT_CONFIRM_SEND,master_sp_send_lmp_dhkey_check + beq SP_STAT_CONFIRM_CHECK,sp_confirm_check + beq SP_STATE_END,master_sp_sm_end + rtn + +master_set_mem_master_sp_flag: + jam SP_FLAG_COMMIT,mem_master_sp_flag + rtn + +master_clear_mem_master_sp_flag: + jam SP_FLAG_STANDBY,mem_master_sp_flag + rtn +sp_calc_sequence: + bpatchx patch32_5,mem_patch32 + fetch 1,mem_ssp_enable + rtn blank + fetch 1,mem_sp_calc + rtn blank + increase 0x80,pdata + store 1,mem_sp_calc + rtnbit1 7 + fetch 1,mem_ec_loopc + branch sp_calc_sequence_done,blank + branch eckp_calc + +sp_calc_sequence_done: + call ecunmapz + fetch 1,mem_sp_calc + beq SP_CALC_PUBKEY,sp_pubkey_generated + beq SP_CALC_DHKEY,sp_dhkey_generated + rtn + + +bn_testbit: + and pdata,7,queue + rshift3 pdata,pdata + iadd contr,contr + ifetch 1,contr + qisolate0 pdata + rtn + + +ec_copy: + call memcpy24 + call memcpy24 + branch memcpy24 + + +bn_eq_zero: + ifetch 8,contr + nrtn blank + ifetch 8,contr + nrtn blank + ifetch 8,contr + rtn + + + /* return zero if eq */ + +bn_eq_0: + ifetch 4,regA + iforce temp + ifetch 4,regB + isub temp,null + nrtn zero + increase 4,regA + increase 4,regB + loop bn_eq_0 + rtn + + /* return positive if A >= B */ +bn_bigeq: + force 6,loopcnt + increase 20,regA + increase 20,regB +bn_bigeq_0: + ifetch 4,regB + iforce temp + ifetch 4,regA + isub temp,pdata + nrtn positive + nrtn blank + increase -4,regA + increase -4,regB + loop bn_bigeq_0 + rtn + +bn_add: + force 6,loopcnt + force 0,regC +bn_add_0: + ifetch 4,regA + iforce temp + ifetch 4,regB + iadd temp,pdata + iadd regC,pdata + istore 4,contw + isolate1 32,pdata + setflag true,0,regC + increase 4,regA + increase 4,regB + loop bn_add_0 + rtn + +bn_sub: + force 6,loopcnt + force 0,regC +bn_sub_0: + ifetch 4,regB + iforce temp + ifetch 4,regA + isub temp,pdata + isub regC,pdata + istore 4,contw + isolate1 32,pdata + setflag true,0,regC + increase 4,regA + increase 4,regB + loop bn_sub_0 + rtn + +bn_rshift6: + force 6,loopcnt + increase 20,regA +bn_rshift: + force 0,regC +bn_rshift_0: + ifetch 4,regA + isolate1 0,pdata + setflag true,1,regC + rshift pdata,pdata + isolate1 0,regC + setflag true,31,pdata + istore 4,regA + increase -4,regA + rshift regC,regC + loop bn_rshift_0 + rtn + +bn_lshift: + force 6,loopcnt + force 0,regC +bn_lshift_0: + ifetch 4,regA + isolate1 31,pdata + setflag true,1,regC + lshift pdata,pdata + isolate1 0,regC + setflag true,0,pdata + istore 4,regA + increase 4,regA + rshift regC,regC + loop bn_lshift_0 + rtn + +bn_lshiftmod: + call bn_lshift +bn_lshiftmod_ismod: + isolate1 0,regC + branch bn_lshiftmod_0,true + arg mem_p,regB + copy regA,regC + increase -24,regA + call bn_bigeq + nrtn positive + copy regC,regA +bn_lshiftmod_0: + increase -24,regA + arg mem_p,regB + copy regA,contw + branch bn_sub + + +bn_addmod: + call bn_add + copy contw,regA + branch bn_lshiftmod_ismod + +bn_submod: + call bn_sub + isolate0 0,regC + rtn true + arg mem_p,regB + add contw,-24,regA + copy regA,contw + branch bn_add + + +bn_p192mod: + copy contw,timeup /* save result ptr */ + copy regA,alarm /* temp save regA */ + arg mem_tmp2,regB + copy regB,contw + add regA,24,contr + ifetch 8,contr + istore 8,contw + istore 8,contw + force 0,pdata + istore 8,contw + copy timeup,contw + call bn_addmod + arg mem_tmp2,regB + copy regB,contw + force 0,pdata + istore 8,contw + add alarm,32,contr + ifetch 8,contr + istore 8,contw + istore 8,contw + copy timeup,regA + copy regA,contw + call bn_addmod + arg mem_tmp2,regB + copy regB,contw + add alarm,40,contr + ifetch 8,contr + istore 8,contw + istore 8,contw + istore 8,contw + copy timeup,regA + copy regA,contw + branch bn_addmod + + +bn_load: + force 6,loopcnt +bn_load_0: + ifetch 4,contr + iforce regext + increase 1,regext_index + loop bn_load_0 + rtn + + + /* cost 1562 clks */ +bn_mulmod: + copy contw,timeup /* save result ptr */ + arg mem_tmp1,contw + call bn_zero + arg mem_tmp1,contw + copy regA,contr + force 0,regext_index + call bn_load + copy regB,contr + call bn_load + force 0,regB +bn_mulmod_1: + force 0,temp + force 6,regC +bn_mulmod_0: + ifetch 4,contw /* d[i+j] */ + iforce regA + copy regB,regext_index + deposit regext + copy regC,regext_index + imul32 regext,pdata + iadd regA,pdata /* uv = a[i]*b[j] + d[i+j] */ + iadd temp,pdata /* uv += u */ + istore 4,contw /* ->d[i+j] */ + rshift32 pdata,temp /* temp = u = uv >> 32 */ + increase 1,regC + compare 12,regC,0xff + nbranch bn_mulmod_0,true + deposit temp + istore 4,contw /* d[i + 12] = u */ + increase -24,contw + increase 1,regB + compare 6,regB,0xff + nbranch bn_mulmod_1,true + arg mem_tmp1,regA + copy timeup,contw + branch bn_p192mod + + +bn_sqrmod: + copy regA,regB + branch bn_mulmod + +bn_rshifteven: + copy regA,alarm +bn_rshifteven_1: + copy alarm,regA + ifetch 1,regA + isolate1 0,pdata + rtn true + call bn_rshift6 + ifetch 1,regB + isolate0 0,pdata + branch bn_rshifteven_0,true + arg mem_p,regA + copy regB,contw + call bn_add + ifetch 1,regB + iadd regC,pdata + istore 1,regB /* [6] */ + increase -24,regB +bn_rshifteven_0: + add regB,24,regA + force 7,loopcnt + call bn_rshift + branch bn_rshifteven_1 + + /* cost 141910 clks */ +bn_invmod: + copy contw,timeup /* save result ptr */ + arg mem_tmp0,contw /* x */ + call bn_zero + force 0,pdata + store 4,mem_tmp5 + store 4,mem_t2 + jam 1,mem_tmp0 + arg mem_tmp1,contw /* y */ + call bn_zero + arg mem_p,contr + arg mem_tmp2,contw /* a */ + call memcpy24 + copy regA,contr + arg mem_tmp3,contw /* b */ + call memcpy24 +bn_invmod_2: + arg mem_tmp3,contr + call bn_eq_zero + branch bn_invmod_0,blank + arg mem_tmp3,regA + arg mem_tmp0,regB + call bn_rshifteven + + arg mem_tmp2,regA + arg mem_tmp1,regB + call bn_rshifteven + arg mem_tmp3,regA + arg mem_tmp2,regB + call bn_bigeq + branch bn_invmod_1,positive + arg mem_tmp2,regA + arg mem_tmp3,regB + copy regA,contw + call bn_sub + arg mem_tmp0,regA + arg mem_tmp1,regB + copy regB,contw + call bn_add + ifetch 1,regA + iadd regC,regC + ifetch 1,regB + iadd regC,pdata + istore 1,regB + branch bn_invmod_2 +bn_invmod_1: + arg mem_tmp3,regA + arg mem_tmp2,regB + copy regA,contw + call bn_sub + arg mem_tmp1,regA + arg mem_tmp0,regB + copy regB,contw + call bn_add + ifetch 1,regA + iadd regC,regC + ifetch 1,regB + iadd regC,pdata + istore 1,regB + branch bn_invmod_2 +bn_invmod_0: + arg mem_tmp0,contw + call bn_zero + fetch 1,mem_tmp5 + store 1,mem_tmp0 + store 1,mem_tmp0a + arg mem_tmp0,regA + arg mem_tmp1,regB + copy regB,contw + call bn_addmod + arg mem_p,regA + arg mem_tmp1,regB + copy timeup,contw + branch bn_submod + + + + /* cost 64742 clks */ +ecdbl: + arg mem_cz,regA + arg mem_t2,contw + call bn_sqrmod + arg mem_t2,regA + arg mem_t3,contw + call bn_sqrmod + arg mem_a,regA + arg mem_t3,regB + arg mem_t3,contw + call bn_mulmod /* t3=a*z4 */ + arg mem_cx,regA + arg mem_t2,contw + call bn_sqrmod + arg mem_t2,contr + arg mem_t1,contw + call memcpy24 + arg mem_t1,regA + call bn_lshiftmod + arg mem_t2,regA + arg mem_t1,regB + arg mem_t2,contw + call bn_addmod + arg mem_t2,regA + arg mem_t3,regB + arg mem_t2,contw + call bn_addmod /* t2=3*x2 + z*z4 D */ + arg mem_cx,contr + arg mem_t1,contw + call memcpy24 + arg mem_cy,regA + arg mem_t3,contw + call bn_sqrmod + arg mem_t1,regA + call bn_lshiftmod + arg mem_t1,regA + call bn_lshiftmod + arg mem_t1,regA + arg mem_t3,regB + arg mem_t1,contw + call bn_mulmod /* t1=4x*y2 B */ + arg mem_t3,regA + arg mem_t0,contw + call bn_sqrmod + arg mem_t0,regA + call bn_lshiftmod + arg mem_t0,regA + call bn_lshiftmod + arg mem_t0,regA + call bn_lshiftmod /* t0=8*y4 C */ + arg mem_cy,contr + arg mem_t3,contw + call memcpy24 + arg mem_t3,regA + call bn_lshiftmod + arg mem_t3,regA + arg mem_cz,regB + arg mem_cz,contw + call bn_mulmod + arg mem_t2,regA + arg mem_t3,contw + call bn_sqrmod + arg mem_t3,regA + arg mem_t1,regB + arg mem_t3,contw + call bn_submod + arg mem_t3,regA + arg mem_t1,regB + arg mem_cx,contw + call bn_submod + arg mem_t1,regA + arg mem_cx,regB + arg mem_t3,contw + call bn_submod + arg mem_t3,regA + arg mem_t2,regB + arg mem_t3,contw + call bn_mulmod + arg mem_t3,regA + arg mem_t0,regB + arg mem_cy,contw + branch bn_submod + + + /* cost 104904 clks */ +ecadd: + arg mem_az,regA + arg mem_t7,contw + call bn_sqrmod + arg mem_cx,regA + arg mem_t7,regB + arg mem_t0,contw + call bn_mulmod /* n1=t0=xa*zb2 */ + arg mem_az,regA + arg mem_t7,regB + arg mem_t7,contw + call bn_mulmod + arg mem_cy,regA + arg mem_t7,regB + arg mem_t1,contw + call bn_mulmod /* n2=t1=ya*zb3 */ + arg mem_cz,regA + arg mem_t7,contw + call bn_sqrmod + arg mem_ax,regA + arg mem_t7,regB + arg mem_t2,contw + call bn_mulmod /* n3=t2=xb*za2 */ + arg mem_cz,regA + arg mem_t7,regB + arg mem_t7,contw + call bn_mulmod + arg mem_ay,regA + arg mem_t7,regB + arg mem_t3,contw + call bn_mulmod /* n4=t3=yb*za3 */ + arg mem_t0,regA + arg mem_t2,regB + arg mem_t7,contw + call bn_submod /* n5=t7=n1-n3=t0-t2 */ + arg mem_t0,regA + arg mem_t2,regB + arg mem_t0,contw + call bn_addmod /* n7=t0=n1+n3=t0+t2 */ + arg mem_t1,regA + arg mem_t3,regB + arg mem_t2,contw + call bn_submod /* n6=t2=n2-n4=t1-t3 */ + arg mem_t1,regA + arg mem_t3,regB + arg mem_t1,contw + call bn_addmod /* n8=t1=n2+n4=t1+t3 */ + arg mem_t1,regA + arg mem_t7,regB + arg mem_t1,contw + call bn_mulmod /* t1=n8*n5 */ + arg mem_cz,regA + arg mem_az,regB + arg mem_t3,contw + call bn_mulmod + arg mem_t3,regA + arg mem_t7,regB + arg mem_cz,contw + call bn_mulmod /* z=za*zb*n5 */ + arg mem_t7,regA + arg mem_t7,contw + call bn_sqrmod /* t7=n5^2 */ + arg mem_t7,regA + arg mem_t0,regB + arg mem_t3,contw + call bn_mulmod /* t3=n5^2*n7 */ + arg mem_t7,regA + arg mem_t1,regB + arg mem_t1,contw + call bn_mulmod /* t1=n8*n5^3 */ + arg mem_t2,regA + arg mem_cx,contw + call bn_sqrmod + arg mem_cx,regA + arg mem_t3,regB + arg mem_cx,contw + call bn_submod /* x=n6^2-n5^2*n7 */ + arg mem_cx,contr + arg mem_t7,contw + call memcpy24 + arg mem_t7,regA + call bn_lshiftmod /* t7=2*x */ + arg mem_t3,regA + arg mem_t7,regB + arg mem_t3,contw + call bn_submod /* t3=n9 */ + arg mem_t3,regA + arg mem_t2,regB + arg mem_t2,contw + call bn_mulmod /* t2=n9*n6 */ + arg mem_t2,regA + arg mem_t1,regB + arg mem_cy,contw + call bn_submod + arg mem_cy,regA + arg mem_p,regB + arg mem_cy,contw + force 0,regC + fetch 1,mem_cy + isolate1 0,pdata + call bn_add,true + copy regC,alarm + arg mem_cy,regA + call bn_rshift6 + fetch 1,mem_cy5 + isolate1 0,alarm + setflag true,7,pdata + store 1,mem_cy5 + rtn + + /* cost 22276983 clks */ + +eckp_0: + fetch 1,mem_ec_loopc + increase -1,pdata + nrtn positive + store 1,mem_ec_loopc + fetch 1,mem_ec_infinite + call ecdbl,blank + fetch 1,mem_ec_loopc + arg mem_k,contr + call bn_testbit + branch eckp_0,true + fetch 1,mem_ec_infinite + nbranch eckp_1,blank + call ecadd + branch eckp_0 +eckp_1: + jam 0,mem_ec_infinite + arg mem_ax,contr + arg mem_cx,contw + call ec_copy + branch eckp_0 + + /* cost 162522 clks */ +ecunmapz: + arg mem_cz,regA + arg mem_t3,contw + call bn_invmod /* t3 = 1/z */ + arg mem_t3,regA + arg mem_t1,contw + call bn_sqrmod /* t1 = 1/z2 */ + arg mem_cx,regA + arg mem_t1,regB + arg mem_bx,contw + call bn_mulmod + arg mem_t3,regA + arg mem_t1,regB + arg mem_t2,contw + call bn_mulmod /* t2 = 1/z3 */ + arg mem_cy,regA + arg mem_t2,regB + arg mem_by,contw + branch bn_mulmod + + + +sha_endian_swap2: + ifetch 4,contr + force 4,regA + increase 3,contw +sha_endian_loop: + istore 1,contw + rshift8 pdata,pdata + increase -2,contw + increase -1,regA + nbranch sha_endian_loop,zero + increase 5,contw + loop sha_endian_swap2 + rtn + + +sha_getw: + lshift2 queue,pdata + iadd timeup,contr + ifetch 4,contr + rtn + +sha_r: + force 16,alarm + arg memdat,timeup +sha_r_loop: + add alarm,-7,queue + call sha_getw + iforce temp /* W[t - 7] */ + add alarm,-16,queue + call sha_getw + iadd temp,temp /* W[t-7] + W[t-16] */ + add alarm,-2,queue + call sha_getw + shasx pdata,1,pdata + iadd temp,temp /* S1(W[t - 2]) + W[t-7] + W[t-16] */ + add alarm,-15,queue + call sha_getw + shasx pdata,0,pdata + iadd temp,temp /* S0(W[t - 15]) + S1(W[t - 2]) + W[t-7] + W[t-16] */ + lshift2 alarm,pdata + iadd timeup,contw + istoret 4,contw + increase 1,alarm + compare 64,alarm,0xff + nbranch sha_r_loop,true + rtn + + +sha_init: + arg memh0,contr + force 7,regext_index +sha_init_0: + ifetch 4,contr + iforce regext + increase -1,regext_index + branch sha_init_0,positive + rtn + +sha: + bpatchx patch32_6,mem_patch32 + call sha_r /* preprocessing data into R() */ + arg memahbak,contw + force 0,regext_index +sha_0: + deposit regext + istore 4,contw + increase 1,regext_index + compare 8,regext_index,0xff + nbranch sha_0,true + call enable_authrom + arg memk,timeup + arg memdat,alarm + force 64,loopcnt +sha_loop: + ifetcht 4,alarm + ifetch 4,timeup + increase 4,timeup + increase 4,alarm + iadd temp,pdata /* x+K */ + force 7,regext_index + iadd regext,temp /* x+K+h */ + force 4,regext_index + shasx regext,3,pdata + iadd temp,temp /* temp = s3(e)+x+K+h */ + force 5,regext_index + deposit regext + force 6,regext_index + ixor regext,pdata + force 4,regext_index + iand regext,pdata /* (e & (f ^ g)) */ + force 6,regext_index + ixor regext,pdata /* F1(e, f, g) = g ^ (e & (f ^ g)) */ + iadd temp,temp /* temp1 = h + S3(e) + F1(e,f,g) + K + x */ + force 7,regext_index + copy temp,regext /* save to H */ + force 3,regext_index + deposit regext + iadd temp,regext /* save to D */ + force 0,regext_index + deposit regext + force 1,regext_index + iand regext,temp /* a & b */ + ior regext,pdata /* a | b */ + force 2,regext_index + iand regext,pdata /* (c & (a | b)) */ + ior temp,temp /* F0:(a & b) | (c & (a | b)) */ + force 0,regext_index + shasx regext,2,pdata + iadd temp,pdata /* temp2 = S2(a) + F0(a,b,c) */ + force 7,regext_index + iadd regext,regext /* h = temp1 + temp2 */ + regexrot /* rotate move h,a-g => a-h */ + loop sha_loop + arg memahbak,contr + force 0,regext_index +sha_1: + ifetch 4,contr + iadd regext,regext + increase 1,regext_index + compare 8,regext_index,0xff + nbranch sha_1,true + branch disable_authrom + + +sha_result: + arg memresult,contw + force 7,regext_index +sha_regext_save: + deposit regext + istore 4,contw + increase -1,regext_index + branch sha_regext_save,positive + rtn + +pad_xor: +// arg memx_end,contr + arg memdat,contw + increase -4,contr + sub loopcnt,16,regA +pad_xor_0: + ifetch 4,contr + ixor temp,pdata + istore 4,contw + increase -8,contr + loop pad_xor_0 + copy regA,loopcnt + deposit temp +pad_xor_1: + istore 4,contw + loop pad_xor_1 + rtn + +g_noninit_number_confirm: + call g_noninit0 + call sha_result + branch g_common0 + +g_noninit: + call g_noninit0 + branch g_common0 + +g_noninit0: + arg mem_sp_pubkey_remote_x_end,contr + arg memdat,contw + force 6,loopcnt + call memcpy_dword_swap + arg mem_sp_pubkey_local_x_end,contr + force 6,loopcnt + call memcpy_dword_swap + arg mem_sp_random_remote_end,contr + call memcpy_dword_swap4 + call sha_init + call sha + arg mem_sp_random_local_end,contr + arg memdat,contw + branch g_common + +g_init: + arg mem_sp_pubkey_local_x_end,contr + arg memdat,contw + force 6,loopcnt + call memcpy_dword_swap + arg mem_sp_pubkey_remote_x_end,contr + force 6,loopcnt + call memcpy_dword_swap + arg mem_sp_random_local_end,contr + call memcpy_dword_swap4 + call sha_init + call sha + arg mem_sp_random_remote_end,contr + arg memdat,contw + call g_common + branch g_common0 + +g_common: + call memcpy_dword_swap4 + setarg 0x800000 + lshift8 pdata,pdata + istore 4,contw + force 5,loopcnt + call memset0 + setarg 640 + istore 4,contw + branch sha +g_common0: + fetch 4,memresult +// store 4,mem_gkey + arg 1000,rega + idiv rega + call wait_div_end + remainder pdata + store 4,mem_gkey + quotient pdata + arg 1000,rega + idiv rega + call wait_div_end + remainder pdata + arg 1000,rega + imul32 rega,pdata + fetcht 4,mem_gkey + iadd temp,pdata + store 4,mem_gkey + rtn + +function_f1_no_key: + jam 0,mem_passkey_1bit + branch function_f1_common + +function_f1: + fetch 1,mem_ssp_mode_flag + bne SSP_MODE_PASSKEY_ENTRY_FLAG,function_f1_no_key +function_f1_common: + bpatchx patch32_7,mem_patch32 + setarg 0x363636 + lshift8 pdata,temp + or_into 0x36,temp + fetch 2,mem_sp_prarm_stack + copy pdata,contr + force 4,loopcnt + call pad_xor + call sha_init + call sha + fetch 2,mem_sp_prarm_stack+2 + copy pdata,contr + arg memdat,contw + force 6,loopcnt + call memcpy_dword_swap + fetch 2,mem_sp_prarm_stack+4 + copy pdata,contr + force 6,loopcnt + call memcpy_dword_swap + setarg 0x800000 + istore 3,contw + + fetch 1,mem_passkey_1bit + + istore 1,contw + force 0,pdata + istore 8,contw + setarg 0x0388 + istore 4,contw + call sha + call sha_result + arg memresult,contr + arg memahsave,contw + call memcpy32 + + setarg 0x5c5c5c + lshift8 pdata,temp + or_into 0x5c,temp + fetch 2,mem_sp_prarm_stack + copy pdata,contr + force 4,loopcnt + call pad_xor + call sha_init + call sha + arg memahsave_end,contr + arg memdat,contw + force 8,loopcnt + call memcpy_dword_swap + setarg 0x800000 + lshift8 pdata,pdata + istore 4,contw + call bn_zero + setarg 0x0300 + istore 4,contw + call sha + branch sha_result + + +function_f2: + setarg 0x363636 + lshift8 pdata,temp + or_into 0x36,temp + arg mem_sp_dhkey_end,contr + force 6,loopcnt + call pad_xor + call sha_init + call sha + fetch 2,mem_sp_prarm_stack+12 + copy pdata,contr + arg memdat,contw + call memcpy_dword_swap4 + fetch 2,mem_sp_prarm_stack+14 + copy pdata,contr + call memcpy_dword_swap4 + + setarg 0x62746c + lshift8 pdata,pdata + or_into 0x6b,pdata + istore 4,contw + arg mem_addr_value_end,contr + force 3,loopcnt + call memcpy_dword_swap + + setarg 0x800000 + lshift8 pdata,pdata + istore 4,contw + force 0,pdata + istore 8,contw + setarg 0x0380 + istore 4,contw + call sha + + call sha_result + arg memresult,contr + arg memahsave,contw + call memcpy32 + + setarg 0x5c5c5c + lshift8 pdata,temp + or_into 0x5c,temp + arg mem_sp_dhkey_end,contr + force 6,loopcnt + call pad_xor + call sha_init + call sha + arg memahsave_end,contr + arg memdat,contw + force 8,loopcnt + call memcpy_dword_swap + setarg 0x800000 + lshift8 pdata,pdata + istore 4,contw + call bn_zero + setarg 0x0300 + istore 4,contw + call sha + branch sha_result + + +function_f3a: + fetch 1,mem_ssp_mode_flag + bne SSP_MODE_PASSKEY_ENTRY_FLAG,function_f3a_no_pin +function_f3a_common: + bpatchx patch33_0,mem_patch33 + setarg 0x363636 + lshift8 pdata,temp + or_into 0x36,temp + arg mem_sp_dhkey_end,contr + force 6,loopcnt + call pad_xor + call sha_init + call sha + arg mem_sp_random_remote_end,contr + arg memdat,contw + call memcpy_dword_swap4 + arg mem_sp_random_local_end,contr + call memcpy_dword_swap4 + branch function_f3_common + +function_f3a_no_pin: + setarg 0 + store 4,mem_pin + branch function_f3a_common + +function_f3b_no_pin: + setarg 0 + store 4,mem_pin + branch function_f3b_common + + +function_f3b: + fetch 1,mem_ssp_mode_flag + bne SSP_MODE_PASSKEY_ENTRY_FLAG,function_f3b_no_pin +function_f3b_common: + setarg 0x363636 + lshift8 pdata,temp + or_into 0x36,temp + arg mem_sp_dhkey_end,contr + force 6,loopcnt + call pad_xor + call sha_init + call sha + + arg mem_sp_random_local_end,contr + arg memdat,contw + call memcpy_dword_swap4 + arg mem_sp_random_remote_end,contr + call memcpy_dword_swap4 +function_f3_common: + setarg 0x0 + istore 8,contw + istore 4,contw + fetch 4,mem_pin + istore 4,contw + + copy contw,temp + jam 0x80,mem_addr_padding + copy temp,contw + arg mem_addr_iocap_end,contr + call memcpy_dword_swap4 + + call sha + + arg memdat,contw + force 7,loopcnt + call memset0 + istore 4,contw + setarg 0x03F8 + istore 4,contw + call sha + call sha_result + + arg memresult,contr + arg memahsave,contw + call memcpy32 + + setarg 0x5c5c5c + lshift8 pdata,temp + or_into 0x5c,temp + arg mem_sp_dhkey_end,contr + force 6,loopcnt + call pad_xor + call sha_init + call sha + arg memahsave_end,contr + arg memdat,contw + force 8,loopcnt + call memcpy_dword_swap + setarg 0x800000 + lshift8 pdata,pdata + istore 4,contw + call bn_zero + setarg 0x0300 + istore 4,contw + call sha + branch sha_result + +/* +eckp: + jam 192,mem_ec_loopc + jam 1,mem_ec_infinite +*/ +eckp_calc_init: + jam 192,mem_ec_loopc +eckp_calc_init_1: + fetch 1,mem_ec_loopc + rtn blank + increase -1,pdata + store 1,mem_ec_loopc + arg mem_k,contr + call bn_testbit + branch eckp_calc_init_1,true + arg mem_ax,contr + arg mem_cx,contw + branch ec_copy + +eckp_calc: + call ecdbl + fetch 1,mem_ec_loopc + increase -1,pdata + store 1,mem_ec_loopc + arg mem_k,contr + call bn_testbit + rtn true + branch ecadd + +memcpy_dword_swap4: + force 4,loopcnt +memcpy_dword_swap: + increase -4,contr +memcpy_dword_swap_loop: + ifetch 4,contr + istore 4,contw + increase -8,contr + loop memcpy_dword_swap_loop + rtn + +else +sp_initialize: + rtn + +endif + + +ifdef SECURE_CONNECTION + +sp_initialize_256: + bpatchx patch33_1,mem_patch33 + fetch 1,mem_le_secure_connect_enable + branch le_secure_connection_disable,blank + call le_secure_connection_enable + call sp_clear_flags +// jam SP_KEY_INVALID_256,mem_le_sc_local_key_invalid + branch sp_pubkey_calc_256 + + + + +sp_pubkey_calc_256: + fetch 1,mem_le_sc_local_key_invalid + rtnne SP_KEY_INVALID + fetch 1,mem_le_sc_calc + rtnne SP_CALC_STANDBY + + arg mem_le_private_key_256,contw + force 15,queue + call random_generator + random pdata + rshift pdata,pdata + istore 2,contw + + arg mem_k_256,contw + arg mem_le_private_key_256,contr + call memcpy32 //mem_sp_private_key=>mem_k + + arg mem_ax_256,contw + arg mem_gx_256,contr + call memcpy64 //mem_gx=>mem_ax + + arg mem_az_256,contw + call clear_mem_256 + jam 1,mem_az_256 //0=>mem_az + + call eckp_calc_init_256 + jam SP_CALC_PUBKEY_256,mem_le_sc_calc + rtn + +sp_pubkey_generated_256: + arg mem_le_pubkey_local_x_256,contw + arg mem_bx_256,contr + call memcpy64 + jam SP_KEY_VALID_256,mem_le_sc_local_key_invalid + jam SP_CALC_STANDBY,mem_le_sc_calc + rtn + + + +sp_dhkey_calc_256: + fetch 1,mem_sp_dhkey_invalid + rtnne SP_KEY_INVALID + fetch 1,mem_le_sc_calc + rtnne SP_CALC_STANDBY + + arg mem_k_256,contw + arg mem_le_private_key_256,contr + call memcpy32 + + arg mem_ax_256,contw + arg mem_le_pubkey_remote_x_256,contr + call memcpy64 + + arg mem_az_256,contw + call clear_mem_256 + jam 1,mem_az_256 //0=>mem_az + + call eckp_calc_init_256 + jam SP_CALC_DHKEY_256,mem_le_sc_calc + rtn + + +sp_dhkey_generated_256: +// jam SP_FLAG_COMMIT,mem_sp_dh_ready + arg mem_le_dhkey_256,contw + arg mem_bx_256,contr + call memcpy32 + jam SP_KEY_VALID_256,mem_sp_dhkey_invalid + jam SP_CALC_STANDBY,mem_le_sc_calc + rtn + + + +sp_calc_sequence_256: + fetch 1,mem_le_secure_connect_enable + rtn blank + fetch 1,mem_le_sc_calc + rtn blank + increase 0x80,pdata + store 1,mem_le_sc_calc + rtnbit1 7 + fetch 2,mem_ec_loopc + branch sp_calc_sequence_done_256,blank + branch eckp_calc_256 + +sp_calc_sequence_done_256: + bpatchx patch33_2,mem_patch33 + call ecunmapz_256 + fetch 1,mem_le_sc_calc + beq SP_CALC_PUBKEY_256,sp_pubkey_generated_256 + beq SP_CALC_DHKEY_256,sp_dhkey_generated_256 + rtn + + +eckp_calc_256: + call ecdbl_256 + fetch 2,mem_ec_loopc + increase -1,pdata + store 2,mem_ec_loopc + arg mem_k_256,contr + call bn_testbit + rtn true + branch ecadd_256 + +eckp_calc_init_256: + bpatchx patch33_3,mem_patch33 + setarg 256,pdata + store 2,mem_ec_loopc +eckp_calc_init_256_1: + fetch 2,mem_ec_loopc + rtn blank + increase -1,pdata + store 2,mem_ec_loopc + arg mem_k_256,contr + call bn_testbit + branch eckp_calc_init_256_1,true + arg mem_ax_256,contr + arg mem_cx_256,contw + branch memcpy96 + + +ecunmapz_256: + arg mem_cz_256,regA + arg mem_t3_256,contw + call bn_invmod_256 /* t3 = 1/z */ + arg mem_t3_256,regA + arg mem_t1_256,contw + call bn_sqrmod_256 /* t1 = 1/z2 */ + arg mem_cx_256,regA + arg mem_t1_256,regB + arg mem_bx_256,contw + call bn_mulmod_256 + arg mem_t3_256,regA + arg mem_t1_256,regB + arg mem_t2_256,contw + call bn_mulmod_256 /* t2 = 1/z3 */ + arg mem_cy_256,regA + arg mem_t2_256,regB + arg mem_by_256,contw + branch bn_mulmod_256 + +ecdbl_256: + arg mem_cz_256,regA + arg mem_t2_256,contw + call bn_sqrmod_256 + arg mem_t2_256,regA + arg mem_t3_256,contw + call bn_sqrmod_256 +//call ice_break + arg mem_a_256,regA + arg mem_t3_256,regB + arg mem_t3_256,contw + call bn_mulmod_256 /* t3=a*z4 */ + arg mem_cx_256,regA + arg mem_t2_256,contw + call bn_sqrmod_256 +//call ice_break + arg mem_t2_256,contr + arg mem_t1_256,contw + call memcpy32 + arg mem_t1_256,regA + call bn_lshiftmod_256 + arg mem_t2_256,regA + arg mem_t1_256,regB + arg mem_t2_256,contw + call bn_addmod_256 +//call ice_break + arg mem_t2_256,regA + arg mem_t3_256,regB + arg mem_t2_256,contw + call bn_addmod_256 /* t2=3*x2 + z*z4 D */ +//call ice_break + arg mem_cx_256,contr + arg mem_t1_256,contw + call memcpy32 + arg mem_cy_256,regA + arg mem_t3_256,contw + call bn_sqrmod_256 + arg mem_t1_256,regA + call bn_lshiftmod_256 + arg mem_t1_256,regA + call bn_lshiftmod_256 + arg mem_t1_256,regA + arg mem_t3_256,regB + arg mem_t1_256,contw + call bn_mulmod_256 //S = 4X1Y1^2/* t1=4x*y2 B */ + arg mem_t3_256,regA + arg mem_t0_256,contw + call bn_sqrmod_256 + arg mem_t0_256,regA + call bn_lshiftmod_256 + arg mem_t0_256,regA + call bn_lshiftmod_256 + arg mem_t0_256,regA + call bn_lshiftmod_256 //T = 8Y1^4 /* t0=8*y4 C */ + arg mem_cy_256,contr + arg mem_t3_256,contw + call memcpy32 + arg mem_t3_256,regA + call bn_lshiftmod_256 + arg mem_t3_256,regA + arg mem_cz_256,regB + arg mem_cz_256,contw + call bn_mulmod_256 //z = 2Y1Z1 + + + arg mem_t2_256,regA + arg mem_t3_256,contw + call bn_sqrmod_256 // M ^2 +//call ice_break + arg mem_t3_256,regA + arg mem_t1_256,regB + arg mem_t3_256,contw + call bn_submod_256 // t2^2 - 4*cx *cy^2 + arg mem_t3_256,regA + arg mem_t1_256,regB + arg mem_cx_256,contw + call bn_submod_256 //X2 + arg mem_t1_256,regA + arg mem_cx_256,regB + arg mem_t3_256,contw + call bn_submod_256 //S-X2 + arg mem_t3_256,regA + arg mem_t2_256,regB + arg mem_t3_256,contw + call bn_mulmod_256 //M(S-X2) + arg mem_t3_256,regA + arg mem_t0_256,regB + arg mem_cy_256,contw + branch bn_submod_256 //M(S-X2)-T Y2 + +ecadd_256: + + arg mem_az_256,regA + arg mem_t7_256,contw + call bn_sqrmod_256 + arg mem_cx_256,regA + arg mem_t7_256,regB + arg mem_t0_256,contw + call bn_mulmod_256 /* n1=t0=xa*zb2 U1 = X1Z0^2*/ + + + arg mem_az_256,regA + arg mem_t7_256,regB + arg mem_t7_256,contw + call bn_mulmod_256 + arg mem_cy_256,regA + arg mem_t7_256,regB + arg mem_t1_256,contw + call bn_mulmod_256 /* n2=t1=ya*zb3 S1 = Y1Z0^3*/ + + + arg mem_cz_256,regA + arg mem_t7_256,contw + call bn_sqrmod_256 + arg mem_ax_256,regA + arg mem_t7_256,regB + arg mem_t2_256,contw + call bn_mulmod_256 /* n3=t2=xb*za2 U0 = X0Z1^2*/ + + arg mem_cz_256,regA + arg mem_t7_256,regB + arg mem_t7_256,contw + call bn_mulmod_256 + arg mem_ay_256,regA + arg mem_t7_256,regB + arg mem_t3_256,contw + call bn_mulmod_256 /* n4=t3=yb*za3 S0 = Y0Z1^3*/ + + +// arg mem_t0_256,regA +// arg mem_t2_256,regB + arg mem_t0_256,regb + arg mem_t2_256,rega + arg mem_t7_256,contw + call bn_submod_256 /* n5=t7=n1-n3=t0-t2 W=U1-U0*/ + arg mem_t0_256,regA + arg mem_t2_256,regB + arg mem_t0_256,contw + call bn_addmod_256 /* n7=t0=n1+n3=t0+t2 T=U1+U0 */ +// arg mem_t1_256,regA +// arg mem_t3_256,regB + arg mem_t1_256,regb + arg mem_t3_256,rega + arg mem_t2_256,contw + call bn_submod_256 /* n6=t2=n2-n4=t1-t3 S1-S0 */ + arg mem_t1_256,regA + arg mem_t3_256,regB + arg mem_t1_256,contw + call bn_addmod_256 /* n8=t1=n2+n4=t1+t3 M=S1+S0*/ + arg mem_t1_256,regA + arg mem_t7_256,regB + arg mem_t1_256,contw + call bn_mulmod_256 /* t1=n8*n5 MW */ + arg mem_cz_256,regA + arg mem_az_256,regB + arg mem_t3_256,contw + call bn_mulmod_256 //Z0Z1 + arg mem_t3_256,regA + arg mem_t7_256,regB + arg mem_cz_256,contw + call bn_mulmod_256 /* z=za*zb*n5 Z0Z1W */ + + arg mem_t7_256,regA + arg mem_t7_256,contw + call bn_sqrmod_256 /* t7=n5^2 */ + arg mem_t7_256,regA + arg mem_t0_256,regB + arg mem_t3_256,contw + call bn_mulmod_256 /* t3=n5^2*n7 */ + arg mem_t7_256,regA + arg mem_t1_256,regB + arg mem_t1_256,contw + call bn_mulmod_256 /* t1=n8*n5^3 */ + arg mem_t2_256,regA + arg mem_cx_256,contw + call bn_sqrmod_256 + arg mem_cx_256,regA + arg mem_t3_256,regB + arg mem_cx_256,contw + call bn_submod_256 /* x=n6^2-n5^2*n7 */ + arg mem_cx_256,contr + arg mem_t7_256,contw + call memcpy32 + arg mem_t7_256,regA + call bn_lshiftmod_256 /* t7=2*x */ + arg mem_t3_256,regA + arg mem_t7_256,regB + arg mem_t3_256,contw + call bn_submod_256 /* t3=n9 */ + arg mem_t3_256,regA + arg mem_t2_256,regB + arg mem_t2_256,contw + call bn_mulmod_256 /* t2=n9*n6 */ + arg mem_t2_256,regA + arg mem_t1_256,regB + arg mem_cy_256,contw + call bn_submod_256 + arg mem_cy_256,regA + arg mem_p_256,regB + arg mem_cy_256,contw + force 0,regC + fetch 1,mem_cy_256 + isolate1 0,pdata + call bn_add_256,true + copy regC,alarm + arg mem_cy_256,regA + call bn_rshift_256 + fetch 1,mem_cy5_256 + isolate1 0,alarm + setflag true,7,pdata + store 1,mem_cy5_256 + rtn + +bn_invmod_256: + copy contw,timeup + arg mem_tmp0_256,contw + call clear_mem_256 + force 0,pdata +// store 4,mem_tmp52 + store 4,mem_t2_256 + jam 1,mem_tmp0_256 //y1 + arg mem_tmp1_256,contw //y2 + call clear_mem_512 + arg mem_p_256,contr + arg mem_tmp2_256,contw //j + call memcpy32 + copy regA,contr + arg mem_tmp3_256,contw //i + call memcpy32 + +// arg mem_tmp22,regA +// arg mem_tmp32,regB +// call p_bn_bigeq_256 +// branch assert,positive +bn_invmod_256_2: + arg mem_tmp3_256,contr + call bn_eq_zero_256 + branch bn_invmod_256_0,blank +//call ice_break +//fetch 1,0x4ffe +//increase 1,pdata +//store 1,0x4ffe + arg mem_tmp3_256,regA + arg mem_tmp0_256,regB + call bn_rshifteven_256 + arg mem_tmp2_256,regA + arg mem_tmp1_256,regB + call bn_rshifteven_256 + + arg mem_tmp3_256,regA + arg mem_tmp2_256,regB + call bn_bigeq_256 + branch bn_invmod_256_1,positive + arg mem_tmp2_256,regA + arg mem_tmp3_256,regB + copy regA,contw + call bn_sub_256 + arg mem_tmp0_256,regA + arg mem_tmp1_256,regB + copy regB,contw + call bn_add_256 + ifetch 1,regA + iadd regC,regC + ifetch 1,regB + iadd regC,pdata + istore 1,regB + branch bn_invmod_256_2 +bn_invmod_256_1: + arg mem_tmp3_256,regA + arg mem_tmp2_256,regB + copy regA,contw + call bn_sub_256 + arg mem_tmp1_256,regA + arg mem_tmp0_256,regB + copy regB,contw + call bn_add_256 + ifetch 1,regA + iadd regC,regC + ifetch 1,regB + iadd regC,pdata + istore 1,regB + branch bn_invmod_256_2 +bn_invmod_256_0: +//call ice_break + arg mem_tmp1_256,regA + copy timeup,contw + call bn_p256mod +//call ice_break + arg mem_p_256,regA + copy timeup,regB + copy timeup,contw + branch bn_submod_256 + + +bn_mulmod_256: + copy contw,timeup /* save result ptr */ + + force 0,regext_index + + arg mem_tmp1_256,contw + call clear_mem_512 + arg mem_regext,contw + call clear_mem_512 +// jam 0,mem_regext_index + +// arg mem_tmp12,contw + copy regA,contr +// force 0,regext_index + jam 0,mem_regext + setarg 0 + call bn_load_mem + copy regB,contr + call bn_load_256 +// force 0,regB +// jam 0,mem_regb + force 0,queue + arg mem_tmp1_256,contw +bn_mulmod_256_1: +// copy regb,pdata +// store 1, + arg mem_regext,temp + copy queue,regb + lshift2 regb,pdata +// lshift4 pdata,pdata + iadd temp,regb + force 0,temp + force 0,regC +bn_mulmod_256_0: +// copy contw,pdata +// store 2,mem_contw +//call ice_break +// copy pdata,contw + ifetch 4,contw /* d[i+j] */ + iforce regA +// copy regB,regext_index +// deposit regext + ifetch 4,regb + copy regC,regext_index + imul32 regext,pdata + iadd regA,pdata /* uv = a[i]*b[j] + d[i+j] */ + iadd temp,pdata /* uv += u */ + istore 4,contw /* ->d[i+j] */ + rshift32 pdata,temp /* temp = u = uv >> 32 */ + increase 1,regC + compare 8,regC,0xff + nbranch bn_mulmod_256_0,true +//call ice_break + deposit temp + istore 4,contw /* d[i + 12] = u */ + increase -32,contw +// fetch 1,mem_regb +// copy pdata,regb + increase 1,queue + compare 8,queue,0xff + nbranch bn_mulmod_256_1,true + arg mem_tmp1_256,regA + copy timeup,contw + branch bn_p256mod + +bn_p256mod: + bpatchx patch33_4,mem_patch33 + copy contw,timeup /* save result ptr */ + copy regA,alarm /* temp save regA */ + arg mem_tmp2_256,regB + copy regB,contw + call memset0_4 + istore 8,contw + add regA,44,contr + call memcpy8 + call memcpy12 + copy regb,rega + call bn_lshiftmod_256 //2S1 + arg mem_tmp2_256,regB + copy alarm,rega + copy timeup,contw + call bn_addmod_256 //T+2S1 +//call ice_break + arg mem_tmp2_256,regB + copy regB,contw + call memset0_4 + istore 8,contw + add alarm,48,contr + call memcpy16 + call memset0_4 + copy regb,rega + call bn_lshiftmod_256 //2S2 +//call ice_break +// arg 0,regB + + arg mem_tmp2_256,regB + copy timeup,rega + copy regA,contw + call bn_addmod_256 //+2S2 +//call ice_break +// arg 0,regB + + arg mem_tmp2_256,regB + copy regB,contw + add alarm,32,contr + call memcpy12 + call memset0_4 + istore 8,contw + add alarm,56,contr + call memcpy8 + copy timeup,regA + copy regA,contw + call bn_addmod_256 //+S3 +//call ice_break +// arg 0,regB + + arg mem_tmp2_256,regB + copy regB,contw + add alarm,36,contr + call memcpy12 + add alarm,52,contr + call memcpy12 + add alarm,52,contr + call memcpy4 + add alarm,32,contr + call memcpy4 + copy timeup,regA + copy regA,contw + call bn_addmod_256 //+S4 +//call ice_break +// arg 1,regB + arg mem_tmp2_256,regB + copy regB,contw + add alarm,44,contr + call memcpy12 + call memset0_4 + istore 8,contw + add alarm,32,contr + call memcpy4 + add alarm,40,contr + call memcpy4 + copy timeup,regA + copy regA,contw + call bn_submod_256 //-D1 +//call ice_break +// arg 2,regB + arg mem_tmp2_256,regB + copy regB,contw + add alarm,48,contr + call memcpy8 + call memcpy8 + force 0,pdata + istore 8,contw + add alarm,36,contr + call memcpy4 + add alarm,44,contr + call memcpy4 + copy timeup,regA + copy regA,contw + call bn_submod_256 //-D2 +//call ice_break +// arg 3,regB + arg mem_tmp2_256,regB + copy regB,contw + add alarm,52,contr + call memcpy12 + add alarm,32,contr + call memcpy12 + call memset0_4 + add alarm,48,contr + call memcpy4 + copy timeup,regA + copy regA,contw + call bn_submod_256 //-D3 +//call ice_break +// arg 4,regB + arg mem_tmp2_256,regB + copy regB,contw + add alarm,56,contr + call memcpy8 + call memset0_4 + add alarm,36,contr + call memcpy12 + call memset0_4 + add alarm,52,contr + call memcpy4 + copy timeup,regA + copy regA,contw + branch bn_submod_256 //-D4 + + +bn_load_mem: + force 32,loopcnt + arg mem_regext,contw + iadd contw,contw + branch memcpy + +bn_load_256: + force 8,loopcnt + branch bn_load_0 + +bn_sqrmod_256: + copy regA,regB + branch bn_mulmod_256 + +bn_add_256: + force 8,loopcnt + branch bn_add+1 + +bn_addmod_256: + call bn_add_256 + copy contw,regA + branch bn_lshiftmod_ismod_256 + +bn_lshiftmod_256: + call bn_lshift_256 +bn_lshiftmod_ismod_256: + isolate1 0,regC + branch bn_lshiftmod_p_256,true + arg mem_p_256,regB + copy regA,regC + increase -32,regA + call bn_bigeq_256 + nrtn positive + copy regC,regA + branch sub_p2_256 + +bn_lshiftmod_p_256: + call sub_p2_256 +// nrtn true + copy regA,regC + increase -32,regA + arg mem_p_256,regB + call bn_bigeq_256 + nrtn positive + copy regC,regA + branch sub_p2_256 + + +sub_p2_256: + increase -32,regA + arg mem_p_256,regB + copy regA,contw + branch bn_sub_256 + + + + +bn_submod_256: + call bn_sub_256 +// isolate1 0,regC + branch bn_submod_256_np,true +// copy regA,regC +// increase -32,regA + add contw,-32,regA + arg mem_p_256,regB + call bn_bigeq_256 + nrtn positive + arg mem_p_256,regB + add contw,-32,regA +// copy regC,regA + copy rega,contw + branch bn_sub_256 +bn_submod_256_np: + add contw,-32,regA + arg mem_p_256,regB + copy regA,contw + call bn_add_256 +// isolate1 0,regC + rtn true + add contw,-32,regA + arg mem_p_256,regB + copy regA,contw + branch bn_add_256 + + + +bn_sub_256: + force 8,loopcnt + branch bn_sub+1 + +bn_rshift_256: + force 8,loopcnt + increase 28,regA + branch bn_rshift + +bn_lshift_256: + force 8,loopcnt + force 0,regC + branch bn_lshift_0 + +bn_bigeq_256: + force 8,loopcnt + increase 28,regA + increase 28,regB + branch bn_bigeq_0 + + +bn_eq_zero_256: + ifetch 8,contr + nrtn blank + branch bn_eq_zero + + + + +bn_rshifteven_256: + copy regA,alarm +bn_rshifteven_256_1: + copy alarm,regA + ifetch 1,regA + isolate1 0,pdata + rtn true + call bn_rshift_256 + ifetch 1,regB + isolate0 0,pdata + branch bn_rshifteven_256_0,true + arg mem_p_256,regA + copy regB,contw + call bn_add_256 + ifetch 1,regB + iadd regC,pdata + istore 1,regB + increase -32,regB +bn_rshifteven_256_0: + add regB,32,regA + force 9,loopcnt + call bn_rshift + branch bn_rshifteven_256_1 + +else +sp_initialize_256: + rtn + +endif + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/ui.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/ui.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/ui.prog (working copy) @@ -0,0 +1,349 @@ +ui_init: + call lpm_disable_exen_output + rtn wake + branch ui_timer_init + +ui_dispatch: + branch ui_timer_check + + + + +ui_timer_timeout: + setarg 0x1000 + lshift16 pdata,pdata + iadd regb,regb + rtn + +ui_timer_check: + bpatchx patch33_5,mem_patch33 + arg 0,rega + fetcht 4,mem_ui_timer_last_btclk + copy clkn_bt,regb + copy regb,pdata + isub temp,null + ncall ui_timer_timeout,positive + //call ice_break +ui_timer_check_loop: + copy regb,pdata + increase 160,temp //320btclk = 100ms + increase 160,temp + isub temp,null + nbranch ui_timer_check_end,positive + increase 1,rega //increase 1 every 100ms count + and rega,0x0f,pdata + nbranch ui_timer_check_loop,blank + arg 0,rega //reset timer if it's longer than 1.5s between 2 checks + call ui_timer_check_send_evt +ui_timer_init: + copy clkn_bt,pdata + store 4,mem_ui_timer_last_btclk + rtn +ui_timer_check_end: + bpatchx patch33_6,mem_patch33 + copy rega,pdata + rtn blank + increase -160,temp //320btclk = 100ms + increase -160,temp + set0 28,temp + storet 4,mem_ui_timer_last_btclk +ui_timer_check_send_evt: + branch app_evt_timer + + + +//**********************************************************// +//************UI Inter-Processor Communication*******// +//**********************************************************// +ui_ipc_get_lock: + jam 1,mem_ipc_lock_bt +ui_ipc_get_lock_wait: + fetch 1,mem_ipc_lock_c51 + nbranch ui_ipc_get_lock_wait,blank + rtn + +ui_ipc_put_lock: + jam 0,mem_ipc_lock_bt + rtn + + + +ui_ipc_send_event: + bpatchx patch33_7,mem_patch33 + call ui_ipc_get_lock + copy rega,pdata + store 4,mem_ipc_rega_temp + arg mem_ipc_fifo_bt2c51,rega + call fifo_in + fetch 4,mem_ipc_rega_temp + copy pdata,rega + branch ui_ipc_put_lock + +ui_ipc_send_cmd: + bpatchx patch34_0,mem_patch34 + call ui_ipc_get_lock + copy rega,pdata + store 4,mem_ipc_rega_temp + arg mem_ipc_fifo_c512bt,rega + call fifo_in + fetch 4,mem_ipc_rega_temp + copy pdata,rega + branch ui_ipc_put_lock + +ui_ipc_clean_all_fifo: + setarg 0 + store UTIL_FIFO_LEN,mem_ipc_fifo_c512bt + store UTIL_FIFO_LEN,mem_ipc_fifo_bt2c51 + rtn + +check_51cmd: + bpatchx patch34_1,mem_patch34 + fetch 1,mem_hci_cmd + nrtn blank + arg mem_ipc_fifo_c512bt,rega + call fifo_is_empty + rtn blank + jam IPC_CONTINUE_PROCESS,mem_ipc_skip_continue_proc + call check_51cmd_once + fetch 1,mem_ipc_skip_continue_proc + branch check_51cmd,blank + rtn + +check_51cmd_once: + call ui_ipc_get_lock + arg mem_ipc_fifo_c512bt,rega + call fifo_out + copy pdata,temp + call ui_ipc_put_lock + bpatchx patch34_2,mem_patch34 + copy temp,pdata + rtn blank + beq BT_CMD_START_DISCOVERY,check_51cmd_start_discovery + beq BT_CMD_STOP_DISCOVERY,check_51cmd_stop_discovery + beq BT_CMD_RECONNECT,check_51cmd_reconnect + beq BT_CMD_ENTER_SNIFF_SUBRATING,check_51cmd_enter_sniff_subrating + beq BT_CMD_EXIT_SNIFF_SUBRATING,check_51cmd_exit_sniff_subrating + beq BT_CMD_SNIFF_TEST,check_51cmd_sniff_test + beq BT_CMD_START_INQUIRY,check_51cmd_inq + beq BT_CMD_STOP_INQUIRY,check_51cmd_stop_inq + beq BT_CMD_START_ADV,check_51cmd_adv + beq BT_CMD_STOP_ADV,check_51cmd_stop_adv + beq BT_CMD_START_DIRECT_ADV,check_51cmd_direct_adv + beq BT_CMD_STOP_DIRECT_ADV,check_51cmd_stop_direct_adv + beq BT_CMD_LE_START_CONN,check_51cmd_le_start_con + beq BT_CMD_LE_START_SCAN,check_51cmd_start_scan + beq BT_CMD_LE_STOP_SCAN,check_51cmd_stop_scan + beq BT_CMD_ENTER_HIBERNATE,check_51cmd_hibernate + beq BT_CMD_LE_SMP_SECURITY_REQUEST,check_51cmd_le_smp_sec_req + beq BT_CMD_BB_RECONN_CANCEL,check_51cmd_bb_reconn_cancel + //context related, process in context + store 1,mem_fifo_temp + bpatchx patch34_3,mem_patch34 + call lmo_fifo_check + nbranch check_51cmd_restore,blank //process this cmd next time while lmo fifo is full +check_51cmd_once_continue: + fetch 1,mem_fifo_temp + bmark0 mark_context,check_51cmd_check_idle + beq BT_CMD_DISCONNECT,check_51cmd_disconnect + beq BT_CMD_ENTER_SNIFF,cmd_in_sniff + beq BT_CMD_EXIT_SNIFF,cmd_exit_sniff + beq BT_CMD_SET_PIN_CODE,check_51cmd_pincode + beq BT_CMD_LE_DISCONNECT,check_51cmd_le_disconnect + beq BT_CMD_LE_UPDATE_CONN,check_51cmd_ble_update_connect_param + beq BT_CMD_ROLE_SWITCH,check_51cmd_role_switch + beq BT_CMD_STORE_RECONN_INFO_LE,eeprom_store_le_reconn_info + beq BT_CMD_STORE_RECONN_INFO_BT,eeprom_store_bd_reconn_info + beq BT_CMD_DHKEY_NOT_ACCEPT,check_51cmd_dhkey_not_accept + beq BT_CMD_STORE_RECONN_INFO,check_51cmd_store_reconn_info + rtn + +check_51cmd_check_idle: + store 1,mem_fifo_temp + call context_check_idle + branch check_51cmd_restore,zero + call context_search_plap + nrtn zero +check_51cmd_restore: + jam IPC_SKIP_CONTINUE_PROCESS,mem_ipc_skip_continue_proc + branch ui_ipc_send_cmd + + /******************** 51COMMAND*********************/ + +//command opcode 0x01 +check_51cmd_start_discovery: + fetch 2,mem_ui_state_map + set1 UI_STATE_BT_DISCOVERY + store 2,mem_ui_state_map + jam 3,mem_scan_mode + rtn + + +//command opcode 0x02 +check_51cmd_stop_discovery: + jam 0,mem_hid_handshake_timer_count + jam 0,mem_scan_mode + fetch 2,mem_ui_state_map + set0 UI_STATE_BT_DISCOVERY + store 2,mem_ui_state_map + rtn + + +//command opcode 0x03 +check_51cmd_reconnect: + jam hci_cmd_create_conn,mem_hci_cmd + rtn + + +//command opcode 0x04 +check_51cmd_disconnect: + jam LMP_DETACH,mem_lmo_opcode2 + jam OTHER_END_TERMINATED,mem_disconn_reason_send + rtn + + +//command opcode 0x07 +check_51cmd_enter_sniff_subrating: + rtn + + +//command opcode 0x08 +check_51cmd_exit_sniff_subrating: + rtn + + +//command opcode 0x09 +check_51cmd_sniff_test: + rtn + + +//command opcode 0x10 +check_51cmd_pincode: + jam pincode_state_pincode_ready,mem_pincode_state + branch cmd_pair + + +//command opcode 0x11 +check_51cmd_inq: + rtn + + +//command opcode 0x12 +check_51cmd_stop_inq: + rtn + + +//command opcode 0x13 +check_51cmd_adv: + jam ON,mem_le_adv_enable + jam ADV_IND,mem_le_adv_type + fetch 2,mem_ui_state_map + set1 UI_STATE_BLE_ADV,pdata + store 2,mem_ui_state_map + rtn + + +//command opcode 0x14 +check_51cmd_stop_adv: + fetch 2,mem_ui_state_map + set0 UI_STATE_BLE_ADV,pdata + store 2,mem_ui_state_map + jam OFF,mem_le_adv_enable + rtn + + +//command opcode 0x15 +check_51cmd_direct_adv: + jam ON,mem_le_adv_enable + jam ADV_DIRECT_IND,mem_le_adv_type + fetch 2,mem_ui_state_map + set1 UI_STATE_BLE_ADV,pdata + store 2,mem_ui_state_map + rtn + + +//command opcode 0x16 +check_51cmd_stop_direct_adv: + fetch 2,mem_ui_state_map + set0 UI_STATE_BLE_ADV,pdata + store 2,mem_ui_state_map + jam OFF,mem_le_adv_enable + rtn + + +//command opcode 0x17 +check_51cmd_le_disconnect: + setarg 20 // 100ms + store 2,mem_le_superto + store 2,mem_le_init_superto + branch le_send_terminate_ind_user_terminated + + +//command opcode 0x18 +check_51cmd_ble_update_connect_param: + branch le_l2cap_tx_update_req + + + +//command opcode 0x22 +check_51cmd_le_start_con: + jam ON,mem_le_scan_enable + jam hci_cmd_le_create_conn,mem_hci_cmd +// fetch 6,mem_app_peer_addr +// store 6,mem_le_conn_peer_addr + rtn + + +//command opcode 0x23 +check_51cmd_start_scan: + jam ON,mem_le_scan_enable + rtn + + +//command opcode 0x24 +check_51cmd_stop_scan: + jam OFF,mem_le_scan_enable + jam 0,mem_hci_cmd + rtn + + +//command opcode 0x25 +check_51cmd_hibernate: + fetch 2,mem_cb_before_hibernate + call callback_func + call ui_ipc_clean_all_fifo + branch lpm_hibernate + + +//command opcode 0x27 +check_51cmd_le_smp_sec_req: + branch le_send_smp_security_request + + +//command opcode 0x29 +check_51cmd_role_switch: + jam LMP_SLOT_OFFSET,mem_lmo_opcode2 + set1 mark_switch_initiated,mark + nrtn master + jam SWITCH_FLAG_INIT,mem_switch_flag + jam LMP_SWITCH_REQ ,mem_lmo_opcode2 + fetch 1,mem_connection_options + set0 CONNECTION_SWITCH,pdata + store 1,mem_connection_options + rtn + + +//command opcode 0x30 +check_51cmd_bb_reconn_cancel: + force page_length_timer,queue + branch timer_stop + + +//command opcode 0x33 +check_51cmd_dhkey_not_accept: + call tid_set_reply + jam LMP_DHKey_Check,mem_lmi_opcode2 + branch parse_lmp_dhkey_check_reject + + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/utility.prog =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/utility.prog (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/program/utility.prog (working copy) @@ -0,0 +1,609 @@ + +right_shift_n: //rshiftN pdata,pdata + sub loopcnt,0,null + rtn zero +right_shift_n_loop: + rshift pdata,pdata + loop right_shift_n_loop + rtn + +/* lshift. 0:1 byte; 1:2byte; 2:4byte; 3:8byte; 4:16byte*/ +left_shift_n: + force 1,pdata + sub loopcnt,0,null + rtn zero +left_shift_n_loop: + lshift pdata,pdata + loop left_shift_n_loop + rtn +push_stack: + deposit contw + store 2, mem_contw + storet 8,mem_temp + deposit timeup + store 4,mem_timeup + call push_stack_rega_b_c + deposit contr + store 2, mem_contr + rtn + +push_stack_rega_b_c: + deposit rega + store 4, mem_rega + deposit regb + store 4, mem_regb + deposit regc + store 3, mem_regc + rtn + +pop_stack: + fetcht 8,mem_temp + fetch 4,mem_timeup + iforce timeup + call pop_stack_rega_b_c + fetch 2, mem_contw + iforce contw + fetch 2, mem_contr + iforce contr + rtn + +pop_stack_rega_b_c: + fetch 4, mem_rega + iforce rega + fetch 4, mem_regb + iforce regb + fetch 3,mem_regc + iforce regc + rtn + +get_contw: + fetch 2,mem_contw + copy pdata,contw + rtn +get_contr: + fetch 2,mem_contr + copy pdata,contr + rtn +store_contw: + copy contw,pdata + store 2,mem_contw + rtn +store_contr: + copy contr,pdata + store 2,mem_contr + rtn + + +// +save_cont_pointers: + copy contw,pdata + store 2,mem_hold_contw + copy contr,pdata + store 2,mem_hold_contr + rtn +load_cont_pointers: + fetch 2,mem_hold_contw + copy pdata,contw + fetch 2,mem_hold_contr + copy pdata,contr + rtn + +memcpy96: + call memcpy32 +memcpy64: + call memcpy32 + branch memcpy32 +memcpy12: + call memcpy8 +memcpy4: + ifetch 4,contr + istore 4,contw + rtn +memcpy8: + ifetch 8,contr + istore 8,contw + rtn + +memcpy48: + call memcpy16 +memcpy32: + call memcpy8 +memcpy24: + call memcpy8 +memcpy16: + call memcpy8 + branch memcpy8 + + + +delay_10ms: + arg 10,loopcnt +delay_ms_wait: + nop 12000 + loop delay_ms_wait + rtn + +bn_zero: + force 3,loopcnt +memset0: + force 0,pdata +memset8: + istore 8,contw + loop memset8 + rtn + +memset0_8: + force 0,pdata + istore 8,contw + rtn +memset0_4: + force 0,pdata + istore 4,contw + rtn + +clear_mem_256: + force 4,loopcnt + branch memset0 +clear_mem_512: + force 8,loopcnt + branch memset0 + +clear_mem: + deposit loopcnt + rtn blank + setarg 0 +clear_mem_loop: + istore 1,contw + loop clear_mem_loop + rtn + + +clear_temp_block: + arg 32,loopcnt + arg mem_temp_block0,contw + branch clear_mem + +xor_loop: + ifetch 4,regc + ifetcht 4,rega + ixor temp,pdata + istore 4,contw + increase 4,rega + increase 4,regc + loop xor_loop + rtn + +// 11 22 -> 22 11; 11 22 33 -> 33 22 11 +// rega:data addr ;loopnct:length +inverse_data: + bpatchx patch34_4,mem_patch34 + copy loopcnt,pdata + sub pdata,1,null + rtn positive + iadd rega,regb + increase -1,regb + rshift loopcnt,loopcnt +inverse_loop: + ifetcht 1,rega + ifetch 1,regb + istore 1,rega + istoret 1,regb + increase -1,regb + increase 1,rega + loop inverse_loop + rtn + + +memcpy_fast: + deposit loopcnt + rtn blank +memcpy_fast_loop: + increase -8,loopcnt + call memcpy8,positive + rtn zero + branch memcpy_fast_loop,positive + increase 8,loopcnt +memcpy_fast_loop_four: + increase -4,loopcnt + call memcpy4,positive + rtn zero + branch memcpy_fast_loop_four,positive + increase 4,loopcnt + branch memcpy + +memcpy: + deposit loopcnt + rtn blank +memcpy_loop: + ifetch 1,contr + istore 1,contw + loop memcpy_loop + rtn + +timer_stop: + setarg 0 +timer_init: + rshift clkn_bt,temp + storet 4,mem_last_clkn + arg mem_timers,contw + iforce temp + lshift queue,pdata + iadd contw,contw + istoret 2,contw + bpatchx patch34_5,mem_patch34 + rtn + +timer_check_timeout: + arg 0x800,timeup + lshift16 timeup,timeup + iadd timeup,pdata + rtn + + +timer_reinit: + arg 0,queue +timer_check: + bpatchx patch34_6,mem_patch34 + fetcht 4,mem_last_clkn + rshift clkn_bt,pdata + store 4,mem_last_clkn + isub temp,null + ncall timer_check_timeout,positive + isub temp,timeup + copy timeup,temp + arg mem_timers,contr + copy contr,contw + arg 16,loopcnt +timer_loop: + ifetch 2,contr + isub temp,pdata + branch timer_counting,positive + force 0,pdata +timer_counting: + istore 2,contw + loop timer_loop + arg mem_timers,contr + lshift queue,pdata + iadd contr,contr + ifetch 2,contr + rtn + + + + /* pdata 28+16 bit add temp 26+16 bit, result in temp */ +clk_add: + iadd temp,temp + copy temp, loopcnt + setarg 3750 + isub loopcnt,pdata + rtn positive + sub pdata,0,pdata + rshift16 temp,temp + increase 1,temp + lshift16 temp,temp + ior temp,temp + rtn + +clk_diff_rt: + call clk_diff + branch clk2rt + +/* pdata -temp -> pdata, all are 28+16 bits, set user if negative */ +clk_diff: + disable user + isub temp,pdata + branch clk_diff_pos,positive + enable user + sub pdata,0,pdata +clk_diff_pos: + rtnbit0 15 + arg -61786,temp + iadd temp,pdata + set0 64,pdata + rtn + +clk2rt: + iforce contr + rshift16 pdata,pdata + arg 3750,temp + imul32 temp,pdata + iadd contr,pdata + rtn + + /* pdata = clks in, temp = lpo out */ +clk2lpo: + lshift8 pdata,pdata + lshift4 pdata,pdata + fetcht 3,mem_clks_per_lpo + idiv temp + call wait_div_end + quotient temp + rtn + + /* rt clk -> bt+rt clk */ +clk2bt: + arg 3750,temp + idiv temp + call wait_div_end + quotient pdata + lshift16 pdata,pdata + remainder temp + ior temp,temp + rtn + + + +//input:contru +//output:temp +//used register: temp regc +string2dec_from_uart: + arg 0,temp +string2dec_from_uart_done: + copy temp,regc + ifetch 1,contru + call uchar2dialog + copy regc,temp + call swap + arg 10,regb + imul32 regb,pdata + iadd temp,pdata + copy pdata,temp + loop string2dec_from_uart_done + rtn + + + +uchar2dialog: + arg 0x3a,temp + isub temp,null + nbranch uchar2dialog_number,positive + arg 0x61,temp + isub temp,null + branch uchar2dialog_a2f,positive + arg 0x37,temp + isub temp,pdata + rtn +uchar2dialog_number: + arg 0x30,temp + isub temp,pdata + rtn +uchar2dialog_a2f: + arg 0x57,temp + isub temp,pdata + rtn + +pn9: + copy temp,alarm + setarg 0x1ff + force 0,regb +pn9_loop: + rshift3 pdata,rega + rshift rega,rega + ixor rega,rega + isolate1 0,rega + setflag true,9,pdata + rshift temp,temp + isolate1 0,pdata + setflag true,7,temp + rshift pdata,pdata + increase 1,regb + compare 0,regb,0x7 + nbranch pn9_loop,true + istoret 1,contw + loop pn9_loop + copy alarm,temp + rtn + + +wait_div_end: + rtn modone + branch wait_div_end + + + +//input: +// count:loopcnt str1:rega str2:regb +//output: +// same:set falg true ,diff set falg false +// using: +// reg:temp null flag:zero +compare_loop: +string_compare: + ifetch 1,rega + ifetcht 1,regb + isub temp,null + nrtn zero + increase 1,rega + increase 1,regb + loop string_compare + force 0,null + rtn + + /* pdata = temp if pdata > temp */ +ceiling: + isub temp,null + nrtn positive + deposit temp + rtn + +swap: + iadd temp,pdata + isub temp,temp + isub temp,pdata + rtn + +clean_mem: + arg 0x200,loopcnt + arg 0x4000,contw + branch memset0 // clear xram at boot + + //cb function ptr in pdata +callback_func: + rtn blank + copy pdata,pc //rtn through cb functon. + //branch assert + + +ice_break: + hjam 0x1,core_ice_ctrl + rtn + +ice_setbp: + hstore 2,core_ice_break0 + hfetch 1,core_ice_ctrl + set1 4,pdata + hstore 1,core_ice_ctrl + rtn +ice_setbp2: + hstore 2,core_ice_break1 + hfetch 1,core_ice_ctrl + set1 6,pdata + hstore 1,core_ice_ctrl + rtn + +ice_set_write_bp: + hstore 2,core_ice_break0 + hjam 0x30,core_ice_ctrl + rtn + +test_no_white: + hfetch 1,core_config + set1 whiteoff_bit,pdata + hstore 1,core_config /* whitening off */ + rtn + + +test_enable_white: + hfetch 1,core_config + set0 whiteoff_bit,pdata + hstore 1,core_config /* whitening on */ + rtn + + + //fuction fifo_in + //rega pointer to fifo memory , *(rega+len) is the end of fifo + //mem_fifo_temp data into fifo + //assert if fifo was full +fifo_in: + bpatchx patch34_7,mem_patch34 + ifetcht UTIL_FIFO_LEN,rega + and temp,0xff,pdata + nbranch fifo_in_push,blank + rshift8 temp,pdata + istore UTIL_FIFO_LEN,rega +fifo_in_push: + increase UTIL_FIFO_LEN+UTIL_FIFO_OFFSET,rega + ifetch 1,rega + nbranch assert,blank //fifo full + fetch 1,mem_fifo_temp + istore 1,rega + rtn + + //fuction fifo_out + //rega pointer to fifo memory + //pdata data from fifo, blank mains fifo empty +fifo_out: + bpatchx patch35_0,mem_patch35 + arg UTIL_FIFO_LEN,loopcnt + ifetch UTIL_FIFO_LEN,rega + rtn blank +fifo_out_loop: + ifetch 1,rega + nbranch fifo_out_end,blank + increase 1,rega + loop fifo_out_loop + branch assert +fifo_out_end: + arg 0,temp + istoret 1,rega + rtn + + //fuction fifo_is_empty + //rega pointer to fifo memory + //blank--- fifo is empty +fifo_is_empty: + ifetch UTIL_FIFO_LEN,rega + rtn + + //fuction fifo_is_full + //rega pointer to fifo memory + //blank--- fifo is NOT full +fifo_is_full: + ifetch 1,rega + rtn + //rega pointer to fifo memory + //blank--- fifo is NOT near full +fifo_is_near_full: + ifetch 2,rega + rtn + + //rega pointer to fifo memory + //count output via pdata +fifo_content_count: + arg 0,temp +fifo_content_count_loop: + fetch 1,contr + loop fifo_content_count_loop,blank + increase 1,temp + loop fifo_content_count_loop + copy temp,pdata + rtn + +not_greater_than: + isub temp,null + nrtn positive + copy temp,pdata + rtn + + +disable_positive: + force -1,null + rtn +enable_positive: +disable_zero: + force 1,null + rtn +enable_zero: + force 0,null + rtn + +enable_user: + enable user + rtn + +disable_user: + disable user + rtn + +enable_user2: + enable user2 + rtn + +disable_user2: + disable user2 + rtn + +disable_blank: + setarg 1 + rtn + +enable_blank: + setarg 0 + rtn + + +reverse_byte: + copy loopcnt,pdata + rtn blank + copy contr,pdata + iadd loopcnt,pdata + increase -1,pdata + copy pdata,contr +reverse_loop: + ifetch 1,contr + increase -2,contr + istore 1,contw + loop reverse_loop + rtn + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/109x.dat =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/109x.dat (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/109x.dat (working copy) @@ -0,0 +1,53 @@ +mem_patch00:02 +mem_patch10:20 +mem_patch11:02 +mem_patch14:04 +mem_patch17:19 +mem_patch20:68 +mem_patch27:44 +mem_patch28:02 +mem_patch2a:04 +mem_patch33:02 + +#mem_lpm_config:0f 84 30 +mem_lpm_config:0f 84 f0 +mem_lpm_xtalcnt:0a 0b b2 32 +mem_lpm_hibernate_switch:8b +mem_lpm_doze_switch:0b +mem_gpio_wakeup:00 00 00 00 00 00 00 00 + +mem_fcomp_mul:02 +mem_fcomp_div:24 +mem_iscan_window:40 00 +mem_iscan_interval:00 02 +mem_pscan_window:32 00 +mem_pscan_interval:00 02 + +mem_inq_window:20 00 +mem_page_window:20 00 +mem_page_interval:00 00 +mem_page_to:00 20 +mem_rx_window_init:80 04 +mem_rx_window_sniff:00 10 + + + +mem_lmp_version:08 0e 05 04 00 + +mem_eeprom_base:30 1f +mem_eeprom_block_size:20 +mem_context_number:01 + +mem_rf_init: +4b ba +55 d0 +56 e0 +57 88 +58 6c +59 10 +07 ff +ff +mem_rf_init_ptr:mem_rf_init + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/DM_module.dat =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/DM_module.dat (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/DM_module.dat (working copy) @@ -0,0 +1,46 @@ + +mem_device_option:0a + +##############NVRAM CONFIG############## +mem_nv_data_ptr:mem_module_nv_data +mem_nv_data_number:00 +##################################### + + + + +################IPC BUFFER INIT##################### +4FF0:00 1C +4FF2:FF 1F +4FF4:00 1C +4FF6:00 1C +4FF8:00 4D +4FFA:E0 4F +4FFC:00 4D +4FFE:00 4D #at least 255bytes +##################################### + + +##############BLUETOOTH CONFIG############## +###commom### +mem_soft_version_num:00 0b +mem_module_state:03 +mem_module_bluetooth_stauts_by_command:07 + +mem_module_flag:00 +#bit0 MODULE_FLAG_UART_FLOW_CONTROL +#bit1 MODULE_FLAG_BLE_SEND_MTU23 +#bit2 MODULE_FLAG_BLE_DATA_ENCRYPT +mem_rfcomm_lmp_dis_flag:00 +# 1: tianyu MPOS +# 0: wobosi printer +mem_lpm_mode:00 +mem_lpm_interval:00 01 +mem_lpm_overhead:08 +mem_lpm_mult_timeout:02 + + + +##################################### + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/ble_config.dat =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/ble_config.dat (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/ble_config.dat (working copy) @@ -0,0 +1,77 @@ + +mem_module_le_lpm_mult:05 +mem_module_data_write_handle:2d 00 +mem_module_data_write_handle2:2f 00 + +mem_le_pres:02 03 00 05 10 02 03 + +mem_le_interval_min: +08 00 #min interval +10 00 #max interval +00 00 #latency +2c 01 #timeout + +mem_le_pairing_handle:31 00 + + +mem_le_local_mtu:f0 +mem_le_remote_mtu:17 + +mem_le_secure_connect_enable:00 +mem_le_adv_channel_map:07 +mem_le_pairing_mode:00 + +mem_le_adv_enable:00 +mem_le_adv_interval:40 00 + +mem_le_lap:21 22 01 33 02 3a +mem_le_name_len: +'3121 ble demo + +mem_le_adv_data_len:1f +mem_le_adv_data: +02 01 02 + +mem_le_scan_data_len:1f +mem_le_scan_data:# 1 byte length + 1 byte type + N bytes data +'\093121 ble demo + + +mem_ui_le_uuid_table:mem_module_le_att_list + +#attribute list: handle 2bytes, uuid 2bytes, length 1bytes, attribute Nbytes +mem_module_le_att_list: +#Primary service: GATT +01 00 02 00 28 02 01 18 +#Characteristic: Service changed +02 00 02 03 28 01 20 +03 00 02 05 2a 01 00 +#Client Characteristic Configuration +04 00 02 02 29 02 01 00 + +#Primary Service: GAP +05 00 02 00 28 02 00 18 +#Characteristic: Device Name +06 00 02 03 28 01 02 +07 00 02 00 2a +1e 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 20 +#Characteristic: Appearance +08 00 02 03 28 01 02 +09 00 02 01 2a 02 00 00 +#Characteristic: Peripheral Preferred Connection Parameters +0a 00 02 03 28 01 02 +0b 00 02 04 2a 08 10 00 20 00 05 00 2c 01 + +#Primary service yichip transmit +0c 00 02 00 28 10 55 e4 05 d2 af 9f a9 8f e5 4a 7d fe 43 53 53 49 +#Characteristic tx--notify +0d 00 02 03 28 01 10 +0e 00 10 16 96 24 47 C6 23 61 BA D9 4B 4D 1E 43 53 53 49 01 00 +#Client Characteristic Configuration +0f 00 02 02 29 02 00 00 +#Characteristic rx--write +10 00 02 03 28 01 0c +11 00 10 b3 9b 72 34 be ec d4 a8 f4 43 41 88 43 53 53 49 01 00 + +00 00 + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/bt_config.dat =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/bt_config.dat (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/sched/bt_config.dat (working copy) @@ -0,0 +1,107 @@ + + +mem_app_connection_options:17 + +###3.0### +mem_scan_mode:00 +mem_module_spp_lpm_mult:28 + +##############SPP CONFIG############## +mem_credit_flag:00 +mem_rfcomm_max_frame_size:c8 00 +mem_rfcomm_credit_init_data:07 +##################################### + +##############SSP CONFIG############## +mem_sp_iocap_local: +03 #IO_CAPABILITY_NO_INPUT_NO_OUTPUT +00 #OOB_DATA_PRESENT_NOT_PRESENT +04 #AUTH_REQ_MITM_PROTECTION_NOT_REQUIRED_GENERAL_BONDING + +mem_ssp_enable:01 +mem_pin_length:04 30 30 30 30 30 +##################################### + +mem_ui_profile_supported:48 + + +mem_lap:a7 2a 2a 21 10 55 +mem_local_name_length: +'3121 bt demo + +###3.0 sinff param### +mem_sniff_param_interval:20 00 +mem_sniff_param_attempt:01 +mem_sniff_param_timeout:00 +mem_unsniff2sniff_timer:0a + +mem_class:08 04 24 + +mem_ptt:00 +mem_features: +ff +fb +8f +f8 #openACL3M fe +8B #AFHclose 83 +85 +59 +83 #83 ssp + + +mem_eir_enable:01 +mem_all_uuid_16bits: +04 +03#Type: Complete list of 16-bit UUIDs +0012 0001 0100 1e11 + +mem_all_uuid_128bits:00 + + +mem_ui_uuid_table:mem_module_uuid_list + +mem_module_uuid_list: +#hfp +#uuids +03 111e 0003 0100 + +#handle +00010000 + +#total length +360037 + +#attribute start, first 4 digit is attribute ID +09 00 00 0A 00 01 00 00 +09 00 01 35 06 19 11 1E 19 12 03 +09 00 04 35 0C 35 03 19 01 00 35 05 19 00 03 08 01 +09 00 09 35 08 35 06 19 11 1E 09 01 05 +09 03 11 09 00 1F +#attribute end + + +#pnp +#uuids +03 1200 1002 0001 + +#handle +00010002 + +#total length +360033 + +#attribute start, first 4 digit is attribute ID +09 00 00 0A 00 01 00 02 +09 00 01 35 03 19 12 00 +09 02 00 09 01 03 09 02 01 +09 0e 05 09 02 02 09 12 34 +09 02 03 09 01 01 +09 02 04 28 01 +09 02 05 09 00 01 + + + +mem_UI_HF_brsf_feature:34 + + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/define_info.pl =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/define_info.pl (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/define_info.pl (working copy) @@ -0,0 +1,55 @@ +use strict; +use warnings; + +sub read_definfo{ + my $filename = shift(); + my $const_chip = "CHIP VERSION£º"; + my $const_config = "CONFIG: "; + my $version = ""; + my @res; + open(FILE,$filename) || die("can not open file:$filename £¡\n"); + while(my $line = ){ + next if ($line eq "\n"||$line =~ "REVD"); + last if ($line =~ "INCLUDE"); + last if ($line =~ "SIMPLE_PAIRING"); + + if ($line =~ "FPGA" && $line !~ "//"){ + $version = $version."FPGA"; + }elsif($line =~ "ROMCODE" && $line !~ "//"){ + $version = $version."ROMCODE"; + print $const_chip.$version."\n\n"; + }elsif($line !~ "//"){ # valid + if ($line =~"liandi"){ + print "baud rate : boot rate\n"; + } + elsif ($line =~ "CREDIT"){ + print "credit : from mcu\n"; + } + elsif ($line =~ "SSP_EXT"){ + print "ssp confirm: suport\n"; + } + elsif ($line =~ "NVRAM"){ + print "nvram : by mcu\n"; + }elsif ($line=~"RELEASE"){ + print "version : release\n"; + } + }elsif ($line =~ "//"){ #noted + if ($line =~"liandi"){ + print "baud rate : 115200 or other \n"; + } + elsif ($line =~ "CREDIT"){ + print "credit : auto\n"; + } + elsif ($line =~ "SSP_EXT"){ + print "ssp confirm: justwork only\n"; + } + elsif ($line =~ "NVRAM"){ + print "nvram : in eep\n"; + }elsif ($line =~ "RELEASE"){ + print "version : debug\n"; + } + } + } +} + +&read_definfo("bt.prog"); \ No newline at end of file Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/geneep.exe =================================================================== Cannot display: file marked as a binary type. svn:mime-type = application/octet-stream Property changes on: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/geneep.exe ___________________________________________________________________ Added: svn:mime-type ## -0,0 +1 ## +application/octet-stream \ No newline at end of property Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/memalloc.pl =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/memalloc.pl (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/memalloc.pl (working copy) @@ -0,0 +1,90 @@ +$path=$ARGV[0]; +open file, $path; +@f = ; +close file; +open file, ">$path"; +$path =~ s/\/.*//; +open file1, ">$path/memmap.format"; +$xaddr = 0x4000; +$addr = 0; +#if($#ARGV == 1) { +# $addr = hex($ARGV[0]); +# $xaddr = hex($ARGV[1]); +#} +for($i = 0;$i < @f;$i++) { $cmalloc[$i] = (); } +for($i = 0;$i < @f;$i++) { + $_ = $f[$i]; + $start = 1 if(/^\s*memalloc\s*\(\s*$/); + $start = 2 if(/^\s*xmemalloc\s*\(\s*$/); + $start = 3 if(/^\s*omemalloc\s*\(\s*$/); + $start = 4 if(/^\s*bmemalloc\s*\(\s*$/); + $start = 10 + $1 if(/^\s*cmemalloc\s+([0-9])\s*\(\s*$/); + if($start) { + if(/^\s*([0-9]+)\s+([a-zA-Z0-9_]+)\s*(.*)$/) { + if($start == 1) { + $str = sprintf "0x%04x %s%s\n", $addr, $2, $3; + $addr += $1; + $bstr .= $str; + $sstr .= $str; + } elsif($start == 2) { + $str = sprintf "0x%04x %s%s\n", $xaddr, $2, $3; + $xaddr += $1; + $xstr .= $str; + } else { + push @ostr, $_; + } + } + if(/^\s*\)\s*$/) { + if(@ostr > 0) { + if($start == 3) { + push @omalloc,[@ostr]; + } elsif($start == 4) { + push @bmalloc,[@ostr]; + } elsif($start > 9) { + $j = $start - 10; + push @{$cmalloc[$j]},@ostr; + } + } + $start = 0; + @ostr = (); + } + } else { + $sstr .= $_; + } +} +for($i = 0;$i <= $#cmalloc;$i++) { + push @omalloc,$cmalloc[$i]; +# for($j = 0;$j <= $#{$cmalloc[$i]};$j++) { print $cmalloc[$i][$j]; } +} + +$xend = $xaddr; +for($i = 0;$i <= $#omalloc;$i++) { + for($j = 0, $oaddr = $xaddr;$j <= $#{$omalloc[$i]};$j++) { + if($omalloc[$i][$j] =~ /^\s*([0-9]+)\s+([a-zA-Z0-9_]+)\s*(.*)$/) { + $str = sprintf "0x%04x %s%s\n", $oaddr, $2, $3; + $oaddr += $1; + $xstr .= $str; + } + } + $xend = $oaddr if($oaddr > $xend); +} + +$bend = $addr; +for($i = 0;$i <= $#bmalloc;$i++) { + for($j = 0, $baddr = $addr;$j <= $#{$bmalloc[$i]};$j++) { + if($bmalloc[$i][$j] =~ /^\s*([0-9]+)\s+([a-zA-Z0-9_]+)\s*(.*)$/) { + $str = sprintf "0x%04x %s%s\n", $baddr, $2, $3; + $baddr += $1; + $xstr .= $str; + } + } + $bend = $baddr if($baddr > $bend); +} + + +print file $xstr, $sstr; +print file1 $bstr, $xstr; +close file; +close file1; +printf "\nLast allocated address is %04x\n", $bend; +printf "\nLast allocated xmem address is %04x\n", $xend; Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/mergepatch.pl =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/mergepatch.pl (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/mergepatch.pl (working copy) @@ -0,0 +1,45 @@ +$defs = ""; +$fmt = 0; + + +sub parseif { + my($fname) = @_; + open file, $fname; + @f = ; + close file; + open file, ">$fname"; + @valid = (1); + for($i = 0;$i < @f;$i++) { + $_ = $f[$i]; + $defs .= $1 . " " if(/^define\s+(\w+)\s*/); + if(/^ifdef\s+(\w+)\s*/) { + push @valid, ($defs =~ /$1 / ? 1 : 0) & $valid[$#valid]; + } elsif(/^ifndef\s+(\w+)\s*/) { + push @valid, ($defs =~ /$1 / ? 0 : 1) & $valid[$#valid]; + } elsif(/^else/) { + printf "%s\nelse without if at line %d\n", $f[$i - 3], $i if($#valid == 0); + $valid[$#valid] = (1 - $valid[$#valid]) & $valid[$#valid - 1]; + } elsif(/^endif/) { + printf "%s\nendif without if at line %d\n", $_, $i if($#valid == 0); + pop @valid; + } elsif($valid[$#valid]) { + if(/^include\s+(.+)\s*/) { + open file2, "program/$1"; + @f2 = ; + close file2; + splice(@f, $i + 1, 0, @f2); + } else { + next if(/^\s*bpatch\s+/ && $defs !~ /ROMCODE/); + next if(/^\s*set[01] mark_ext_patch/ && $defs !~ /ROMCODE/); + print file $_; + } + } + } + close file; +} + +parseif("output/bt_program23.meta"); +$fmt = 1; +parseif("output/bt_format.meta"); + + Index: ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/rom2h.pl =================================================================== --- /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/rom2h.pl (nonexistent) +++ /YC3121_demo/ModuleDemo/BlueTooth/BT_code_patch/bt_hfp_ble/util/rom2h.pl (working copy) @@ -0,0 +1,8 @@ +#!/usr/bin/perl +@dat = ; +printf "const unsigned char bt_code[] = {\n"; +for($i = 0;$i < @dat;$i++) { + $dat[$i] =~ s/\s//g; + printf "0x%s%s", $dat[$i], $i == $#dat ? "\n" : $i % 16 == 15 ? ",\n" : "," if(length($dat[$i]) == 2); +} +printf "};\n";