// Lepton-FLiR-Arduino Image Capture Example
// In this example, we will copy out thermal image frames to individual BMP files located
// on a MicroSD card using the SD library. Note that you will need a MicroSD card reader
// module for this example to work. Both the FLiR module and MicroSD card reader module
// will be on the same SPI lines, just using different chip enable pins/wires.
#include "LeptonFLiR.h"
#include <SD.h>
const byte flirCSPin = 22;
LeptonFLiR flirController(Wire, flirCSPin); // Library using Wire and chip select pin D22
const byte cardCSPin = 24;
void setup() {
Serial.begin(115200);
Wire.begin(); // Wire must be started first
Wire.setClock(400000); // Supported baud rates are 100kHz, 400kHz, and 1000kHz
SPI.begin(); // SPI must be started first as well
SD.begin(cardCSPin); // SD library using chip select pin D24
// Using memory allocation mode 80x60 8bpp and fahrenheit temperature mode
flirController.init(LeptonFLiR_ImageStorageMode_80x60_8bpp, LeptonFLiR_TemperatureMode_Fahrenheit);
// Setting use of AGC for histogram equalization (since we only have 8-bit per pixel data anyways)
flirController.agc_setAGCEnabled(ENABLED);
flirController.sys_setTelemetryEnabled(ENABLED); // Ensure telemetry is enabled
SD.rmdir("FLIR"); // Starting fresh with new frame captures
}
uint32_t lastFrameNumber = -1; // Tracks for when a new frame is available
void loop() {
if (flirController.readNextFrame()) { // Read next frame and store result into internal imageData
uint32_t frameNumber = flirController.getTelemetryFrameCounter();
if (frameNumber > lastFrameNumber) { // Frame counter increments every 3rd frame due to export restrictions
lastFrameNumber = frameNumber;
char fileName[] = "FLIR/IMG0000.BMP";
uint16_t fileNumber = (uint16_t)(frameNumber / 3);
wordsToHexString((uint16_t *)&fileNumber, 1, &fileName[8], 4);
File bmpFile = SD.open(fileName, FILE_WRITE);
if (bmpFile) {
writeBMPFile(bmpFile,
flirController.getImageData(),
flirController.getImageWidth(),
flirController.getImageHeight(),
flirController.getImagePitch());
bmpFile.close();
Serial.print(fileName);
Serial.println(" written...");
}
}
// Occasionally flat field correction normalization needs ran
if (flirController.getShouldRunFFCNormalization())
flirController.sys_runFFCNormalization();
}
}
// Writes a BMP file out, code from: http://stackoverflow.com/questions/2654480/writing-bmp-image-in-pure-c-c-without-other-libraries
void writeBMPFile(File &bmpFile, byte *imageData, int width, int height, int pitch) {
byte file[14] = {
'B','M', // magic
0,0,0,0, // size in bytes
0,0, // app data
0,0, // app data
40+14,0,0,0 // start of data offset
};
byte info[40] = {
40,0,0,0, // info hd size
0,0,0,0, // width
0,0,0,0, // heigth
1,0, // number color planes
24,0, // bits per pixel
0,0,0,0, // compression is none
0,0,0,0, // image bits size
0x13,0x0B,0,0, // horz resoluition in pixel / m
0x13,0x0B,0,0, // vert resolutions (0x03C3 = 96 dpi, 0x0B13 = 72 dpi)
0,0,0,0, // #colors in pallete
0,0,0,0, // #important colors
};
uint32_t padSize = (4-(width*3)%4)%4;
uint32_t sizeData = width*height*3 + height*padSize;
uint32_t sizeAll = sizeData + sizeof(file) + sizeof(info);
file[ 2] = (byte)((sizeAll ) & 0xFF);
file[ 3] = (byte)((sizeAll >> 8) & 0xFF);
file[ 4] = (byte)((sizeAll >> 16) & 0xFF);
file[ 5] = (byte)((sizeAll >> 24) & 0xFF);
info[ 4] = (byte)((width ) & 0xFF);
info[ 5] = (byte)((width >> 8) & 0xFF);
info[ 6] = (byte)((width >> 16) & 0xFF);
info[ 7] = (byte)((width >> 24) & 0xFF);
info[ 8] = (byte)((height ) & 0xFF);
info[ 9] = (byte)((height >> 8) & 0xFF);
info[10] = (byte)((height >> 16) & 0xFF);
info[11] = (byte)((height >> 24) & 0xFF);
info[20] = (byte)((sizeData ) & 0xFF);
info[21] = (byte)((sizeData >> 8) & 0xFF);
info[22] = (byte)((sizeData >> 16) & 0xFF);
info[23] = (byte)((sizeData >> 24) & 0xFF);
bmpFile.write((byte *)file, sizeof(file));
bmpFile.write((byte *)info, sizeof(info));
byte pad[3] = {0,0,0};
imageData += (height - 1) * pitch;
for (int y = height - 1; y >= 0; --y) {
for (int x = 0; x < width; ++x) {
byte pixel[3]; // blue green red
pixel[0] = pixel[1] = pixel[2] = imageData[x];
bmpFile.write((byte *)pixel, 3);
}
bmpFile.write((byte *)pad, padSize);
imageData -= pitch;
}
}
, i was more involved in STM32 in the past , and the registers / DMA etc used on teensy are actually black magic up i can learn more on this MCU 
