//

// GPS: communicate with ublox GPS module via ubx protocol

//

#include "stm32f0xx_hal.h"

#include "config.h"

#include "gpio.h"

#include "uart.h"

#include "gps.h"

volatile gps_data_t position;

uint8_t gpson = 0;

// Private methods

static void gps_ubx_checksum(uint8_t* data, uint8_t len, uint8_t* cka, uint8_t* ckb);

static uint8_t _gps_verify_checksum(uint8_t* data, uint8_t len);

// Poll for fix data from the GPS and update the internal structure

void gps_update_data(void)

{

    // Construct the request to the GPS

    uint8_t request[8] = {0xB5, 0x62, 0x01, 0x07, 0x00, 0x00, 0xFF, 0xFF};

    volatile uint8_t check_a = 0;

    volatile uint8_t check_b = 0;

    for(uint8_t i = 2; i<6; i++)

    {

    	check_a += request[i];

    	check_b += check_a;

    }

    request[6] = check_a;

    request[7] = check_b;

    uint8_t flushed = uart_gethandle()->Instance->RDR;

    HAL_UART_Transmit(uart_gethandle(), request, 8, 100);

    // Get the message back from the GPS

    uint8_t buf[100];

    for(uint8_t i=0; i<100; i++)

    	buf[i] = 0xaa;

    volatile HAL_StatusTypeDef res = HAL_UART_Receive(uart_gethandle(), buf, 100, 3000);

//    hdma_usart1_tx.Init.PeriphInc = DMA_PINC_DISABLE;

//    hdma_usart1_tx.Init.MemInc = DMA_MINC_DISABLE;

//    hdma_usart1_tx.Init.PeriphDataAlignment = DMA_PDATAALIGN_BYTE;

//    hdma_usart1_tx.Init.MemDataAlignment = DMA_MDATAALIGN_BYTE;

//    hdma_usart1_tx.Init.Mode = DMA_NORMAL;

//    hdma_usart1_tx.Init.Priority = DMA_PRIORITY_LOW;

//    HAL_DMA_Init(&hdma_usart1_tx);

//

//    __HAL_LINKDMA(&huart1,hdmatx,hdma_usart1_tx);

//

////    HAL_NVIC_SetPriority(DMA1_Channel2_3_IRQn, 0, 0);

////    HAL_NVIC_EnableIRQ(DMA1_Channel2_3_IRQn);

    HAL_NVIC_SetPriority(USART1_IRQn, 0, 0);

    //HAL_NVIC_EnableIRQ(USART1_IRQn);

    HAL_NVIC_DisableIRQ(USART1_IRQn);

    uart_initted = 1;

}

void uart_deinit(void)

{

    if(uart_initted == 1)

    {

        HAL_UART_DeInit(&huart1);

        uart_initted = 0;

    }

}

UART_HandleTypeDef* uart_gethandle(void)

{

    return &huart1;

} 

DMA_HandleTypeDef* uart_get_txdma_handle(void)

{

    return &hdma_usart1_tx;

}

DMA_HandleTypeDef* uart_get_rxdma_handle(void)

{

    return &hdma_usart1_rx;

}