增加弯道状态

This commit is contained in:
Glz
2024-03-26 21:39:39 +08:00
parent cbea30033a
commit f5654ba679
3 changed files with 34 additions and 13 deletions

View File

@@ -19,6 +19,25 @@ float calculate_vector_angle(float x1, float y1, float x2, float y2)
return angle_degrees;
}
// void CheckGarage()
// {
// int change_num = 0;
// int check_garage_h = 60;
// for (int check_garage_w = 50; check_garage_w < IMAGE_W - 50; check_garage_w++) {
// if ((GET_PIX_1C(mt9v03x_image_copy[0], check_garage_h, check_garage_w) < FIX_BINTHRESHOLD && GET_PIX_1C(mt9v03x_image_copy[0], check_garage_h, check_garage_w + 1) >= FIX_BINTHRESHOLD) ||
// (GET_PIX_1C(mt9v03x_image_copy[0], check_garage_h, check_garage_w) >= FIX_BINTHRESHOLD && GET_PIX_1C(mt9v03x_image_copy[0], check_garage_h, check_garage_w + 1) < FIX_BINTHRESHOLD)) {
// change_num++;
// }
// }
// if (change_num > 14) {
// garage_type = GARAGE_FOUND;
// // printf("跳变点的数量为:%d\r\n", change_num);
// }
// change_num = 0;
// }
void CheckGarage()
{
int change_num = 0;