diff --git a/app/main.c b/app/main.c index cc688e8..0ca9590 100644 --- a/app/main.c +++ b/app/main.c @@ -42,7 +42,9 @@ int main(void) // while (imu660ra_init()) // ; - Page_Init(); + // system_delay_ms(2000); + // gyroOffset_init(); + // pit_ms_init(TIM6_PIT, 2); while (1) { @@ -50,6 +52,8 @@ int main(void) if (mt9v03x_finish_flag) { // 该操作消耗大概 1970 个 tick,折合约 110us memcpy(mt9v03x_image_copy[0], mt9v03x_image[0], (sizeof(mt9v03x_image_copy) / sizeof(uint8_t))); + adaptiveThreshold((uint8_t*)mt9v03x_image_copy, (uint8_t*)mt9v03x_image_copy, 188, 120, 7, 17); + ips200_show_gray_image(0, 0, mt9v03x_image_copy[0], MT9V03X_W, MT9V03X_H, MT9V03X_W, MT9V03X_H, 0); mt9v03x_finish_flag = 0; state_type = COMMON_STATE; @@ -60,6 +64,27 @@ int main(void) // ElementJudge(); // ElementRun(); MidLineTrack(); + } } +} + + + +void adaptiveThreshold(uint8_t* img_data, uint8_t* output_data, int width, int height, int block, uint8_t clip_value){ + int half_block = block / 2; + for(int y=half_block; ythres ? 255 : 0; + } + } } \ No newline at end of file