完成的 TowerPro (輝盛)SG90 微型舵機(Micro Servo)控制板後,便需要編寫驅動程式,祇要根據 TowerPro SG90 微型舵機的的 PWM 信號時間,透過訊號線傳送 PWM 脈波來控制軸柄的停止位置和旋轉角度,這次是由 GPIO2(D4)直接連接到微型舵機的控制線,直接驅動微型舵機。
ESP8266 D1 mini SG90 微型舵機控制板 |
TowerPro SG90 微型舵機的控制訊號 |
ESP8266 D1 mini SG90 微型舵機的插頭 |
// ESP8266 D1 mini GPIO2=D4 (On
Board BLUE LED PIN_FUNC_SELECT(PERIPHS_IO_MUX_GPIO2_U,
FUNC_GPIO2);
|
ESP8266 D1 mini SG90 微型舵機程式:
// SG90 PWM Time Variables
uint8 cw_time=0; // Clockwise
uint8 ccw_time=0; // Counter Clockwise
uint32 step_time=30000; // Step to step time
if (led==0){
// SG90 + MG995 Clockwise = 500us = 0.5ms in 20ms
Def=23
for (cw_time=0; cw_time<23 cw_time="" span="">23>
{
GPIO_OUTPUT_SET(GPIO_ID_PIN(2),1);
os_delay_us(500);
GPIO_OUTPUT_SET(GPIO_ID_PIN(2),0);
os_delay_us(19500);
os_delay_us(step_time);
}
} else {
// SG90 + MG995 Counterclockwise = 2500us = 2.5ms in
20ms Def=23
for (ccw_time=0; ccw_time<23 ccw_time="" span="">23>
{
GPIO_OUTPUT_SET(GPIO_ID_PIN(2),1);
os_delay_us(2500);
GPIO_OUTPUT_SET(GPIO_ID_PIN(2),0);
os_delay_us(17500);
os_delay_us(step_time);
}
}
|
ESP8266 程式:DIY - ESP12F - 025 - Servo 02 SG90 MG995 90DRG GPIO2 - 20180319
轉動中的 TowerPro SG90 微型舵機控制板 |
TowerPro SG90 微型舵機控制板的顯示 |
2018年 9月 4日 天氣報告
氣溫:28.7度 @ 19:50
相對濕度:百分之 86%
天氣:天色大致良好
沒有留言:
張貼留言