fixed Current logging output.

git-svn-id: https://arducopter.googlecode.com/svn/trunk@1572 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
jasonshort 2011-01-29 05:55:23 +00:00
parent 1af6a3b4e8
commit e1b4ec3132
2 changed files with 14 additions and 6 deletions

View File

@ -538,12 +538,14 @@ void Log_Read(int start_page, int end_page)
if(data==HEAD_BYTE1) // Head byte 1
log_step++;
break;
case 1:
if(data==HEAD_BYTE2) // Head byte 2
log_step++;
else
log_step = 0;
break;
case 2:
if(data==LOG_ATTITUDE_MSG){
Log_Read_Attitude();
@ -573,9 +575,14 @@ void Log_Read(int start_page, int end_page)
Log_Read_Cmd();
log_step++;
}else if(data==LOG_CURRENT_MSG){
Log_Read_Current();
log_step++;
}else if(data==LOG_STARTUP_MSG){
Log_Read_Startup();
log_step++;
}else {
if(data == LOG_GPS_MSG){
Log_Read_GPS();
@ -587,6 +594,7 @@ void Log_Read(int start_page, int end_page)
}
}
break;
case 3:
if(data==END_BYTE){
packet_count++;

View File

@ -264,7 +264,7 @@ test_stabilize(uint8_t argc, const Menu::arg *argv)
ts_num++;
if (ts_num > 10){
ts_num = 0;
Serial.printf_P(PSTR("r: %d, p:%d, rc1:%d, Int%4.4f, "),
Serial.printf_P(PSTR("r: %d, p:%d, rc1:%d, Int:%4.4f, "),
(int)(dcm.roll_sensor/100),
(int)(dcm.pitch_sensor/100),
rc_1.pwm_out,