chore: refactor code blocks
This commit is contained in:
@@ -23,6 +23,7 @@ println("Hello, world!")
|
|||||||
package top.blackcyan.kt
|
package top.blackcyan.kt
|
||||||
|
|
||||||
val message: ListOf<String> = ["Hello ", "world!"]
|
val message: ListOf<String> = ["Hello ", "world!"]
|
||||||
|
|
||||||
message.forEach {
|
message.forEach {
|
||||||
print(it)
|
print(it)
|
||||||
}
|
}
|
||||||
@@ -36,7 +37,11 @@ println()
|
|||||||
package top.blackcyan.kt
|
package top.blackcyan.kt
|
||||||
|
|
||||||
fun greeting() = "Hello"
|
fun greeting() = "Hello"
|
||||||
fun String.printOut() { println("${greeting()} $this!") }
|
|
||||||
|
fun String.printOut() {
|
||||||
|
println("${greeting()} $this!")
|
||||||
|
}
|
||||||
|
|
||||||
fun main() {
|
fun main() {
|
||||||
"world".printOut()
|
"world".printOut()
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -131,8 +131,7 @@ println("总花费:$totalCost")
|
|||||||
|
|
||||||
输出结果:
|
输出结果:
|
||||||
|
|
||||||
```kotlin
|
```
|
||||||
"""
|
|
||||||
最小花费的高铁修建方案如下:
|
最小花费的高铁修建方案如下:
|
||||||
A -- D : 费用 5
|
A -- D : 费用 5
|
||||||
C -- E : 费用 5
|
C -- E : 费用 5
|
||||||
@@ -141,7 +140,6 @@ A -- B : 费用 7
|
|||||||
B -- E : 费用 7
|
B -- E : 费用 7
|
||||||
E -- G : 费用 9
|
E -- G : 费用 9
|
||||||
总花费:39
|
总花费:39
|
||||||
"""
|
|
||||||
|
|
||||||
```
|
```
|
||||||
|
|
||||||
@@ -236,8 +234,7 @@ println("总花费:$totalCost")
|
|||||||
|
|
||||||
输出结果:
|
输出结果:
|
||||||
|
|
||||||
```kotlin
|
```
|
||||||
"""
|
|
||||||
最小花费的高铁修建方案如下:
|
最小花费的高铁修建方案如下:
|
||||||
A -- B : 费用 7
|
A -- B : 费用 7
|
||||||
E -- C : 费用 5
|
E -- C : 费用 5
|
||||||
@@ -246,7 +243,6 @@ B -- E : 费用 7
|
|||||||
D -- F : 费用 6
|
D -- F : 费用 6
|
||||||
E -- G : 费用 9
|
E -- G : 费用 9
|
||||||
总花费:39
|
总花费:39
|
||||||
"""
|
|
||||||
|
|
||||||
```
|
```
|
||||||
|
|
||||||
|
|||||||
@@ -130,26 +130,26 @@ return int(angle)
|
|||||||
def apply_filters(raw_angle):
|
def apply_filters(raw_angle):
|
||||||
global angle_buffer
|
global angle_buffer
|
||||||
|
|
||||||
# 1. 无效数据跳过
|
# 无效数据跳过
|
||||||
if raw_angle is None:
|
if raw_angle is None:
|
||||||
return None
|
return None
|
||||||
|
|
||||||
# 2. 更新数据缓冲区
|
# 更新数据缓冲区
|
||||||
angle_buffer.append(raw_angle)
|
angle_buffer.append(raw_angle)
|
||||||
if len(angle_buffer) > FILTER_WINDOW:
|
if len(angle_buffer) > FILTER_WINDOW:
|
||||||
angle_buffer.pop(0)
|
angle_buffer.pop(0)
|
||||||
|
|
||||||
# 3. 中值滤波
|
# 中值滤波
|
||||||
sorted_angles = sorted(angle_buffer)
|
sorted_angles = sorted(angle_buffer)
|
||||||
median_angle = sorted_angles[len(sorted_angles) // 2]
|
median_angle = sorted_angles[len(sorted_angles) // 2]
|
||||||
|
|
||||||
# 4. 移动平均滤波
|
# 移动平均滤波
|
||||||
avg_angle = sum(angle_buffer) / len(angle_buffer)
|
avg_angle = sum(angle_buffer) / len(angle_buffer)
|
||||||
|
|
||||||
# 5. 加权组合滤波结果
|
# 加权组合滤波结果
|
||||||
filtered_angle = 0.6 * median_angle + 0.4 * avg_angle
|
filtered_angle = 0.6 * median_angle + 0.4 * avg_angle
|
||||||
|
|
||||||
# 6. 角度连续性处理
|
# 角度连续性处理
|
||||||
if filtered_angle > 180:
|
if filtered_angle > 180:
|
||||||
filtered_angle -= 360
|
filtered_angle -= 360
|
||||||
elif filtered_angle < -180:
|
elif filtered_angle < -180:
|
||||||
@@ -167,7 +167,7 @@ angle_360 = angle % 360
|
|||||||
if angle_360 < 0:
|
if angle_360 < 0:
|
||||||
angle_360 += 360
|
angle_360 += 360
|
||||||
|
|
||||||
# 检查角度是否在有效范围内 (270°~90° 的半圆)
|
# 检查角度是否在有效范围内
|
||||||
if 90 < angle_360 < 270:
|
if 90 < angle_360 < 270:
|
||||||
return False, None # 无效角度
|
return False, None # 无效角度
|
||||||
|
|
||||||
@@ -186,7 +186,7 @@ return True, duty_val
|
|||||||
|
|
||||||
def main():
|
def main():
|
||||||
global angle_buffer
|
global angle_buffer
|
||||||
last_valid_duty = 7.5 # 最后有效的duty值(初始为中间位置)
|
last_valid_duty = 7.5 # 最后有效的 duty 值
|
||||||
|
|
||||||
try:
|
try:
|
||||||
# 初始化角度缓冲区
|
# 初始化角度缓冲区
|
||||||
@@ -222,7 +222,7 @@ raw_str = str(raw_angle) if raw_angle is not None else "--"
|
|||||||
info = "原始角度: %s° -> 滤波角度: %d°" % (raw_str, filtered_angle)
|
info = "原始角度: %s° -> 滤波角度: %d°" % (raw_str, filtered_angle)
|
||||||
info += "\n能量数据: " + str(energy_data)
|
info += "\n能量数据: " + str(energy_data)
|
||||||
print(info)
|
print(info)
|
||||||
print('-' * 30)
|
print("-" * 30)
|
||||||
|
|
||||||
# 转换角度到舵机控制信号
|
# 转换角度到舵机控制信号
|
||||||
is_valid, duty_val = convert_angle(filtered_angle)
|
is_valid, duty_val = convert_angle(filtered_angle)
|
||||||
@@ -247,13 +247,13 @@ delay_time = max(10, 100 - loop_time)
|
|||||||
time.sleep_ms(delay_time)
|
time.sleep_ms(delay_time)
|
||||||
|
|
||||||
except KeyboardInterrupt:
|
except KeyboardInterrupt:
|
||||||
print('用户退出')
|
print("用户退出")
|
||||||
finally:
|
finally:
|
||||||
mic.deinit()
|
mic.deinit()
|
||||||
pwm.duty(7.5) # 回到中间位置
|
pwm.duty(7.5) # 回到中间位置
|
||||||
print("资源已释放")
|
print("资源已释放")
|
||||||
|
|
||||||
if __name__ == '__main__':
|
if __name__ == "__main__":
|
||||||
init()
|
init()
|
||||||
main()
|
main()
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user