Make camera identify itself

This commit is contained in:
Matt 2016-04-18 21:25:30 -04:00
parent 7c9b56822e
commit 3fa5b06e82
1 changed files with 9 additions and 0 deletions

View File

@ -12,6 +12,8 @@ boolean cam_dir = true; //camera defaults to forward
const char cmd_camera = 'c'; const char cmd_camera = 'c';
const char cmd_cam_forward = 'e'; const char cmd_cam_forward = 'e';
const char cmd_cam_backward = 'f'; const char cmd_cam_backward = 'f';
const char cmd_mcopy_identifier = 'm';
const char cmd_cam_identifier = 'k';
const char cmd_debug = 'd'; const char cmd_debug = 'd';
const char cmd_connect = 'i'; const char cmd_connect = 'i';
@ -40,6 +42,8 @@ void cmd (char val) {
debug(); debug();
} else if (val == cmd_connect) { } else if (val == cmd_connect) {
connect(); connect();
} else if (val == cmd_mcopy_identifier) {
identify();
} else if (val == cmd_camera) { } else if (val == cmd_camera) {
camera(); camera();
} else if (val == cmd_cam_forward) { } else if (val == cmd_cam_forward) {
@ -60,6 +64,11 @@ void connect () {
log("connect()"); log("connect()");
} }
void identify () {
Serial.println(cmd_cam_identifier);
log("identify()");
}
void camera () { void camera () {
/* FROM INTVAL /* FROM INTVAL
* WILL USE OPTICAL ENDSTOP * WILL USE OPTICAL ENDSTOP