Skip to main content

Servo test

舵机测试实例由9行指令,测试电位器模块对舵机旋转角度的控制。

所需素材
  • 编程器主控板
  • 扩展板
  • 电源
tip

舵机应当连接到PWM发生器的0号通道,而电位器连接在扩展板的AIN0接口。

caution

操作时,应当将带有明显颜色的对象放置在传感器的正上方进行检测。

danger

注意测试过程中的正确连线!

实例拆解

1. 启用模块

首先调用C5C1指令启用板外置PWM发生器与ADC模数转换器模块。

C5 0001 0000
C1 0001 0000

2. 设定参数


3. 驱动舵机


4. 循环执行

舵机测试要求响应尽可能实时,所以执行完驱动指令后,直接调用0E指令,无条件跳转到驱动指令前循环执行。

0E 0000 0003

完整代码

servo-test.ist
C5 0001 0000
C1 0001 0000
10 0000 0007
10 0001 0014
11 0002 0024
1D 0002 0001
12 0002 00D2
EB 0000 0002
0E 0000 0003