Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-11 02:18:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

uncrustify libraries/DataFlash/examples/DataFlash_test/DataFlash_test.pde

Browse Source
This commit is contained in:
uncrustify 2012-08-16 23:21:25 -07:00 committed by Pat Hickey
parent 36a3fad796
commit 15d8ba45e3
1 changed files with 86 additions and 86 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

156
libraries/DataFlash/examples/DataFlash_test/DataFlash_test.pde
View File

@ -1,108 +1,108 @@
/*
Example of DataFlash library.
Code by Jordi MuÒoz and Jose Julio. DIYDrones.com
*/
* Example of DataFlash library.
* Code by Jordi MuÒoz and Jose Julio. DIYDrones.com
*/
// Libraries
#include <SPI.h> // Arduino SPI lib
#include <SPI.h> // Arduino SPI lib
#include <DataFlash.h>
#define HEAD_BYTE1 0xA3
#define HEAD_BYTE2 0x95
// NOTE: You must uncomment one of the following two lines
DataFlash_APM2 DataFlash; // Uncomment this line if using APM2 hardware
DataFlash_APM2 DataFlash; // Uncomment this line if using APM2 hardware
//DataFlash_APM1 DataFlash; // Uncomment this line if using APM1 hardware
void setup()
{
Serial.begin(115200);
DataFlash.Init(); // DataFlash initialization
Serial.begin(115200);
DataFlash.Init(); // DataFlash initialization
Serial.println("Dataflash Log Test 1.0");
Serial.println("Dataflash Log Test 1.0");
// Test
delay(20);
DataFlash.ReadManufacturerID();
delay(10);
Serial.print("Manufacturer:");
Serial.print(int(DataFlash.df_manufacturer));
Serial.print(",");
Serial.print(DataFlash.df_device);
Serial.println();
// Test
delay(20);
DataFlash.ReadManufacturerID();
delay(10);
Serial.print("Manufacturer:");
Serial.print(int(DataFlash.df_manufacturer));
Serial.print(",");
Serial.print(DataFlash.df_device);
Serial.println();
// We start to write some info (sequentialy) starting from page 1
// This is similar to what we will do...
DataFlash.StartWrite(1);
Serial.println("After testing perform erase before using DataFlash for logging!");
Serial.println("");
Serial.println("Writing to flash... wait...");
for (int i = 0; i < 1000; i++){ // Write 1000 packets...
// We write packets of binary data... (without worry about nothing more)
DataFlash.WriteByte(HEAD_BYTE1);
DataFlash.WriteByte(HEAD_BYTE2);
DataFlash.WriteInt(2000 + i);
DataFlash.WriteInt(2001 + i);
DataFlash.WriteInt(2002 + i);
DataFlash.WriteInt(2003 + i);
DataFlash.WriteLong((long)i * 5000);
DataFlash.WriteLong((long)i * 16268);
DataFlash.WriteByte(0xA2); // 2 bytes of checksum (example)
DataFlash.WriteByte(0x4E);
delay(10);
}
delay(100);
// We start to write some info (sequentialy) starting from page 1
// This is similar to what we will do...
DataFlash.StartWrite(1);
Serial.println("After testing perform erase before using DataFlash for logging!");
Serial.println("");
Serial.println("Writing to flash... wait...");
for (int i = 0; i < 1000; i++) { // Write 1000 packets...
// We write packets of binary data... (without worry about nothing more)
DataFlash.WriteByte(HEAD_BYTE1);
DataFlash.WriteByte(HEAD_BYTE2);
DataFlash.WriteInt(2000 + i);
DataFlash.WriteInt(2001 + i);
DataFlash.WriteInt(2002 + i);
DataFlash.WriteInt(2003 + i);
DataFlash.WriteLong((long)i * 5000);
DataFlash.WriteLong((long)i * 16268);
DataFlash.WriteByte(0xA2); // 2 bytes of checksum (example)
DataFlash.WriteByte(0x4E);
delay(10);
}
delay(100);
}
void loop()
{
int i, tmp_int;
byte tmp_byte1, tmp_byte2;
long tmp_long;
int i, tmp_int;
byte tmp_byte1, tmp_byte2;
long tmp_long;
Serial.println("Start reading page 1...");
Serial.println("Start reading page 1...");
DataFlash.StartRead(1); // We start reading from page 1
DataFlash.StartRead(1); // We start reading from page 1
for (i = 0; i < 200; i++){ // Read 200 packets...
for (i = 0; i < 200; i++) { // Read 200 packets...
tmp_byte1 = DataFlash.ReadByte();
tmp_byte2 = DataFlash.ReadByte();
tmp_byte1 = DataFlash.ReadByte();
tmp_byte2 = DataFlash.ReadByte();
Serial.print("PACKET:");
Serial.print("PACKET:");
if ((tmp_byte1 == HEAD_BYTE1) && (tmp_byte1 == HEAD_BYTE1)){
// Read 4 ints...
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
if ((tmp_byte1 == HEAD_BYTE1) && (tmp_byte1 == HEAD_BYTE1)) {
// Read 4 ints...
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
tmp_int = DataFlash.ReadInt();
Serial.print(tmp_int);
Serial.print(",");
// Read 2 longs...
tmp_long = DataFlash.ReadLong();
Serial.print(tmp_long);
Serial.print(",");
tmp_long = DataFlash.ReadLong();
Serial.print(tmp_long);
Serial.print(";");
// Read 2 longs...
tmp_long = DataFlash.ReadLong();
Serial.print(tmp_long);
Serial.print(",");
tmp_long = DataFlash.ReadLong();
Serial.print(tmp_long);
Serial.print(";");
// Read the checksum...
tmp_byte1 = DataFlash.ReadByte();
tmp_byte2 = DataFlash.ReadByte();
}
Serial.println();
}
Serial.println("");
Serial.println("Test complete. Test will repeat in 20 seconds");
Serial.println("");
delay(20000);
// Read the checksum...
tmp_byte1 = DataFlash.ReadByte();
tmp_byte2 = DataFlash.ReadByte();
}
Serial.println();
}
Serial.println("");
Serial.println("Test complete. Test will repeat in 20 seconds");
Serial.println("");
delay(20000);
}