// Finich Demo #1
// finchrobot.com $99
// download the C++ Visual Studio (Windows) zip file and replace the code in the main.cpp file with this code

#include <iostream>           // cout
#include <cstdlib>            // system
#include <conio.h>            // _getch()
#include "./Finch/Finch.h"    // make sure Finch.h & Finch.cpp are in Finch folder
using namespace std;

int main() 
{
    Finch myFinch;      // robot
    char option = 0;    // user's command

    cout << "m to start Motor" << endl;
    cout << "s to Stop motor" << endl;
    cout << "r to turn Right" << endl;
    cout << "l to turn Left" << endl;
    cout << "q to Quit" << endl;
	
    while (option != 'q' && option != 'Q') 
    {	
        option = _getch();

        if (option == 's' || option == 'S')
        {
            myFinch.setMotors(0, 0);
        }
        else if (option == 'm' || option == 'M')
        {
            myFinch.setMotors(100, 100);
        }
        else if (option == 'l' || option == 'L')
        {
            myFinch.setMotors(0, 100);
        }
        else if (option == 'r' || option == 'R')
        {
            myFinch.setMotors(100, 0);
        }

    }
	
    system("pause");
    return 0;
}// end of main