2024/1/25飞行测试
This commit is contained in:
@ -23,6 +23,7 @@ void mymain()
|
||||
Angel_closed_loop(motory,&FOCStruct_Y,2.3);
|
||||
i++;
|
||||
}
|
||||
i=0;
|
||||
LED_ON;
|
||||
while(1)
|
||||
{
|
||||
@ -32,8 +33,8 @@ void mymain()
|
||||
y = Angle.roll ;
|
||||
Zitai_closed_loop(motorx,&FOCStruct_X,x);
|
||||
Zitai_closed_loop(motory,&FOCStruct_Y,-y);
|
||||
x = getAngle(motorx);
|
||||
y = getAngle(motory);
|
||||
// x = getAngle(motorx);
|
||||
// y = getAngle(motory);
|
||||
// printf("%fY%f\n",x,y);
|
||||
// speed_closed_loop(motorx,&FOCStruct_X,_2PI*5);
|
||||
// speed_closed_loop(motory,&FOCStruct_Y,_2PI*2);
|
||||
@ -44,7 +45,7 @@ void mymain()
|
||||
// }
|
||||
// i++;
|
||||
//
|
||||
// Data_send(x,y,0,0);
|
||||
Data_send(x,y);
|
||||
// HAL_Delay(3);
|
||||
}
|
||||
}
|
Reference in New Issue
Block a user