Updated STM32/STM32F3xx/SPI-L3GD20
git-svn-id: https://svn.code.sf.net/p/chibios/svn2/trunk@11644 110e8d01-0319-4d1e-a829-52ad28d1bb01
This commit is contained in:
parent
3f7504385e
commit
c02e7a5abc
|
@ -196,7 +196,7 @@ CPPWARN = -Wall -Wextra -Wundef
|
||||||
#
|
#
|
||||||
|
|
||||||
# List all user C define here, like -D_DEBUG=1
|
# List all user C define here, like -D_DEBUG=1
|
||||||
UDEFS = -DCHPRINTF_USE_FLOAT=1 -DSHELL_CMD_TEST_ENABLED=0 \
|
UDEFS = -DCHPRINTF_USE_FLOAT=1 \
|
||||||
-DLSM303DLHC_ACC_USE_ADVANCED=0 -DLSM303DLHC_COMP_USE_ADVANCED=0 \
|
-DLSM303DLHC_ACC_USE_ADVANCED=0 -DLSM303DLHC_COMP_USE_ADVANCED=0 \
|
||||||
-DLSM303DLHC_SHARED_I2C=0
|
-DLSM303DLHC_SHARED_I2C=0
|
||||||
|
|
||||||
|
|
|
@ -87,6 +87,9 @@ PROJECT = ch
|
||||||
|
|
||||||
# Imported source files and paths
|
# Imported source files and paths
|
||||||
CHIBIOS = ../../../..
|
CHIBIOS = ../../../..
|
||||||
|
|
||||||
|
# Licensing files.
|
||||||
|
include $(CHIBIOS)/os/license/license.mk
|
||||||
# Startup files.
|
# Startup files.
|
||||||
include $(CHIBIOS)/os/common/startup/ARMCMx/compilers/GCC/mk/startup_stm32f3xx.mk
|
include $(CHIBIOS)/os/common/startup/ARMCMx/compilers/GCC/mk/startup_stm32f3xx.mk
|
||||||
# HAL-OSAL files (optional).
|
# HAL-OSAL files (optional).
|
||||||
|
@ -97,31 +100,23 @@ include $(CHIBIOS)/os/hal/osal/rt/osal.mk
|
||||||
# RTOS files (optional).
|
# RTOS files (optional).
|
||||||
include $(CHIBIOS)/os/rt/rt.mk
|
include $(CHIBIOS)/os/rt/rt.mk
|
||||||
include $(CHIBIOS)/os/common/ports/ARMCMx/compilers/GCC/mk/port_v7m.mk
|
include $(CHIBIOS)/os/common/ports/ARMCMx/compilers/GCC/mk/port_v7m.mk
|
||||||
# Other files (optional).
|
# EX files (optional).
|
||||||
include $(CHIBIOS)/os/ex/ST/l3gd20.mk
|
include $(CHIBIOS)/os/ex/ST/l3gd20.mk
|
||||||
|
# Other files (optional).
|
||||||
include $(CHIBIOS)/os/hal/lib/streams/streams.mk
|
include $(CHIBIOS)/os/hal/lib/streams/streams.mk
|
||||||
include $(CHIBIOS)/os/various/shell/shell.mk
|
|
||||||
|
|
||||||
# Define linker script file here
|
# Define linker script file here
|
||||||
LDSCRIPT= $(STARTUPLD)/STM32F303xC.ld
|
LDSCRIPT= $(STARTUPLD)/STM32F303xC.ld
|
||||||
|
|
||||||
# C sources that can be compiled in ARM or THUMB mode depending on the global
|
# C sources that can be compiled in ARM or THUMB mode depending on the global
|
||||||
# setting.
|
# setting.
|
||||||
CSRC = $(STARTUPSRC) \
|
CSRC = $(ALLCSRC) \
|
||||||
$(KERNSRC) \
|
$(TESTSRC) \
|
||||||
$(PORTSRC) \
|
main.c
|
||||||
$(OSALSRC) \
|
|
||||||
$(HALSRC) \
|
|
||||||
$(PLATFORMSRC) \
|
|
||||||
$(BOARDSRC) \
|
|
||||||
$(L3GD20SRC) \
|
|
||||||
$(STREAMSSRC) \
|
|
||||||
$(SHELLSRC) \
|
|
||||||
usbcfg.c main.c
|
|
||||||
|
|
||||||
# C++ sources that can be compiled in ARM or THUMB mode depending on the global
|
# C++ sources that can be compiled in ARM or THUMB mode depending on the global
|
||||||
# setting.
|
# setting.
|
||||||
CPPSRC =
|
CPPSRC = $(AllCPPSRC)
|
||||||
|
|
||||||
# C sources to be compiled in ARM mode regardless of the global setting.
|
# C sources to be compiled in ARM mode regardless of the global setting.
|
||||||
# NOTE: Mixing ARM and THUMB mode enables the -mthumb-interwork compiler
|
# NOTE: Mixing ARM and THUMB mode enables the -mthumb-interwork compiler
|
||||||
|
@ -147,10 +142,11 @@ TCPPSRC =
|
||||||
ASMSRC =
|
ASMSRC =
|
||||||
ASMXSRC = $(STARTUPASM) $(PORTASM) $(OSALASM)
|
ASMXSRC = $(STARTUPASM) $(PORTASM) $(OSALASM)
|
||||||
|
|
||||||
INCDIR = $(CHIBIOS)/os/license \
|
# List ASM source files here
|
||||||
$(STARTUPINC) $(KERNINC) $(PORTINC) $(OSALINC) \
|
ASMSRC = $(ALLASMSRC)
|
||||||
$(HALINC) $(PLATFORMINC) $(BOARDINC) $(L3GD20INC) \
|
ASMXSRC = $(ALLXASMSRC)
|
||||||
$(STREAMSINC) $(SHELLINC)
|
|
||||||
|
INCDIR = $(ALLINC) $(TESTINC)
|
||||||
|
|
||||||
#
|
#
|
||||||
# Project, sources and paths
|
# Project, sources and paths
|
||||||
|
@ -200,7 +196,7 @@ CPPWARN = -Wall -Wextra -Wundef
|
||||||
#
|
#
|
||||||
|
|
||||||
# List all user C define here, like -D_DEBUG=1
|
# List all user C define here, like -D_DEBUG=1
|
||||||
UDEFS = -DCHPRINTF_USE_FLOAT=1 -DSHELL_CMD_TEST_ENABLED=0 \
|
UDEFS = -DCHPRINTF_USE_FLOAT=1 \
|
||||||
-DL3GD20_USE_ADVANCED=0 -DL3GD20_SHARED_SPI=0
|
-DL3GD20_USE_ADVANCED=0 -DL3GD20_SHARED_SPI=0
|
||||||
|
|
||||||
# Define ASM defines here
|
# Define ASM defines here
|
||||||
|
|
|
@ -146,14 +146,14 @@
|
||||||
* @brief Enables the SERIAL subsystem.
|
* @brief Enables the SERIAL subsystem.
|
||||||
*/
|
*/
|
||||||
#if !defined(HAL_USE_SERIAL) || defined(__DOXYGEN__)
|
#if !defined(HAL_USE_SERIAL) || defined(__DOXYGEN__)
|
||||||
#define HAL_USE_SERIAL FALSE
|
#define HAL_USE_SERIAL TRUE
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* @brief Enables the SERIAL over USB subsystem.
|
* @brief Enables the SERIAL over USB subsystem.
|
||||||
*/
|
*/
|
||||||
#if !defined(HAL_USE_SERIAL_USB) || defined(__DOXYGEN__)
|
#if !defined(HAL_USE_SERIAL_USB) || defined(__DOXYGEN__)
|
||||||
#define HAL_USE_SERIAL_USB TRUE
|
#define HAL_USE_SERIAL_USB FALSE
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
@ -174,7 +174,7 @@
|
||||||
* @brief Enables the USB subsystem.
|
* @brief Enables the USB subsystem.
|
||||||
*/
|
*/
|
||||||
#if !defined(HAL_USE_USB) || defined(__DOXYGEN__)
|
#if !defined(HAL_USE_USB) || defined(__DOXYGEN__)
|
||||||
#define HAL_USE_USB TRUE
|
#define HAL_USE_USB FALSE
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|
|
@ -17,13 +17,11 @@
|
||||||
#include "ch.h"
|
#include "ch.h"
|
||||||
#include "hal.h"
|
#include "hal.h"
|
||||||
|
|
||||||
#include "usbcfg.h"
|
|
||||||
#include "string.h"
|
|
||||||
#include "shell.h"
|
|
||||||
#include "chprintf.h"
|
#include "chprintf.h"
|
||||||
|
|
||||||
#include "l3gd20.h"
|
#include "l3gd20.h"
|
||||||
|
|
||||||
|
#define cls(chp) chprintf(chp, "\033[2J\033[1;1H")
|
||||||
|
|
||||||
/*===========================================================================*/
|
/*===========================================================================*/
|
||||||
/* L3GD20 related. */
|
/* L3GD20 related. */
|
||||||
/*===========================================================================*/
|
/*===========================================================================*/
|
||||||
|
@ -31,10 +29,10 @@
|
||||||
/* L3GD20 Driver: This object represent an L3GD20 instance.*/
|
/* L3GD20 Driver: This object represent an L3GD20 instance.*/
|
||||||
static L3GD20Driver L3GD20D1;
|
static L3GD20Driver L3GD20D1;
|
||||||
|
|
||||||
static int32_t rawdata[L3GD20_NUMBER_OF_AXES];
|
static int32_t gyroraw[L3GD20_GYRO_NUMBER_OF_AXES];
|
||||||
static float cookeddata[L3GD20_NUMBER_OF_AXES];
|
static float gyrocooked[L3GD20_GYRO_NUMBER_OF_AXES];
|
||||||
|
|
||||||
static char axisID[L3GD20_NUMBER_OF_AXES] = {'X', 'Y', 'Z'};
|
static char axisID[L3GD20_GYRO_NUMBER_OF_AXES] = {'X', 'Y', 'Z'};
|
||||||
static uint32_t i;
|
static uint32_t i;
|
||||||
|
|
||||||
static const SPIConfig spicfg = {
|
static const SPIConfig spicfg = {
|
||||||
|
@ -64,136 +62,12 @@ static L3GD20Config l3gd20cfg = {
|
||||||
};
|
};
|
||||||
|
|
||||||
/*===========================================================================*/
|
/*===========================================================================*/
|
||||||
/* Command line related. */
|
/* Generic code. */
|
||||||
/*===========================================================================*/
|
/*===========================================================================*/
|
||||||
|
|
||||||
|
static BaseSequentialStream* chp = (BaseSequentialStream*)&SD1;
|
||||||
/*
|
/*
|
||||||
* DP resistor control is not possible on the STM32F3-Discovery, using stubs
|
* Red LED blinker thread, times are in milliseconds.
|
||||||
* for the connection macros.
|
|
||||||
*/
|
|
||||||
#define usb_lld_connect_bus(usbp)
|
|
||||||
#define usb_lld_disconnect_bus(usbp)
|
|
||||||
|
|
||||||
/* Enable use of special ANSI escape sequences.*/
|
|
||||||
#define CHPRINTF_USE_ANSI_CODE TRUE
|
|
||||||
#define SHELL_WA_SIZE THD_WORKING_AREA_SIZE(2048)
|
|
||||||
|
|
||||||
static void cmd_read(BaseSequentialStream *chp, int argc, char *argv[]) {
|
|
||||||
(void)argv;
|
|
||||||
if (argc != 1) {
|
|
||||||
chprintf(chp, "Usage: read [raw|cooked]\r\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
while (chnGetTimeout((BaseChannel *)chp, 150) == Q_TIMEOUT) {
|
|
||||||
if (!strcmp (argv[0], "raw")) {
|
|
||||||
#if CHPRINTF_USE_ANSI_CODE
|
|
||||||
chprintf(chp, "\033[2J\033[1;1H");
|
|
||||||
#endif
|
|
||||||
gyroscopeReadRaw(&L3GD20D1, rawdata);
|
|
||||||
chprintf(chp, "L3GD20 Gyroscope raw data...\r\n");
|
|
||||||
for(i = 0; i < L3GD20_NUMBER_OF_AXES; i++) {
|
|
||||||
chprintf(chp, "%c-axis: %d\r\n", axisID[i], rawdata[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
else if (!strcmp (argv[0], "cooked")) {
|
|
||||||
#if CHPRINTF_USE_ANSI_CODE
|
|
||||||
chprintf(chp, "\033[2J\033[1;1H");
|
|
||||||
#endif
|
|
||||||
gyroscopeReadCooked(&L3GD20D1, cookeddata);
|
|
||||||
chprintf(chp, "L3GD20 Gyroscope cooked data...\r\n");
|
|
||||||
for(i = 0; i < L3GD20_NUMBER_OF_AXES; i++) {
|
|
||||||
chprintf(chp, "%c-axis: %.4f DPS\r\n", axisID[i], cookeddata[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
chprintf(chp, "Usage: read [raw|cooked]\r\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
chprintf(chp, "Stopped\r\n");
|
|
||||||
}
|
|
||||||
|
|
||||||
static void cmd_fullscale(BaseSequentialStream *chp, int argc, char *argv[]) {
|
|
||||||
(void)argv;
|
|
||||||
if (argc != 1) {
|
|
||||||
chprintf(chp, "Usage: fullscale [250|500|2000]\r\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
#if CHPRINTF_USE_ANSI_CODE
|
|
||||||
chprintf(chp, "\033[2J\033[1;1H");
|
|
||||||
#endif
|
|
||||||
if(!strcmp (argv[0], "250")) {
|
|
||||||
gyroscopeSetFullScale(&L3GD20D1, L3GD20_FS_250DPS);
|
|
||||||
chprintf(chp, "L3GD20 Gyroscope full scale set to 250 dps...\r\n");
|
|
||||||
}
|
|
||||||
else if(!strcmp (argv[0], "500")) {
|
|
||||||
gyroscopeSetFullScale(&L3GD20D1, L3GD20_FS_500DPS);
|
|
||||||
chprintf(chp, "L3GD20 Gyroscope full scale set to 500 dps...\r\n");
|
|
||||||
}
|
|
||||||
else if(!strcmp (argv[0], "2000")) {
|
|
||||||
gyroscopeSetFullScale(&L3GD20D1, L3GD20_FS_2000DPS);
|
|
||||||
chprintf(chp, "L3GD20 Gyroscope full scale set to 2000 dps...\r\n");
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
chprintf(chp, "Usage: fullscale [250|500|2000]\r\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static void cmd_bias(BaseSequentialStream *chp, int argc, char *argv[]) {
|
|
||||||
(void)argv;
|
|
||||||
if (argc != 1) {
|
|
||||||
chprintf(chp, "Usage: bias [sample|reset]\r\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
if(!strcmp (argv[0], "sample")) {
|
|
||||||
#if CHPRINTF_USE_ANSI_CODE
|
|
||||||
chprintf(chp, "\033[2J\033[1;1H");
|
|
||||||
#endif
|
|
||||||
chprintf(chp, "Please don't move the device while Green LEDs are on!\r\n");
|
|
||||||
chprintf(chp, "Press a key to start...\r\n");
|
|
||||||
while (chnGetTimeout((BaseChannel *)chp, 500) == Q_TIMEOUT)
|
|
||||||
;
|
|
||||||
palSetLine(LINE_LED6_GREEN);
|
|
||||||
palSetLine(LINE_LED7_GREEN);
|
|
||||||
chThdSleepMilliseconds(1000);
|
|
||||||
gyroscopeSampleBias(&L3GD20D1);
|
|
||||||
palClearLine(LINE_LED6_GREEN);
|
|
||||||
palClearLine(LINE_LED7_GREEN);
|
|
||||||
chprintf(chp, "Procedure completed!\r\n");
|
|
||||||
}
|
|
||||||
else if(!strcmp (argv[0], "reset")) {
|
|
||||||
#if CHPRINTF_USE_ANSI_CODE
|
|
||||||
chprintf(chp, "\033[2J\033[1;1H");
|
|
||||||
#endif
|
|
||||||
gyroscopeResetBias(&L3GD20D1);
|
|
||||||
chprintf(chp, "Bias correction removed!\r\n");
|
|
||||||
}
|
|
||||||
else {
|
|
||||||
chprintf(chp, "Usage: bias [sample|reset]\r\n");
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static const ShellCommand commands[] = {
|
|
||||||
{"read", cmd_read},
|
|
||||||
{"fullscale", cmd_fullscale},
|
|
||||||
{"bias", cmd_bias},
|
|
||||||
{NULL, NULL}
|
|
||||||
};
|
|
||||||
|
|
||||||
static const ShellConfig shell_cfg1 = {
|
|
||||||
(BaseSequentialStream *)&SDU1,
|
|
||||||
commands
|
|
||||||
};
|
|
||||||
|
|
||||||
/*===========================================================================*/
|
|
||||||
/* Main code. */
|
|
||||||
/*===========================================================================*/
|
|
||||||
|
|
||||||
/*
|
|
||||||
* LED blinker thread, times are in milliseconds.
|
|
||||||
*/
|
*/
|
||||||
static THD_WORKING_AREA(waThread1, 128);
|
static THD_WORKING_AREA(waThread1, 128);
|
||||||
static THD_FUNCTION(Thread1, arg) {
|
static THD_FUNCTION(Thread1, arg) {
|
||||||
|
@ -201,13 +75,8 @@ static THD_FUNCTION(Thread1, arg) {
|
||||||
(void)arg;
|
(void)arg;
|
||||||
chRegSetThreadName("blinker");
|
chRegSetThreadName("blinker");
|
||||||
while (true) {
|
while (true) {
|
||||||
systime_t time;
|
palToggleLine(LINE_LED3_RED);
|
||||||
|
chThdSleepMilliseconds(250);
|
||||||
time = serusbcfg.usbp->state == USB_ACTIVE ? 250 : 500;
|
|
||||||
palClearLine(LINE_LED3_RED);
|
|
||||||
chThdSleepMilliseconds(time);
|
|
||||||
palSetLine(LINE_LED3_RED);
|
|
||||||
chThdSleepMilliseconds(time);
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -226,41 +95,44 @@ int main(void) {
|
||||||
halInit();
|
halInit();
|
||||||
chSysInit();
|
chSysInit();
|
||||||
|
|
||||||
/* Initializes a serial-over-USB CDC driver.*/
|
/*
|
||||||
sduObjectInit(&SDU1);
|
* Activates the serial driver 1 using the driver default configuration.
|
||||||
sduStart(&SDU1, &serusbcfg);
|
*/
|
||||||
|
sdStart(&SD1, NULL);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Activates the USB driver and then the USB bus pull-up on D+.
|
* Creates the blinker thread.
|
||||||
* Note, a delay is inserted in order to not have to disconnect the cable
|
|
||||||
* after a reset.
|
|
||||||
*/
|
*/
|
||||||
usbDisconnectBus(serusbcfg.usbp);
|
chThdCreateStatic(waThread1, sizeof(waThread1), NORMALPRIO, Thread1, NULL);
|
||||||
chThdSleepMilliseconds(1500);
|
|
||||||
usbStart(serusbcfg.usbp, &usbcfg);
|
|
||||||
usbConnectBus(serusbcfg.usbp);
|
|
||||||
|
|
||||||
/* Creates the blinker thread.*/
|
/*
|
||||||
chThdCreateStatic(waThread1, sizeof(waThread1), NORMALPRIO + 1, Thread1, NULL);
|
* L3GD20 Object Initialization
|
||||||
|
*/
|
||||||
/* L3GD20 Object Initialization.*/
|
|
||||||
l3gd20ObjectInit(&L3GD20D1);
|
l3gd20ObjectInit(&L3GD20D1);
|
||||||
|
|
||||||
/* Activates the L3GD20 driver.*/
|
/*
|
||||||
|
* Activates the L3GD20 driver.
|
||||||
|
*/
|
||||||
l3gd20Start(&L3GD20D1, &l3gd20cfg);
|
l3gd20Start(&L3GD20D1, &l3gd20cfg);
|
||||||
|
|
||||||
/* Shell manager initialization.*/
|
/*
|
||||||
shellInit();
|
* Normal main() thread activity, printing MEMS data on the serial driver 1.
|
||||||
|
*/
|
||||||
while(TRUE) {
|
while (true) {
|
||||||
if (SDU1.config->usbp->state == USB_ACTIVE) {
|
l3gd20GyroscopeReadRaw(&L3GD20D1, gyroraw);
|
||||||
thread_t *shelltp = chThdCreateFromHeap(NULL, SHELL_WA_SIZE,
|
chprintf(chp, "L3GD20 Gyroscope raw data...\r\n");
|
||||||
"shell", NORMALPRIO + 1,
|
for(i = 0; i < L3GD20_GYRO_NUMBER_OF_AXES; i++) {
|
||||||
shellThread, (void *)&shell_cfg1);
|
chprintf(chp, "%c-axis: %d\r\n", axisID[i], gyroraw[i]);
|
||||||
chThdWait(shelltp); /* Waiting termination. */
|
|
||||||
}
|
}
|
||||||
chThdSleepMilliseconds(1000);
|
|
||||||
|
l3gd20GyroscopeReadCooked(&L3GD20D1, gyrocooked);
|
||||||
|
chprintf(chp, "L3GD20 Gyroscope cooked data...\r\n");
|
||||||
|
for(i = 0; i < L3GD20_GYRO_NUMBER_OF_AXES; i++) {
|
||||||
|
chprintf(chp, "%c-axis: %.3f\r\n", axisID[i], gyrocooked[i]);
|
||||||
|
}
|
||||||
|
|
||||||
|
chThdSleepMilliseconds(100);
|
||||||
|
cls(chp);
|
||||||
}
|
}
|
||||||
l3gd20Stop(&L3GD20D1);
|
l3gd20Stop(&L3GD20D1);
|
||||||
return 0;
|
|
||||||
}
|
}
|
||||||
|
|
|
@ -192,7 +192,7 @@
|
||||||
/*
|
/*
|
||||||
* SERIAL driver system settings.
|
* SERIAL driver system settings.
|
||||||
*/
|
*/
|
||||||
#define STM32_SERIAL_USE_USART1 FALSE
|
#define STM32_SERIAL_USE_USART1 TRUE
|
||||||
#define STM32_SERIAL_USE_USART2 FALSE
|
#define STM32_SERIAL_USE_USART2 FALSE
|
||||||
#define STM32_SERIAL_USE_USART3 FALSE
|
#define STM32_SERIAL_USE_USART3 FALSE
|
||||||
#define STM32_SERIAL_USE_UART4 FALSE
|
#define STM32_SERIAL_USE_UART4 FALSE
|
||||||
|
@ -240,7 +240,7 @@
|
||||||
/*
|
/*
|
||||||
* USB driver system settings.
|
* USB driver system settings.
|
||||||
*/
|
*/
|
||||||
#define STM32_USB_USE_USB1 TRUE
|
#define STM32_USB_USE_USB1 FALSE
|
||||||
#define STM32_USB_LOW_POWER_ON_SUSPEND FALSE
|
#define STM32_USB_LOW_POWER_ON_SUSPEND FALSE
|
||||||
#define STM32_USB_USB1_HP_IRQ_PRIORITY 13
|
#define STM32_USB_USB1_HP_IRQ_PRIORITY 13
|
||||||
#define STM32_USB_USB1_LP_IRQ_PRIORITY 14
|
#define STM32_USB_USB1_LP_IRQ_PRIORITY 14
|
||||||
|
|
|
@ -4,16 +4,15 @@
|
||||||
|
|
||||||
** TARGET **
|
** TARGET **
|
||||||
|
|
||||||
The demo runs on an STM32F3 Discovery board.
|
The demo runs on an ST STM32F3-Discovery board.
|
||||||
|
|
||||||
** The Demo **
|
** The Demo **
|
||||||
|
|
||||||
The demo uses the ChibiOS Shell in order to test L3GD20 APIs.
|
The demo prints L3GD20 data on the SD1 BaseSequentialStream.
|
||||||
Shell is used on the SDU1 BaseSequentialStream.
|
|
||||||
|
|
||||||
** Build Procedure **
|
** Build Procedure **
|
||||||
|
|
||||||
The demo has been tested by using the free Codesourcery GCC-based toolchain
|
The demo has been tested using the free Codesourcery GCC-based toolchain
|
||||||
and YAGARTO.
|
and YAGARTO.
|
||||||
Just modify the TRGT line in the makefile in order to use different GCC ports.
|
Just modify the TRGT line in the makefile in order to use different GCC ports.
|
||||||
|
|
||||||
|
@ -24,4 +23,4 @@ ST Microelectronics and are licensed under a different license.
|
||||||
Also note that not all the files present in the ST library are distributed
|
Also note that not all the files present in the ST library are distributed
|
||||||
with ChibiOS/RT, you can find the whole library on the ST web site:
|
with ChibiOS/RT, you can find the whole library on the ST web site:
|
||||||
|
|
||||||
http://www.st.com
|
http://www.st.com
|
||||||
|
|
|
@ -1,342 +0,0 @@
|
||||||
/*
|
|
||||||
ChibiOS - Copyright (C) 2006..2018 Giovanni Di Sirio
|
|
||||||
|
|
||||||
Licensed under the Apache License, Version 2.0 (the "License");
|
|
||||||
you may not use this file except in compliance with the License.
|
|
||||||
You may obtain a copy of the License at
|
|
||||||
|
|
||||||
http://www.apache.org/licenses/LICENSE-2.0
|
|
||||||
|
|
||||||
Unless required by applicable law or agreed to in writing, software
|
|
||||||
distributed under the License is distributed on an "AS IS" BASIS,
|
|
||||||
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
||||||
See the License for the specific language governing permissions and
|
|
||||||
limitations under the License.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include "hal.h"
|
|
||||||
|
|
||||||
/* Virtual serial port over USB.*/
|
|
||||||
SerialUSBDriver SDU1;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Endpoints to be used for USBD1.
|
|
||||||
*/
|
|
||||||
#define USBD1_DATA_REQUEST_EP 1
|
|
||||||
#define USBD1_DATA_AVAILABLE_EP 1
|
|
||||||
#define USBD1_INTERRUPT_REQUEST_EP 2
|
|
||||||
|
|
||||||
/*
|
|
||||||
* USB Device Descriptor.
|
|
||||||
*/
|
|
||||||
static const uint8_t vcom_device_descriptor_data[18] = {
|
|
||||||
USB_DESC_DEVICE (0x0110, /* bcdUSB (1.1). */
|
|
||||||
0x02, /* bDeviceClass (CDC). */
|
|
||||||
0x00, /* bDeviceSubClass. */
|
|
||||||
0x00, /* bDeviceProtocol. */
|
|
||||||
0x40, /* bMaxPacketSize. */
|
|
||||||
0x0483, /* idVendor (ST). */
|
|
||||||
0x5740, /* idProduct. */
|
|
||||||
0x0200, /* bcdDevice. */
|
|
||||||
1, /* iManufacturer. */
|
|
||||||
2, /* iProduct. */
|
|
||||||
3, /* iSerialNumber. */
|
|
||||||
1) /* bNumConfigurations. */
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Device Descriptor wrapper.
|
|
||||||
*/
|
|
||||||
static const USBDescriptor vcom_device_descriptor = {
|
|
||||||
sizeof vcom_device_descriptor_data,
|
|
||||||
vcom_device_descriptor_data
|
|
||||||
};
|
|
||||||
|
|
||||||
/* Configuration Descriptor tree for a CDC.*/
|
|
||||||
static const uint8_t vcom_configuration_descriptor_data[67] = {
|
|
||||||
/* Configuration Descriptor.*/
|
|
||||||
USB_DESC_CONFIGURATION(67, /* wTotalLength. */
|
|
||||||
0x02, /* bNumInterfaces. */
|
|
||||||
0x01, /* bConfigurationValue. */
|
|
||||||
0, /* iConfiguration. */
|
|
||||||
0xC0, /* bmAttributes (self powered). */
|
|
||||||
50), /* bMaxPower (100mA). */
|
|
||||||
/* Interface Descriptor.*/
|
|
||||||
USB_DESC_INTERFACE (0x00, /* bInterfaceNumber. */
|
|
||||||
0x00, /* bAlternateSetting. */
|
|
||||||
0x01, /* bNumEndpoints. */
|
|
||||||
0x02, /* bInterfaceClass (Communications
|
|
||||||
Interface Class, CDC section
|
|
||||||
4.2). */
|
|
||||||
0x02, /* bInterfaceSubClass (Abstract
|
|
||||||
Control Model, CDC section 4.3). */
|
|
||||||
0x01, /* bInterfaceProtocol (AT commands,
|
|
||||||
CDC section 4.4). */
|
|
||||||
0), /* iInterface. */
|
|
||||||
/* Header Functional Descriptor (CDC section 5.2.3).*/
|
|
||||||
USB_DESC_BYTE (5), /* bLength. */
|
|
||||||
USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */
|
|
||||||
USB_DESC_BYTE (0x00), /* bDescriptorSubtype (Header
|
|
||||||
Functional Descriptor. */
|
|
||||||
USB_DESC_BCD (0x0110), /* bcdCDC. */
|
|
||||||
/* Call Management Functional Descriptor. */
|
|
||||||
USB_DESC_BYTE (5), /* bFunctionLength. */
|
|
||||||
USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */
|
|
||||||
USB_DESC_BYTE (0x01), /* bDescriptorSubtype (Call Management
|
|
||||||
Functional Descriptor). */
|
|
||||||
USB_DESC_BYTE (0x00), /* bmCapabilities (D0+D1). */
|
|
||||||
USB_DESC_BYTE (0x01), /* bDataInterface. */
|
|
||||||
/* ACM Functional Descriptor.*/
|
|
||||||
USB_DESC_BYTE (4), /* bFunctionLength. */
|
|
||||||
USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */
|
|
||||||
USB_DESC_BYTE (0x02), /* bDescriptorSubtype (Abstract
|
|
||||||
Control Management Descriptor). */
|
|
||||||
USB_DESC_BYTE (0x02), /* bmCapabilities. */
|
|
||||||
/* Union Functional Descriptor.*/
|
|
||||||
USB_DESC_BYTE (5), /* bFunctionLength. */
|
|
||||||
USB_DESC_BYTE (0x24), /* bDescriptorType (CS_INTERFACE). */
|
|
||||||
USB_DESC_BYTE (0x06), /* bDescriptorSubtype (Union
|
|
||||||
Functional Descriptor). */
|
|
||||||
USB_DESC_BYTE (0x00), /* bMasterInterface (Communication
|
|
||||||
Class Interface). */
|
|
||||||
USB_DESC_BYTE (0x01), /* bSlaveInterface0 (Data Class
|
|
||||||
Interface). */
|
|
||||||
/* Endpoint 2 Descriptor.*/
|
|
||||||
USB_DESC_ENDPOINT (USBD1_INTERRUPT_REQUEST_EP|0x80,
|
|
||||||
0x03, /* bmAttributes (Interrupt). */
|
|
||||||
0x0008, /* wMaxPacketSize. */
|
|
||||||
0xFF), /* bInterval. */
|
|
||||||
/* Interface Descriptor.*/
|
|
||||||
USB_DESC_INTERFACE (0x01, /* bInterfaceNumber. */
|
|
||||||
0x00, /* bAlternateSetting. */
|
|
||||||
0x02, /* bNumEndpoints. */
|
|
||||||
0x0A, /* bInterfaceClass (Data Class
|
|
||||||
Interface, CDC section 4.5). */
|
|
||||||
0x00, /* bInterfaceSubClass (CDC section
|
|
||||||
4.6). */
|
|
||||||
0x00, /* bInterfaceProtocol (CDC section
|
|
||||||
4.7). */
|
|
||||||
0x00), /* iInterface. */
|
|
||||||
/* Endpoint 3 Descriptor.*/
|
|
||||||
USB_DESC_ENDPOINT (USBD1_DATA_AVAILABLE_EP, /* bEndpointAddress.*/
|
|
||||||
0x02, /* bmAttributes (Bulk). */
|
|
||||||
0x0040, /* wMaxPacketSize. */
|
|
||||||
0x00), /* bInterval. */
|
|
||||||
/* Endpoint 1 Descriptor.*/
|
|
||||||
USB_DESC_ENDPOINT (USBD1_DATA_REQUEST_EP|0x80, /* bEndpointAddress.*/
|
|
||||||
0x02, /* bmAttributes (Bulk). */
|
|
||||||
0x0040, /* wMaxPacketSize. */
|
|
||||||
0x00) /* bInterval. */
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Configuration Descriptor wrapper.
|
|
||||||
*/
|
|
||||||
static const USBDescriptor vcom_configuration_descriptor = {
|
|
||||||
sizeof vcom_configuration_descriptor_data,
|
|
||||||
vcom_configuration_descriptor_data
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* U.S. English language identifier.
|
|
||||||
*/
|
|
||||||
static const uint8_t vcom_string0[] = {
|
|
||||||
USB_DESC_BYTE(4), /* bLength. */
|
|
||||||
USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */
|
|
||||||
USB_DESC_WORD(0x0409) /* wLANGID (U.S. English). */
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Vendor string.
|
|
||||||
*/
|
|
||||||
static const uint8_t vcom_string1[] = {
|
|
||||||
USB_DESC_BYTE(38), /* bLength. */
|
|
||||||
USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */
|
|
||||||
'S', 0, 'T', 0, 'M', 0, 'i', 0, 'c', 0, 'r', 0, 'o', 0, 'e', 0,
|
|
||||||
'l', 0, 'e', 0, 'c', 0, 't', 0, 'r', 0, 'o', 0, 'n', 0, 'i', 0,
|
|
||||||
'c', 0, 's', 0
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Device Description string.
|
|
||||||
*/
|
|
||||||
static const uint8_t vcom_string2[] = {
|
|
||||||
USB_DESC_BYTE(56), /* bLength. */
|
|
||||||
USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */
|
|
||||||
'C', 0, 'h', 0, 'i', 0, 'b', 0, 'i', 0, 'O', 0, 'S', 0, '/', 0,
|
|
||||||
'R', 0, 'T', 0, ' ', 0, 'V', 0, 'i', 0, 'r', 0, 't', 0, 'u', 0,
|
|
||||||
'a', 0, 'l', 0, ' ', 0, 'C', 0, 'O', 0, 'M', 0, ' ', 0, 'P', 0,
|
|
||||||
'o', 0, 'r', 0, 't', 0
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Serial Number string.
|
|
||||||
*/
|
|
||||||
static const uint8_t vcom_string3[] = {
|
|
||||||
USB_DESC_BYTE(8), /* bLength. */
|
|
||||||
USB_DESC_BYTE(USB_DESCRIPTOR_STRING), /* bDescriptorType. */
|
|
||||||
'0' + CH_KERNEL_MAJOR, 0,
|
|
||||||
'0' + CH_KERNEL_MINOR, 0,
|
|
||||||
'0' + CH_KERNEL_PATCH, 0
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Strings wrappers array.
|
|
||||||
*/
|
|
||||||
static const USBDescriptor vcom_strings[] = {
|
|
||||||
{sizeof vcom_string0, vcom_string0},
|
|
||||||
{sizeof vcom_string1, vcom_string1},
|
|
||||||
{sizeof vcom_string2, vcom_string2},
|
|
||||||
{sizeof vcom_string3, vcom_string3}
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Handles the GET_DESCRIPTOR callback. All required descriptors must be
|
|
||||||
* handled here.
|
|
||||||
*/
|
|
||||||
static const USBDescriptor *get_descriptor(USBDriver *usbp,
|
|
||||||
uint8_t dtype,
|
|
||||||
uint8_t dindex,
|
|
||||||
uint16_t lang) {
|
|
||||||
|
|
||||||
(void)usbp;
|
|
||||||
(void)lang;
|
|
||||||
switch (dtype) {
|
|
||||||
case USB_DESCRIPTOR_DEVICE:
|
|
||||||
return &vcom_device_descriptor;
|
|
||||||
case USB_DESCRIPTOR_CONFIGURATION:
|
|
||||||
return &vcom_configuration_descriptor;
|
|
||||||
case USB_DESCRIPTOR_STRING:
|
|
||||||
if (dindex < 4)
|
|
||||||
return &vcom_strings[dindex];
|
|
||||||
}
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief IN EP1 state.
|
|
||||||
*/
|
|
||||||
static USBInEndpointState ep1instate;
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief OUT EP1 state.
|
|
||||||
*/
|
|
||||||
static USBOutEndpointState ep1outstate;
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief EP1 initialization structure (both IN and OUT).
|
|
||||||
*/
|
|
||||||
static const USBEndpointConfig ep1config = {
|
|
||||||
USB_EP_MODE_TYPE_BULK,
|
|
||||||
NULL,
|
|
||||||
sduDataTransmitted,
|
|
||||||
sduDataReceived,
|
|
||||||
0x0040,
|
|
||||||
0x0040,
|
|
||||||
&ep1instate,
|
|
||||||
&ep1outstate,
|
|
||||||
2,
|
|
||||||
NULL
|
|
||||||
};
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief IN EP2 state.
|
|
||||||
*/
|
|
||||||
static USBInEndpointState ep2instate;
|
|
||||||
|
|
||||||
/**
|
|
||||||
* @brief EP2 initialization structure (IN only).
|
|
||||||
*/
|
|
||||||
static const USBEndpointConfig ep2config = {
|
|
||||||
USB_EP_MODE_TYPE_INTR,
|
|
||||||
NULL,
|
|
||||||
sduInterruptTransmitted,
|
|
||||||
NULL,
|
|
||||||
0x0010,
|
|
||||||
0x0000,
|
|
||||||
&ep2instate,
|
|
||||||
NULL,
|
|
||||||
1,
|
|
||||||
NULL
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Handles the USB driver global events.
|
|
||||||
*/
|
|
||||||
static void usb_event(USBDriver *usbp, usbevent_t event) {
|
|
||||||
extern SerialUSBDriver SDU1;
|
|
||||||
|
|
||||||
switch (event) {
|
|
||||||
case USB_EVENT_ADDRESS:
|
|
||||||
return;
|
|
||||||
case USB_EVENT_CONFIGURED:
|
|
||||||
chSysLockFromISR();
|
|
||||||
|
|
||||||
/* Enables the endpoints specified into the configuration.
|
|
||||||
Note, this callback is invoked from an ISR so I-Class functions
|
|
||||||
must be used.*/
|
|
||||||
usbInitEndpointI(usbp, USBD1_DATA_REQUEST_EP, &ep1config);
|
|
||||||
usbInitEndpointI(usbp, USBD1_INTERRUPT_REQUEST_EP, &ep2config);
|
|
||||||
|
|
||||||
/* Resetting the state of the CDC subsystem.*/
|
|
||||||
sduConfigureHookI(&SDU1);
|
|
||||||
|
|
||||||
chSysUnlockFromISR();
|
|
||||||
return;
|
|
||||||
case USB_EVENT_RESET:
|
|
||||||
/* Falls into.*/
|
|
||||||
case USB_EVENT_UNCONFIGURED:
|
|
||||||
/* Falls into.*/
|
|
||||||
case USB_EVENT_SUSPEND:
|
|
||||||
chSysLockFromISR();
|
|
||||||
|
|
||||||
/* Disconnection event on suspend.*/
|
|
||||||
sduSuspendHookI(&SDU1);
|
|
||||||
|
|
||||||
chSysUnlockFromISR();
|
|
||||||
return;
|
|
||||||
case USB_EVENT_WAKEUP:
|
|
||||||
chSysLockFromISR();
|
|
||||||
|
|
||||||
/* Disconnection event on suspend.*/
|
|
||||||
sduWakeupHookI(&SDU1);
|
|
||||||
|
|
||||||
chSysUnlockFromISR();
|
|
||||||
return;
|
|
||||||
case USB_EVENT_STALLED:
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Handles the USB driver global events.
|
|
||||||
*/
|
|
||||||
static void sof_handler(USBDriver *usbp) {
|
|
||||||
|
|
||||||
(void)usbp;
|
|
||||||
|
|
||||||
osalSysLockFromISR();
|
|
||||||
sduSOFHookI(&SDU1);
|
|
||||||
osalSysUnlockFromISR();
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* USB driver configuration.
|
|
||||||
*/
|
|
||||||
const USBConfig usbcfg = {
|
|
||||||
usb_event,
|
|
||||||
get_descriptor,
|
|
||||||
sduRequestsHook,
|
|
||||||
sof_handler
|
|
||||||
};
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Serial over USB driver configuration.
|
|
||||||
*/
|
|
||||||
const SerialUSBConfig serusbcfg = {
|
|
||||||
&USBD1,
|
|
||||||
USBD1_DATA_REQUEST_EP,
|
|
||||||
USBD1_DATA_AVAILABLE_EP,
|
|
||||||
USBD1_INTERRUPT_REQUEST_EP
|
|
||||||
};
|
|
|
@ -1,26 +0,0 @@
|
||||||
/*
|
|
||||||
ChibiOS - Copyright (C) 2006..2018 Giovanni Di Sirio
|
|
||||||
|
|
||||||
Licensed under the Apache License, Version 2.0 (the "License");
|
|
||||||
you may not use this file except in compliance with the License.
|
|
||||||
You may obtain a copy of the License at
|
|
||||||
|
|
||||||
http://www.apache.org/licenses/LICENSE-2.0
|
|
||||||
|
|
||||||
Unless required by applicable law or agreed to in writing, software
|
|
||||||
distributed under the License is distributed on an "AS IS" BASIS,
|
|
||||||
WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
||||||
See the License for the specific language governing permissions and
|
|
||||||
limitations under the License.
|
|
||||||
*/
|
|
||||||
|
|
||||||
#ifndef USBCFG_H
|
|
||||||
#define USBCFG_H
|
|
||||||
|
|
||||||
extern const USBConfig usbcfg;
|
|
||||||
extern SerialUSBConfig serusbcfg;
|
|
||||||
extern SerialUSBDriver SDU1;
|
|
||||||
|
|
||||||
#endif /* USBCFG_H */
|
|
||||||
|
|
||||||
/** @} */
|
|
Loading…
Reference in New Issue