|
//--------------------------------------------------------------------------------------------------
void setup() {
ExcSerial.begin(9600); //与手机蓝牙波特率一致
modem.begin();
ReadConfig();
stepper.SetSpeed(6);
pinMode(LedPin,OUTPUT);
delay(2500); //延时,在此期间调整俯仰伺服器使天线指向正上,减少伺服器损伤
SERVO_V.attach(9);
cur_dgree.H = 0.0; stepper.StepNumberYT=0;
lst_dgree.V = 89.0; cur_dgree.V = 90.0;
Servo_Move(); //调用Servo_Update可能会是水平位置,所以不能用
delay(500); //等待俯仰伺服器运动到位
#if USE_GY85
Gy85.Init();
if( QuickOrient ) QuickOrientByMag(); //根据电子罗盘***定位正北
else OrientByMag(); //自检后旋转一周,测出地磁北后,根据安装调整角驱动步进电机使天线指北
#endif
Servo_Init(); //天线指向水平(正北)
fjspj=0.0; fjgdj=0.0;
}
//------------------
只修改过电机转动速度
|
|