Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include "stm32f4_discovery.h"
- int8_t podatki[16];
- void delay();
- void delay() {
- uint32_t d = 500;
- while(d--);
- }
- void initUSART1()
- {
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_USART1, ENABLE); // USART naprava
- RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOB, ENABLE);
- RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOC, ENABLE);
- USART_InitTypeDef USART_InitStruct;
- USART_InitStruct.USART_BaudRate = 115200;
- USART_InitStruct.USART_WordLength = USART_WordLength_8b;
- USART_InitStruct.USART_StopBits = USART_StopBits_1;
- USART_InitStruct.USART_Parity = USART_Parity_No;
- USART_InitStruct.USART_HardwareFlowControl = USART_HardwareFlowControl_None;
- USART_InitStruct.USART_Mode = USART_Mode_Tx | USART_Mode_Rx;
- USART_Init(USART1, &USART_InitStruct);
- USART_DMACmd(USART1, USART_DMAReq_Rx, ENABLE);
- USART_Cmd(USART1, ENABLE);
- GPIO_InitTypeDef GPIO_InitStructure;
- GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7;
- GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
- GPIO_InitStructure.GPIO_Speed = GPIO_Speed_2MHz;
- GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
- GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
- GPIO_Init(GPIOB, &GPIO_InitStructure);
- //nastavitve AF za pine
- GPIO_PinAFConfig(GPIOB, GPIO_PinSource6, GPIO_AF_USART1);
- GPIO_PinAFConfig(GPIOB, GPIO_PinSource7, GPIO_AF_USART1);
- }
- void initDMA2()
- {
- RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_DMA2, ENABLE);
- DMA_InitTypeDef DMA_InitStructure;
- DMA_InitStructure.DMA_Channel = DMA_Channel_4;
- DMA_InitStructure.DMA_DIR = DMA_DIR_PeripheralToMemory;
- DMA_InitStructure.DMA_Memory0BaseAddr = (uint32_t) podatki;
- DMA_InitStructure.DMA_PeripheralBaseAddr = (uint32_t) &(USART1->DR);
- DMA_InitStructure.DMA_BufferSize = 16;
- DMA_InitStructure.DMA_MemoryInc = DMA_MemoryInc_Enable;
- DMA_InitStructure.DMA_PeripheralInc = DMA_PeripheralInc_Disable;
- DMA_InitStructure.DMA_MemoryDataSize = DMA_MemoryDataSize_Byte;
- DMA_InitStructure.DMA_PeripheralDataSize = DMA_PeripheralDataSize_Byte;
- DMA_InitStructure.DMA_Mode = DMA_Mode_Circular;
- DMA_InitStructure.DMA_Priority = DMA_Priority_Medium;
- DMA_InitStructure.DMA_FIFOMode = DMA_FIFOMode_Disable;
- DMA_Init(DMA2_Stream2, &DMA_InitStructure);
- DMA_Cmd(DMA2_Stream2, ENABLE);
- }
- int main(void)
- {
- //lucke
- RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOD, ENABLE);
- GPIO_InitTypeDef leds;
- leds.GPIO_Pin = GPIO_Pin_12 | GPIO_Pin_13 | GPIO_Pin_14 | GPIO_Pin_15;
- leds.GPIO_Mode = GPIO_Mode_OUT;
- leds.GPIO_OType = GPIO_OType_PP;
- leds.GPIO_PuPd = GPIO_PuPd_NOPULL;
- leds.GPIO_Speed = GPIO_Speed_2MHz;
- GPIO_Init(GPIOD, &leds);
- initUSART1();
- initDMA2();
- volatile int8_t x, y;
- while (1)
- {
- x = 0;
- for(int i = 0; i<16;i+2){
- x += podatki[i];
- }
- x = x/8;
- y = 0;
- for(int i = 1; i<16;i+2){
- y += podatki[i];
- }
- y = y/8;
- // x-axis leds
- if (x < -6) {
- // Vklopi ledico
- GPIO_SetBits(GPIOD, GPIO_Pin_12);
- delay();
- GPIO_ResetBits(GPIOD, GPIO_Pin_12);
- }
- if (x > 6) {
- GPIO_SetBits(GPIOD, GPIO_Pin_14);
- delay();
- GPIO_ResetBits(GPIOD, GPIO_Pin_14);
- }
- if (y < -6) {
- GPIO_SetBits(GPIOD, GPIO_Pin_13);
- delay();
- GPIO_ResetBits(GPIOD, GPIO_Pin_13);
- }
- if (y > 6) {
- GPIO_SetBits(GPIOD, GPIO_Pin_15);
- delay();
- GPIO_ResetBits(GPIOD, GPIO_Pin_15);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement