kopia lustrzana https://github.com/Qyon/STM32_RTTY
removed fun.c and fun.h
rodzic
0ac3d90c0b
commit
e60b70a6b1
73
fun.c
73
fun.c
|
@ -1,73 +0,0 @@
|
|||
#include <stm32f10x_usart.h>
|
||||
#include <stm32f10x_spi.h>
|
||||
#include <stm32f10x_gpio.h>
|
||||
|
||||
const char ascii[] = "0123456789ABCDEF";
|
||||
int srednia_u[5] = {0, 0, 0, 0, 0};
|
||||
|
||||
|
||||
|
||||
int HexCharToInt(char ch) {
|
||||
if (ch < 48 || (ch > 57 && ch < 65) || ch > 70) return 0;
|
||||
return (ch < 58) ? ch - 48 : ch - 55;
|
||||
}
|
||||
|
||||
void print(char *s) {
|
||||
#ifdef DEBUG
|
||||
while (*s) {
|
||||
while (USART_GetFlagStatus(USART3, USART_FLAG_TC) == RESET) {
|
||||
}
|
||||
USART_SendData(USART3, *(s++));
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
void send_hex(unsigned char data) {
|
||||
#ifdef DEBUG
|
||||
while (USART_GetFlagStatus(USART3, USART_FLAG_TC) == RESET) {
|
||||
}
|
||||
USART_SendData(USART3, ascii[data >> 4]);
|
||||
while (USART_GetFlagStatus(USART3, USART_FLAG_TC) == RESET) {
|
||||
}
|
||||
USART_SendData(USART3, ascii[data & 0x0f]);
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
|
||||
uint16_t gps_CRC16_checksum(char *string) {
|
||||
uint16_t crc = 0xffff;
|
||||
char i;
|
||||
while (*(string) != 0) {
|
||||
crc = crc ^ (*(string++) << 8);
|
||||
for (i = 0; i < 8; i++) {
|
||||
if (crc & 0x8000)
|
||||
crc = (uint16_t) ((crc << 1) ^ 0x1021);
|
||||
else
|
||||
crc <<= 1;
|
||||
}
|
||||
}
|
||||
return crc;
|
||||
}
|
||||
|
||||
int srednia(int dana) {
|
||||
static uint8_t nr_pom = 0;
|
||||
static uint8_t first = 1;
|
||||
uint8_t i;
|
||||
int sr = 0;
|
||||
if (first) {
|
||||
for (i = 0; i < 5; i++) {
|
||||
srednia_u[i] = dana;
|
||||
}
|
||||
first = 0;
|
||||
}
|
||||
srednia_u[nr_pom] = dana;
|
||||
if (++nr_pom > 4) {
|
||||
nr_pom = 0;
|
||||
}
|
||||
for (i = 0; i < 5; i++) {
|
||||
sr += srednia_u[i];
|
||||
}
|
||||
sr = sr / 5;
|
||||
return sr;
|
||||
}
|
8
fun.h
8
fun.h
|
@ -1,8 +0,0 @@
|
|||
int HexCharToInt(char ch);
|
||||
void print( char* s);
|
||||
void send_hex(unsigned char data);
|
||||
|
||||
unsigned char czytaj_GPS(unsigned char pos,unsigned char len, char *source, char * destination);
|
||||
uint16_t gps_CRC16_checksum (char *string);
|
||||
int srednia (int dana);
|
||||
|
Ładowanie…
Reference in New Issue