2024/1/25飞行测试

This commit is contained in:
2024-01-26 15:31:40 +08:00
parent 9be12234ec
commit 08cbf4ba74
5 changed files with 80 additions and 20 deletions

View File

@ -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);
}
}