fixed printf_P bug

git-svn-id: https://arducopter.googlecode.com/svn/trunk@1705 f9c3cf11-9bcb-44bc-f272-b75c42450872

ArduCopterMega/ArduCopterMega.pde

@@ -1016,7 +1016,9 @@ void update_alt()
 			sonar_alt		= min(sonar_alt, 600);
 			current_loc.alt = sonar_alt + home.alt;
 		}
+
 	}else{
+
 		// no sonar altitude
 		current_loc.alt = baro_alt + home.alt;
 	}

ArduCopterMega/setup.pde

@@ -1057,33 +1057,19 @@ void print_enabled(boolean b)
 void
 print_accel_offsets(void)
 {
-	Serial.println("jason");
+	Serial.printf_P(PSTR("Accel offsets: %4.2f, %4.2f, %4.2f\n"),
-	Serial.println(imu.ax(), 2);
-	Serial.println((float)imu.ax(),2);
-	Serial.println(imu.ax(), DEC);
-	Serial.println("jason");
-
-	Serial.printf(PSTR("Accel offsets: %4.2f, %4.2f, %4.2f\n"),
 						(float)imu.ax(),
 						(float)imu.ay(),
-						(float)imu.az()
+						(float)imu.az());
-	);
 }
 
 void
 print_gyro_offsets(void)
 {
-	Serial.println("jasong");
+	Serial.printf_P(PSTR("Gyro offsets: %4.2f, %4.2f, %4.2f\n"),
-	Serial.println(imu.gx(), 2);
-	Serial.println((float)imu.gx(),2);
-	Serial.println(imu.gx(), DEC);
-	Serial.println("jasong");
-
-	Serial.printf(PSTR("Gyro offsets: %4.2f, %4.2f, %4.2f\n"),
 						(float)imu.gx(),
 						(float)imu.gy(),
-						(float)imu.gz()
+						(float)imu.gz());
-	);
 }