Usando a Câmera Serial Grove
O código abaixo é uma adaptação do exemplo disponível neste link, para utilização da Câmera Serial Grove com a Linkit ONE.
Esta adaptação é necessária por vários motivos:
- Não existe implementação da biblioteca SoftwareSerial para a Linkit ONE, em compensação ela tem duas portas seriais.
- O acesso ao cartão SD e ao armazenamento interno é feito através de bibliotecas próprias da Linkit ONE (apesar dos cabeçalhos serem diferentes, a utilização é praticamente igual);
- O pino CS do armazenamento/SD é o 10, ao invés do 4.
Devido a isso, foram feitas pequenas modificações para que o código pudesse compilar e funcionar corretamente:
#include <arduino.h>
#include <LFlash.h>
#include <LSD.h>
#include <LStorage.h>
#define PIC_PKT_LEN 128 //data length of each read, dont set this too big because ram is limited
#define PIC_FMT_VGA 7
#define PIC_FMT_CIF 5
#define PIC_FMT_OCIF 3
#define CAM_ADDR 0
#define CAM_SERIAL Serial1
#define PIC_FMT PIC_FMT_VGA
#define SD LFlash // use Internal 10M Flash
//#define SD LSD // use SD card
LFile myFile;
const byte cameraAddr = (CAM_ADDR << 5); // addr
const int buttonPin = 4; // the number of the pushbutton pin
unsigned long picTotalLen = 0; // picture length
int picNameNum = 0;
/*********************************************************************/
void setup()
{
Serial.begin(9600);
CAM_SERIAL.begin(9600); //cant be faster than 9600, maybe difference with diff board.
pinMode(buttonPin, INPUT); // initialize the pushbutton pin as an input
Serial.println("Initializing SD card....");
pinMode(10, OUTPUT); // CS pin of SD Card Shield
if (!SD.begin()) {
Serial.print("sd init failed");
return;
}
Serial.println("sd init done.");
initialize();
}
/*********************************************************************/
void loop()
{
int n = 0;
while (1) {
Serial.println("\r\nPress the button to take a picture");
while (digitalRead(buttonPin) == LOW); //wait for buttonPin status to HIGH
Serial.println("taking");
if (digitalRead(buttonPin) == HIGH) {
delay(20); //Debounce
if (digitalRead(buttonPin) == HIGH)
{
delay(200);
if (n == 0) preCapture();
Capture();
Serial.print("Saving picture...");
GetData();
}
Serial.print("\r\nDone ,number : ");
Serial.println(n);
n++ ;
}
}
}
/*********************************************************************/
void clearRxBuf()
{
while (CAM_SERIAL.available())
{
CAM_SERIAL.read();
}
}
/*********************************************************************/
void sendCmd(char cmd[], int cmd_len)
{
for (char i = 0; i < cmd_len; i++) CAM_SERIAL.write(cmd[i]);
}
/*********************************************************************/
int readBytes(char *dest, int len, unsigned int timeout)
{
int read_len = 0;
unsigned long t = millis();
while (read_len < len)
{
while (CAM_SERIAL.available() < 1)
{
if ((millis() - t) > timeout)
{
return read_len;
}
}
*(dest + read_len) = CAM_SERIAL.read();
//Serial.write(*(dest+read_len));
read_len++;
}
return read_len;
}
/*********************************************************************/
void initialize()
{
char cmd[] = {0xaa, 0x0d | cameraAddr, 0x00, 0x00, 0x00, 0x00} ;
unsigned char resp[6];
Serial.print("initializing camera...");
while (1)
{
sendCmd(cmd, 6);
if (readBytes((char *)resp, 6, 1000) != 6)
{
Serial.print(".");
continue;
}
if (resp[0] == 0xaa && resp[1] == (0x0e | cameraAddr) && resp[2] == 0x0d && resp[4] == 0 && resp[5] == 0)
{
if (readBytes((char *)resp, 6, 500) != 6) continue;
if (resp[0] == 0xaa && resp[1] == (0x0d | cameraAddr) && resp[2] == 0 && resp[3] == 0 && resp[4] == 0 && resp[5] == 0) break;
}
}
cmd[1] = 0x0e | cameraAddr;
cmd[2] = 0x0d;
sendCmd(cmd, 6);
Serial.println("\nCamera initialization done.");
}
/*********************************************************************/
void preCapture()
{
char cmd[] = { 0xaa, 0x01 | cameraAddr, 0x00, 0x07, 0x00, PIC_FMT };
unsigned char resp[6];
while (1)
{
clearRxBuf();
sendCmd(cmd, 6);
if (readBytes((char *)resp, 6, 100) != 6) continue;
if (resp[0] == 0xaa && resp[1] == (0x0e | cameraAddr) && resp[2] == 0x01 && resp[4] == 0 && resp[5] == 0) break;
}
}
void Capture()
{
char cmd[] = { 0xaa, 0x06 | cameraAddr, 0x08, PIC_PKT_LEN & 0xff, (PIC_PKT_LEN >> 8) & 0xff , 0};
unsigned char resp[6];
while (1)
{
clearRxBuf();
sendCmd(cmd, 6);
if (readBytes((char *)resp, 6, 100) != 6) continue;
if (resp[0] == 0xaa && resp[1] == (0x0e | cameraAddr) && resp[2] == 0x06 && resp[4] == 0 && resp[5] == 0) break;
}
cmd[1] = 0x05 | cameraAddr;
cmd[2] = 0;
cmd[3] = 0;
cmd[4] = 0;
cmd[5] = 0;
while (1)
{
clearRxBuf();
sendCmd(cmd, 6);
if (readBytes((char *)resp, 6, 100) != 6) continue;
if (resp[0] == 0xaa && resp[1] == (0x0e | cameraAddr) && resp[2] == 0x05 && resp[4] == 0 && resp[5] == 0) break;
}
cmd[1] = 0x04 | cameraAddr;
cmd[2] = 0x1;
while (1)
{
clearRxBuf();
sendCmd(cmd, 6);
if (readBytes((char *)resp, 6, 100) != 6) continue;
if (resp[0] == 0xaa && resp[1] == (0x0e | cameraAddr) && resp[2] == 0x04 && resp[4] == 0 && resp[5] == 0)
{
if (readBytes((char *)resp, 6, 1000) != 6)
{
continue;
}
if (resp[0] == 0xaa && resp[1] == (0x0a | cameraAddr) && resp[2] == 0x01)
{
picTotalLen = (resp[3]) | (resp[4] << 8) | (resp[5] << 16);
//Serial.print("picTotalLen:");
//Serial.println(picTotalLen);
break;
}
}
}
}
/*********************************************************************/
void GetData()
{
unsigned int pktCnt = (picTotalLen) / (PIC_PKT_LEN - 6);
if ((picTotalLen % (PIC_PKT_LEN - 6)) != 0) pktCnt += 1;
char cmd[] = { 0xaa, 0x0e | cameraAddr, 0x00, 0x00, 0x00, 0x00 };
unsigned char pkt[PIC_PKT_LEN];
char picName[] = "pix00.jpg";
picName[3] = picNameNum / 10 + '0';
picName[4] = picNameNum % 10 + '0';
if (SD.exists(picName))
{
SD.remove(picName);
}
myFile = SD.open(picName, FILE_WRITE);
if (!myFile) {
Serial.println("myFile open fail...");
}
else {
for (unsigned int i = 0; i < pktCnt; i++)
{
cmd[4] = i & 0xff;
cmd[5] = (i >> 8) & 0xff;
int retry_cnt = 0;
retry:
delay(10);
clearRxBuf();
sendCmd(cmd, 6);
uint16_t cnt = readBytes((char *)pkt, PIC_PKT_LEN, 200);
unsigned char sum = 0;
for (int y = 0; y < cnt - 2; y++)
{
sum += pkt[y];
}
if (sum != pkt[cnt - 2])
{
if (++retry_cnt < 100) goto retry;
else break;
}
myFile.write((const uint8_t *)&pkt[4], cnt - 6);
//if (cnt != PIC_PKT_LEN) break;
}
cmd[4] = 0xf0;
cmd[5] = 0xf0;
sendCmd(cmd, 6);
}
myFile.close();
picNameNum ++;
}
Essa câmera vem com o cabinho grove, então você pode conectá-la diretamente na devida porta na Linkit ONE (repare que existem duas, uma é para a comunicação I2C, com GND, 5V, SDA e SCL, mas é na que tem GND, 5V, TX e RX que você deve conectar), conforme a imagem abaixo:
Lembrando que a Linkit ONE tem duas seriais, então diferentemente do Arduino UNO, você usa os pinos D0 e D1, RX e TX respectivamente, sem ter problemas com a comunicação serial entre a placa e o computador. Para tanto, você deve usar o objeto “Serial1”, ao invés de apenas “Serial”.
Fora isso, ainda tenho que descobrir como alterar a velocidade de comunicação (baud rate), porque levar 20 segundos pra tirar uma foto com resolução VGA é demais… rsrsrsrsrs.