robossembler/servo
7
0
Fork 0
Code Issues 27 Pull requests 2 Projects 1 Releases 1 Packages Wiki Activity Actions

ADD: DEADBEEF packet #8

Browse source
This commit is contained in:
vanyabeat 2024-01-24 00:03:40 +03:00
parent 8157b41ea9
commit 578962d9fe
3 changed files with 20 additions and 7 deletions
Download patch file Download diff file Expand all files Collapse all files

15
Src/main.c
View file

@ -109,10 +109,9 @@ int main(void)
/* Infinite loop */
/* USER CODE BEGIN WHILE */
char buf[100];
float angle_values[200];
uint8_t angle_index = 0;
float ADC123_ANGLE[4] = {0, 0, 0, 0};
while (1)
{
if (flag_10kHz == SET)
@ -132,11 +131,13 @@ int main(void)
average += angle_values[i];
}
average /= 20.0;
float adcValue1 = GetCurrentFromADC(ReadADCValue(&hadc2, ADC_CHANNEL_15)); // Read ADC
float adcValue2 = GetCurrentFromADC(ReadADCValue(&hadc2, ADC_CHANNEL_8)); // Read ADC
float adcValue3 = GetCurrentFromADC(ReadADCValue(&hadc2, ADC_CHANNEL_9)); // Read ADC
sprintf(buf, "ADC1:%f, ADC2:%f, ADC3:%f, ANGLE:%f\n", adcValue1, adcValue2, adcValue3, average);
USART1_PutString(buf);
ADC123_ANGLE[0] = GetCurrentFromADC(ReadADCValue(&hadc2, ADC_CHANNEL_15)); // Read ADC
ADC123_ANGLE[1] = GetCurrentFromADC(ReadADCValue(&hadc2, ADC_CHANNEL_8)); // Read ADC
ADC123_ANGLE[2] = GetCurrentFromADC(ReadADCValue(&hadc2, ADC_CHANNEL_9)); // Read ADC
ADC123_ANGLE[3] = average;
USART1_PutString("\xDE\xAD");
SendFloatsWithLL((uint8_t *)ADC123_ANGLE);
USART1_PutString("\xBE\xAF");
}
if (status == 0)
{