写一段单片机程序：用取峰值函数，遍历每个采样点，每检测到波形中有一个峰值就增加1毫米的位移，最后把位移输出

以下是一个基于STM32单片机的程序示例，实现了上述功能：

#include "stm32f1xx_hal.h"

#define SAMPLE_COUNT 100
#define THRESHOLD 2000

// 函数声明
uint16_t findPeakValue(uint16_t *samples, uint16_t sampleCount);

int main(void)
{
    // 初始化HAL库
    HAL_Init();

    // 配置系统时钟
    SystemClock_Config();

    // 初始化ADC模块和DMA
    MX_ADC1_Init();
    MX_DMA_Init();

    // 启动ADC转换
    HAL_ADC_Start_DMA(&hadc1, (uint32_t*)samples, SAMPLE_COUNT);

    // 主循环
    while (1)
    {
        // 找到下一个峰值
        uint16_t peakValue = findPeakValue(samples, SAMPLE_COUNT);

        // 如果检测到峰值
        if (peakValue > THRESHOLD)
        {
            // 增加1毫米的位移
            position += 1;

            // 输出位移
            printf("Position: %d\n", position);
        }
    }
}

// 找到采样数组中的最大值
uint16_t findPeakValue(uint16_t *samples, uint16_t sampleCount)
{
    uint16_t peakValue = 0;

    for (int i = 0; i < sampleCount; i++)
    {
        if (samples[i] > peakValue)
        {
            peakValue = samples[i];
        }
    }

    return peakValue;
}

该程序使用了一个ADC模块和DMA，来采集到100个采样数据。在主循环中，程序通过调用`findPeakValue()`函数来找到采样数组中的最大值，如果这个最大值超过了设定的阈值，那么程序会增加1毫米的位移，并输出当前的位移值。请注意，这段程序仅仅是一个示例，实际应用中还需要根据具体的硬件和需求进行相应的修改。