Added max30101, working, got FIFO working on lsm6dsv16

This commit is contained in:
ggw
2026-05-07 14:31:34 -05:00
parent c9d0ff0686
commit 02517fe9ae
19 changed files with 378 additions and 247 deletions
-2
View File
@@ -59,7 +59,6 @@ void Error_Handler(void);
/* Private defines -----------------------------------------------------------*/
#define IMU_DRDY_Pin GPIO_PIN_3
#define IMU_DRDY_GPIO_Port GPIOC
#define IMU_DRDY_EXTI_IRQn EXTI3_IRQn
#define CLKIN_ADC_Pin GPIO_PIN_0
#define CLKIN_ADC_GPIO_Port GPIOA
#define ADC_CS_Pin GPIO_PIN_3
@@ -84,7 +83,6 @@ void Error_Handler(void);
#define LED3_GPIO_Port GPIOB
#define PPG_DRDY_Pin GPIO_PIN_7
#define PPG_DRDY_GPIO_Port GPIOC
#define PPG_DRDY_EXTI_IRQn EXTI9_5_IRQn
#define SD_DETECT_Pin GPIO_PIN_15
#define SD_DETECT_GPIO_Port GPIOA
+5
View File
@@ -0,0 +1,5 @@
#include "i2c.h"
void initialize_max30101(I2C_HandleTypeDef *hi2c1);
void read_max30101(I2C_HandleTypeDef *hi2c1);
+11 -53
View File
@@ -25,43 +25,21 @@ struct packet_vbatt {
struct packet_imu {
uint32_t t;
uint16_t readings_cnts[4];
uint8_t data[141];
};
struct packet_ekg {
struct packet_adc {
uint32_t t;
uint8_t index;
int32_t readings_cnts[50];
};
struct packet_strain {
uint32_t t;
uint8_t index;
int32_t readings_cnts[5];
};
struct packet_outsideT {
uint32_t t;
uint8_t index;
int32_t readings_cnts[5];
};
struct packet_insideT {
uint32_t t;
uint8_t index;
int32_t readings_cnts[5];
};
struct packet_button {
uint32_t t;
uint8_t button_vec;
int32_t ekg_readings_cnts[50];
int32_t str_readings_cnts[5];
int32_t oT_readings_cnts[5];
int32_t iT_readings_cnts[5];
};
struct packet_spo2 {
uint32_t t;
uint32_t green_cnts[25];
uint32_t red_cnts[25];
uint32_t ir_cnts[25];
uint8_t bytes[180];
};
struct packet_msg {
@@ -85,41 +63,21 @@ __inline__ uint8_t typecode<struct packet_vbatt>() {
}
template<>
__inline__ uint8_t typecode<struct packet_ekg>() {
__inline__ uint8_t typecode<struct packet_imu>() {
return 3;
}
template<>
__inline__ uint8_t typecode<struct packet_strain>() {
__inline__ uint8_t typecode<struct packet_adc>() {
return 4;
}
template<>
__inline__ uint8_t typecode<struct packet_outsideT>() {
__inline__ uint8_t typecode<struct packet_spo2>() {
return 5;
}
template<>
__inline__ uint8_t typecode<struct packet_insideT>() {
__inline__ uint8_t typecode<struct packet_msg>() {
return 6;
}
template<>
__inline__ uint8_t typecode<struct packet_button>() {
return 7;
}
template<>
__inline__ uint8_t typecode<struct packet_spo2>() {
return 8;
}
template<>
__inline__ uint8_t typecode<struct packet_imu>() {
return 9;
}
template<>
__inline__ uint8_t typecode<struct packet_msg>() {
return 10;
}
+2 -1
View File
@@ -56,9 +56,10 @@ void DebugMon_Handler(void);
void PendSV_Handler(void);
void SysTick_Handler(void);
void EXTI0_IRQHandler(void);
void EXTI3_IRQHandler(void);
void DMA1_Channel4_IRQHandler(void);
void DMA1_Channel5_IRQHandler(void);
void DMA1_Channel6_IRQHandler(void);
void DMA1_Channel7_IRQHandler(void);
void ADC1_IRQHandler(void);
void EXTI9_5_IRQHandler(void);
void I2C1_EV_IRQHandler(void);
+20 -58
View File
@@ -18,7 +18,7 @@ void initialize_ads131(SPI_HandleTypeDef *hspi1) {
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, (uint8_t*) cmd, (uint8_t*) rx_buff, 18, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_SET);
HAL_Delay(1);
HAL_Delay(2);
// set OSR, reg 3h
cmd[0] = 0b01100001;
@@ -32,11 +32,11 @@ void initialize_ads131(SPI_HandleTypeDef *hspi1) {
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, (uint8_t*) cmd, (uint8_t*) rx_buff, 18, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_SET);
HAL_Delay(1);
HAL_Delay(2);
memset(cmd, 0, 6);
// set gain to 8, reg 4h
// set gain to 1, reg 4h
cmd[0] = 0b01100010;
cmd[1] = 0b00000000;
cmd[2] = 0x00;
@@ -48,7 +48,7 @@ void initialize_ads131(SPI_HandleTypeDef *hspi1) {
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, (uint8_t*) cmd, (uint8_t*) rx_buff, 18, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_SET);
HAL_Delay(1);
HAL_Delay(2);
memset(cmd, 0, 6);
@@ -60,10 +60,7 @@ void initialize_ads131(SPI_HandleTypeDef *hspi1) {
}
}
struct packet_ekg p_ekg;
struct packet_strain p_strain;
struct packet_outsideT p_outsideT;
struct packet_insideT p_insideT;
struct packet_adc p_adc;
extern volatile uint16_t tim6_reloads;
@@ -83,58 +80,23 @@ void read_ads131(SPI_HandleTypeDef *hspi1) {
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, (uint8_t*) cmd, (uint8_t*) rx_buff, 18, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOA, ADC_CS_Pin, GPIO_PIN_SET);
// WARNING AVERAGING LATER PROBABLY WON'T WORK - 2s COMPLEMENT!!!
//--------------
if (p_ekg.index == 0) {
p_ekg.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
if (p_adc.index == 0) {
p_adc.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
}
p_ekg.readings_cnts[p_ekg.index] = to_signed_24(&rx_buff[3]);
if (p_ekg.index == 49) {
write(p_ekg);
p_ekg.index = 0;
p_adc.ekg_readings_cnts[p_adc.index] = to_signed_24(&rx_buff[3]);
p_adc.str_readings_cnts[p_adc.index / 10] += to_signed_24(&rx_buff[6]);
p_adc.oT_readings_cnts[p_adc.index / 10] += to_signed_24(&rx_buff[9]);
p_adc.iT_readings_cnts[p_adc.index / 10] += to_signed_24(&rx_buff[12]);
if (p_adc.index == 49) {
write(p_adc);
p_adc.index = 0;
memset(p_adc.str_readings_cnts, 0, sizeof(p_adc.str_readings_cnts));
memset(p_adc.oT_readings_cnts, 0, sizeof(p_adc.oT_readings_cnts));
memset(p_adc.iT_readings_cnts, 0, sizeof(p_adc.iT_readings_cnts));
} else {
p_ekg.index++;
p_adc.index++;
}
//-------------
if (p_strain.index == 0) {
p_strain.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
}
p_strain.readings_cnts[p_strain.index / 10] += to_signed_24(&rx_buff[6]);
if (p_strain.index == 49) {
write(p_strain);
p_strain.index = 0;
memset(p_strain.readings_cnts, 0, sizeof(p_strain.readings_cnts));
} else {
p_strain.index++;
}
//-------------
if (p_outsideT.index == 0) {
p_outsideT.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
}
p_outsideT.readings_cnts[p_outsideT.index / 10] += to_signed_24(&rx_buff[9]);
if (p_outsideT.index == 49) {
write(p_outsideT);
p_outsideT.index = 0;
memset(p_outsideT.readings_cnts, 0, sizeof(p_outsideT.readings_cnts));
} else {
p_outsideT.index++;
}
//-------------
if (p_insideT.index == 0) {
p_insideT.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
}
p_insideT.readings_cnts[p_insideT.index / 10] += to_signed_24(&rx_buff[12]);
if (p_insideT.index == 49) {
write(p_insideT);
p_insideT.index = 0;
memset(p_insideT.readings_cnts, 0, sizeof(p_insideT.readings_cnts));
} else {
p_insideT.index++;
}
//-------------
}
+3 -23
View File
@@ -21,37 +21,17 @@ void data_description(bool to_usb, bool to_file) {
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d\n\r", "packet_imu", typecode<packet_imu>(), sizeof(packet_imu), "uint32_t t", offsetof(packet_imu, t), sizeof(uint32_t), "uint16_t readings_cnts[4]", offsetof(packet_imu, readings_cnts), sizeof(uint16_t));
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d\n\r", "packet_imu", typecode<packet_imu>(), sizeof(packet_imu), "uint32_t t", offsetof(packet_imu, t), sizeof(uint32_t), "uint8_t data[141]", offsetof(packet_imu, data), sizeof(uint8_t));
if (to_file) {unsigned int bw; f_write(&file, buff, cx, &bw);}
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d %s %d %d\n\r", "packet_ekg", typecode<packet_ekg>(), sizeof(packet_ekg), "uint32_t t", offsetof(packet_ekg, t), sizeof(uint32_t), "uint8_t index", offsetof(packet_ekg, index), sizeof(uint8_t), "int32_t readings_cnts[50]", offsetof(packet_ekg, readings_cnts), sizeof(int32_t));
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d %d %s %d %d\n\r", "packet_adc", typecode<packet_adc>(), sizeof(packet_adc), "uint32_t t", offsetof(packet_adc, t), sizeof(uint32_t), "uint8_t index", offsetof(packet_adc, index), sizeof(uint8_t), "int32_t ekg_readings_cnts[50]", offsetof(packet_adc, ekg_readings_cnts), sizeof(int32_t), "int32_t str_readings_cnts[5]", offsetof(packet_adc, str_readings_cnts), sizeof(int32_t), "int32_t oT_readings_cnts[5]", offsetof(packet_adc, oT_readings_cnts), sizeof(int32_t), "int32_t iT_readings_cnts[5]", offsetof(packet_adc, iT_readings_cnts), sizeof(int32_t));
if (to_file) {unsigned int bw; f_write(&file, buff, cx, &bw);}
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d %s %d %d\n\r", "packet_strain", typecode<packet_strain>(), sizeof(packet_strain), "uint32_t t", offsetof(packet_strain, t), sizeof(uint32_t), "uint8_t index", offsetof(packet_strain, index), sizeof(uint8_t), "int32_t readings_cnts[5]", offsetof(packet_strain, readings_cnts), sizeof(int32_t));
if (to_file) {unsigned int bw; f_write(&file, buff, cx, &bw);}
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d %s %d %d\n\r", "packet_outsideT", typecode<packet_outsideT>(), sizeof(packet_outsideT), "uint32_t t", offsetof(packet_outsideT, t), sizeof(uint32_t), "uint8_t index", offsetof(packet_outsideT, index), sizeof(uint8_t), "int32_t readings_cnts[5]", offsetof(packet_outsideT, readings_cnts), sizeof(int32_t));
if (to_file) {unsigned int bw; f_write(&file, buff, cx, &bw);}
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d %s %d %d\n\r", "packet_insideT", typecode<packet_insideT>(), sizeof(packet_insideT), "uint32_t t", offsetof(packet_insideT, t), sizeof(uint32_t), "uint8_t index", offsetof(packet_insideT, index), sizeof(uint8_t), "int32_t readings_cnts[5]", offsetof(packet_insideT, readings_cnts), sizeof(int32_t));
if (to_file) {unsigned int bw; f_write(&file, buff, cx, &bw);}
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d\n\r", "packet_button", typecode<packet_button>(), sizeof(packet_button), "uint32_t t", offsetof(packet_button, t), sizeof(uint32_t), "uint8_t button_vec", offsetof(packet_button, button_vec), sizeof(uint8_t));
if (to_file) {unsigned int bw; f_write(&file, buff, cx, &bw);}
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d %s %d %d %s %d %d\n\r", "packet_spo2", typecode<packet_spo2>(), sizeof(packet_spo2), "uint32_t t", offsetof(packet_spo2, t), sizeof(uint32_t), "uint32_t green_cnts[25]", offsetof(packet_spo2, green_cnts), sizeof(uint32_t), "uint32_t red_cnts[25]", offsetof(packet_spo2, red_cnts), sizeof(uint32_t), "uint32_t ir_cnts[25]", offsetof(packet_spo2, ir_cnts), sizeof(uint32_t));
cx = snprintf(buff, sizeof(buff), "%s %d %d %s %d %d %s %d %d\n\r", "packet_spo2", typecode<packet_spo2>(), sizeof(packet_spo2), "uint32_t t", offsetof(packet_spo2, t), sizeof(uint32_t), "uint8_t bytes[180]", offsetof(packet_spo2, bytes), sizeof(uint8_t));
if (to_file) {unsigned int bw; f_write(&file, buff, cx, &bw);}
if (to_usb) {CDC_Transmit_FS((uint8_t*)buff, cx);}
HAL_Delay(50);
+6
View File
@@ -50,6 +50,12 @@ void MX_DMA_Init(void)
/* DMA1_Channel5_IRQn interrupt configuration */
HAL_NVIC_SetPriority(DMA1_Channel5_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(DMA1_Channel5_IRQn);
/* DMA1_Channel6_IRQn interrupt configuration */
HAL_NVIC_SetPriority(DMA1_Channel6_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(DMA1_Channel6_IRQn);
/* DMA1_Channel7_IRQn interrupt configuration */
HAL_NVIC_SetPriority(DMA1_Channel7_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(DMA1_Channel7_IRQn);
/* DMA2_Channel4_IRQn interrupt configuration */
HAL_NVIC_SetPriority(DMA2_Channel4_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(DMA2_Channel4_IRQn);
+9 -12
View File
@@ -59,9 +59,9 @@ void MX_GPIO_Init(void)
/*Configure GPIO pin Output Level */
HAL_GPIO_WritePin(GPIOB, LED1_Pin|LED2_Pin|LED3_Pin, GPIO_PIN_SET);
/*Configure GPIO pins : IMU_DRDY_Pin PPG_DRDY_Pin */
GPIO_InitStruct.Pin = IMU_DRDY_Pin|PPG_DRDY_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_IT_RISING;
/*Configure GPIO pins : IMU_DRDY_Pin BUTTON2_Pin */
GPIO_InitStruct.Pin = IMU_DRDY_Pin|BUTTON2_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
GPIO_InitStruct.Pull = GPIO_NOPULL;
HAL_GPIO_Init(GPIOC, &GPIO_InitStruct);
@@ -85,12 +85,6 @@ void MX_GPIO_Init(void)
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
HAL_GPIO_Init(IMU_CS_GPIO_Port, &GPIO_InitStruct);
/*Configure GPIO pin : BUTTON2_Pin */
GPIO_InitStruct.Pin = BUTTON2_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
GPIO_InitStruct.Pull = GPIO_NOPULL;
HAL_GPIO_Init(BUTTON2_GPIO_Port, &GPIO_InitStruct);
/*Configure GPIO pin : BUTTON1_Pin */
GPIO_InitStruct.Pin = BUTTON1_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_IT_RISING;
@@ -104,6 +98,12 @@ void MX_GPIO_Init(void)
GPIO_InitStruct.Speed = GPIO_SPEED_FREQ_LOW;
HAL_GPIO_Init(GPIOB, &GPIO_InitStruct);
/*Configure GPIO pin : PPG_DRDY_Pin */
GPIO_InitStruct.Pin = PPG_DRDY_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
GPIO_InitStruct.Pull = GPIO_PULLUP;
HAL_GPIO_Init(PPG_DRDY_GPIO_Port, &GPIO_InitStruct);
/*Configure GPIO pin : SD_DETECT_Pin */
GPIO_InitStruct.Pin = SD_DETECT_Pin;
GPIO_InitStruct.Mode = GPIO_MODE_INPUT;
@@ -114,9 +114,6 @@ void MX_GPIO_Init(void)
HAL_NVIC_SetPriority(EXTI0_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(EXTI0_IRQn);
HAL_NVIC_SetPriority(EXTI3_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(EXTI3_IRQn);
HAL_NVIC_SetPriority(EXTI9_5_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(EXTI9_5_IRQn);
+42 -1
View File
@@ -25,6 +25,8 @@
/* USER CODE END 0 */
I2C_HandleTypeDef hi2c1;
DMA_HandleTypeDef hdma_i2c1_rx;
DMA_HandleTypeDef hdma_i2c1_tx;
/* I2C1 init function */
void MX_I2C1_Init(void)
@@ -38,7 +40,7 @@ void MX_I2C1_Init(void)
/* USER CODE END I2C1_Init 1 */
hi2c1.Instance = I2C1;
hi2c1.Init.Timing = 0x10D19CE4;
hi2c1.Init.Timing = 0x00F12981;
hi2c1.Init.OwnAddress1 = 0;
hi2c1.Init.AddressingMode = I2C_ADDRESSINGMODE_7BIT;
hi2c1.Init.DualAddressMode = I2C_DUALADDRESS_DISABLE;
@@ -105,6 +107,41 @@ void HAL_I2C_MspInit(I2C_HandleTypeDef* i2cHandle)
/* I2C1 clock enable */
__HAL_RCC_I2C1_CLK_ENABLE();
/* I2C1 DMA Init */
/* I2C1_RX Init */
hdma_i2c1_rx.Instance = DMA1_Channel7;
hdma_i2c1_rx.Init.Request = DMA_REQUEST_3;
hdma_i2c1_rx.Init.Direction = DMA_PERIPH_TO_MEMORY;
hdma_i2c1_rx.Init.PeriphInc = DMA_PINC_DISABLE;
hdma_i2c1_rx.Init.MemInc = DMA_MINC_ENABLE;
hdma_i2c1_rx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE;
hdma_i2c1_rx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE;
hdma_i2c1_rx.Init.Mode = DMA_NORMAL;
hdma_i2c1_rx.Init.Priority = DMA_PRIORITY_LOW;
if (HAL_DMA_Init(&hdma_i2c1_rx) != HAL_OK)
{
Error_Handler();
}
__HAL_LINKDMA(i2cHandle,hdmarx,hdma_i2c1_rx);
/* I2C1_TX Init */
hdma_i2c1_tx.Instance = DMA1_Channel6;
hdma_i2c1_tx.Init.Request = DMA_REQUEST_3;
hdma_i2c1_tx.Init.Direction = DMA_MEMORY_TO_PERIPH;
hdma_i2c1_tx.Init.PeriphInc = DMA_PINC_DISABLE;
hdma_i2c1_tx.Init.MemInc = DMA_MINC_ENABLE;
hdma_i2c1_tx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE;
hdma_i2c1_tx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE;
hdma_i2c1_tx.Init.Mode = DMA_NORMAL;
hdma_i2c1_tx.Init.Priority = DMA_PRIORITY_LOW;
if (HAL_DMA_Init(&hdma_i2c1_tx) != HAL_OK)
{
Error_Handler();
}
__HAL_LINKDMA(i2cHandle,hdmatx,hdma_i2c1_tx);
/* I2C1 interrupt Init */
HAL_NVIC_SetPriority(I2C1_EV_IRQn, 0, 0);
HAL_NVIC_EnableIRQ(I2C1_EV_IRQn);
@@ -133,6 +170,10 @@ void HAL_I2C_MspDeInit(I2C_HandleTypeDef* i2cHandle)
HAL_GPIO_DeInit(GPIOA, GPIO_PIN_10);
/* I2C1 DMA DeInit */
HAL_DMA_DeInit(i2cHandle->hdmarx);
HAL_DMA_DeInit(i2cHandle->hdmatx);
/* I2C1 interrupt Deinit */
HAL_NVIC_DisableIRQ(I2C1_EV_IRQn);
/* USER CODE BEGIN I2C1_MspDeInit 1 */
+41 -49
View File
@@ -15,98 +15,90 @@ void initialize_lsm6dsv(SPI_HandleTypeDef *hspi1) {
hspi1->Init.CLKPolarity = SPI_POLARITY_HIGH;
HAL_SPI_Init(hspi1);
// Reset
tx_buff[0] = 0x01;
tx_buff[0] = 0x01; // Reset
tx_buff[1] = 0x04;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(1);
HAL_Delay(30);
tx_buff[0] = 0x09; // Set 7.5Hz data rate for fifo
tx_buff[1] = 0b00100010;
tx_buff[0] = 0x03; // active high pushpull interrupt
tx_buff[1] = 0x01; // I2C and I3C disabled
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
tx_buff[0] = 0x0A; // Set continuous mode for fifo
tx_buff[1] = 0b00000110;
HAL_Delay(30);
tx_buff[0] = 0x09; // Set 60Hz data rate for fifo
tx_buff[1] = 0b01010101;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(30);
tx_buff[0] = 0x0D; // Set drdy based on fifo
tx_buff[1] = 0b00111000;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(30);
tx_buff[0] = 0x10; // Set 7.5Hz accelerometer high performance
tx_buff[1] = 0b00000010;
tx_buff[0] = 0x10; // Set 60Hz accelerometer high performance
tx_buff[1] = 0b00000101;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(30);
tx_buff[0] = 0x11; // Set 7.5Hz gyro high performance
tx_buff[1] = 0b00000010;
tx_buff[0] = 0x11; // Set 60Hz gyro high performance
tx_buff[1] = 0b00000101;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(30);
// todo: get watermark working
tx_buff[0] = 0x07;
tx_buff[1] = 0x07;
tx_buff[1] = 21; // 21 samples
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(30);
tx_buff[0] = 0x0A; // Set bypass mode for fifo
tx_buff[1] = 0b00000000; // to clear fifo
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(30);
tx_buff[0] = 0x0A; // Set continuous mode for fifo
tx_buff[1] = 0b00000110;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 2, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
HAL_Delay(30);
}
struct packet_imu p_imu;
void read_lsm6dsv(SPI_HandleTypeDef *hspi1) {
if (HAL_GPIO_ReadPin(GPIOC, IMU_DRDY_Pin) != GPIO_PIN_RESET) {
if (HAL_GPIO_ReadPin(GPIOC, IMU_DRDY_Pin) == GPIO_PIN_RESET) {
return;
}
//CDC_Transmit_FS((uint8_t*) "Detected\n\r", 10);
uint8_t tx_buff[8] = {0};
uint8_t rx_buff[8] = {0};
HAL_SPI_DeInit(hspi1);
hspi1->Init.CLKPolarity = SPI_POLARITY_HIGH;
HAL_SPI_Init(hspi1);
tx_buff[0] = 0b10000000 + 0x1B;
tx_buff[1] = 0;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 3, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
// todo: read in batches
if (rx_buff[1] != 0) {
tx_buff[0] = 0b10000000 + 0x78; // FIFO addr
tx_buff[1] = 0;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, rx_buff, 8, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
uint8_t tx_buff[141] = {0b10000000 + 0x78}; // FIFO addr
// cx = snprintf(buffer, 64, "%02x %02x %02x %02x %02x %02x %02x %02x\n\r",
// rx_buff[0],
// rx_buff[1],
// rx_buff[2],
// rx_buff[3],
// rx_buff[4],
// rx_buff[5],
// rx_buff[6],
// rx_buff[7]);
// CDC_Transmit_FS((uint8_t*)buffer, cx);
p_imu.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
p_imu.readings_cnts[0] = rx_buff[1];
p_imu.readings_cnts[1] = ((uint16_t)rx_buff[2] << 8) + rx_buff[3];
p_imu.readings_cnts[2] = ((uint16_t)rx_buff[4] << 8) + rx_buff[5];
p_imu.readings_cnts[3] = ((uint16_t)rx_buff[6] << 8) + rx_buff[7];
write(p_imu);
}
// Watermark set for 21 samples, read 20
tx_buff[0] = 0b10000000 + 0x78; // FIFO addr
p_imu.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_RESET);
HAL_SPI_TransmitReceive(hspi1, tx_buff, p_imu.data, 141, HAL_MAX_DELAY);
HAL_GPIO_WritePin(GPIOC, IMU_CS_Pin, GPIO_PIN_SET);
write(p_imu);
}
+16 -16
View File
@@ -39,6 +39,7 @@
#include "buff.hpp"
#include "ads131.hpp"
#include "lsm6dsv.hpp"
#include "max30101.hpp"
#include "datadescriptor.hpp"
/* USER CODE END Includes */
@@ -146,10 +147,7 @@ void turn_on_sd(void) {
return;
}
alignas(32) char buffer1[32];
alignas(32) char buffer2[32];
int cx = snprintf(buffer1, 32, "%08lu.log", ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT % 99999999);
cx = snprintf(buffer2, 32, "%s\n\r", buffer1);
CDC_Transmit_FS((uint8_t*)buffer2, cx);
res = f_open(&file, buffer1, FA_WRITE | FA_CREATE_ALWAYS);
if (res != FR_OK) {
res = f_mount(NULL, "", 1);
@@ -167,7 +165,6 @@ void turn_off_sd(void) {
f_sync(&file);
f_close(&file);
res = f_mount(NULL, "", 1);
CDC_Transmit_FS((uint8_t*)"CLS\n\r", 7);
sd_ready = false;
}
}
@@ -217,7 +214,7 @@ int main(void)
MX_USB_DEVICE_Init();
MX_FATFS_Init();
/* USER CODE BEGIN 2 */
/* USER CODE END 2 */
/* Infinite loop */
@@ -226,20 +223,24 @@ int main(void)
//HAL_UART_Receive_DMA(&huart1, uart_rx_data, sizeof(uart_rx_data));
// For some reason initializing the ads131 first breaks the lsm6dsv gyro readings
initialize_lsm6dsv(&hspi1);
initialize_ads131(&hspi1);
//initialize_ads131(&hspi1);
//initialize_max30101(&hi2c1);
uint8_t buf[512];
while (1)
{
if (to_turn_on_sd) {
turn_on_sd();
}
if (to_turn_off_sd) {
turn_off_sd();
}
read_lsm6dsv(&hspi1);
//read_max30101(&hi2c1);
//read_ads131(&hspi1);
HAL_Delay(1);
continue;
// if (to_turn_on_sd) {
// turn_on_sd();
// }
// if (to_turn_off_sd) {
// turn_off_sd();
// }
// continue;
/* USER CODE END WHILE */
/* USER CODE BEGIN 3 */
@@ -273,7 +274,6 @@ int main(void)
read_ads131(&hspi1);
read_lsm6dsv(&hspi1);
// HAL_GPIO_WritePin(GPIOB, LED1_Pin|LED2_Pin|LED3_Pin, GPIO_PIN_SET);
// HAL_Delay(100);
// HAL_GPIO_WritePin(GPIOB, LED1_Pin|LED2_Pin|LED3_Pin, GPIO_PIN_RESET);
+75
View File
@@ -0,0 +1,75 @@
#include "max30101.hpp"
#include <cstring>
#include "gpio.h"
#include "tim.h"
#include "packet.hpp"
#include "buff.hpp"
extern uint16_t tim6_reloads;
struct packet_spo2 p_spo2;
uint8_t data[4];
bool followup = false;
bool print_ready = false;
void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c1) {
if (not followup) {
print_ready = true;
// Clear interrupt
HAL_I2C_Mem_Read_DMA(hi2c1, 0xAE, 0x00, 1, data, 1);
followup = true;
} else {
followup = false;
}
}
void initialize_max30101(I2C_HandleTypeDef *hi2c1) {
data[0] = 0b01000111; // Reset
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x09, 1, data, 1, HAL_MAX_DELAY);
data[0] = 0b00000111; // Turn on all LEDs
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x09, 1, data, 1, HAL_MAX_DELAY);
data[0] = 0b00000011; //0.4mS pulse width
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x0A, 1, data, 1, HAL_MAX_DELAY);
memset(data, 0x0F, 4); // Set power
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x0C, 1, data, 4, HAL_MAX_DELAY);
data[0] = 0b00010010; // Time slots: RED, IR
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x11, 1, data, 1, HAL_MAX_DELAY);
data[0] = 0b00000011; // Time slots ctd: None, Green
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x12, 1, data, 1, HAL_MAX_DELAY);
// No averaging, FIFO rollover, FIFO almost full @ 29 samples
data[0] = 0b00010011;
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x08, 1, data, 1, HAL_MAX_DELAY);
// Interrupt only on FIFO almost full
data[0] = 0b10000000;
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x02, 1, data, 1, HAL_MAX_DELAY);
// clear write and read ptrs
data[0] = 0;
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x04, 1, data, 1, HAL_MAX_DELAY);
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x05, 1, data, 1, HAL_MAX_DELAY);
HAL_I2C_Mem_Write(hi2c1, 0xAE, 0x06, 1, data, 1, HAL_MAX_DELAY);
// read once to start the thing
HAL_I2C_Mem_Read(hi2c1, 0xAE, 0x07, 1, p_spo2.bytes, 180, HAL_MAX_DELAY);
}
void read_max30101(I2C_HandleTypeDef *hi2c1) {
if (print_ready) {
p_spo2.t = ((uint32_t)tim6_reloads) * (htim6.Init.Period + 1) + TIM6->CNT;
write(p_spo2);
print_ready = false;
}
if (HAL_GPIO_ReadPin(GPIOC, PPG_DRDY_Pin) != GPIO_PIN_RESET) {
return;
}
if (HAL_I2C_GetState(hi2c1) == HAL_I2C_STATE_READY) {
HAL_I2C_Mem_Read_DMA(hi2c1, 0xAE, 0x07, 1, p_spo2.bytes, 180);
print_ready = false;
}
}
+1 -1
View File
@@ -44,7 +44,7 @@ void MX_SPI1_Init(void)
hspi1.Init.CLKPolarity = SPI_POLARITY_LOW;
hspi1.Init.CLKPhase = SPI_PHASE_2EDGE;
hspi1.Init.NSS = SPI_NSS_SOFT;
hspi1.Init.BaudRatePrescaler = SPI_BAUDRATEPRESCALER_128;
hspi1.Init.BaudRatePrescaler = SPI_BAUDRATEPRESCALER_64;
hspi1.Init.FirstBit = SPI_FIRSTBIT_MSB;
hspi1.Init.TIMode = SPI_TIMODE_DISABLE;
hspi1.Init.CRCCalculation = SPI_CRCCALCULATION_DISABLE;
+30 -15
View File
@@ -57,6 +57,8 @@
/* External variables --------------------------------------------------------*/
extern PCD_HandleTypeDef hpcd_USB_FS;
extern ADC_HandleTypeDef hadc1;
extern DMA_HandleTypeDef hdma_i2c1_rx;
extern DMA_HandleTypeDef hdma_i2c1_tx;
extern I2C_HandleTypeDef hi2c1;
extern DMA_HandleTypeDef hdma_sdmmc1;
extern SD_HandleTypeDef hsd1;
@@ -221,20 +223,6 @@ void EXTI0_IRQHandler(void)
/* USER CODE END EXTI0_IRQn 1 */
}
/**
* @brief This function handles EXTI line3 interrupt.
*/
void EXTI3_IRQHandler(void)
{
/* USER CODE BEGIN EXTI3_IRQn 0 */
/* USER CODE END EXTI3_IRQn 0 */
HAL_GPIO_EXTI_IRQHandler(IMU_DRDY_Pin);
/* USER CODE BEGIN EXTI3_IRQn 1 */
/* USER CODE END EXTI3_IRQn 1 */
}
/**
* @brief This function handles DMA1 channel4 global interrupt.
*/
@@ -263,6 +251,34 @@ void DMA1_Channel5_IRQHandler(void)
/* USER CODE END DMA1_Channel5_IRQn 1 */
}
/**
* @brief This function handles DMA1 channel6 global interrupt.
*/
void DMA1_Channel6_IRQHandler(void)
{
/* USER CODE BEGIN DMA1_Channel6_IRQn 0 */
/* USER CODE END DMA1_Channel6_IRQn 0 */
HAL_DMA_IRQHandler(&hdma_i2c1_tx);
/* USER CODE BEGIN DMA1_Channel6_IRQn 1 */
/* USER CODE END DMA1_Channel6_IRQn 1 */
}
/**
* @brief This function handles DMA1 channel7 global interrupt.
*/
void DMA1_Channel7_IRQHandler(void)
{
/* USER CODE BEGIN DMA1_Channel7_IRQn 0 */
/* USER CODE END DMA1_Channel7_IRQn 0 */
HAL_DMA_IRQHandler(&hdma_i2c1_rx);
/* USER CODE BEGIN DMA1_Channel7_IRQn 1 */
/* USER CODE END DMA1_Channel7_IRQn 1 */
}
/**
* @brief This function handles ADC1 global interrupt.
*/
@@ -286,7 +302,6 @@ void EXTI9_5_IRQHandler(void)
/* USER CODE END EXTI9_5_IRQn 0 */
HAL_GPIO_EXTI_IRQHandler(ADC_DRDY_Pin);
HAL_GPIO_EXTI_IRQHandler(PPG_DRDY_Pin);
/* USER CODE BEGIN EXTI9_5_IRQn 1 */
/* USER CODE END EXTI9_5_IRQn 1 */
+1 -1
View File
@@ -1,5 +1,5 @@
##########################################################################################################################
# File automatically-generated by tool: [projectgenerator] version: [4.9.0-B19] date: [Tue May 05 18:08:47 CDT 2026]
# File automatically-generated by tool: [projectgenerator] version: [4.9.0-B19] date: [Thu May 07 13:29:52 CDT 2026]
##########################################################################################################################
# ------------------------------------------------
+44
View File
@@ -0,0 +1,44 @@
import serial
import matplotlib.pyplot as plt
import numpy as np
ser = serial.Serial(port='/dev/ttyACM1', timeout = 1)
ser.flush()
ser.reset_input_buffer()
gyros = []
accs = []
fig, axs = plt.subplots(2)
i = 0
while(1):
x = [int(e, 16) for e in ser.readline()[1:-1].split(b" ")]
imu_reading_type = x[0] >> 3
imu_reading_tag_cnt = (x[0] >> 1) & 3
#print(imu_reading_type, imu_reading_tag_cnt)
reading_xyz = [int.from_bytes(x[1:3], byteorder = 'little', signed = True),
int.from_bytes(x[3:5], byteorder = 'little', signed = True),
int.from_bytes(x[5:7], byteorder = 'little', signed = True)]
i += 1
if imu_reading_type == 1:
gyros.append([250 * e / (1 << 16) for e in reading_xyz])
elif imu_reading_type == 2:
accs.append([4 * e / (1<<16) for e in reading_xyz])
if len(gyros) > 50 and (i % 10) == 0:
gyros = gyros[-100:]
accs = accs[-100:]
a = np.array(accs)
g = np.array(gyros)
a -= np.mean(a, axis = 0).reshape(1, 3)
g -= np.mean(g, axis = 0).reshape(1, 3)
axs[0].cla()
axs[0].plot(g[:,0])
axs[0].plot(g[:,1])
axs[0].plot(g[:,2])
axs[1].cla()
axs[1].plot(a[:,0])
axs[1].plot(a[:,1])
axs[1].plot(a[:,2])
plt.pause(0.0001)
+34 -14
View File
@@ -10,10 +10,30 @@ ADC1.master=1
CAD.formats=
CAD.pinconfig=
CAD.provider=
Dma.I2C1_RX.3.Direction=DMA_PERIPH_TO_MEMORY
Dma.I2C1_RX.3.Instance=DMA1_Channel7
Dma.I2C1_RX.3.MemDataAlignment=DMA_MDATAALIGN_BYTE
Dma.I2C1_RX.3.MemInc=DMA_MINC_ENABLE
Dma.I2C1_RX.3.Mode=DMA_NORMAL
Dma.I2C1_RX.3.PeriphDataAlignment=DMA_PDATAALIGN_BYTE
Dma.I2C1_RX.3.PeriphInc=DMA_PINC_DISABLE
Dma.I2C1_RX.3.Priority=DMA_PRIORITY_LOW
Dma.I2C1_RX.3.RequestParameters=Instance,Direction,PeriphInc,MemInc,PeriphDataAlignment,MemDataAlignment,Mode,Priority
Dma.I2C1_TX.4.Direction=DMA_MEMORY_TO_PERIPH
Dma.I2C1_TX.4.Instance=DMA1_Channel6
Dma.I2C1_TX.4.MemDataAlignment=DMA_MDATAALIGN_BYTE
Dma.I2C1_TX.4.MemInc=DMA_MINC_ENABLE
Dma.I2C1_TX.4.Mode=DMA_NORMAL
Dma.I2C1_TX.4.PeriphDataAlignment=DMA_PDATAALIGN_BYTE
Dma.I2C1_TX.4.PeriphInc=DMA_PINC_DISABLE
Dma.I2C1_TX.4.Priority=DMA_PRIORITY_LOW
Dma.I2C1_TX.4.RequestParameters=Instance,Direction,PeriphInc,MemInc,PeriphDataAlignment,MemDataAlignment,Mode,Priority
Dma.Request0=USART1_RX
Dma.Request1=USART1_TX
Dma.Request2=SDMMC1
Dma.RequestsNb=3
Dma.Request3=I2C1_RX
Dma.Request4=I2C1_TX
Dma.RequestsNb=5
Dma.SDMMC1.2.Direction=DMA_PERIPH_TO_MEMORY
Dma.SDMMC1.2.Instance=DMA2_Channel4
Dma.SDMMC1.2.MemDataAlignment=DMA_MDATAALIGN_WORD
@@ -59,8 +79,9 @@ FATFS0.BSP.semaphore=
FATFS0.BSP.solution=PA15 (JTDI)
File.Version=6
GPIO.groupedBy=Group By Peripherals
I2C1.IPParameters=Timing
I2C1.Timing=0x10D19CE4
I2C1.I2C_Speed_Mode=I2C_Fast
I2C1.IPParameters=Timing,I2C_Speed_Mode
I2C1.Timing=0x00F12981
KeepUserPlacement=false
Mcu.CPN=STM32L452RET3
Mcu.Family=STM32L4
@@ -129,10 +150,11 @@ NVIC.ADC1_IRQn=true\:0\:0\:false\:false\:true\:true\:true\:true
NVIC.BusFault_IRQn=true\:0\:0\:false\:false\:true\:false\:false\:false
NVIC.DMA1_Channel4_IRQn=true\:0\:0\:false\:false\:true\:false\:true\:true
NVIC.DMA1_Channel5_IRQn=true\:0\:0\:false\:false\:true\:false\:true\:true
NVIC.DMA1_Channel6_IRQn=true\:0\:0\:false\:false\:true\:false\:true\:true
NVIC.DMA1_Channel7_IRQn=true\:0\:0\:false\:false\:true\:false\:true\:true
NVIC.DMA2_Channel4_IRQn=true\:0\:0\:false\:false\:true\:false\:true\:true
NVIC.DebugMonitor_IRQn=true\:0\:0\:false\:false\:true\:false\:false\:false
NVIC.EXTI0_IRQn=true\:0\:0\:false\:false\:true\:true\:true\:true
NVIC.EXTI3_IRQn=true\:0\:0\:false\:false\:true\:true\:true\:true
NVIC.EXTI9_5_IRQn=true\:0\:0\:false\:false\:true\:true\:true\:true
NVIC.ForceEnableDMAVector=true
NVIC.HardFault_IRQn=true\:0\:0\:false\:false\:true\:false\:false\:false
@@ -221,10 +243,11 @@ PC11.Mode=SD_4_bits_Wide_bus
PC11.Signal=SDMMC1_D3
PC12.Mode=SD_4_bits_Wide_bus
PC12.Signal=SDMMC1_CK
PC3.GPIOParameters=GPIO_Label
PC3.GPIOParameters=GPIO_PuPd,GPIO_Label
PC3.GPIO_Label=IMU_DRDY
PC3.GPIO_PuPd=GPIO_NOPULL
PC3.Locked=true
PC3.Signal=GPXTI3
PC3.Signal=GPIO_Input
PC4.GPIOParameters=PinState,GPIO_Label
PC4.GPIO_Label=IMU_CS
PC4.Locked=true
@@ -234,10 +257,11 @@ PC5.GPIOParameters=GPIO_Label
PC5.GPIO_Label=BUTTON2
PC5.Locked=true
PC5.Signal=GPIO_Input
PC7.GPIOParameters=GPIO_Label
PC7.GPIOParameters=GPIO_PuPd,GPIO_Label
PC7.GPIO_Label=PPG_DRDY
PC7.GPIO_PuPd=GPIO_PULLUP
PC7.Locked=true
PC7.Signal=GPXTI7
PC7.Signal=GPIO_Input
PC8.Mode=SD_4_bits_Wide_bus
PC8.Signal=SDMMC1_D0
PC9.Mode=SD_4_bits_Wide_bus
@@ -334,17 +358,13 @@ SH.ADCx_IN16.0=ADC1_IN16,IN16-Single-Ended
SH.ADCx_IN16.ConfNb=1
SH.GPXTI0.0=GPIO_EXTI0
SH.GPXTI0.ConfNb=1
SH.GPXTI3.0=GPIO_EXTI3
SH.GPXTI3.ConfNb=1
SH.GPXTI5.0=GPIO_EXTI5
SH.GPXTI5.ConfNb=1
SH.GPXTI7.0=GPIO_EXTI7
SH.GPXTI7.ConfNb=1
SH.S_TIM2_ETR.0=TIM2_ETR,ClockSourceETR_Mode2
SH.S_TIM2_ETR.ConfNb=1
SPI1.BaudRatePrescaler=SPI_BAUDRATEPRESCALER_128
SPI1.BaudRatePrescaler=SPI_BAUDRATEPRESCALER_64
SPI1.CLKPhase=SPI_PHASE_2EDGE
SPI1.CalculateBaudRate=625.0 KBits/s
SPI1.CalculateBaudRate=1.25 MBits/s
SPI1.DataSize=SPI_DATASIZE_8BIT
SPI1.Direction=SPI_DIRECTION_2LINES
SPI1.IPParameters=VirtualType,Mode,Direction,CalculateBaudRate,DataSize,BaudRatePrescaler,CLKPhase
-1
View File
@@ -4,7 +4,6 @@ from scipy import signal
import time
import serial
ser = serial.Serial(port = '/dev/ttyACM1', timeout = 10.0)
ser.reset_input_buffer()
start = time.time()
+38
View File
@@ -0,0 +1,38 @@
import serial
import numpy as np
import matplotlib.pyplot as plt
import time
ser = serial.Serial(port = '/dev/ttyACM1', timeout = 10.0)
ser.reset_input_buffer()
ser.flush()
D = np.zeros((0,3))
fig, axs = plt.subplots(3)
counter = 0
start = time.time()
while(1):
ser.write(b"R")
read_data = ser.read(180)
counter += 1
p = np.array([int.from_bytes(read_data[3 * i : 3 * i + 3], byteorder = 'big') for i in range(60)]).reshape(20,3)
D = np.concatenate((D, p))
if counter == 30:
print(15 * 30 / (time.time() - start))
start = time.time()
counter = 0
if D.shape[0] > 400:
D = D[-400:,:]
axs[0].cla()
axs[0].plot(D[:,0])
axs[1].cla()
axs[1].plot(D[:,1])
axs[2].cla()
axs[2].plot(D[:,2])
plt.pause(0.00001)