Compare commits
5 Commits
release/0.
...
release/0.
| Author | SHA1 | Date | |
|---|---|---|---|
|
|
218102c5c4 | ||
|
|
2c9e6b69d2 | ||
|
|
1d38c24233 | ||
|
|
a9de53c36b | ||
|
|
83486efd5f |
10
AUTHORS
10
AUTHORS
@@ -6,6 +6,16 @@ Kaz Kojima:
|
|||||||
Added STM32 Primer2 support.
|
Added STM32 Primer2 support.
|
||||||
board/board-stm32-primer2.h
|
board/board-stm32-primer2.h
|
||||||
|
|
||||||
|
Kenji Rikitake:
|
||||||
|
Added ST Dongle support.
|
||||||
|
board/board-st-dongle.h
|
||||||
|
Added ST Nucleo F103 support.
|
||||||
|
board/board-st-nucleo-f103.h
|
||||||
|
|
||||||
|
Kiwamu Okabe:
|
||||||
|
Wrote an OpenOCD scirpt:
|
||||||
|
example-fsm-55/stlink-v2.cfg
|
||||||
|
|
||||||
NIIBE Yutaka:
|
NIIBE Yutaka:
|
||||||
Write the library:
|
Write the library:
|
||||||
chopstx.c, eventflag.c, entry.c, clk_gpio_init.c
|
chopstx.c, eventflag.c, entry.c, clk_gpio_init.c
|
||||||
|
|||||||
29
ChangeLog
29
ChangeLog
@@ -1,3 +1,32 @@
|
|||||||
|
2015-07-31 Niibe Yutaka <gniibe@fsij.org>
|
||||||
|
|
||||||
|
* VERSION: 0.08.
|
||||||
|
* doc/chopstx.texi (VERSION): 0.08.
|
||||||
|
|
||||||
|
* example-fsm-55/Makefile (DEFS): Remove HAVE_SYS_H.
|
||||||
|
Add MAKE_ENTRY_PUBLIC.
|
||||||
|
* example-fsm-55/hacker-emblem.ld: Put vectors on ROM.
|
||||||
|
* example-fsm-55/sys.c: No system services.
|
||||||
|
* entry.c (entry): Can be public.
|
||||||
|
* clk_gpio_init.c [MCU_STM32F0] (clock_init): Don't change CFGR1.
|
||||||
|
|
||||||
|
2015-07-30 Niibe Yutaka <gniibe@fsij.org>
|
||||||
|
|
||||||
|
* board/board-st-nucleo-f103.h: New. Contributed by Kenji
|
||||||
|
Rikitake.
|
||||||
|
|
||||||
|
2015-07-29 Niibe Yutaka <gniibe@fsij.org>
|
||||||
|
|
||||||
|
* board/board-st-dongle.h: New. Contributed by Kenji Rikitake.
|
||||||
|
|
||||||
|
* board/board-*.h (FLASH_PAGE_SIZE): Remove.
|
||||||
|
|
||||||
|
2015-07-28 Niibe Yutaka <gniibe@fsij.org>
|
||||||
|
|
||||||
|
* example-cdc/usb_stm32f103.c: Update from Gnuk.
|
||||||
|
* example-cdc/usb_lld.h: Ditto.
|
||||||
|
* example-cdc/usb-cdc.c: Follow the change.
|
||||||
|
|
||||||
2015-07-15 Niibe Yutaka <gniibe@fsij.org>
|
2015-07-15 Niibe Yutaka <gniibe@fsij.org>
|
||||||
|
|
||||||
* VERSION: 0.07.
|
* VERSION: 0.07.
|
||||||
|
|||||||
12
NEWS
12
NEWS
@@ -1,6 +1,18 @@
|
|||||||
NEWS - Noteworthy changes
|
NEWS - Noteworthy changes
|
||||||
|
|
||||||
|
|
||||||
|
* Major changes in Chopstx 0.08
|
||||||
|
|
||||||
|
Released 2015-07-31
|
||||||
|
|
||||||
|
** New board support: ST Nucleo F103
|
||||||
|
It is contributed by Kenji Rikitake.
|
||||||
|
|
||||||
|
** New board support: ST Dongle
|
||||||
|
It is contributed by Kenji Rikitake.
|
||||||
|
It's the ST-Link/V2-1 part of ST Nucleo F103.
|
||||||
|
|
||||||
|
|
||||||
* Major changes in Chopstx 0.07
|
* Major changes in Chopstx 0.07
|
||||||
|
|
||||||
Released 2015-07-15
|
Released 2015-07-15
|
||||||
|
|||||||
4
README
4
README
@@ -1,6 +1,6 @@
|
|||||||
Chopstx - Threads and only Threads
|
Chopstx - Threads and only Threads
|
||||||
Version 0.07
|
Version 0.08
|
||||||
2015-07-15
|
2015-07-31
|
||||||
Niibe Yutaka
|
Niibe Yutaka
|
||||||
Flying Stone Technology
|
Flying Stone Technology
|
||||||
|
|
||||||
|
|||||||
@@ -1,7 +1,6 @@
|
|||||||
#define BOARD_NAME "CQ STARM"
|
#define BOARD_NAME "CQ STARM"
|
||||||
#define BOARD_ID 0xc5480875
|
#define BOARD_ID 0xc5480875
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
#define STM32F10X_MD /* Medium-density device */
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
@@ -10,8 +9,7 @@
|
|||||||
|
|
||||||
#define GPIO_LED_BASE GPIOC_BASE
|
#define GPIO_LED_BASE GPIOC_BASE
|
||||||
#define GPIO_LED_SET_TO_EMIT 6
|
#define GPIO_LED_SET_TO_EMIT 6
|
||||||
#undef GPIO_USB_BASE
|
#undef GPIO_USB_BASE /* No external DISCONNECT/RENUM circuit. */
|
||||||
#undef GPIO_USB_CLEAR_TO_ENABLE
|
|
||||||
#define GPIO_OTHER_BASE GPIOA_BASE
|
#define GPIO_OTHER_BASE GPIOA_BASE
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
|||||||
@@ -9,8 +9,6 @@
|
|||||||
/* __ARM_ARCH_6M__ */
|
/* __ARM_ARCH_6M__ */
|
||||||
|
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
#define STM32_PLLMUL_VALUE 12
|
#define STM32_PLLMUL_VALUE 12
|
||||||
#define STM32_HSICLK 8000000
|
#define STM32_HSICLK 8000000
|
||||||
|
|||||||
@@ -1,7 +1,6 @@
|
|||||||
#define BOARD_NAME "FST-01-00"
|
#define BOARD_NAME "FST-01-00"
|
||||||
#define BOARD_ID 0x613870a9
|
#define BOARD_ID 0x613870a9
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
#define STM32F10X_MD /* Medium-density device */
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
|
|||||||
@@ -2,7 +2,6 @@
|
|||||||
#define BOARD_ID 0x696886af
|
#define BOARD_ID 0x696886af
|
||||||
/* echo -n "FST-01" | sha256sum | sed -e 's/^.*\(........\) -$/\1/' */
|
/* echo -n "FST-01" | sha256sum | sed -e 's/^.*\(........\) -$/\1/' */
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
#define STM32F10X_MD /* Medium-density device */
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
@@ -15,19 +14,6 @@
|
|||||||
#define GPIO_USB_SET_TO_ENABLE 10
|
#define GPIO_USB_SET_TO_ENABLE 10
|
||||||
#undef GPIO_OTHER_BASE
|
#undef GPIO_OTHER_BASE
|
||||||
|
|
||||||
/* For pin-cir settings of Gnuk */
|
|
||||||
#define TIMx TIM2
|
|
||||||
#define INTR_REQ_TIM TIM2_IRQ
|
|
||||||
#define AFIO_EXTICR_INDEX 0
|
|
||||||
#define AFIO_EXTICR1_EXTIx_Py AFIO_EXTICR1_EXTI2_PA
|
|
||||||
#define EXTI_PR EXTI_PR_PR2
|
|
||||||
#define EXTI_IMR EXTI_IMR_MR2
|
|
||||||
#define EXTI_FTSR_TR EXTI_FTSR_TR2
|
|
||||||
#define INTR_REQ_EXTI EXTI2_IRQ
|
|
||||||
#define ENABLE_RCC_APB1
|
|
||||||
#define RCC_APBnENR_TIMxEN RCC_APB1ENR_TIM2EN
|
|
||||||
#define RCC_APBnRSTR_TIMxRST RCC_APB1RSTR_TIM2RST
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Port A setup.
|
* Port A setup.
|
||||||
* PA0 - input with pull-up (TIM2_CH1): AN0 for NeuG
|
* PA0 - input with pull-up (TIM2_CH1): AN0 for NeuG
|
||||||
@@ -65,3 +51,34 @@
|
|||||||
|
|
||||||
#define RCC_ENR_IOP_EN (RCC_APB2ENR_IOPAEN | RCC_APB2ENR_IOPBEN)
|
#define RCC_ENR_IOP_EN (RCC_APB2ENR_IOPAEN | RCC_APB2ENR_IOPBEN)
|
||||||
#define RCC_RSTR_IOP_RST (RCC_APB2RSTR_IOPARST | RCC_APB2RSTR_IOPBRST)
|
#define RCC_RSTR_IOP_RST (RCC_APB2RSTR_IOPARST | RCC_APB2RSTR_IOPBRST)
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Board specific information other than clock and GPIO initial
|
||||||
|
* setting should not be in board-*.h, but each driver should include
|
||||||
|
* information by itself.
|
||||||
|
*
|
||||||
|
* Please see NeuG's ADC driver how board specific handling is done.
|
||||||
|
*
|
||||||
|
* Given the situation of Chopstx's boards support, which is not that
|
||||||
|
* huge, this works well. If scalability and flexibility will matter,
|
||||||
|
* we will need something like device tree in which boot process can
|
||||||
|
* pass information to application program.
|
||||||
|
*
|
||||||
|
* Following constants are here, because experimental CIR driver is
|
||||||
|
* written before this design decision of Chopstx.
|
||||||
|
*
|
||||||
|
* Those will be removed soon, once such an driver will be improved
|
||||||
|
* in new style.
|
||||||
|
*/
|
||||||
|
/* For pin-cir settings of Gnuk */
|
||||||
|
#define TIMx TIM2
|
||||||
|
#define INTR_REQ_TIM TIM2_IRQ
|
||||||
|
#define AFIO_EXTICR_INDEX 0
|
||||||
|
#define AFIO_EXTICR1_EXTIx_Py AFIO_EXTICR1_EXTI2_PA
|
||||||
|
#define EXTI_PR EXTI_PR_PR2
|
||||||
|
#define EXTI_IMR EXTI_IMR_MR2
|
||||||
|
#define EXTI_FTSR_TR EXTI_FTSR_TR2
|
||||||
|
#define INTR_REQ_EXTI EXTI2_IRQ
|
||||||
|
#define ENABLE_RCC_APB1
|
||||||
|
#define RCC_APBnENR_TIMxEN RCC_APB1ENR_TIM2EN
|
||||||
|
#define RCC_APBnRSTR_TIMxRST RCC_APB1RSTR_TIM2RST
|
||||||
|
|||||||
@@ -1,7 +1,6 @@
|
|||||||
#define BOARD_NAME "Maple Mini"
|
#define BOARD_NAME "Maple Mini"
|
||||||
#define BOARD_ID 0x7a445272
|
#define BOARD_ID 0x7a445272
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
#define STM32F10X_MD /* Medium-density device */
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
|
|||||||
@@ -1,7 +1,6 @@
|
|||||||
#define BOARD_NAME "Olimex STM32-H103"
|
#define BOARD_NAME "Olimex STM32-H103"
|
||||||
#define BOARD_ID 0xf92bb594
|
#define BOARD_ID 0xf92bb594
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
#define STM32F10X_MD /* Medium-density device */
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
|
|||||||
33
board/board-st-dongle.h
Normal file
33
board/board-st-dongle.h
Normal file
@@ -0,0 +1,33 @@
|
|||||||
|
#define BOARD_NAME "ST Dongle"
|
||||||
|
/* echo -n "ST Dongle" | shasum -a 256 | sed -e 's/^.*\(........\) -$/\1/' */
|
||||||
|
#define BOARD_ID 0x2cd4e471
|
||||||
|
|
||||||
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
|
#define STM32_PLLMUL_VALUE 9
|
||||||
|
#define STM32_HSECLK 8000000
|
||||||
|
|
||||||
|
#define GPIO_LED_BASE GPIOA_BASE
|
||||||
|
#define GPIO_LED_SET_TO_EMIT 9
|
||||||
|
#define GPIO_USB_BASE GPIOA_BASE
|
||||||
|
#define GPIO_USB_SET_TO_ENABLE 15
|
||||||
|
#undef GPIO_OTHER_BASE
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Port A setup.
|
||||||
|
* PA0 - input with pull-up. AN0
|
||||||
|
* PA1 - input with pull-up. AN1
|
||||||
|
* PA9 - Push pull output 50MHz (LED 1:ON 0:OFF)
|
||||||
|
* PA11 - Push Pull output 10MHz 0 default (until USB enabled) (USBDM)
|
||||||
|
* PA12 - Push Pull output 10MHz 0 default (until USB enabled) (USBDP)
|
||||||
|
* PA15 - Push pull output 50MHz (USB 1:ON 0:OFF)
|
||||||
|
* ------------------------ Default
|
||||||
|
* PAx - input with pull-up
|
||||||
|
*/
|
||||||
|
#define VAL_GPIO_LED_ODR 0xFFFFE7FF
|
||||||
|
#define VAL_GPIO_LED_CRL 0x88888888 /* PA7...PA0 */
|
||||||
|
#define VAL_GPIO_LED_CRH 0x38811838 /* PA15...PA8 */
|
||||||
|
|
||||||
|
#define RCC_ENR_IOP_EN RCC_APB2ENR_IOPAEN
|
||||||
|
#define RCC_RSTR_IOP_RST RCC_APB2RSTR_IOPARST
|
||||||
45
board/board-st-nucleo-f103.h
Normal file
45
board/board-st-nucleo-f103.h
Normal file
@@ -0,0 +1,45 @@
|
|||||||
|
#define BOARD_NAME "ST Nucleo F103"
|
||||||
|
#define BOARD_ID 0x9b87c16d
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Please add X3 and USB cable to ST Nucleo F103.
|
||||||
|
*
|
||||||
|
* Solder X3 XTAL of 8MHz (and put C33 and C34 of 22pF).
|
||||||
|
* Solder the bridges for R35 and R37, since it's 0 ohm.
|
||||||
|
*
|
||||||
|
* (Optional) Remove SB54 and SB55.
|
||||||
|
*
|
||||||
|
* At CN10, connect USB cable
|
||||||
|
* Vbus RED --> 10 NC ----------> CN7 (6 E5V)
|
||||||
|
* D+ GREEN --> 12 PA11 ---[1K5]--> CN6 (4 3V3)
|
||||||
|
* D- WHITE --> 14 PA12
|
||||||
|
* GND BLACK --> 20 GND
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
|
#define STM32_PLLMUL_VALUE 9
|
||||||
|
#define STM32_HSECLK 8000000
|
||||||
|
|
||||||
|
#define GPIO_LED_BASE GPIOA_BASE
|
||||||
|
#define GPIO_LED_SET_TO_EMIT 5
|
||||||
|
#undef GPIO_USB_BASE /* No external DISCONNECT/RENUM circuit. */
|
||||||
|
#undef GPIO_OTHER_BASE
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Port A setup.
|
||||||
|
* PA0 - input with pull-up. AN0
|
||||||
|
* PA1 - input with pull-up. AN1
|
||||||
|
* PA5 - Push pull output 50MHz (LED 1:ON 0:OFF)
|
||||||
|
* PA11 - Push Pull output 10MHz 0 default (until USB enabled) (USBDM)
|
||||||
|
* PA12 - Push Pull output 10MHz 0 default (until USB enabled) (USBDP)
|
||||||
|
* ------------------------ Default
|
||||||
|
* PAx - input with pull-up
|
||||||
|
*/
|
||||||
|
#define VAL_GPIO_LED_ODR 0xFFFFE7FF
|
||||||
|
#define VAL_GPIO_LED_CRL 0x88388888 /* PA7...PA0 */
|
||||||
|
#define VAL_GPIO_LED_CRH 0x88811888 /* PA15...PA8 */
|
||||||
|
|
||||||
|
#define RCC_ENR_IOP_EN RCC_APB2ENR_IOPAEN
|
||||||
|
#define RCC_RSTR_IOP_RST RCC_APB2RSTR_IOPARST
|
||||||
@@ -1,7 +1,6 @@
|
|||||||
#define BOARD_NAME "STBee Mini"
|
#define BOARD_NAME "STBee Mini"
|
||||||
#define BOARD_ID 0x1f341961
|
#define BOARD_ID 0x1f341961
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
#define STM32F10X_MD /* Medium-density device */
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
|
|||||||
@@ -1,8 +1,6 @@
|
|||||||
#define BOARD_NAME "STBee"
|
#define BOARD_NAME "STBee"
|
||||||
#define BOARD_ID 0x945c37e8
|
#define BOARD_ID 0x945c37e8
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 2048
|
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
#define STM32_PLLMUL_VALUE 6
|
#define STM32_PLLMUL_VALUE 6
|
||||||
#define STM32_HSECLK 12000000
|
#define STM32_HSECLK 12000000
|
||||||
|
|||||||
@@ -1,8 +1,6 @@
|
|||||||
#define BOARD_NAME "STM32 Primer2"
|
#define BOARD_NAME "STM32 Primer2"
|
||||||
#define BOARD_ID 0x21e5798d
|
#define BOARD_ID 0x21e5798d
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 2048
|
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
#define STM32_PLLMUL_VALUE 6
|
#define STM32_PLLMUL_VALUE 6
|
||||||
#define STM32_HSECLK 12000000
|
#define STM32_HSECLK 12000000
|
||||||
|
|||||||
@@ -9,8 +9,6 @@
|
|||||||
/* __ARM_ARCH_6M__ */
|
/* __ARM_ARCH_6M__ */
|
||||||
|
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
#define STM32_PLLMUL_VALUE 12
|
#define STM32_PLLMUL_VALUE 12
|
||||||
#define STM32_HSICLK 8000000
|
#define STM32_HSICLK 8000000
|
||||||
|
|||||||
@@ -1,7 +1,6 @@
|
|||||||
#define BOARD_NAME "STM8S Discovery"
|
#define BOARD_NAME "STM8S Discovery"
|
||||||
#define BOARD_ID 0x2f0976bb
|
#define BOARD_ID 0x2f0976bb
|
||||||
|
|
||||||
#define FLASH_PAGE_SIZE 1024
|
|
||||||
#define STM32F10X_MD /* Medium-density device */
|
#define STM32F10X_MD /* Medium-density device */
|
||||||
|
|
||||||
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
#define STM32_PLLXTPRE STM32_PLLXTPRE_DIV1
|
||||||
@@ -10,25 +9,9 @@
|
|||||||
|
|
||||||
#define GPIO_LED_BASE GPIOA_BASE
|
#define GPIO_LED_BASE GPIOA_BASE
|
||||||
#define GPIO_LED_SET_TO_EMIT 8
|
#define GPIO_LED_SET_TO_EMIT 8
|
||||||
#undef GPIO_USB_BASE
|
#undef GPIO_USB_BASE /* No external DISCONNECT/RENUM circuit. */
|
||||||
#undef GPIO_USB_CLEAR_TO_ENABLE
|
|
||||||
#define GPIO_OTHER_BASE GPIOB_BASE
|
#define GPIO_OTHER_BASE GPIOB_BASE
|
||||||
|
|
||||||
/* For pin-cir settings of Gnuk */
|
|
||||||
#define TIMx TIM3
|
|
||||||
#define INTR_REQ_TIM TIM3_IRQ
|
|
||||||
#define AFIO_EXTICR_INDEX 1
|
|
||||||
#define AFIO_EXTICR1_EXTIx_Py AFIO_EXTICR2_EXTI5_PB
|
|
||||||
#define EXTI_PR EXTI_PR_PR5
|
|
||||||
#define EXTI_IMR EXTI_IMR_MR5
|
|
||||||
#define EXTI_FTSR_TR EXTI_FTSR_TR5
|
|
||||||
#define INTR_REQ_EXTI EXTI9_5_IRQ
|
|
||||||
#define ENABLE_RCC_APB1
|
|
||||||
#define RCC_APBnENR_TIMxEN RCC_APB1ENR_TIM3EN
|
|
||||||
#define RCC_APBnRSTR_TIMxRST RCC_APB1RSTR_TIM3RST
|
|
||||||
#define AFIO_MAPR_SOMETHING AFIO_MAPR_TIM3_REMAP_PARTIALREMAP
|
|
||||||
/* Remap (PB4, PB5) -> (TIM3_CH1, TIM3_CH2) */
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Port A setup.
|
* Port A setup.
|
||||||
* PA0 - input with pull-up. AN0
|
* PA0 - input with pull-up. AN0
|
||||||
@@ -58,3 +41,19 @@
|
|||||||
#define VAL_GPIO_OTHER_ODR 0xFFFFFFFE
|
#define VAL_GPIO_OTHER_ODR 0xFFFFFFFE
|
||||||
#define VAL_GPIO_OTHER_CRL 0x88888888 /* PB7...PB0 */
|
#define VAL_GPIO_OTHER_CRL 0x88888888 /* PB7...PB0 */
|
||||||
#define VAL_GPIO_OTHER_CRH 0x88888888 /* PB15...PB8 */
|
#define VAL_GPIO_OTHER_CRH 0x88888888 /* PB15...PB8 */
|
||||||
|
|
||||||
|
|
||||||
|
/* For pin-cir settings of Gnuk */
|
||||||
|
#define TIMx TIM3
|
||||||
|
#define INTR_REQ_TIM TIM3_IRQ
|
||||||
|
#define AFIO_EXTICR_INDEX 1
|
||||||
|
#define AFIO_EXTICR1_EXTIx_Py AFIO_EXTICR2_EXTI5_PB
|
||||||
|
#define EXTI_PR EXTI_PR_PR5
|
||||||
|
#define EXTI_IMR EXTI_IMR_MR5
|
||||||
|
#define EXTI_FTSR_TR EXTI_FTSR_TR5
|
||||||
|
#define INTR_REQ_EXTI EXTI9_5_IRQ
|
||||||
|
#define ENABLE_RCC_APB1
|
||||||
|
#define RCC_APBnENR_TIMxEN RCC_APB1ENR_TIM3EN
|
||||||
|
#define RCC_APBnRSTR_TIMxRST RCC_APB1RSTR_TIM3RST
|
||||||
|
#define AFIO_MAPR_SOMETHING AFIO_MAPR_TIM3_REMAP_PARTIALREMAP
|
||||||
|
/* Remap (PB4, PB5) -> (TIM3_CH1, TIM3_CH2) */
|
||||||
|
|||||||
@@ -231,8 +231,10 @@ clock_init (void)
|
|||||||
RCC->APB2RSTR = RCC_APB2RSTR_SYSCFGRST;
|
RCC->APB2RSTR = RCC_APB2RSTR_SYSCFGRST;
|
||||||
RCC->APB2RSTR = 0;
|
RCC->APB2RSTR = 0;
|
||||||
|
|
||||||
|
# if defined(HAVE_SYS_H)
|
||||||
/* Use vectors on RAM */
|
/* Use vectors on RAM */
|
||||||
SYSCFG->CFGR1 = (SYSCFG->CFGR1 & ~SYSCFG_CFGR1_MEM_MODE) | 3;
|
SYSCFG->CFGR1 = (SYSCFG->CFGR1 & ~SYSCFG_CFGR1_MEM_MODE) | 3;
|
||||||
|
# endif
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|||||||
@@ -1,7 +1,7 @@
|
|||||||
\input texinfo @c -*-texinfo-*-
|
\input texinfo @c -*-texinfo-*-
|
||||||
@c %**start of header
|
@c %**start of header
|
||||||
@setfilename chopstx.info
|
@setfilename chopstx.info
|
||||||
@set VERSION 0.07
|
@set VERSION 0.08
|
||||||
@settitle Chopstx Reference Manual
|
@settitle Chopstx Reference Manual
|
||||||
@c Unify some of the indices.
|
@c Unify some of the indices.
|
||||||
@syncodeindex tp fn
|
@syncodeindex tp fn
|
||||||
|
|||||||
8
entry.c
8
entry.c
@@ -41,6 +41,12 @@
|
|||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
|
||||||
|
#ifdef MAKE_ENTRY_PUBLIC
|
||||||
|
#define STATIC_ENTRY
|
||||||
|
#else
|
||||||
|
#define STATIC_ENTRY static
|
||||||
|
#endif
|
||||||
|
|
||||||
extern uint8_t __main_stack_end__;
|
extern uint8_t __main_stack_end__;
|
||||||
extern void svc (void);
|
extern void svc (void);
|
||||||
extern void preempt (void);
|
extern void preempt (void);
|
||||||
@@ -98,7 +104,7 @@ uint32_t vectors_in_ram[48];
|
|||||||
/*
|
/*
|
||||||
* This routine only changes PSP and not MSP.
|
* This routine only changes PSP and not MSP.
|
||||||
*/
|
*/
|
||||||
static __attribute__ ((naked,section(".text.startup.0")))
|
STATIC_ENTRY __attribute__ ((naked,section(".text.startup.0")))
|
||||||
void entry (void)
|
void entry (void)
|
||||||
{
|
{
|
||||||
asm volatile ("bl clock_init\n\t"
|
asm volatile ("bl clock_init\n\t"
|
||||||
|
|||||||
@@ -7,6 +7,8 @@
|
|||||||
#define BOARD_ID_STBEE 0x945c37e8
|
#define BOARD_ID_STBEE 0x945c37e8
|
||||||
#define BOARD_ID_STM32_PRIMER2 0x21e5798d
|
#define BOARD_ID_STM32_PRIMER2 0x21e5798d
|
||||||
#define BOARD_ID_STM8S_DISCOVERY 0x2f0976bb
|
#define BOARD_ID_STM8S_DISCOVERY 0x2f0976bb
|
||||||
|
#define BOARD_ID_ST_DONGLE 0x2cd4e471
|
||||||
|
#define BOARD_ID_ST_NUCLEO_F103 0x9b87c16d
|
||||||
|
|
||||||
extern const uint8_t sys_version[8];
|
extern const uint8_t sys_version[8];
|
||||||
extern const uint32_t sys_board_id;
|
extern const uint32_t sys_board_id;
|
||||||
|
|||||||
@@ -36,7 +36,7 @@ static const uint8_t vcom_device_desc[18] = {
|
|||||||
};
|
};
|
||||||
|
|
||||||
/* Configuration Descriptor tree for a CDC.*/
|
/* Configuration Descriptor tree for a CDC.*/
|
||||||
static const uint8_t vcom_configuration_desc[67] = {
|
static const uint8_t vcom_config_desc[67] = {
|
||||||
9,
|
9,
|
||||||
USB_CONFIGURATION_DESCRIPTOR_TYPE, /* bDescriptorType: Configuration */
|
USB_CONFIGURATION_DESCRIPTOR_TYPE, /* bDescriptorType: Configuration */
|
||||||
/* Configuration Descriptor.*/
|
/* Configuration Descriptor.*/
|
||||||
@@ -167,7 +167,7 @@ usb_cb_device_reset (void)
|
|||||||
usb_lld_set_configuration (0);
|
usb_lld_set_configuration (0);
|
||||||
|
|
||||||
/* Current Feature initialization */
|
/* Current Feature initialization */
|
||||||
usb_lld_set_feature (vcom_configuration_desc[7]);
|
usb_lld_set_feature (vcom_config_desc[7]);
|
||||||
|
|
||||||
usb_lld_reset ();
|
usb_lld_reset ();
|
||||||
|
|
||||||
@@ -177,14 +177,12 @@ usb_cb_device_reset (void)
|
|||||||
|
|
||||||
|
|
||||||
void
|
void
|
||||||
usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no, uint16_t value,
|
usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no, uint16_t value)
|
||||||
uint16_t index, uint16_t len)
|
|
||||||
{
|
{
|
||||||
uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);
|
uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);
|
||||||
|
|
||||||
if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT)
|
if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT)
|
||||||
&& index == 0 && USB_SETUP_SET (req) && len == 0
|
&& USB_SETUP_SET (req) && req_no == USB_CDC_REQ_SET_CONTROL_LINE_STATE)
|
||||||
&& req_no == USB_CDC_REQ_SET_CONTROL_LINE_STATE)
|
|
||||||
{
|
{
|
||||||
/* Open/close the connection. */
|
/* Open/close the connection. */
|
||||||
chopstx_mutex_lock (&usb_mtx);
|
chopstx_mutex_lock (&usb_mtx);
|
||||||
@@ -211,22 +209,17 @@ static struct line_coding line_coding = {
|
|||||||
|
|
||||||
|
|
||||||
static int
|
static int
|
||||||
vcom_port_data_setup (uint8_t req, uint8_t req_no, uint16_t value, uint16_t len)
|
vcom_port_data_setup (uint8_t req, uint8_t req_no, struct control_info *detail)
|
||||||
{
|
{
|
||||||
(void)value;
|
|
||||||
if (USB_SETUP_GET (req))
|
if (USB_SETUP_GET (req))
|
||||||
{
|
{
|
||||||
if (req_no == USB_CDC_REQ_GET_LINE_CODING
|
if (req_no == USB_CDC_REQ_GET_LINE_CODING)
|
||||||
&& len == sizeof (line_coding))
|
return usb_lld_reply_request (&line_coding, sizeof(line_coding), detail);
|
||||||
{
|
|
||||||
usb_lld_set_data_to_send (&line_coding, sizeof (line_coding));
|
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
else /* USB_SETUP_SET (req) */
|
else /* USB_SETUP_SET (req) */
|
||||||
{
|
{
|
||||||
if (req_no == USB_CDC_REQ_SET_LINE_CODING
|
if (req_no == USB_CDC_REQ_SET_LINE_CODING
|
||||||
&& len == sizeof (line_coding))
|
&& detail->len == sizeof (line_coding))
|
||||||
{
|
{
|
||||||
usb_lld_set_data_to_recv (&line_coding, sizeof (line_coding));
|
usb_lld_set_data_to_recv (&line_coding, sizeof (line_coding));
|
||||||
return USB_SUCCESS;
|
return USB_SUCCESS;
|
||||||
@@ -239,38 +232,29 @@ vcom_port_data_setup (uint8_t req, uint8_t req_no, uint16_t value, uint16_t len)
|
|||||||
}
|
}
|
||||||
|
|
||||||
int
|
int
|
||||||
usb_cb_setup (uint8_t req, uint8_t req_no,
|
usb_cb_setup (uint8_t req, uint8_t req_no, struct control_info *detail)
|
||||||
uint16_t value, uint16_t index, uint16_t len)
|
|
||||||
{
|
{
|
||||||
uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);
|
uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);
|
||||||
|
|
||||||
(void)len;
|
if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT) && detail->index == 0)
|
||||||
if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT))
|
return vcom_port_data_setup (req, req_no, detail);
|
||||||
if (index == 0)
|
|
||||||
return vcom_port_data_setup (req, req_no, value, len);
|
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
int
|
int
|
||||||
usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
|
usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
|
||||||
uint16_t index)
|
struct control_info *detail)
|
||||||
{
|
{
|
||||||
(void)index;
|
|
||||||
if (rcp != DEVICE_RECIPIENT)
|
if (rcp != DEVICE_RECIPIENT)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (desc_type == DEVICE_DESCRIPTOR)
|
if (desc_type == DEVICE_DESCRIPTOR)
|
||||||
{
|
return usb_lld_reply_request (vcom_device_desc, sizeof (vcom_device_desc),
|
||||||
usb_lld_set_data_to_send (vcom_device_desc, sizeof (vcom_device_desc));
|
detail);
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
|
||||||
else if (desc_type == CONFIG_DESCRIPTOR)
|
else if (desc_type == CONFIG_DESCRIPTOR)
|
||||||
{
|
return usb_lld_reply_request (vcom_config_desc, sizeof (vcom_config_desc),
|
||||||
usb_lld_set_data_to_send (vcom_configuration_desc,
|
detail);
|
||||||
sizeof (vcom_configuration_desc));
|
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
|
||||||
else if (desc_type == STRING_DESCRIPTOR)
|
else if (desc_type == STRING_DESCRIPTOR)
|
||||||
{
|
{
|
||||||
const uint8_t *str;
|
const uint8_t *str;
|
||||||
@@ -298,8 +282,7 @@ usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
|
|||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
usb_lld_set_data_to_send (str, size);
|
return usb_lld_reply_request (str, size, detail);
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
@@ -374,9 +357,11 @@ int usb_cb_handle_event (uint8_t event_type, uint16_t value)
|
|||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
int usb_cb_interface (uint8_t cmd, uint16_t interface, uint16_t alt)
|
int usb_cb_interface (uint8_t cmd, struct control_info *detail)
|
||||||
{
|
{
|
||||||
static uint8_t zero = 0;
|
const uint8_t zero = 0;
|
||||||
|
uint16_t interface = detail->index;
|
||||||
|
uint16_t alt = detail->value;
|
||||||
|
|
||||||
if (interface >= NUM_INTERFACES)
|
if (interface >= NUM_INTERFACES)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
@@ -393,8 +378,7 @@ int usb_cb_interface (uint8_t cmd, uint16_t interface, uint16_t alt)
|
|||||||
}
|
}
|
||||||
|
|
||||||
case USB_GET_INTERFACE:
|
case USB_GET_INTERFACE:
|
||||||
usb_lld_set_data_to_send (&zero, 1);
|
return usb_lld_reply_request (&zero, 1, detail);
|
||||||
return USB_SUCCESS;
|
|
||||||
|
|
||||||
default:
|
default:
|
||||||
case USB_QUERY_INTERFACE:
|
case USB_QUERY_INTERFACE:
|
||||||
|
|||||||
@@ -55,15 +55,19 @@ enum
|
|||||||
USB_SUCCESS = 1,
|
USB_SUCCESS = 1,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
struct control_info {
|
||||||
|
uint16_t value;
|
||||||
|
uint16_t index;
|
||||||
|
uint16_t len;
|
||||||
|
};
|
||||||
|
|
||||||
void usb_cb_device_reset (void);
|
void usb_cb_device_reset (void);
|
||||||
void usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no,
|
int usb_cb_setup (uint8_t req, uint8_t req_no, struct control_info *detail);
|
||||||
uint16_t value, uint16_t index, uint16_t len);
|
int usb_cb_interface (uint8_t cmd, struct control_info *detail);
|
||||||
int usb_cb_setup (uint8_t req, uint8_t req_no, uint16_t value,
|
|
||||||
uint16_t index, uint16_t len);
|
|
||||||
int usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
|
int usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
|
||||||
uint16_t index);
|
struct control_info *detail);
|
||||||
int usb_cb_handle_event (uint8_t event_type, uint16_t value);
|
int usb_cb_handle_event (uint8_t event_type, uint16_t value);
|
||||||
int usb_cb_interface (uint8_t cmd, uint16_t interface, uint16_t value);
|
void usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no, uint16_t value);
|
||||||
|
|
||||||
enum {
|
enum {
|
||||||
USB_EVENT_ADDRESS,
|
USB_EVENT_ADDRESS,
|
||||||
@@ -89,51 +93,30 @@ enum DEVICE_STATE
|
|||||||
CONFIGURED
|
CONFIGURED
|
||||||
};
|
};
|
||||||
|
|
||||||
|
void usb_lld_init (uint8_t feature);
|
||||||
|
void usb_lld_to_pmabuf (const void *src, uint16_t addr, size_t n);
|
||||||
|
void usb_lld_from_pmabuf (void *dst, uint16_t addr, size_t n);
|
||||||
|
void usb_lld_stall_tx (int ep_num);
|
||||||
|
void usb_lld_stall_rx (int ep_num);
|
||||||
|
int usb_lld_tx_data_len (int ep_num);
|
||||||
|
void usb_lld_txcpy (const void *src, int ep_num, int offset, size_t len);
|
||||||
|
void usb_lld_tx_enable (int ep_num, size_t len);
|
||||||
|
void usb_lld_write (uint8_t ep_num, const void *buf, size_t len);
|
||||||
|
int usb_lld_reply_request (const void *buf, size_t buflen,
|
||||||
|
struct control_info *ctrl);
|
||||||
|
void usb_lld_rx_enable (int ep_num);
|
||||||
|
int usb_lld_rx_data_len (int ep_num);
|
||||||
|
void usb_lld_rxcpy (uint8_t *dst, int ep_num, int offset, size_t len);
|
||||||
|
void usb_lld_reset (void);
|
||||||
|
void usb_lld_setup_endpoint (int ep_num, int ep_type, int ep_kind,
|
||||||
|
int ep_rx_addr, int ep_tx_addr,
|
||||||
|
int ep_rx_memory_size);
|
||||||
|
void usb_lld_set_configuration (uint8_t config);
|
||||||
|
uint8_t usb_lld_current_configuration (void);
|
||||||
|
void usb_lld_set_feature (uint8_t feature);
|
||||||
|
void usb_lld_set_data_to_recv (const void *p, size_t len);
|
||||||
|
|
||||||
extern void usb_lld_init (uint8_t feature);
|
void usb_lld_prepare_shutdown (void);
|
||||||
|
void usb_lld_shutdown (void);
|
||||||
|
|
||||||
extern void usb_lld_to_pmabuf (const void *src, uint16_t addr, size_t n);
|
void usb_interrupt_handler (void);
|
||||||
|
|
||||||
extern void usb_lld_from_pmabuf (void *dst, uint16_t addr, size_t n);
|
|
||||||
|
|
||||||
extern void usb_lld_stall_tx (int ep_num);
|
|
||||||
|
|
||||||
extern void usb_lld_stall_rx (int ep_num);
|
|
||||||
|
|
||||||
extern int usb_lld_tx_data_len (int ep_num);
|
|
||||||
|
|
||||||
extern void usb_lld_txcpy (const void *src, int ep_num, int offset, size_t len);
|
|
||||||
|
|
||||||
extern void usb_lld_tx_enable (int ep_num, size_t len);
|
|
||||||
|
|
||||||
extern void usb_lld_write (uint8_t ep_num, const void *buf, size_t len);
|
|
||||||
|
|
||||||
extern void usb_lld_rx_enable (int ep_num);
|
|
||||||
|
|
||||||
extern int usb_lld_rx_data_len (int ep_num);
|
|
||||||
|
|
||||||
extern void usb_lld_rxcpy (uint8_t *dst, int ep_num, int offset, size_t len);
|
|
||||||
|
|
||||||
extern void usb_lld_reset (void);
|
|
||||||
|
|
||||||
extern void usb_lld_setup_endpoint (int ep_num, int ep_type, int ep_kind,
|
|
||||||
int ep_rx_addr, int ep_tx_addr,
|
|
||||||
int ep_rx_memory_size);
|
|
||||||
|
|
||||||
extern void usb_lld_set_configuration (uint8_t config);
|
|
||||||
|
|
||||||
extern uint8_t usb_lld_current_configuration (void);
|
|
||||||
|
|
||||||
extern void usb_lld_set_feature (uint8_t feature);
|
|
||||||
|
|
||||||
extern void usb_lld_set_data_to_send (const void *p, size_t len);
|
|
||||||
|
|
||||||
extern inline void usb_lld_set_data_to_recv (void *p, size_t len)
|
|
||||||
{
|
|
||||||
usb_lld_set_data_to_send ((const void *)p, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
extern void usb_lld_prepare_shutdown (void);
|
|
||||||
extern void usb_lld_shutdown (void);
|
|
||||||
|
|
||||||
extern void usb_interrupt_handler (void);
|
|
||||||
|
|||||||
@@ -1,9 +1,6 @@
|
|||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
|
|
||||||
#define TRUE 1
|
|
||||||
#define FALSE 0
|
|
||||||
|
|
||||||
#include "sys.h"
|
#include "sys.h"
|
||||||
#include "usb_lld.h"
|
#include "usb_lld.h"
|
||||||
|
|
||||||
@@ -49,33 +46,27 @@ enum FEATURE_SELECTOR
|
|||||||
|
|
||||||
struct DATA_INFO
|
struct DATA_INFO
|
||||||
{
|
{
|
||||||
uint16_t len;
|
|
||||||
uint16_t offset;
|
|
||||||
uint8_t *addr;
|
uint8_t *addr;
|
||||||
|
uint16_t len;
|
||||||
uint8_t require_zlp;
|
uint8_t require_zlp;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct CONTROL_INFO
|
|
||||||
{
|
|
||||||
uint8_t bmRequestType;
|
|
||||||
uint8_t bRequest;
|
|
||||||
uint16_t wValue;
|
|
||||||
uint16_t wIndex;
|
|
||||||
uint16_t wLength;
|
|
||||||
};
|
|
||||||
|
|
||||||
struct DEVICE_INFO
|
struct DEVICE_INFO
|
||||||
{
|
{
|
||||||
uint8_t current_configuration;
|
uint8_t current_configuration;
|
||||||
uint8_t current_feature;
|
uint8_t current_feature;
|
||||||
uint8_t state;
|
uint8_t state;
|
||||||
|
/**/
|
||||||
|
uint8_t bmRequestType;
|
||||||
|
uint8_t bRequest;
|
||||||
|
/**/
|
||||||
|
uint16_t value;
|
||||||
};
|
};
|
||||||
|
|
||||||
static struct CONTROL_INFO control_info;
|
|
||||||
static struct DEVICE_INFO device_info;
|
static struct DEVICE_INFO device_info;
|
||||||
static struct DATA_INFO data_info;
|
static struct DATA_INFO data_info;
|
||||||
|
|
||||||
static struct CONTROL_INFO *const ctrl_p = &control_info;
|
|
||||||
static struct DEVICE_INFO *const dev_p = &device_info;
|
static struct DEVICE_INFO *const dev_p = &device_info;
|
||||||
static struct DATA_INFO *const data_p = &data_info;
|
static struct DATA_INFO *const data_p = &data_info;
|
||||||
|
|
||||||
@@ -412,16 +403,14 @@ static void handle_datastage_out (void)
|
|||||||
{
|
{
|
||||||
if (data_p->addr && data_p->len)
|
if (data_p->addr && data_p->len)
|
||||||
{
|
{
|
||||||
uint8_t *buf;
|
|
||||||
uint32_t len = st103_get_rx_count (ENDP0);
|
uint32_t len = st103_get_rx_count (ENDP0);
|
||||||
|
|
||||||
if (len > data_p->len)
|
if (len > data_p->len)
|
||||||
len = data_p->len;
|
len = data_p->len;
|
||||||
|
|
||||||
buf = data_p->addr + data_p->offset;
|
usb_lld_from_pmabuf (data_p->addr, st103_get_rx_addr (ENDP0), len);
|
||||||
usb_lld_from_pmabuf (buf, st103_get_rx_addr (ENDP0), len);
|
|
||||||
data_p->len -= len;
|
data_p->len -= len;
|
||||||
data_p->offset += len;
|
data_p->addr += len;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (data_p->len == 0)
|
if (data_p->len == 0)
|
||||||
@@ -440,13 +429,12 @@ static void handle_datastage_out (void)
|
|||||||
static void handle_datastage_in (void)
|
static void handle_datastage_in (void)
|
||||||
{
|
{
|
||||||
uint32_t len = USB_MAX_PACKET_SIZE;;
|
uint32_t len = USB_MAX_PACKET_SIZE;;
|
||||||
const uint8_t *buf;
|
|
||||||
|
|
||||||
if ((data_p->len == 0) && (dev_p->state == LAST_IN_DATA))
|
if ((data_p->len == 0) && (dev_p->state == LAST_IN_DATA))
|
||||||
{
|
{
|
||||||
if (data_p->require_zlp == TRUE)
|
if (data_p->require_zlp)
|
||||||
{
|
{
|
||||||
data_p->require_zlp = FALSE;
|
data_p->require_zlp = 0;
|
||||||
|
|
||||||
/* No more data to send. Send empty packet */
|
/* No more data to send. Send empty packet */
|
||||||
st103_set_tx_count (ENDP0, 0);
|
st103_set_tx_count (ENDP0, 0);
|
||||||
@@ -467,40 +455,33 @@ static void handle_datastage_in (void)
|
|||||||
if (len > data_p->len)
|
if (len > data_p->len)
|
||||||
len = data_p->len;
|
len = data_p->len;
|
||||||
|
|
||||||
buf = (const uint8_t *)data_p->addr + data_p->offset;
|
usb_lld_to_pmabuf (data_p->addr, st103_get_tx_addr (ENDP0), len);
|
||||||
usb_lld_to_pmabuf (buf, st103_get_tx_addr (ENDP0), len);
|
|
||||||
data_p->len -= len;
|
data_p->len -= len;
|
||||||
data_p->offset += len;
|
data_p->addr += len;
|
||||||
st103_set_tx_count (ENDP0, len);
|
st103_set_tx_count (ENDP0, len);
|
||||||
st103_ep_set_tx_status (ENDP0, EP_TX_VALID);
|
st103_ep_set_tx_status (ENDP0, EP_TX_VALID);
|
||||||
}
|
}
|
||||||
|
|
||||||
typedef int (*HANDLER) (uint8_t req,
|
typedef int (*HANDLER) (uint8_t req, struct control_info *detail);
|
||||||
uint16_t value, uint16_t index, uint16_t length);
|
|
||||||
|
|
||||||
static int std_none (uint8_t req,
|
static int std_none (uint8_t req, struct control_info *detail)
|
||||||
uint16_t value, uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
(void)req; (void)value; (void)index; (void)length;
|
(void)req; (void)detail;
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_get_status (uint8_t req,
|
static int std_get_status (uint8_t req, struct control_info *detail)
|
||||||
uint16_t value, uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
static uint16_t status_info;
|
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
uint16_t status_info = 0;
|
||||||
|
|
||||||
status_info = 0; /* Reset Status Information */
|
if (detail->value != 0 || detail->len != 2 || (detail->index >> 8) != 0
|
||||||
data_p->addr = (uint8_t *)&status_info;
|
|
||||||
|
|
||||||
if (value != 0 || length != 2 || (index >> 8) != 0
|
|
||||||
|| (req & REQUEST_DIR) == 0)
|
|| (req & REQUEST_DIR) == 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (rcp == DEVICE_RECIPIENT)
|
if (rcp == DEVICE_RECIPIENT)
|
||||||
{
|
{
|
||||||
if (index == 0)
|
if (detail->index == 0)
|
||||||
{
|
{
|
||||||
/* Get Device Status */
|
/* Get Device Status */
|
||||||
uint8_t feature = dev_p->current_feature;
|
uint8_t feature = dev_p->current_feature;
|
||||||
@@ -517,8 +498,7 @@ static int std_get_status (uint8_t req,
|
|||||||
else /* Self-powered */
|
else /* Self-powered */
|
||||||
status_info &= ~1;
|
status_info &= ~1;
|
||||||
|
|
||||||
data_p->len = 2;
|
return usb_lld_reply_request (&status_info, 2, detail);
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else if (rcp == INTERFACE_RECIPIENT)
|
else if (rcp == INTERFACE_RECIPIENT)
|
||||||
@@ -528,22 +508,21 @@ static int std_get_status (uint8_t req,
|
|||||||
if (dev_p->current_configuration == 0)
|
if (dev_p->current_configuration == 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
r = usb_cb_interface (USB_QUERY_INTERFACE, index, 0);
|
r = usb_cb_interface (USB_QUERY_INTERFACE, detail);
|
||||||
if (r != USB_SUCCESS)
|
if (r != USB_SUCCESS)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
data_p->len = 2;
|
return usb_lld_reply_request (&status_info, 2, detail);
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
}
|
||||||
else if (rcp == ENDPOINT_RECIPIENT)
|
else if (rcp == ENDPOINT_RECIPIENT)
|
||||||
{
|
{
|
||||||
uint8_t endpoint = (index & 0x0f);
|
uint8_t endpoint = (detail->index & 0x0f);
|
||||||
uint16_t status;
|
uint16_t status;
|
||||||
|
|
||||||
if ((index & 0x70) || endpoint == ENDP0)
|
if ((detail->index & 0x70) || endpoint == ENDP0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if ((index & 0x80))
|
if ((detail->index & 0x80))
|
||||||
{
|
{
|
||||||
status = st103_ep_get_tx_status (endpoint);
|
status = st103_ep_get_tx_status (endpoint);
|
||||||
if (status == 0) /* Disabled */
|
if (status == 0) /* Disabled */
|
||||||
@@ -560,15 +539,13 @@ static int std_get_status (uint8_t req,
|
|||||||
status_info |= 1; /* OUT Endpoint stalled */
|
status_info |= 1; /* OUT Endpoint stalled */
|
||||||
}
|
}
|
||||||
|
|
||||||
data_p->len = 2;
|
return usb_lld_reply_request (&status_info, 2, detail);
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_clear_feature (uint8_t req, uint16_t value,
|
static int std_clear_feature (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
@@ -577,10 +554,10 @@ static int std_clear_feature (uint8_t req, uint16_t value,
|
|||||||
|
|
||||||
if (rcp == DEVICE_RECIPIENT)
|
if (rcp == DEVICE_RECIPIENT)
|
||||||
{
|
{
|
||||||
if (length != 0 || index != 0)
|
if (detail->len != 0 || detail->index != 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (value == DEVICE_REMOTE_WAKEUP)
|
if (detail->value == DEVICE_REMOTE_WAKEUP)
|
||||||
{
|
{
|
||||||
dev_p->current_feature &= ~(1 << 5);
|
dev_p->current_feature &= ~(1 << 5);
|
||||||
return USB_SUCCESS;
|
return USB_SUCCESS;
|
||||||
@@ -588,17 +565,17 @@ static int std_clear_feature (uint8_t req, uint16_t value,
|
|||||||
}
|
}
|
||||||
else if (rcp == ENDPOINT_RECIPIENT)
|
else if (rcp == ENDPOINT_RECIPIENT)
|
||||||
{
|
{
|
||||||
uint8_t endpoint = (index & 0x0f);
|
uint8_t endpoint = (detail->index & 0x0f);
|
||||||
uint16_t status;
|
uint16_t status;
|
||||||
|
|
||||||
if (dev_p->current_configuration == 0)
|
if (dev_p->current_configuration == 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (length != 0 || (index >> 8) != 0 || value != ENDPOINT_STALL
|
if (detail->len != 0 || (detail->index >> 8) != 0
|
||||||
|| endpoint == ENDP0)
|
|| detail->value != ENDPOINT_STALL || endpoint == ENDP0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if ((index & 0x80))
|
if ((detail->index & 0x80))
|
||||||
status = st103_ep_get_tx_status (endpoint);
|
status = st103_ep_get_tx_status (endpoint);
|
||||||
else
|
else
|
||||||
status = st103_ep_get_rx_status (endpoint);
|
status = st103_ep_get_rx_status (endpoint);
|
||||||
@@ -606,7 +583,7 @@ static int std_clear_feature (uint8_t req, uint16_t value,
|
|||||||
if (status == 0) /* Disabled */
|
if (status == 0) /* Disabled */
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (index & 0x80) /* IN endpoint */
|
if (detail->index & 0x80) /* IN endpoint */
|
||||||
st103_ep_clear_dtog_tx (endpoint);
|
st103_ep_clear_dtog_tx (endpoint);
|
||||||
else /* OUT endpoint */
|
else /* OUT endpoint */
|
||||||
st103_ep_clear_dtog_rx (endpoint);
|
st103_ep_clear_dtog_rx (endpoint);
|
||||||
@@ -618,8 +595,7 @@ static int std_clear_feature (uint8_t req, uint16_t value,
|
|||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_set_feature (uint8_t req, uint16_t value,
|
static int std_set_feature (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
@@ -628,10 +604,10 @@ static int std_set_feature (uint8_t req, uint16_t value,
|
|||||||
|
|
||||||
if (rcp == DEVICE_RECIPIENT)
|
if (rcp == DEVICE_RECIPIENT)
|
||||||
{
|
{
|
||||||
if (length != 0 || index != 0)
|
if (detail->len != 0 || detail->index != 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (value == DEVICE_REMOTE_WAKEUP)
|
if (detail->value == DEVICE_REMOTE_WAKEUP)
|
||||||
{
|
{
|
||||||
dev_p->current_feature |= 1 << 5;
|
dev_p->current_feature |= 1 << 5;
|
||||||
// event??
|
// event??
|
||||||
@@ -640,16 +616,17 @@ static int std_set_feature (uint8_t req, uint16_t value,
|
|||||||
}
|
}
|
||||||
else if (rcp == ENDPOINT_RECIPIENT)
|
else if (rcp == ENDPOINT_RECIPIENT)
|
||||||
{
|
{
|
||||||
uint8_t endpoint = (index & 0x0f);
|
uint8_t endpoint = (detail->index & 0x0f);
|
||||||
uint32_t status;
|
uint32_t status;
|
||||||
|
|
||||||
if (dev_p->current_configuration == 0)
|
if (dev_p->current_configuration == 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (length != 0 || (index >> 8) != 0 || value != 0 || endpoint == ENDP0)
|
if (detail->len != 0 || (detail->index >> 8) != 0
|
||||||
|
|| detail->value != 0 || endpoint == ENDP0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if ((index & 0x80))
|
if ((detail->index & 0x80))
|
||||||
status = st103_ep_get_tx_status (endpoint);
|
status = st103_ep_get_tx_status (endpoint);
|
||||||
else
|
else
|
||||||
status = st103_ep_get_rx_status (endpoint);
|
status = st103_ep_get_rx_status (endpoint);
|
||||||
@@ -657,7 +634,7 @@ static int std_set_feature (uint8_t req, uint16_t value,
|
|||||||
if (status == 0) /* Disabled */
|
if (status == 0) /* Disabled */
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (index & 0x80)
|
if (detail->index & 0x80)
|
||||||
/* IN endpoint */
|
/* IN endpoint */
|
||||||
st103_ep_set_tx_status (endpoint, EP_TX_STALL);
|
st103_ep_set_tx_status (endpoint, EP_TX_STALL);
|
||||||
else
|
else
|
||||||
@@ -671,77 +648,59 @@ static int std_set_feature (uint8_t req, uint16_t value,
|
|||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_set_address (uint8_t req, uint16_t value,
|
static int std_set_address (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
if ((req & REQUEST_DIR) == 1)
|
if ((req & REQUEST_DIR) == 1)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (rcp == DEVICE_RECIPIENT)
|
if (rcp == DEVICE_RECIPIENT && detail->len == 0 && detail->value <= 127
|
||||||
{
|
&& detail->index == 0 && dev_p->current_configuration == 0)
|
||||||
if (length == 0 && value <= 127 && index == 0
|
return USB_SUCCESS;
|
||||||
&& dev_p->current_configuration == 0)
|
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_get_descriptor (uint8_t req, uint16_t value,
|
static int std_get_descriptor (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
if ((req & REQUEST_DIR) == 0)
|
if ((req & REQUEST_DIR) == 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
(void)length;
|
return usb_cb_get_descriptor (rcp, (detail->value >> 8),
|
||||||
return usb_cb_get_descriptor (rcp, (value >> 8), (value & 0xff), index);
|
(detail->value & 0xff), detail);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_get_configuration (uint8_t req, uint16_t value,
|
static int std_get_configuration (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
|
(void)detail;
|
||||||
if ((req & REQUEST_DIR) == 0)
|
if ((req & REQUEST_DIR) == 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
(void)value; (void)index; (void)length;
|
|
||||||
if (rcp == DEVICE_RECIPIENT)
|
if (rcp == DEVICE_RECIPIENT)
|
||||||
{
|
return usb_lld_reply_request (&dev_p->current_configuration, 1, detail);
|
||||||
data_p->addr = &dev_p->current_configuration;
|
|
||||||
data_p->len = 1;
|
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_set_configuration (uint8_t req, uint16_t value,
|
static int std_set_configuration (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
if ((req & REQUEST_DIR) == 1)
|
if ((req & REQUEST_DIR) == 1)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (rcp == DEVICE_RECIPIENT && index == 0 && length == 0)
|
if (rcp == DEVICE_RECIPIENT && detail->index == 0 && detail->len == 0)
|
||||||
{
|
return usb_cb_handle_event (USB_EVENT_CONFIG, detail->value);
|
||||||
int r;
|
|
||||||
|
|
||||||
r = usb_cb_handle_event (USB_EVENT_CONFIG, value);
|
|
||||||
if (r == USB_SUCCESS)
|
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_get_interface (uint8_t req, uint16_t value,
|
static int std_get_interface (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
@@ -750,74 +709,61 @@ static int std_get_interface (uint8_t req, uint16_t value,
|
|||||||
|
|
||||||
if (rcp == INTERFACE_RECIPIENT)
|
if (rcp == INTERFACE_RECIPIENT)
|
||||||
{
|
{
|
||||||
if (value != 0 || (index >> 8) != 0 || length != 1)
|
if (detail->value != 0 || (detail->index >> 8) != 0 || detail->len != 1)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (dev_p->current_configuration == 0)
|
if (dev_p->current_configuration == 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
return usb_cb_interface (USB_GET_INTERFACE, index, 0);
|
return usb_cb_interface (USB_GET_INTERFACE, detail);
|
||||||
}
|
}
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int std_set_interface (uint8_t req, uint16_t value,
|
static int std_set_interface (uint8_t req, struct control_info *detail)
|
||||||
uint16_t index, uint16_t length)
|
|
||||||
{
|
{
|
||||||
uint8_t rcp = req & RECIPIENT;
|
uint8_t rcp = req & RECIPIENT;
|
||||||
|
|
||||||
if ((req & REQUEST_DIR) == 1)
|
if ((req & REQUEST_DIR) == 1 || rcp != INTERFACE_RECIPIENT
|
||||||
|
|| detail->len != 0 || (detail->index >> 8) != 0
|
||||||
|
|| (detail->value >> 8) != 0 || dev_p->current_configuration != 0)
|
||||||
return USB_UNSUPPORT;
|
return USB_UNSUPPORT;
|
||||||
|
|
||||||
if (rcp == INTERFACE_RECIPIENT)
|
return usb_cb_interface (USB_SET_INTERFACE, detail);
|
||||||
{
|
|
||||||
int r;
|
|
||||||
|
|
||||||
if (length != 0 || (index >> 8) != 0 || (value >> 8) != 0)
|
|
||||||
return USB_UNSUPPORT;
|
|
||||||
|
|
||||||
if (dev_p->current_configuration != 0)
|
|
||||||
return USB_UNSUPPORT;
|
|
||||||
|
|
||||||
r = usb_cb_interface (USB_SET_INTERFACE, index, value);
|
|
||||||
if (r == USB_SUCCESS)
|
|
||||||
return USB_SUCCESS;
|
|
||||||
}
|
|
||||||
|
|
||||||
return USB_UNSUPPORT;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
static void handle_setup0 (void)
|
static void handle_setup0 (void)
|
||||||
{
|
{
|
||||||
const uint16_t *pw;
|
const uint16_t *pw;
|
||||||
|
struct control_info ctrl;
|
||||||
uint16_t w;
|
uint16_t w;
|
||||||
uint8_t req;
|
uint8_t req_no;
|
||||||
int r = USB_UNSUPPORT;
|
int r = USB_UNSUPPORT;
|
||||||
HANDLER handler;
|
HANDLER handler;
|
||||||
|
|
||||||
pw = (uint16_t *)(PMA_ADDR + (uint8_t *)(st103_get_rx_addr (ENDP0) * 2));
|
pw = (uint16_t *)(PMA_ADDR + (uint8_t *)(st103_get_rx_addr (ENDP0) * 2));
|
||||||
w = *pw++;
|
w = *pw++;
|
||||||
|
|
||||||
ctrl_p->bmRequestType = w & 0xff;
|
dev_p->bmRequestType = w & 0xff;
|
||||||
ctrl_p->bRequest = req = w >> 8;
|
dev_p->bRequest = req_no = w >> 8;
|
||||||
pw++;
|
pw++;
|
||||||
ctrl_p->wValue = *pw++;
|
ctrl.value = *pw++;
|
||||||
pw++;
|
pw++;
|
||||||
ctrl_p->wIndex = *pw++;
|
ctrl.index = *pw++;
|
||||||
pw++;
|
pw++;
|
||||||
ctrl_p->wLength = *pw;
|
ctrl.len = *pw;
|
||||||
|
|
||||||
data_p->addr = NULL;
|
data_p->addr = NULL;
|
||||||
data_p->len = 0;
|
data_p->len = 0;
|
||||||
data_p->offset = 0;
|
data_p->require_zlp = 0;
|
||||||
|
|
||||||
if ((ctrl_p->bmRequestType & REQUEST_TYPE) == STANDARD_REQUEST)
|
if ((dev_p->bmRequestType & REQUEST_TYPE) == STANDARD_REQUEST)
|
||||||
{
|
{
|
||||||
if (req < TOTAL_REQUEST)
|
if (req_no < TOTAL_REQUEST)
|
||||||
{
|
{
|
||||||
switch (req)
|
switch (req_no)
|
||||||
{
|
{
|
||||||
case 0: handler = std_get_status; break;
|
case 0: handler = std_get_status; break;
|
||||||
case 1: handler = std_clear_feature; break;
|
case 1: handler = std_clear_feature; break;
|
||||||
@@ -831,44 +777,30 @@ static void handle_setup0 (void)
|
|||||||
default: handler = std_none; break;
|
default: handler = std_none; break;
|
||||||
}
|
}
|
||||||
|
|
||||||
r = (*handler) (ctrl_p->bmRequestType,
|
r = (*handler) (dev_p->bmRequestType, &ctrl);
|
||||||
ctrl_p->wValue, ctrl_p->wIndex, ctrl_p->wLength);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
r = usb_cb_setup (ctrl_p->bmRequestType, req,
|
r = usb_cb_setup (dev_p->bmRequestType, req_no, &ctrl);
|
||||||
ctrl_p->wValue, ctrl_p->wIndex, ctrl_p->wLength);
|
|
||||||
|
|
||||||
if (r != USB_SUCCESS)
|
if (r != USB_SUCCESS)
|
||||||
dev_p->state = STALLED;
|
dev_p->state = STALLED;
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
if (USB_SETUP_GET (ctrl_p->bmRequestType))
|
if (USB_SETUP_SET (dev_p->bmRequestType))
|
||||||
{
|
{
|
||||||
uint32_t len = ctrl_p->wLength;
|
dev_p->value = ctrl.value;
|
||||||
|
if (ctrl.len == 0)
|
||||||
/* Restrict the data length to be the one host asks for */
|
{
|
||||||
if (data_p->len > len)
|
dev_p->state = WAIT_STATUS_IN;
|
||||||
data_p->len = len;
|
st103_set_tx_count (ENDP0, 0);
|
||||||
|
st103_ep_set_rxtx_status (ENDP0, EP_RX_STALL, EP_TX_VALID);
|
||||||
if ((data_p->len % USB_MAX_PACKET_SIZE) == 0)
|
}
|
||||||
data_p->require_zlp = TRUE;
|
|
||||||
else
|
else
|
||||||
data_p->require_zlp = FALSE;
|
{
|
||||||
|
dev_p->state = OUT_DATA;
|
||||||
dev_p->state = IN_DATA;
|
st103_ep_set_rx_status (ENDP0, EP_RX_VALID);
|
||||||
handle_datastage_in ();
|
}
|
||||||
}
|
|
||||||
else if (ctrl_p->wLength == 0)
|
|
||||||
{
|
|
||||||
dev_p->state = WAIT_STATUS_IN;
|
|
||||||
st103_set_tx_count (ENDP0, 0);
|
|
||||||
st103_ep_set_rxtx_status (ENDP0, EP_RX_STALL, EP_TX_VALID);
|
|
||||||
}
|
|
||||||
else
|
|
||||||
{
|
|
||||||
dev_p->state = OUT_DATA;
|
|
||||||
st103_ep_set_rx_status (ENDP0, EP_RX_VALID);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -879,17 +811,16 @@ static void handle_in0 (void)
|
|||||||
handle_datastage_in ();
|
handle_datastage_in ();
|
||||||
else if (dev_p->state == WAIT_STATUS_IN)
|
else if (dev_p->state == WAIT_STATUS_IN)
|
||||||
{
|
{
|
||||||
if ((ctrl_p->bRequest == SET_ADDRESS) &&
|
if ((dev_p->bRequest == SET_ADDRESS) &&
|
||||||
((ctrl_p->bmRequestType & (REQUEST_TYPE | RECIPIENT))
|
((dev_p->bmRequestType & (REQUEST_TYPE | RECIPIENT))
|
||||||
== (STANDARD_REQUEST | DEVICE_RECIPIENT)))
|
== (STANDARD_REQUEST | DEVICE_RECIPIENT)))
|
||||||
{
|
{
|
||||||
st103_set_daddr (ctrl_p->wValue);
|
st103_set_daddr (dev_p->value);
|
||||||
usb_cb_handle_event (USB_EVENT_ADDRESS, ctrl_p->wValue);
|
usb_cb_handle_event (USB_EVENT_ADDRESS, dev_p->value);
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
usb_cb_ctrl_write_finish (ctrl_p->bmRequestType,
|
usb_cb_ctrl_write_finish (dev_p->bmRequestType, dev_p->bRequest,
|
||||||
ctrl_p->bRequest, ctrl_p->wValue,
|
dev_p->value);
|
||||||
ctrl_p->wIndex, ctrl_p->wLength);
|
|
||||||
|
|
||||||
dev_p->state = STALLED;
|
dev_p->state = STALLED;
|
||||||
}
|
}
|
||||||
@@ -1111,7 +1042,7 @@ void usb_lld_set_feature (uint8_t feature)
|
|||||||
dev_p->current_feature = feature;
|
dev_p->current_feature = feature;
|
||||||
}
|
}
|
||||||
|
|
||||||
void usb_lld_set_data_to_send (const void *p, size_t len)
|
void usb_lld_set_data_to_recv (const void *p, size_t len)
|
||||||
{
|
{
|
||||||
data_p->addr = (uint8_t *)p;
|
data_p->addr = (uint8_t *)p;
|
||||||
data_p->len = len;
|
data_p->len = len;
|
||||||
@@ -1189,3 +1120,49 @@ void usb_lld_from_pmabuf (void *dst, uint16_t addr, size_t n)
|
|||||||
*d = (w & 0xff);
|
*d = (w & 0xff);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*
|
||||||
|
* BUF: Pointer to data memory. Data memory should not be allocated
|
||||||
|
* on stack when BUFLEN > USB_MAX_PACKET_SIZE.
|
||||||
|
*
|
||||||
|
* BUFLEN: size of the data.
|
||||||
|
*/
|
||||||
|
int
|
||||||
|
usb_lld_reply_request (const void *buf, size_t buflen, struct control_info *ctl)
|
||||||
|
{
|
||||||
|
uint32_t len_asked = ctl->len;
|
||||||
|
uint32_t len;
|
||||||
|
|
||||||
|
data_p->addr = (void *)buf;
|
||||||
|
data_p->len = buflen;
|
||||||
|
|
||||||
|
/* Restrict the data length to be the one host asks for */
|
||||||
|
if (data_p->len > len_asked)
|
||||||
|
data_p->len = len_asked;
|
||||||
|
|
||||||
|
if (data_p->len != 0 && (data_p->len % USB_MAX_PACKET_SIZE) == 0)
|
||||||
|
data_p->require_zlp = 1;
|
||||||
|
|
||||||
|
if (data_p->len < USB_MAX_PACKET_SIZE)
|
||||||
|
{
|
||||||
|
len = data_p->len;
|
||||||
|
dev_p->state = LAST_IN_DATA;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
len = USB_MAX_PACKET_SIZE;
|
||||||
|
dev_p->state = IN_DATA;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (len)
|
||||||
|
{
|
||||||
|
usb_lld_to_pmabuf (data_p->addr, st103_get_tx_addr (ENDP0), len);
|
||||||
|
data_p->len -= len;
|
||||||
|
data_p->addr += len;
|
||||||
|
}
|
||||||
|
|
||||||
|
st103_set_tx_count (ENDP0, len);
|
||||||
|
st103_ep_set_tx_status (ENDP0, EP_TX_VALID);
|
||||||
|
return USB_SUCCESS;
|
||||||
|
}
|
||||||
|
|||||||
@@ -14,7 +14,8 @@ OBJCOPY = $(CROSS)objcopy
|
|||||||
|
|
||||||
MCU = cortex-m0 # -save-temps
|
MCU = cortex-m0 # -save-temps
|
||||||
CWARN = -Wall -Wextra -Wstrict-prototypes
|
CWARN = -Wall -Wextra -Wstrict-prototypes
|
||||||
DEFS = -DHAVE_SYS_H -DFREE_STANDING -DMHZ=48 -DUSE_WFI_FOR_IDLE
|
DEFS = -DMAKE_ENTRY_PUBLIC \
|
||||||
|
-DFREE_STANDING -DMHZ=48 -DUSE_WFI_FOR_IDLE
|
||||||
OPT = -O3 -Os -g
|
OPT = -O3 -Os -g
|
||||||
LIBS =
|
LIBS =
|
||||||
|
|
||||||
|
|||||||
12
example-fsm-55/README
Normal file
12
example-fsm-55/README
Normal file
@@ -0,0 +1,12 @@
|
|||||||
|
FSM-55 LED Matrix Display Board is a simple board to play 5x5 LED
|
||||||
|
Display. Please see the product page:
|
||||||
|
|
||||||
|
http://www.seeedstudio.com/depot/FSM55-LED-Matrix-Display-p-2121.html
|
||||||
|
|
||||||
|
The file stlink-v2.cfg can be used for ST-Link/V2 with OpenOCD. You
|
||||||
|
can flash by typing:
|
||||||
|
|
||||||
|
$ openocd -f ./stlink-v2.cfg -c "program build/hacker-emblem.elf"
|
||||||
|
|
||||||
|
Thanks to Kiwamu Okabe who kindly tested OpenOCD and wrote the
|
||||||
|
configuration.
|
||||||
@@ -9,44 +9,24 @@ __process3_stack_size__ = 0x0100; /* third thread program */
|
|||||||
|
|
||||||
MEMORY
|
MEMORY
|
||||||
{
|
{
|
||||||
flash0 : org = 0x08000000, len = 4k
|
flash : org = 0x08000000, len = 16k
|
||||||
flash : org = 0x08000000+0x1000, len = 60k
|
ram : org = 0x20000000, len = 4k
|
||||||
ram : org = 0x20000000, len = 20k
|
|
||||||
}
|
}
|
||||||
|
|
||||||
__ram_start__ = ORIGIN(ram);
|
__ram_start__ = ORIGIN(ram);
|
||||||
__ram_size__ = 20k;
|
__ram_size__ = 4k;
|
||||||
__ram_end__ = __ram_start__ + __ram_size__;
|
__ram_end__ = __ram_start__ + __ram_size__;
|
||||||
|
|
||||||
SECTIONS
|
SECTIONS
|
||||||
{
|
{
|
||||||
. = 0;
|
. = 0;
|
||||||
|
|
||||||
.sys : ALIGN(4) SUBALIGN(4)
|
|
||||||
{
|
|
||||||
_sys = .;
|
|
||||||
KEEP(*(.vectors))
|
|
||||||
. = ALIGN(16);
|
|
||||||
KEEP(*(.sys.version))
|
|
||||||
KEEP(*(.sys.board_id))
|
|
||||||
KEEP(*(.sys.board_name))
|
|
||||||
build/sys.o(.text)
|
|
||||||
build/sys.o(.text.*)
|
|
||||||
build/sys.o(.rodata)
|
|
||||||
build/sys.o(.rodata.*)
|
|
||||||
. = ALIGN(1024);
|
|
||||||
} > flash0 =0xffffffff
|
|
||||||
|
|
||||||
_text = .;
|
_text = .;
|
||||||
|
|
||||||
.startup : ALIGN(128) SUBALIGN(128)
|
|
||||||
{
|
|
||||||
KEEP(*(.startup.vectors))
|
|
||||||
. = ALIGN (16);
|
|
||||||
} > flash =0xffffffff
|
|
||||||
|
|
||||||
.text : ALIGN(16) SUBALIGN(16)
|
.text : ALIGN(16) SUBALIGN(16)
|
||||||
{
|
{
|
||||||
|
KEEP(*(.vectors))
|
||||||
|
. = ALIGN(16);
|
||||||
*(.text.startup.*)
|
*(.text.startup.*)
|
||||||
*(.text)
|
*(.text)
|
||||||
*(.text.*)
|
*(.text.*)
|
||||||
@@ -58,6 +38,12 @@ SECTIONS
|
|||||||
. = ALIGN(8);
|
. = ALIGN(8);
|
||||||
} > flash
|
} > flash
|
||||||
|
|
||||||
|
/DISCARD/ :
|
||||||
|
{
|
||||||
|
*(.startup.vectors)
|
||||||
|
*(.bss.startup.0)
|
||||||
|
}
|
||||||
|
|
||||||
.ARM.extab : {*(.ARM.extab* .gnu.linkonce.armextab.*)} > flash
|
.ARM.extab : {*(.ARM.extab* .gnu.linkonce.armextab.*)} > flash
|
||||||
|
|
||||||
.ARM.exidx : {
|
.ARM.exidx : {
|
||||||
@@ -75,13 +61,6 @@ SECTIONS
|
|||||||
_etext = .;
|
_etext = .;
|
||||||
_textdata = _etext;
|
_textdata = _etext;
|
||||||
|
|
||||||
.vectors_in_ram :
|
|
||||||
{
|
|
||||||
. = ALIGN(8);
|
|
||||||
__vector_ram_addr__ = .;
|
|
||||||
KEEP(*(.bss.startup.*))
|
|
||||||
} > ram
|
|
||||||
|
|
||||||
.process_stack :
|
.process_stack :
|
||||||
{
|
{
|
||||||
. = ALIGN(8);
|
. = ALIGN(8);
|
||||||
|
|||||||
11
example-fsm-55/stlink-v2.cfg
Normal file
11
example-fsm-55/stlink-v2.cfg
Normal file
@@ -0,0 +1,11 @@
|
|||||||
|
# Contributed by Kiwamu Okabe
|
||||||
|
|
||||||
|
source [find interface/stlink-v2.cfg]
|
||||||
|
transport select hla_swd
|
||||||
|
|
||||||
|
# The STM32F030F4P6 is a *tightly* constrained chip; the work area size must be
|
||||||
|
# similarly constrained.
|
||||||
|
set WORKAREASIZE 0x1000
|
||||||
|
source [find target/stm32f0x.cfg]
|
||||||
|
|
||||||
|
# use hardware reset, connect under reset
|
||||||
@@ -1,7 +1,7 @@
|
|||||||
/*
|
/*
|
||||||
* sys.c - system routines for the initial page for STM32F030 / STM32F103.
|
* sys.c - No system routines, but only RESET handler for STM32F030.
|
||||||
*
|
*
|
||||||
* Copyright (C) 2013, 2014, 2015 Flying Stone Technology
|
* Copyright (C) 2015 Flying Stone Technology
|
||||||
* Author: NIIBE Yutaka <gniibe@fsij.org>
|
* Author: NIIBE Yutaka <gniibe@fsij.org>
|
||||||
*
|
*
|
||||||
* Copying and distribution of this file, with or without modification,
|
* Copying and distribution of this file, with or without modification,
|
||||||
@@ -9,453 +9,110 @@
|
|||||||
* notice and this notice are preserved. This file is offered as-is,
|
* notice and this notice are preserved. This file is offered as-is,
|
||||||
* without any warranty.
|
* without any warranty.
|
||||||
*
|
*
|
||||||
* When the flash ROM is protected, we cannot modify the initial page.
|
|
||||||
* We put some system routines (which is useful for any program) here.
|
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
#include "board.h"
|
|
||||||
|
|
||||||
#include "clk_gpio_init.c"
|
|
||||||
|
|
||||||
#define CORTEX_PRIORITY_BITS 4
|
|
||||||
#define CORTEX_PRIORITY_MASK(n) ((n) << (8 - CORTEX_PRIORITY_BITS))
|
|
||||||
#define USB_LP_CAN1_RX0_IRQn 20
|
|
||||||
#define STM32_USB_IRQ_PRIORITY 11
|
|
||||||
|
|
||||||
struct NVIC {
|
|
||||||
uint32_t ISER[8];
|
|
||||||
uint32_t unused1[24];
|
|
||||||
uint32_t ICER[8];
|
|
||||||
uint32_t unused2[24];
|
|
||||||
uint32_t ISPR[8];
|
|
||||||
uint32_t unused3[24];
|
|
||||||
uint32_t ICPR[8];
|
|
||||||
uint32_t unused4[24];
|
|
||||||
uint32_t IABR[8];
|
|
||||||
uint32_t unused5[56];
|
|
||||||
uint32_t IPR[60];
|
|
||||||
};
|
|
||||||
|
|
||||||
static struct NVIC *const NVICBase = ((struct NVIC *const)0xE000E100);
|
|
||||||
#define NVIC_ISER(n) (NVICBase->ISER[n >> 5])
|
|
||||||
#define NVIC_ICPR(n) (NVICBase->ICPR[n >> 5])
|
|
||||||
#define NVIC_IPR(n) (NVICBase->IPR[n >> 2])
|
|
||||||
|
|
||||||
static void
|
|
||||||
nvic_enable_vector (uint32_t n, uint32_t prio)
|
|
||||||
{
|
|
||||||
unsigned int sh = (n & 3) << 3;
|
|
||||||
|
|
||||||
NVIC_IPR (n) = (NVIC_IPR(n) & ~(0xFF << sh)) | (prio << sh);
|
|
||||||
NVIC_ICPR (n) = 1 << (n & 0x1F);
|
|
||||||
NVIC_ISER (n) = 1 << (n & 0x1F);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void
|
|
||||||
usb_cable_config (int enable)
|
|
||||||
{
|
|
||||||
#if defined(GPIO_USB_SET_TO_ENABLE)
|
|
||||||
if (enable)
|
|
||||||
GPIO_USB->BSRR = (1 << GPIO_USB_SET_TO_ENABLE);
|
|
||||||
else
|
|
||||||
GPIO_USB->BRR = (1 << GPIO_USB_SET_TO_ENABLE);
|
|
||||||
#elif defined(GPIO_USB_CLEAR_TO_ENABLE)
|
|
||||||
if (enable)
|
|
||||||
GPIO_USB->BRR = (1 << GPIO_USB_CLEAR_TO_ENABLE);
|
|
||||||
else
|
|
||||||
GPIO_USB->BSRR = (1 << GPIO_USB_CLEAR_TO_ENABLE);
|
|
||||||
#else
|
|
||||||
(void)enable;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
void
|
|
||||||
set_led (int on)
|
|
||||||
{
|
|
||||||
#if defined(GPIO_LED_CLEAR_TO_EMIT)
|
|
||||||
if (on)
|
|
||||||
GPIO_LED->BRR = (1 << GPIO_LED_CLEAR_TO_EMIT);
|
|
||||||
else
|
|
||||||
GPIO_LED->BSRR = (1 << GPIO_LED_CLEAR_TO_EMIT);
|
|
||||||
#else
|
|
||||||
if (on)
|
|
||||||
GPIO_LED->BSRR = (1 << GPIO_LED_SET_TO_EMIT);
|
|
||||||
else
|
|
||||||
GPIO_LED->BRR = (1 << GPIO_LED_SET_TO_EMIT);
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
static void wait (int count)
|
|
||||||
{
|
|
||||||
int i;
|
|
||||||
|
|
||||||
for (i = 0; i < count; i++)
|
|
||||||
asm volatile ("" : : "r" (i) : "memory");
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
static void
|
|
||||||
usb_lld_sys_shutdown (void)
|
|
||||||
{
|
|
||||||
RCC->APB1ENR &= ~RCC_APB1ENR_USBEN;
|
|
||||||
RCC->APB1RSTR = RCC_APB1RSTR_USBRST;
|
|
||||||
usb_cable_config (0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void
|
|
||||||
usb_lld_sys_init (void)
|
|
||||||
{
|
|
||||||
if ((RCC->APB1ENR & RCC_APB1ENR_USBEN)
|
|
||||||
&& (RCC->APB1RSTR & RCC_APB1RSTR_USBRST) == 0)
|
|
||||||
/* Make sure the device is disconnected, even after core reset. */
|
|
||||||
{
|
|
||||||
usb_lld_sys_shutdown ();
|
|
||||||
/* Disconnect requires SE0 (>= 2.5uS). */
|
|
||||||
wait (300);
|
|
||||||
}
|
|
||||||
|
|
||||||
usb_cable_config (1);
|
|
||||||
RCC->APB1ENR |= RCC_APB1ENR_USBEN;
|
|
||||||
nvic_enable_vector (USB_LP_CAN1_RX0_IRQn,
|
|
||||||
CORTEX_PRIORITY_MASK (STM32_USB_IRQ_PRIORITY));
|
|
||||||
/*
|
|
||||||
* Note that we also have other IRQ(s):
|
|
||||||
* USB_HP_CAN1_TX_IRQn (for double-buffered or isochronous)
|
|
||||||
* USBWakeUp_IRQn (suspend/resume)
|
|
||||||
*/
|
|
||||||
RCC->APB1RSTR = RCC_APB1RSTR_USBRST;
|
|
||||||
RCC->APB1RSTR = 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
#define FLASH_KEY1 0x45670123UL
|
|
||||||
#define FLASH_KEY2 0xCDEF89ABUL
|
|
||||||
|
|
||||||
enum flash_status
|
|
||||||
{
|
|
||||||
FLASH_BUSY = 1,
|
|
||||||
FLASH_ERROR_PG,
|
|
||||||
FLASH_ERROR_WRP,
|
|
||||||
FLASH_COMPLETE,
|
|
||||||
FLASH_TIMEOUT
|
|
||||||
};
|
|
||||||
|
|
||||||
static void __attribute__ ((used))
|
|
||||||
flash_unlock (void)
|
|
||||||
{
|
|
||||||
FLASH->KEYR = FLASH_KEY1;
|
|
||||||
FLASH->KEYR = FLASH_KEY2;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
#define intr_disable() asm volatile ("cpsid i" : : : "memory")
|
|
||||||
#define intr_enable() asm volatile ("cpsie i" : : : "memory")
|
|
||||||
|
|
||||||
#define FLASH_SR_BSY 0x01
|
|
||||||
#define FLASH_SR_PGERR 0x04
|
|
||||||
#define FLASH_SR_WRPRTERR 0x10
|
|
||||||
#define FLASH_SR_EOP 0x20
|
|
||||||
|
|
||||||
#define FLASH_CR_PG 0x0001
|
|
||||||
#define FLASH_CR_PER 0x0002
|
|
||||||
#define FLASH_CR_MER 0x0004
|
|
||||||
#define FLASH_CR_OPTPG 0x0010
|
|
||||||
#define FLASH_CR_OPTER 0x0020
|
|
||||||
#define FLASH_CR_STRT 0x0040
|
|
||||||
#define FLASH_CR_LOCK 0x0080
|
|
||||||
#define FLASH_CR_OPTWRE 0x0200
|
|
||||||
#define FLASH_CR_ERRIE 0x0400
|
|
||||||
#define FLASH_CR_EOPIE 0x1000
|
|
||||||
|
|
||||||
static int
|
|
||||||
flash_wait_for_last_operation (uint32_t timeout)
|
|
||||||
{
|
|
||||||
int status;
|
|
||||||
|
|
||||||
do
|
|
||||||
{
|
|
||||||
status = FLASH->SR;
|
|
||||||
if (--timeout == 0)
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
while ((status & FLASH_SR_BSY) != 0);
|
|
||||||
|
|
||||||
return status & (FLASH_SR_BSY|FLASH_SR_PGERR|FLASH_SR_WRPRTERR);
|
|
||||||
}
|
|
||||||
|
|
||||||
#define FLASH_PROGRAM_TIMEOUT 0x00010000
|
|
||||||
#define FLASH_ERASE_TIMEOUT 0x01000000
|
|
||||||
|
|
||||||
static int
|
|
||||||
flash_program_halfword (uint32_t addr, uint16_t data)
|
|
||||||
{
|
|
||||||
int status;
|
|
||||||
|
|
||||||
status = flash_wait_for_last_operation (FLASH_PROGRAM_TIMEOUT);
|
|
||||||
|
|
||||||
intr_disable ();
|
|
||||||
if (status == 0)
|
|
||||||
{
|
|
||||||
FLASH->CR |= FLASH_CR_PG;
|
|
||||||
|
|
||||||
*(volatile uint16_t *)addr = data;
|
|
||||||
|
|
||||||
status = flash_wait_for_last_operation (FLASH_PROGRAM_TIMEOUT);
|
|
||||||
FLASH->CR &= ~FLASH_CR_PG;
|
|
||||||
}
|
|
||||||
intr_enable ();
|
|
||||||
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int
|
|
||||||
flash_erase_page (uint32_t addr)
|
|
||||||
{
|
|
||||||
int status;
|
|
||||||
|
|
||||||
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
|
||||||
|
|
||||||
intr_disable ();
|
|
||||||
if (status == 0)
|
|
||||||
{
|
|
||||||
FLASH->CR |= FLASH_CR_PER;
|
|
||||||
FLASH->AR = addr;
|
|
||||||
FLASH->CR |= FLASH_CR_STRT;
|
|
||||||
|
|
||||||
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
|
||||||
FLASH->CR &= ~FLASH_CR_PER;
|
|
||||||
}
|
|
||||||
intr_enable ();
|
|
||||||
|
|
||||||
return status;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int
|
|
||||||
flash_check_blank (const uint8_t *p_start, size_t size)
|
|
||||||
{
|
|
||||||
const uint8_t *p;
|
|
||||||
|
|
||||||
for (p = p_start; p < p_start + size; p++)
|
|
||||||
if (*p != 0xff)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
#define FLASH_START_ADDR 0x08000000 /* Fixed for all STM32F0/F1. */
|
|
||||||
#define FLASH_OFFSET 0x1000 /* First pages are not-writable
|
|
||||||
when protected. */
|
|
||||||
#if defined(__ARM_ARCH_6M__)
|
|
||||||
#define FLASH_SIZE_REG ((uint16_t *)0x1ffff7cc)
|
|
||||||
#define CHIP_ID_REG ((uint32_t *)0x40015800)
|
|
||||||
#else
|
|
||||||
#define FLASH_SIZE_REG ((uint16_t *)0x1ffff7e0)
|
|
||||||
#define CHIP_ID_REG ((uint32_t *)0xe0042000)
|
|
||||||
#endif
|
|
||||||
#define FLASH_START (FLASH_START_ADDR+FLASH_OFFSET)
|
|
||||||
|
|
||||||
static int
|
|
||||||
flash_write (uint32_t dst_addr, const uint8_t *src, size_t len)
|
|
||||||
{
|
|
||||||
int status;
|
|
||||||
uint32_t flash_end = FLASH_START_ADDR + (*FLASH_SIZE_REG)*1024;
|
|
||||||
|
|
||||||
if (dst_addr < FLASH_START || dst_addr + len > flash_end)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
while (len)
|
|
||||||
{
|
|
||||||
uint16_t hw = *src++;
|
|
||||||
|
|
||||||
hw |= (*src++ << 8);
|
|
||||||
status = flash_program_halfword (dst_addr, hw);
|
|
||||||
if (status != 0)
|
|
||||||
return 0; /* error return */
|
|
||||||
|
|
||||||
dst_addr += 2;
|
|
||||||
len -= 2;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
#define OPTION_BYTES_ADDR 0x1ffff800
|
|
||||||
|
|
||||||
static int
|
|
||||||
flash_protect (void)
|
|
||||||
{
|
|
||||||
int status;
|
|
||||||
uint32_t option_bytes_value;
|
|
||||||
|
|
||||||
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
|
||||||
|
|
||||||
intr_disable ();
|
|
||||||
if (status == 0)
|
|
||||||
{
|
|
||||||
FLASH->OPTKEYR = FLASH_KEY1;
|
|
||||||
FLASH->OPTKEYR = FLASH_KEY2;
|
|
||||||
|
|
||||||
FLASH->CR |= FLASH_CR_OPTER;
|
|
||||||
FLASH->CR |= FLASH_CR_STRT;
|
|
||||||
|
|
||||||
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
|
||||||
FLASH->CR &= ~FLASH_CR_OPTER;
|
|
||||||
}
|
|
||||||
intr_enable ();
|
|
||||||
|
|
||||||
if (status != 0)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
option_bytes_value = *(uint32_t *)OPTION_BYTES_ADDR;
|
|
||||||
return (option_bytes_value & 0xff) == 0xff ? 1 : 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__((naked))
|
|
||||||
flash_erase_all_and_exec (void (*entry)(void))
|
|
||||||
{
|
|
||||||
uint32_t addr = FLASH_START;
|
|
||||||
uint32_t end = FLASH_START_ADDR + (*FLASH_SIZE_REG)*1024;
|
|
||||||
uint32_t page_size = 1024;
|
|
||||||
int r;
|
|
||||||
|
|
||||||
if (((*CHIP_ID_REG) & 0xfff) == 0x0414)
|
|
||||||
page_size = 2048;
|
|
||||||
|
|
||||||
while (addr < end)
|
|
||||||
{
|
|
||||||
r = flash_erase_page (addr);
|
|
||||||
if (r != 0)
|
|
||||||
break;
|
|
||||||
|
|
||||||
addr += page_size;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (addr >= end)
|
|
||||||
(*entry) ();
|
|
||||||
|
|
||||||
for (;;);
|
|
||||||
}
|
|
||||||
|
|
||||||
struct SCB
|
|
||||||
{
|
|
||||||
volatile uint32_t CPUID;
|
|
||||||
volatile uint32_t ICSR;
|
|
||||||
volatile uint32_t VTOR;
|
|
||||||
volatile uint32_t AIRCR;
|
|
||||||
volatile uint32_t SCR;
|
|
||||||
volatile uint32_t CCR;
|
|
||||||
volatile uint8_t SHP[12];
|
|
||||||
volatile uint32_t SHCSR;
|
|
||||||
volatile uint32_t CFSR;
|
|
||||||
volatile uint32_t HFSR;
|
|
||||||
volatile uint32_t DFSR;
|
|
||||||
volatile uint32_t MMFAR;
|
|
||||||
volatile uint32_t BFAR;
|
|
||||||
volatile uint32_t AFSR;
|
|
||||||
volatile uint32_t PFR[2];
|
|
||||||
volatile uint32_t DFR;
|
|
||||||
volatile uint32_t ADR;
|
|
||||||
volatile uint32_t MMFR[4];
|
|
||||||
volatile uint32_t ISAR[5];
|
|
||||||
};
|
|
||||||
|
|
||||||
#define SCS_BASE (0xE000E000)
|
|
||||||
#define SCB_BASE (SCS_BASE + 0x0D00)
|
|
||||||
static struct SCB *const SCB = ((struct SCB *const) SCB_BASE);
|
|
||||||
|
|
||||||
#define SYSRESETREQ 0x04
|
|
||||||
static void
|
|
||||||
nvic_system_reset (void)
|
|
||||||
{
|
|
||||||
SCB->AIRCR = (0x05FA0000 | (SCB->AIRCR & 0x70) | SYSRESETREQ);
|
|
||||||
asm volatile ("dsb");
|
|
||||||
for (;;);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void __attribute__ ((naked))
|
static void __attribute__ ((naked))
|
||||||
reset (void)
|
reset (void)
|
||||||
{
|
{
|
||||||
/*
|
|
||||||
* This code may not be at the start of flash ROM, because of DFU.
|
|
||||||
* So, we take the address from PC.
|
|
||||||
*/
|
|
||||||
#if defined(__ARM_ARCH_6M__)
|
|
||||||
asm volatile ("cpsid i\n\t" /* Mask all interrupts. */
|
asm volatile ("cpsid i\n\t" /* Mask all interrupts. */
|
||||||
"ldr r0, 1f\n\t" /* r0 = RAM start */
|
"mov r0, pc\n\t" /* r0 = PC & ~0x0fff */
|
||||||
"mov r1, pc\n\t" /* r1 = (PC + 0x1000) & ~0x0fff */
|
"mov r1, #0x10\n\t"
|
||||||
"mov r2, #0x10\n\t"
|
"lsl r1, #8\n\t"
|
||||||
"lsl r2, #8\n\t"
|
"sub r1, r1, #1\n\t"
|
||||||
"add r1, r1, r2\n\t"
|
"bic r0, r0, r1\n\t"
|
||||||
"sub r2, r2, #1\n\t"
|
"ldr r2, [r0]\n\t"
|
||||||
"bic r1, r1, r2\n\t"
|
"msr MSP, r2\n\t" /* Main (exception handler) stack. */
|
||||||
"mov r2, #188\n"
|
"b entry\n\t"
|
||||||
"2:\n\t" /* Copy vectors. It will be enabled later by clock_init. */
|
|
||||||
"ldr r3, [r1, r2]\n\t"
|
|
||||||
"str r3, [r0, r2]\n\t"
|
|
||||||
"sub r2, #4\n\t"
|
|
||||||
"bcs 2b\n\t"
|
|
||||||
"msr MSP, r3\n\t" /* Main (exception handler) stack. */
|
|
||||||
"ldr r0, [r1, #4]\n\t" /* Reset handler. */
|
|
||||||
"bx r0\n\t"
|
|
||||||
".align 2\n"
|
|
||||||
"1: .word 0x20000000"
|
|
||||||
: /* no output */ : /* no input */ : "memory");
|
: /* no output */ : /* no input */ : "memory");
|
||||||
#else
|
|
||||||
extern const unsigned long *FT0, *FT1, *FT2;
|
|
||||||
asm volatile ("cpsid i\n\t" /* Mask all interrupts. */
|
|
||||||
"ldr r0, 1f\n\t" /* r0 = SCR */
|
|
||||||
"mov r1, pc\n\t" /* r1 = (PC + 0x1000) & ~0x0fff */
|
|
||||||
"mov r2, #0x1000\n\t"
|
|
||||||
"add r1, r1, r2\n\t"
|
|
||||||
"sub r2, r2, #1\n\t"
|
|
||||||
"bic r1, r1, r2\n\t"
|
|
||||||
"str r1, [r0, #8]\n\t" /* Set SCR->VCR */
|
|
||||||
"ldr r0, [r1], #4\n\t"
|
|
||||||
"msr MSP, r0\n\t" /* Main (exception handler) stack. */
|
|
||||||
"ldr r0, [r1]\n\t" /* Reset handler. */
|
|
||||||
"bx r0\n\t"
|
|
||||||
".align 2\n"
|
|
||||||
"1: .word 0xe000ed00"
|
|
||||||
: /* no output */ : /* no input */ : "memory");
|
|
||||||
/* Artificial entry to refer FT0, FT1, and FT2. */
|
|
||||||
asm volatile (""
|
|
||||||
: : "r" (FT0), "r" (FT1), "r" (FT2));
|
|
||||||
#endif
|
|
||||||
/* Never reach here. */
|
/* Never reach here. */
|
||||||
}
|
}
|
||||||
|
|
||||||
|
extern uint8_t __main_stack_end__;
|
||||||
|
extern void svc (void);
|
||||||
|
extern void preempt (void);
|
||||||
|
extern void chx_timer_expired (void);
|
||||||
|
extern void chx_handle_intr (void);
|
||||||
|
|
||||||
|
static void nmi (void)
|
||||||
|
{
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __attribute__ ((naked))
|
||||||
|
hard_fault (void)
|
||||||
|
{
|
||||||
|
register uint32_t primask;
|
||||||
|
|
||||||
|
asm ("mrs %0, PRIMASK" : "=r" (primask));
|
||||||
|
|
||||||
|
if (primask)
|
||||||
|
asm volatile ("b svc");
|
||||||
|
else
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void mem_manage (void)
|
||||||
|
{
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void bus_fault (void)
|
||||||
|
{
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void usage_fault (void)
|
||||||
|
{
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void none (void)
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
typedef void (*handler)(void);
|
typedef void (*handler)(void);
|
||||||
extern uint8_t __ram_end__;
|
extern uint8_t __main_stack_end__;
|
||||||
|
|
||||||
handler vector[] __attribute__ ((section(".vectors"))) = {
|
handler vector[] __attribute__ ((section(".vectors"))) = {
|
||||||
(handler)&__ram_end__,
|
(handler)&__main_stack_end__,
|
||||||
reset,
|
reset,
|
||||||
(handler)set_led,
|
nmi, /* nmi */
|
||||||
flash_unlock,
|
hard_fault, /* hard fault */
|
||||||
(handler)flash_program_halfword,
|
/* 0x10 */
|
||||||
(handler)flash_erase_page,
|
mem_manage, /* mem manage */
|
||||||
(handler)flash_check_blank,
|
bus_fault, /* bus fault */
|
||||||
(handler)flash_write,
|
usage_fault, /* usage fault */
|
||||||
(handler)flash_protect,
|
none,
|
||||||
(handler)flash_erase_all_and_exec,
|
/* 0x20 */
|
||||||
usb_lld_sys_init,
|
none, none, none, /* reserved */
|
||||||
usb_lld_sys_shutdown,
|
svc, /* SVCall */
|
||||||
nvic_system_reset,
|
none, /* Debug */
|
||||||
clock_init,
|
none, /* reserved */
|
||||||
gpio_init,
|
preempt, /* PendSV */
|
||||||
NULL,
|
chx_timer_expired, /* SysTick */
|
||||||
|
/* 0x40 */
|
||||||
|
chx_handle_intr /* WWDG */, chx_handle_intr /* PVD */,
|
||||||
|
chx_handle_intr /* TAMPER */, chx_handle_intr /* RTC */,
|
||||||
|
chx_handle_intr /* FLASH */, chx_handle_intr /* RCC */,
|
||||||
|
chx_handle_intr /* EXTI0 */, chx_handle_intr /* EXTI1 */,
|
||||||
|
/* 0x60 */
|
||||||
|
chx_handle_intr /* EXTI2 */, chx_handle_intr /* EXTI3 */,
|
||||||
|
chx_handle_intr /* EXTI4 */, chx_handle_intr /* DMA1 CH1 */,
|
||||||
|
chx_handle_intr /* DMA1 CH2 */, chx_handle_intr /* DMA1 CH3 */,
|
||||||
|
chx_handle_intr /* DMA1 CH4 */, chx_handle_intr /* DMA1 CH5 */,
|
||||||
|
/* 0x80 */
|
||||||
|
chx_handle_intr /* DMA1 CH6 */, chx_handle_intr /* DMA1 CH7 */,
|
||||||
|
chx_handle_intr /* ADC1_2 */, chx_handle_intr /* USB HP */,
|
||||||
|
/* 0x90 */
|
||||||
|
chx_handle_intr /* USB LP */, chx_handle_intr /* CAN */,
|
||||||
|
/* ... and more. EXT9_5, TIMx, I2C, SPI, USART, EXT15_10 */
|
||||||
|
chx_handle_intr, chx_handle_intr,
|
||||||
|
/* 0xA0 */
|
||||||
|
chx_handle_intr, chx_handle_intr, chx_handle_intr, chx_handle_intr,
|
||||||
|
chx_handle_intr, chx_handle_intr, chx_handle_intr, chx_handle_intr,
|
||||||
|
/* 0xc0 */
|
||||||
};
|
};
|
||||||
|
|
||||||
const uint8_t sys_version[8] __attribute__((section(".sys.version"))) = {
|
|
||||||
3*2+2, /* bLength */
|
|
||||||
0x03, /* bDescriptorType = USB_STRING_DESCRIPTOR_TYPE */
|
|
||||||
/* sys version: "2.1" */
|
|
||||||
'2', 0, '.', 0, '1', 0,
|
|
||||||
};
|
|
||||||
|
|
||||||
const uint32_t __attribute__((section(".sys.board_id")))
|
|
||||||
sys_board_id = BOARD_ID;
|
|
||||||
|
|
||||||
const uint8_t __attribute__((section(".sys.board_name")))
|
|
||||||
sys_board_name[] = BOARD_NAME;
|
|
||||||
|
|||||||
@@ -1,132 +0,0 @@
|
|||||||
#if defined(__ARM_ARCH_6M__)
|
|
||||||
#define BOARD_ID_STM32F0_DISCOVERY 0xde4b4bc1
|
|
||||||
#define BOARD_ID_FSM_55 0x83433c76
|
|
||||||
#else
|
|
||||||
#define BOARD_ID_CQ_STARM 0xc5480875
|
|
||||||
#define BOARD_ID_FST_01_00 0x613870a9
|
|
||||||
#define BOARD_ID_FST_01 0x696886af
|
|
||||||
#define BOARD_ID_MAPLE_MINI 0x7a445272
|
|
||||||
#define BOARD_ID_OLIMEX_STM32_H103 0xf92bb594
|
|
||||||
#define BOARD_ID_STBEE_MINI 0x1f341961
|
|
||||||
#define BOARD_ID_STBEE 0x945c37e8
|
|
||||||
#define BOARD_ID_STM32_PRIMER2 0x21e5798d
|
|
||||||
#define BOARD_ID_STM8S_DISCOVERY 0x2f0976bb
|
|
||||||
#endif
|
|
||||||
|
|
||||||
extern const uint8_t sys_version[8];
|
|
||||||
extern const uint32_t sys_board_id;
|
|
||||||
extern const uint8_t sys_board_name[];
|
|
||||||
|
|
||||||
typedef void (*handler)(void);
|
|
||||||
extern handler vector[16];
|
|
||||||
|
|
||||||
static inline const uint8_t *
|
|
||||||
unique_device_id (void)
|
|
||||||
{
|
|
||||||
/* STM32F103 has 96-bit unique device identifier */
|
|
||||||
const uint8_t *addr = (const uint8_t *)0x1ffff7e8;
|
|
||||||
|
|
||||||
return addr;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void
|
|
||||||
set_led (int on)
|
|
||||||
{
|
|
||||||
void (*func) (int) = (void (*)(int))vector[2];
|
|
||||||
|
|
||||||
return (*func) (on);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void
|
|
||||||
flash_unlock (void)
|
|
||||||
{
|
|
||||||
(*vector[3]) ();
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int
|
|
||||||
flash_program_halfword (uint32_t addr, uint16_t data)
|
|
||||||
{
|
|
||||||
int (*func) (uint32_t, uint16_t) = (int (*)(uint32_t, uint16_t))vector[4];
|
|
||||||
|
|
||||||
return (*func) (addr, data);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int
|
|
||||||
flash_erase_page (uint32_t addr)
|
|
||||||
{
|
|
||||||
int (*func) (uint32_t) = (int (*)(uint32_t))vector[5];
|
|
||||||
|
|
||||||
return (*func) (addr);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int
|
|
||||||
flash_check_blank (const uint8_t *p_start, size_t size)
|
|
||||||
{
|
|
||||||
int (*func) (const uint8_t *, int) = (int (*)(const uint8_t *, int))vector[6];
|
|
||||||
|
|
||||||
return (*func) (p_start, size);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int
|
|
||||||
flash_write (uint32_t dst_addr, const uint8_t *src, size_t len)
|
|
||||||
{
|
|
||||||
int (*func) (uint32_t, const uint8_t *, size_t)
|
|
||||||
= (int (*)(uint32_t, const uint8_t *, size_t))vector[7];
|
|
||||||
|
|
||||||
return (*func) (dst_addr, src, len);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int
|
|
||||||
flash_protect (void)
|
|
||||||
{
|
|
||||||
int (*func) (void) = (int (*)(void))vector[8];
|
|
||||||
|
|
||||||
return (*func) ();
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void __attribute__((noreturn))
|
|
||||||
flash_erase_all_and_exec (void (*entry)(void))
|
|
||||||
{
|
|
||||||
void (*func) (void (*)(void)) = (void (*)(void (*)(void)))vector[9];
|
|
||||||
|
|
||||||
(*func) (entry);
|
|
||||||
for (;;);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void
|
|
||||||
usb_lld_sys_init (void)
|
|
||||||
{
|
|
||||||
(*vector[10]) ();
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void
|
|
||||||
usb_lld_sys_shutdown (void)
|
|
||||||
{
|
|
||||||
(*vector[11]) ();
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void
|
|
||||||
nvic_system_reset (void)
|
|
||||||
{
|
|
||||||
(*vector[12]) ();
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Users can override INLINE by 'attribute((used))' to have an
|
|
||||||
* implementation defined.
|
|
||||||
*/
|
|
||||||
#if !defined(INLINE)
|
|
||||||
#define INLINE __inline__
|
|
||||||
#endif
|
|
||||||
|
|
||||||
static INLINE void
|
|
||||||
clock_init (void)
|
|
||||||
{
|
|
||||||
(*vector[13]) ();
|
|
||||||
}
|
|
||||||
|
|
||||||
static INLINE void
|
|
||||||
gpio_init (void)
|
|
||||||
{
|
|
||||||
(*vector[14]) ();
|
|
||||||
}
|
|
||||||
@@ -1 +0,0 @@
|
|||||||
../example-fsm-55/sys.c
|
|
||||||
461
example-led/sys.c
Normal file
461
example-led/sys.c
Normal file
@@ -0,0 +1,461 @@
|
|||||||
|
/*
|
||||||
|
* sys.c - system routines for the initial page for STM32F030 / STM32F103.
|
||||||
|
*
|
||||||
|
* Copyright (C) 2013, 2014, 2015 Flying Stone Technology
|
||||||
|
* Author: NIIBE Yutaka <gniibe@fsij.org>
|
||||||
|
*
|
||||||
|
* Copying and distribution of this file, with or without modification,
|
||||||
|
* are permitted in any medium without royalty provided the copyright
|
||||||
|
* notice and this notice are preserved. This file is offered as-is,
|
||||||
|
* without any warranty.
|
||||||
|
*
|
||||||
|
* When the flash ROM is protected, we cannot modify the initial page.
|
||||||
|
* We put some system routines (which is useful for any program) here.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include "board.h"
|
||||||
|
|
||||||
|
#include "clk_gpio_init.c"
|
||||||
|
|
||||||
|
#define CORTEX_PRIORITY_BITS 4
|
||||||
|
#define CORTEX_PRIORITY_MASK(n) ((n) << (8 - CORTEX_PRIORITY_BITS))
|
||||||
|
#define USB_LP_CAN1_RX0_IRQn 20
|
||||||
|
#define STM32_USB_IRQ_PRIORITY 11
|
||||||
|
|
||||||
|
struct NVIC {
|
||||||
|
uint32_t ISER[8];
|
||||||
|
uint32_t unused1[24];
|
||||||
|
uint32_t ICER[8];
|
||||||
|
uint32_t unused2[24];
|
||||||
|
uint32_t ISPR[8];
|
||||||
|
uint32_t unused3[24];
|
||||||
|
uint32_t ICPR[8];
|
||||||
|
uint32_t unused4[24];
|
||||||
|
uint32_t IABR[8];
|
||||||
|
uint32_t unused5[56];
|
||||||
|
uint32_t IPR[60];
|
||||||
|
};
|
||||||
|
|
||||||
|
static struct NVIC *const NVICBase = ((struct NVIC *const)0xE000E100);
|
||||||
|
#define NVIC_ISER(n) (NVICBase->ISER[n >> 5])
|
||||||
|
#define NVIC_ICPR(n) (NVICBase->ICPR[n >> 5])
|
||||||
|
#define NVIC_IPR(n) (NVICBase->IPR[n >> 2])
|
||||||
|
|
||||||
|
static void
|
||||||
|
nvic_enable_vector (uint32_t n, uint32_t prio)
|
||||||
|
{
|
||||||
|
unsigned int sh = (n & 3) << 3;
|
||||||
|
|
||||||
|
NVIC_IPR (n) = (NVIC_IPR(n) & ~(0xFF << sh)) | (prio << sh);
|
||||||
|
NVIC_ICPR (n) = 1 << (n & 0x1F);
|
||||||
|
NVIC_ISER (n) = 1 << (n & 0x1F);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
usb_cable_config (int enable)
|
||||||
|
{
|
||||||
|
#if defined(GPIO_USB_SET_TO_ENABLE)
|
||||||
|
if (enable)
|
||||||
|
GPIO_USB->BSRR = (1 << GPIO_USB_SET_TO_ENABLE);
|
||||||
|
else
|
||||||
|
GPIO_USB->BRR = (1 << GPIO_USB_SET_TO_ENABLE);
|
||||||
|
#elif defined(GPIO_USB_CLEAR_TO_ENABLE)
|
||||||
|
if (enable)
|
||||||
|
GPIO_USB->BRR = (1 << GPIO_USB_CLEAR_TO_ENABLE);
|
||||||
|
else
|
||||||
|
GPIO_USB->BSRR = (1 << GPIO_USB_CLEAR_TO_ENABLE);
|
||||||
|
#else
|
||||||
|
(void)enable;
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
void
|
||||||
|
set_led (int on)
|
||||||
|
{
|
||||||
|
#if defined(GPIO_LED_CLEAR_TO_EMIT)
|
||||||
|
if (on)
|
||||||
|
GPIO_LED->BRR = (1 << GPIO_LED_CLEAR_TO_EMIT);
|
||||||
|
else
|
||||||
|
GPIO_LED->BSRR = (1 << GPIO_LED_CLEAR_TO_EMIT);
|
||||||
|
#else
|
||||||
|
if (on)
|
||||||
|
GPIO_LED->BSRR = (1 << GPIO_LED_SET_TO_EMIT);
|
||||||
|
else
|
||||||
|
GPIO_LED->BRR = (1 << GPIO_LED_SET_TO_EMIT);
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
static void wait (int count)
|
||||||
|
{
|
||||||
|
int i;
|
||||||
|
|
||||||
|
for (i = 0; i < count; i++)
|
||||||
|
asm volatile ("" : : "r" (i) : "memory");
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static void
|
||||||
|
usb_lld_sys_shutdown (void)
|
||||||
|
{
|
||||||
|
RCC->APB1ENR &= ~RCC_APB1ENR_USBEN;
|
||||||
|
RCC->APB1RSTR = RCC_APB1RSTR_USBRST;
|
||||||
|
usb_cable_config (0);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void
|
||||||
|
usb_lld_sys_init (void)
|
||||||
|
{
|
||||||
|
if ((RCC->APB1ENR & RCC_APB1ENR_USBEN)
|
||||||
|
&& (RCC->APB1RSTR & RCC_APB1RSTR_USBRST) == 0)
|
||||||
|
/* Make sure the device is disconnected, even after core reset. */
|
||||||
|
{
|
||||||
|
usb_lld_sys_shutdown ();
|
||||||
|
/* Disconnect requires SE0 (>= 2.5uS). */
|
||||||
|
wait (300);
|
||||||
|
}
|
||||||
|
|
||||||
|
usb_cable_config (1);
|
||||||
|
RCC->APB1ENR |= RCC_APB1ENR_USBEN;
|
||||||
|
nvic_enable_vector (USB_LP_CAN1_RX0_IRQn,
|
||||||
|
CORTEX_PRIORITY_MASK (STM32_USB_IRQ_PRIORITY));
|
||||||
|
/*
|
||||||
|
* Note that we also have other IRQ(s):
|
||||||
|
* USB_HP_CAN1_TX_IRQn (for double-buffered or isochronous)
|
||||||
|
* USBWakeUp_IRQn (suspend/resume)
|
||||||
|
*/
|
||||||
|
RCC->APB1RSTR = RCC_APB1RSTR_USBRST;
|
||||||
|
RCC->APB1RSTR = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
#define FLASH_KEY1 0x45670123UL
|
||||||
|
#define FLASH_KEY2 0xCDEF89ABUL
|
||||||
|
|
||||||
|
enum flash_status
|
||||||
|
{
|
||||||
|
FLASH_BUSY = 1,
|
||||||
|
FLASH_ERROR_PG,
|
||||||
|
FLASH_ERROR_WRP,
|
||||||
|
FLASH_COMPLETE,
|
||||||
|
FLASH_TIMEOUT
|
||||||
|
};
|
||||||
|
|
||||||
|
static void __attribute__ ((used))
|
||||||
|
flash_unlock (void)
|
||||||
|
{
|
||||||
|
FLASH->KEYR = FLASH_KEY1;
|
||||||
|
FLASH->KEYR = FLASH_KEY2;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
#define intr_disable() asm volatile ("cpsid i" : : : "memory")
|
||||||
|
#define intr_enable() asm volatile ("cpsie i" : : : "memory")
|
||||||
|
|
||||||
|
#define FLASH_SR_BSY 0x01
|
||||||
|
#define FLASH_SR_PGERR 0x04
|
||||||
|
#define FLASH_SR_WRPRTERR 0x10
|
||||||
|
#define FLASH_SR_EOP 0x20
|
||||||
|
|
||||||
|
#define FLASH_CR_PG 0x0001
|
||||||
|
#define FLASH_CR_PER 0x0002
|
||||||
|
#define FLASH_CR_MER 0x0004
|
||||||
|
#define FLASH_CR_OPTPG 0x0010
|
||||||
|
#define FLASH_CR_OPTER 0x0020
|
||||||
|
#define FLASH_CR_STRT 0x0040
|
||||||
|
#define FLASH_CR_LOCK 0x0080
|
||||||
|
#define FLASH_CR_OPTWRE 0x0200
|
||||||
|
#define FLASH_CR_ERRIE 0x0400
|
||||||
|
#define FLASH_CR_EOPIE 0x1000
|
||||||
|
|
||||||
|
static int
|
||||||
|
flash_wait_for_last_operation (uint32_t timeout)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
|
||||||
|
do
|
||||||
|
{
|
||||||
|
status = FLASH->SR;
|
||||||
|
if (--timeout == 0)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
while ((status & FLASH_SR_BSY) != 0);
|
||||||
|
|
||||||
|
return status & (FLASH_SR_BSY|FLASH_SR_PGERR|FLASH_SR_WRPRTERR);
|
||||||
|
}
|
||||||
|
|
||||||
|
#define FLASH_PROGRAM_TIMEOUT 0x00010000
|
||||||
|
#define FLASH_ERASE_TIMEOUT 0x01000000
|
||||||
|
|
||||||
|
static int
|
||||||
|
flash_program_halfword (uint32_t addr, uint16_t data)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
|
||||||
|
status = flash_wait_for_last_operation (FLASH_PROGRAM_TIMEOUT);
|
||||||
|
|
||||||
|
intr_disable ();
|
||||||
|
if (status == 0)
|
||||||
|
{
|
||||||
|
FLASH->CR |= FLASH_CR_PG;
|
||||||
|
|
||||||
|
*(volatile uint16_t *)addr = data;
|
||||||
|
|
||||||
|
status = flash_wait_for_last_operation (FLASH_PROGRAM_TIMEOUT);
|
||||||
|
FLASH->CR &= ~FLASH_CR_PG;
|
||||||
|
}
|
||||||
|
intr_enable ();
|
||||||
|
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int
|
||||||
|
flash_erase_page (uint32_t addr)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
|
||||||
|
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
||||||
|
|
||||||
|
intr_disable ();
|
||||||
|
if (status == 0)
|
||||||
|
{
|
||||||
|
FLASH->CR |= FLASH_CR_PER;
|
||||||
|
FLASH->AR = addr;
|
||||||
|
FLASH->CR |= FLASH_CR_STRT;
|
||||||
|
|
||||||
|
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
||||||
|
FLASH->CR &= ~FLASH_CR_PER;
|
||||||
|
}
|
||||||
|
intr_enable ();
|
||||||
|
|
||||||
|
return status;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int
|
||||||
|
flash_check_blank (const uint8_t *p_start, size_t size)
|
||||||
|
{
|
||||||
|
const uint8_t *p;
|
||||||
|
|
||||||
|
for (p = p_start; p < p_start + size; p++)
|
||||||
|
if (*p != 0xff)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
#define FLASH_START_ADDR 0x08000000 /* Fixed for all STM32F0/F1. */
|
||||||
|
#define FLASH_OFFSET 0x1000 /* First pages are not-writable
|
||||||
|
when protected. */
|
||||||
|
#if defined(__ARM_ARCH_6M__)
|
||||||
|
#define FLASH_SIZE_REG ((uint16_t *)0x1ffff7cc)
|
||||||
|
#define CHIP_ID_REG ((uint32_t *)0x40015800)
|
||||||
|
#else
|
||||||
|
#define FLASH_SIZE_REG ((uint16_t *)0x1ffff7e0)
|
||||||
|
#define CHIP_ID_REG ((uint32_t *)0xe0042000)
|
||||||
|
#endif
|
||||||
|
#define FLASH_START (FLASH_START_ADDR+FLASH_OFFSET)
|
||||||
|
|
||||||
|
static int
|
||||||
|
flash_write (uint32_t dst_addr, const uint8_t *src, size_t len)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
uint32_t flash_end = FLASH_START_ADDR + (*FLASH_SIZE_REG)*1024;
|
||||||
|
|
||||||
|
if (dst_addr < FLASH_START || dst_addr + len > flash_end)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
while (len)
|
||||||
|
{
|
||||||
|
uint16_t hw = *src++;
|
||||||
|
|
||||||
|
hw |= (*src++ << 8);
|
||||||
|
status = flash_program_halfword (dst_addr, hw);
|
||||||
|
if (status != 0)
|
||||||
|
return 0; /* error return */
|
||||||
|
|
||||||
|
dst_addr += 2;
|
||||||
|
len -= 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
#define OPTION_BYTES_ADDR 0x1ffff800
|
||||||
|
|
||||||
|
static int
|
||||||
|
flash_protect (void)
|
||||||
|
{
|
||||||
|
int status;
|
||||||
|
uint32_t option_bytes_value;
|
||||||
|
|
||||||
|
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
||||||
|
|
||||||
|
intr_disable ();
|
||||||
|
if (status == 0)
|
||||||
|
{
|
||||||
|
FLASH->OPTKEYR = FLASH_KEY1;
|
||||||
|
FLASH->OPTKEYR = FLASH_KEY2;
|
||||||
|
|
||||||
|
FLASH->CR |= FLASH_CR_OPTER;
|
||||||
|
FLASH->CR |= FLASH_CR_STRT;
|
||||||
|
|
||||||
|
status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
|
||||||
|
FLASH->CR &= ~FLASH_CR_OPTER;
|
||||||
|
}
|
||||||
|
intr_enable ();
|
||||||
|
|
||||||
|
if (status != 0)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
option_bytes_value = *(uint32_t *)OPTION_BYTES_ADDR;
|
||||||
|
return (option_bytes_value & 0xff) == 0xff ? 1 : 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __attribute__((naked))
|
||||||
|
flash_erase_all_and_exec (void (*entry)(void))
|
||||||
|
{
|
||||||
|
uint32_t addr = FLASH_START;
|
||||||
|
uint32_t end = FLASH_START_ADDR + (*FLASH_SIZE_REG)*1024;
|
||||||
|
uint32_t page_size = 1024;
|
||||||
|
int r;
|
||||||
|
|
||||||
|
if (((*CHIP_ID_REG) & 0xfff) == 0x0414)
|
||||||
|
page_size = 2048;
|
||||||
|
|
||||||
|
while (addr < end)
|
||||||
|
{
|
||||||
|
r = flash_erase_page (addr);
|
||||||
|
if (r != 0)
|
||||||
|
break;
|
||||||
|
|
||||||
|
addr += page_size;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (addr >= end)
|
||||||
|
(*entry) ();
|
||||||
|
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
struct SCB
|
||||||
|
{
|
||||||
|
volatile uint32_t CPUID;
|
||||||
|
volatile uint32_t ICSR;
|
||||||
|
volatile uint32_t VTOR;
|
||||||
|
volatile uint32_t AIRCR;
|
||||||
|
volatile uint32_t SCR;
|
||||||
|
volatile uint32_t CCR;
|
||||||
|
volatile uint8_t SHP[12];
|
||||||
|
volatile uint32_t SHCSR;
|
||||||
|
volatile uint32_t CFSR;
|
||||||
|
volatile uint32_t HFSR;
|
||||||
|
volatile uint32_t DFSR;
|
||||||
|
volatile uint32_t MMFAR;
|
||||||
|
volatile uint32_t BFAR;
|
||||||
|
volatile uint32_t AFSR;
|
||||||
|
volatile uint32_t PFR[2];
|
||||||
|
volatile uint32_t DFR;
|
||||||
|
volatile uint32_t ADR;
|
||||||
|
volatile uint32_t MMFR[4];
|
||||||
|
volatile uint32_t ISAR[5];
|
||||||
|
};
|
||||||
|
|
||||||
|
#define SCS_BASE (0xE000E000)
|
||||||
|
#define SCB_BASE (SCS_BASE + 0x0D00)
|
||||||
|
static struct SCB *const SCB = ((struct SCB *const) SCB_BASE);
|
||||||
|
|
||||||
|
#define SYSRESETREQ 0x04
|
||||||
|
static void
|
||||||
|
nvic_system_reset (void)
|
||||||
|
{
|
||||||
|
SCB->AIRCR = (0x05FA0000 | (SCB->AIRCR & 0x70) | SYSRESETREQ);
|
||||||
|
asm volatile ("dsb");
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __attribute__ ((naked))
|
||||||
|
reset (void)
|
||||||
|
{
|
||||||
|
/*
|
||||||
|
* This code may not be at the start of flash ROM, because of DFU.
|
||||||
|
* So, we take the address from PC.
|
||||||
|
*/
|
||||||
|
#if defined(__ARM_ARCH_6M__)
|
||||||
|
asm volatile ("cpsid i\n\t" /* Mask all interrupts. */
|
||||||
|
"ldr r0, 1f\n\t" /* r0 = RAM start */
|
||||||
|
"mov r1, pc\n\t" /* r1 = (PC + 0x1000) & ~0x0fff */
|
||||||
|
"mov r2, #0x10\n\t"
|
||||||
|
"lsl r2, #8\n\t"
|
||||||
|
"add r1, r1, r2\n\t"
|
||||||
|
"sub r2, r2, #1\n\t"
|
||||||
|
"bic r1, r1, r2\n\t"
|
||||||
|
"mov r2, #188\n"
|
||||||
|
"2:\n\t" /* Copy vectors. It will be enabled later by clock_init. */
|
||||||
|
"ldr r3, [r1, r2]\n\t"
|
||||||
|
"str r3, [r0, r2]\n\t"
|
||||||
|
"sub r2, #4\n\t"
|
||||||
|
"bcs 2b\n\t"
|
||||||
|
"msr MSP, r3\n\t" /* Main (exception handler) stack. */
|
||||||
|
"ldr r0, [r1, #4]\n\t" /* Reset handler. */
|
||||||
|
"bx r0\n\t"
|
||||||
|
".align 2\n"
|
||||||
|
"1: .word 0x20000000"
|
||||||
|
: /* no output */ : /* no input */ : "memory");
|
||||||
|
#else
|
||||||
|
extern const unsigned long *FT0, *FT1, *FT2;
|
||||||
|
asm volatile ("cpsid i\n\t" /* Mask all interrupts. */
|
||||||
|
"ldr r0, 1f\n\t" /* r0 = SCR */
|
||||||
|
"mov r1, pc\n\t" /* r1 = (PC + 0x1000) & ~0x0fff */
|
||||||
|
"mov r2, #0x1000\n\t"
|
||||||
|
"add r1, r1, r2\n\t"
|
||||||
|
"sub r2, r2, #1\n\t"
|
||||||
|
"bic r1, r1, r2\n\t"
|
||||||
|
"str r1, [r0, #8]\n\t" /* Set SCR->VCR */
|
||||||
|
"ldr r0, [r1], #4\n\t"
|
||||||
|
"msr MSP, r0\n\t" /* Main (exception handler) stack. */
|
||||||
|
"ldr r0, [r1]\n\t" /* Reset handler. */
|
||||||
|
"bx r0\n\t"
|
||||||
|
".align 2\n"
|
||||||
|
"1: .word 0xe000ed00"
|
||||||
|
: /* no output */ : /* no input */ : "memory");
|
||||||
|
/* Artificial entry to refer FT0, FT1, and FT2. */
|
||||||
|
asm volatile (""
|
||||||
|
: : "r" (FT0), "r" (FT1), "r" (FT2));
|
||||||
|
#endif
|
||||||
|
/* Never reach here. */
|
||||||
|
}
|
||||||
|
|
||||||
|
typedef void (*handler)(void);
|
||||||
|
extern uint8_t __ram_end__;
|
||||||
|
|
||||||
|
handler vector[] __attribute__ ((section(".vectors"))) = {
|
||||||
|
(handler)&__ram_end__,
|
||||||
|
reset,
|
||||||
|
(handler)set_led,
|
||||||
|
flash_unlock,
|
||||||
|
(handler)flash_program_halfword,
|
||||||
|
(handler)flash_erase_page,
|
||||||
|
(handler)flash_check_blank,
|
||||||
|
(handler)flash_write,
|
||||||
|
(handler)flash_protect,
|
||||||
|
(handler)flash_erase_all_and_exec,
|
||||||
|
usb_lld_sys_init,
|
||||||
|
usb_lld_sys_shutdown,
|
||||||
|
nvic_system_reset,
|
||||||
|
clock_init,
|
||||||
|
gpio_init,
|
||||||
|
NULL,
|
||||||
|
};
|
||||||
|
|
||||||
|
const uint8_t sys_version[8] __attribute__((section(".sys.version"))) = {
|
||||||
|
3*2+2, /* bLength */
|
||||||
|
0x03, /* bDescriptorType = USB_STRING_DESCRIPTOR_TYPE */
|
||||||
|
/* sys version: "2.1" */
|
||||||
|
'2', 0, '.', 0, '1', 0,
|
||||||
|
};
|
||||||
|
|
||||||
|
const uint32_t __attribute__((section(".sys.board_id")))
|
||||||
|
sys_board_id = BOARD_ID;
|
||||||
|
|
||||||
|
const uint8_t __attribute__((section(".sys.board_name")))
|
||||||
|
sys_board_name[] = BOARD_NAME;
|
||||||
@@ -1 +0,0 @@
|
|||||||
../example-fsm-55/sys.h
|
|
||||||
134
example-led/sys.h
Normal file
134
example-led/sys.h
Normal file
@@ -0,0 +1,134 @@
|
|||||||
|
#if defined(__ARM_ARCH_6M__)
|
||||||
|
#define BOARD_ID_STM32F0_DISCOVERY 0xde4b4bc1
|
||||||
|
#define BOARD_ID_FSM_55 0x83433c76
|
||||||
|
#else
|
||||||
|
#define BOARD_ID_CQ_STARM 0xc5480875
|
||||||
|
#define BOARD_ID_FST_01_00 0x613870a9
|
||||||
|
#define BOARD_ID_FST_01 0x696886af
|
||||||
|
#define BOARD_ID_MAPLE_MINI 0x7a445272
|
||||||
|
#define BOARD_ID_OLIMEX_STM32_H103 0xf92bb594
|
||||||
|
#define BOARD_ID_STBEE_MINI 0x1f341961
|
||||||
|
#define BOARD_ID_STBEE 0x945c37e8
|
||||||
|
#define BOARD_ID_STM32_PRIMER2 0x21e5798d
|
||||||
|
#define BOARD_ID_STM8S_DISCOVERY 0x2f0976bb
|
||||||
|
#define BOARD_ID_ST_DONGLE 0x2cd4e471
|
||||||
|
#define BOARD_ID_ST_NUCLEO_F103 0x9b87c16d
|
||||||
|
#endif
|
||||||
|
|
||||||
|
extern const uint8_t sys_version[8];
|
||||||
|
extern const uint32_t sys_board_id;
|
||||||
|
extern const uint8_t sys_board_name[];
|
||||||
|
|
||||||
|
typedef void (*handler)(void);
|
||||||
|
extern handler vector[16];
|
||||||
|
|
||||||
|
static inline const uint8_t *
|
||||||
|
unique_device_id (void)
|
||||||
|
{
|
||||||
|
/* STM32F103 has 96-bit unique device identifier */
|
||||||
|
const uint8_t *addr = (const uint8_t *)0x1ffff7e8;
|
||||||
|
|
||||||
|
return addr;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void
|
||||||
|
set_led (int on)
|
||||||
|
{
|
||||||
|
void (*func) (int) = (void (*)(int))vector[2];
|
||||||
|
|
||||||
|
return (*func) (on);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void
|
||||||
|
flash_unlock (void)
|
||||||
|
{
|
||||||
|
(*vector[3]) ();
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int
|
||||||
|
flash_program_halfword (uint32_t addr, uint16_t data)
|
||||||
|
{
|
||||||
|
int (*func) (uint32_t, uint16_t) = (int (*)(uint32_t, uint16_t))vector[4];
|
||||||
|
|
||||||
|
return (*func) (addr, data);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int
|
||||||
|
flash_erase_page (uint32_t addr)
|
||||||
|
{
|
||||||
|
int (*func) (uint32_t) = (int (*)(uint32_t))vector[5];
|
||||||
|
|
||||||
|
return (*func) (addr);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int
|
||||||
|
flash_check_blank (const uint8_t *p_start, size_t size)
|
||||||
|
{
|
||||||
|
int (*func) (const uint8_t *, int) = (int (*)(const uint8_t *, int))vector[6];
|
||||||
|
|
||||||
|
return (*func) (p_start, size);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int
|
||||||
|
flash_write (uint32_t dst_addr, const uint8_t *src, size_t len)
|
||||||
|
{
|
||||||
|
int (*func) (uint32_t, const uint8_t *, size_t)
|
||||||
|
= (int (*)(uint32_t, const uint8_t *, size_t))vector[7];
|
||||||
|
|
||||||
|
return (*func) (dst_addr, src, len);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline int
|
||||||
|
flash_protect (void)
|
||||||
|
{
|
||||||
|
int (*func) (void) = (int (*)(void))vector[8];
|
||||||
|
|
||||||
|
return (*func) ();
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void __attribute__((noreturn))
|
||||||
|
flash_erase_all_and_exec (void (*entry)(void))
|
||||||
|
{
|
||||||
|
void (*func) (void (*)(void)) = (void (*)(void (*)(void)))vector[9];
|
||||||
|
|
||||||
|
(*func) (entry);
|
||||||
|
for (;;);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void
|
||||||
|
usb_lld_sys_init (void)
|
||||||
|
{
|
||||||
|
(*vector[10]) ();
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void
|
||||||
|
usb_lld_sys_shutdown (void)
|
||||||
|
{
|
||||||
|
(*vector[11]) ();
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void
|
||||||
|
nvic_system_reset (void)
|
||||||
|
{
|
||||||
|
(*vector[12]) ();
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Users can override INLINE by 'attribute((used))' to have an
|
||||||
|
* implementation defined.
|
||||||
|
*/
|
||||||
|
#if !defined(INLINE)
|
||||||
|
#define INLINE __inline__
|
||||||
|
#endif
|
||||||
|
|
||||||
|
static INLINE void
|
||||||
|
clock_init (void)
|
||||||
|
{
|
||||||
|
(*vector[13]) ();
|
||||||
|
}
|
||||||
|
|
||||||
|
static INLINE void
|
||||||
|
gpio_init (void)
|
||||||
|
{
|
||||||
|
(*vector[14]) ();
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user