GD32F103 — 21-servo control

来源: DRG GD-1 开发板例程
源文件: GD32/drg_gd_1_gd32f103c8t6-master/21-servo control/test/APP/main.c

子模块

Firmware
test

关键代码

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36


#include <stdio.h>
#include "systick.h"
#include "i2c.h"
#include "oled_i2c.h"
#include "encoder_drive.h"
#include "servo_ctrl.h"

int main(){
	servo_init();
	systick_config();
	i2c_init();

	oled_init();
	oled_clear_all();
	oled_show_string(20, 0, (uint8_t *)"ENCODER TEST", 16);

	encoder_init();
	
	char temp_string[10];
	uint8_t angle_t = 0;

	while(1){
		if(get_encoder_d_flg()){
			oled_show_string(2, 4, (uint8_t *)"CODER D: ON ", 16);
			angle_t = get_encoder_num();
			sprintf(temp_string, "CODER  : %d  ", angle_t);
			servo_set_angle(angle_t);
			oled_show_string(2, 2, (uint8_t *)temp_string, 16);
		}else{
			oled_show_string(2, 2, (uint8_t *)"CODER  : OFF  ", 16);
			oled_show_string(2, 4, (uint8_t *)"CODER D: OFF", 16);
		}

	}

}