GitHub/Avem
1
0
Fork 0
mirror of https://github.com/avem-labs/Avem.git synced 2023-09-01 15:18:49 +08:00
Code Issues Projects Releases Wiki Activity

[MOD]: {Clean} Delete and add some useless space lines

Browse Source
This commit is contained in:
but0n 2016-11-28 16:35:27 +08:00
parent 13b370b410
commit fa55e24fb2
1 changed files with 1 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
src/main.c
View File

@ -34,13 +34,11 @@ void Comput(SixAxis cache) {
norm = sqrt(cache.aX*cache.aX + cache.aY*cache.aY + cache.aZ*cache.aZ); //取模
//向量化
cache.aX = cache.aX / norm;
cache.aY = cache.aY / norm;
cache.aZ = cache.aZ / norm;
//估计方向的重力
vx = 2 * (g_q1 * g_q3 - g_q0 * g_q2);
vy = 2 * (g_q0 * g_q1 + g_q2 * g_q3);
@ -84,7 +82,6 @@ void uart_task() {
uart_sendStr("Pitch Angle: ");
uart_Float2Char(g_Pitch);
uart_sendStr("; Roll Angle: ");
uart_Float2Char(g_Roll);
@ -98,6 +95,7 @@ void uart_task() {
}
#define DEBUG_MPU6050_EULER //Config
#if defined (DEBUG_PID) || defined (DEBUG_MPU6050_EULER) || defined (DEBUG_MPU6050_SOURCEDATA) || defined (DEBUG_BLDC)
SixAxis sourceData;
#endif
@ -111,7 +109,6 @@ void mpu_task() {
}
int main() {
// float Last;
// float *Feedback;
// float Erro;
@ -150,7 +147,6 @@ int main() {
while(1);
while(1) {
#ifdef DEBUG_WIFI
wifi_Config();