arduino环境下用ESP32通过蓝牙串口APP控制舵狗完成动作

我使用的是Goouuu-ESP32它自带了蓝牙模块所以不用再另外购买
此蓝牙的使用程序可参考https://blog.csdn.net/m0_46139849/article/details/107441056

#include <Arduino.h>
#include <WiFi.h>
#include "BluetoothSerial.h"

#if !defined(CONFIG_BT_ENABLED) || !defined(CONFIG_BLUEDROID_ENABLED)
#error Bluetooth is not enabled! Please run `make menuconfig` to and enable it
#endif

#define DJ0_PWM 13
#define DJ1_PWM 12
#define DJ2_PWM 14

#define DJ3_PWM 27
#define DJ4_PWM 25
#define DJ5_PWM 26

#define DJ6_PWM 33
#define DJ7_PWM 32
#define DJ8_PWM 21

#define DJ9_PWM 19
#define DJ10_PWM 22
#define DJ11_PWM 23

BluetoothSerial SerialBT;

char BT;

double d0 = 73.3,d3 = 95.3,d6 = 76.8,d9 = 76.8;

double x,z,BD,xB,zB,L1 = 57,L2 = 50,L3 = 61;

double duty0,duty1,duty2,duty3,duty4,duty5,duty6,duty7,duty8,duty9,duty10,duty11;  // 占空比变量

//double dutyCycle0,dutyCycle1,dutyCycle2,dutyCycle3,dutyCycle4,dutyCycle5,dutyCycle6,dutyCycle7,dutyCycle8,dutyCycle9,dutyCycle10,dutyCycle11;  // 设置占空比

double Initial_Alpha0,Initial_Beta0,
       Initial_Alpha1,Initial_Beta1,
       Initial_Alpha2,Initial_Beta2,
       Initial_Alpha3,Initial_Beta3;  //设置角度

int freq = 50;

int freq0 = freq;    // 频率
int channel0 = 0;    // 通道0，共16个通道，0~15
int resolution0 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq1 = freq;    // 频率
int channel1 = 1;    // 通道1，共16个通道，0~15
int resolution1 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq2 = freq;    // 频率
int channel2 = 2;    // 通道0，共16个通道，0~15
int resolution2 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq3 = freq;    // 频率
int channel3 = 3;    // 通道0，共16个通道，0~15
int resolution3 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq4 = freq;    // 频率
int channel4 = 4;    // 通道0，共16个通道，0~15
int resolution4 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq5 = freq;    // 频率
int channel5 = 5;    // 通道0，共16个通道，0~15
int resolution5 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq6 = freq;    // 频率
int channel6 = 6;    // 通道0，共16个通道，0~15
int resolution6 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq7 = freq;    // 频率
int channel7 = 7;    // 通道0，共16个通道，0~15
int resolution7 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq8 = freq;    // 频率
int channel8 = 8;    // 通道0，共16个通道，0~15
int resolution8 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq9 = freq;    // 频率
int channel9 = 9;    // 通道0，共16个通道，0~15
int resolution9 = 10;   // 分辨率，取值0~20，duty最大取值为2^resolution-1

int freq10 = freq;    // 频率
int channel10