diff --git a/ino/mcopy_camera/mcopy_camera.ino b/ino/mcopy_camera/mcopy_camera.ino index 49fc82d..a972bed 100644 --- a/ino/mcopy_camera/mcopy_camera.ino +++ b/ino/mcopy_camera/mcopy_camera.ino @@ -41,6 +41,9 @@ const char cmd_cam_backward = 'f'; const char cmd_debug = 'd'; const char cmd_connect = 'i'; volatile char cmd_char = 'z'; +const char cmd_mcopy_identifier = 'm'; +const char cmd_cam_identifier = 'k'; + const int serialDelay = 5; void setup() { @@ -72,6 +75,8 @@ void cmd (char val) { debug(); } else if (val == cmd_connect) { connect(); + } else if (val == cmd_mcopy_identifier) { + identify(); } else if (val == cmd_camera) { Frame(); } else if (val == cmd_cam_forward) { @@ -92,6 +97,11 @@ void connect () { log("connect()"); } +void identify () { + Serial.println(cmd_cam_identifier); + log("identify()"); +} + void Pins_init () { pinMode(PIN_MOTOR_FORWARD, OUTPUT); pinMode(PIN_MOTOR_BACKWARD, OUTPUT);