stm32声源定位问题

Question

设备: 1块OLED屏，4个麦克风模块，1块单片机(型号自定)，邦线若干，1台舵机(如SG90)，四种颜色的LED灯，自制声源

题目:实验场地为一块60cm*60cm的区域，将原点确定在该区域的正中心，建立-平面直角坐标系，确定四个象限。用杜邦线将单片机与各个外设连接起来，形成一个系统，该系统组件可以任意摆放，要求实现以下功能:
1.声源位于不同象限， 相应象限的LED亮。
2.用OLED屏显示出声源的坐标信息，1cm记为1，(如果声 源在第-象限横向距离原点18cm,纵向距离原点16厘米处,则OLED屏上显示的坐 标信息为X: 18， Y: 16)
3. 舵机指向声源所在位置。

建议:将单片机的位置与原点重合，四个麦克风模块分别位于四个坐标轴上。

Answer 1

引自免费微信小程序：皆我百晓生

为了实现这个项目，你需要按照以下步骤进行：

第一步：硬件连接

首先，你需要正确地连接硬件。由于这是一个物理装置，没有实际的在线连接选项，但我会描述如何通过杜邦线将它们连接起来。

1. STM32单片机:

   • VCC: 连接到电源的正极（通常为5V）
   • GND: 连接到电源的负极
   • SDA/SCL (I2C接口): 连接到OLED屏幕的对应引脚
   • 引脚用于控制舵机: 连接至舵机的信号线
   • 引脚用于控制LED灯: 连接至每个LED灯的公共端
   • 麦克风模块的输出线: 连接到单片机的输入引脚，例如ADC输入端口

2. OLED屏幕:

   • SDA/SCL: 连接到STM32的SDA/SCL引脚
   • VCC: 连接到电源的正极（通常为3.3V或5V）
   • GND: 连接到电源的负极

3. 舵机:

   • VCC: 连接到电源的正极（通常为5V）
   • GND: 连接到电源的负极
   • Signal: 连接到STM32的一个GPIO引脚

4. 麦克风模块:

   • 接收音频信号的引脚: 连接到STM32的ADC输入端口
   • VCC: 连接到电源的正极
   • GND: 连接到电源的负极

5. LED灯:

   • 供电线: 连接到电源的正极
   • 控制线: 连接到STM32的GPIO引脚

第二步：软件设计

接下来是编写STM32的固件。这里我们将使用C语言，并且假设你已经安装了STM32CubeIDE工具链。你需要配置ADC读取麦克风模块的输入，并根据这些数据计算声源的位置。

1. 初始化硬件

#include "stm32f4xx.h"

void SystemClock_Config(void);
void MX_GPIO_Init(void);
void MX_ADC1_Init(void);

int main(void)
{
    // 初始化系统时钟、GPIO和ADC
    SystemClock_Config();
    MX_GPIO_Init();
    MX_ADC1_Init();

    while (1)
    {
        // 主循环
    }
}

2. ADC配置

#define ADC_CHANNEL_1 1
#define ADC_CHANNEL_2 2
#define ADC_CHANNEL_3 3
#define ADC_CHANNEL_4 4

void MX_ADC1_Init(void)
{
    ADC_HandleTypeDef hadc1;

    /* ADC1 init function */
    hadc1.Instance = ADC1;
    hadc1.Init.ScanConvMode = ADC_SCAN_DISABLE;
    hadc1.Init.ContinuousConvMode = ENABLE;
    hadc1.Init.DiscontinuousConvMode = DISABLE;
    hadc1.Init.ExternalTrigConvEdge = ADC_EXTERNALTRIGCONVEDGE_NONE;
    hadc1.Init.DataAlign = ADC_DATAALIGN_RIGHT;
    hadc1.Init.NbrOfConversion = 4; // 4 channels
    hadc1.Init.DMAContinuousRequests = DISABLE;
    hadc1.Init.EOCSelection = ADC_EOC_SINGLE_CONV;
    HAL_ADC_Init(&hadc1);

    // 配置通道触发源
    HAL_ADC_ConfigChannel(&hadc1, &hadc_channel1);
    HAL_ADC_ConfigChannel(&hadc1, &hadc_channel2);
    HAL_ADC_ConfigChannel(&hadc1, &hadc_channel3);
    HAL_ADC_ConfigChannel(&hadc1, &hadc_channel4);
}

3. ADC中断处理函数

uint16_t adc_data[4];

void HAL_ADC_ConvCpltCallback(ADC_HandleTypeDef *hadc)
{
    uint32_t i;

    for(i = 0; i < 4; i++)
    {
        adc_data[i] = HAL_ADC_GetValue(&hadc1);
    }

    // 在这里处理声源定位算法并更新LED和舵机
    // ...
}

// 其他必要的头文件和配置

4. 声源定位算法

你需要一个简单的声源定位算法，这里我们使用一个简单的平均值方法。在HAL_ADC_ConvCpltCallback函数中添加以下内容：

float x_sum = 0, y_sum = 0;
float x_avg, y_avg;

for(i = 0; i < 4; i++)
{
    if(i == 0 || i == 2) // X方向
    {
        x_sum += adc_data[i];
    }
    else // Y方向
    {
        y_sum += adc_data[i];
    }
}

x_avg = x_sum / 2;
y_avg = y_sum / 2;

// 转换到厘米
x_cm = x_avg / MAX_ADC_VALUE * 60;
y_cm = y_avg / MAX_ADC_VALUE * 60;

// 更新LED和舵机
// ...

// OLED显示屏显示坐标
// ...

注意：这里的MAX_ADC_VALUE是你ADC的最大值，例如对于STM32F4系列，可能是4095。你需要根据实际情况调整。

5. OLED显示屏驱动和舵机控制

这部分依赖于你使用的具体OLED库和舵机驱动。你可能需要查找相关文档并调用相应的函数来实现这些功能。例如，如果你使用的是SSD1306 OLED库，你可以这样显示坐标：

void display_coordinates(float x_cm, float y_cm)
{
    char str[10][10]; // 两个浮点数的字符串缓冲区
    sprintf(str[0], "X: %.0f", x_cm);
    sprintf(str[1], "Y: %.0f", y_cm);

    oled_init(); // OLED初始化函数
    oled_clear(); // 清除屏幕
    oled_set_pos(0, 0); // 设置光标位置
    oled_write_string(str[0]); // 显示X坐标
    oled_set_pos(0, 10); // 下移一行
    oled_write_string(str[1]); // 显示Y坐标
    oled_update(); // 刷新屏幕
}

对于舵机控制，你需要找到一个舵机库，比如STM32 Servo库，然后根据声源位置计算角度，设置舵机的角度。

void set_servo_angle(float angle)
{
    servo_init(); // 初始化舵机
    servo_move(angle); // 移动舵机到指定角度
}

将以上所有部分整合在一起，你应该就能实现声源定位的功能。记得根据实际情况调整代码，因为这只是一个基本的框架。你可能需要优化算法以提高精度，以及处理边缘情况。