#include<iostream>
#include<string>
#include"eyebot++.h"
#include"maze_parameter.h"
#include"maze_func.h"
using namespace std;


void BOTturn(int turn)
{
    if (turn == -1)  //右转
    {
        ENCODERReset(1);
        ENCODERReset(2);
        do 
		{
			MOTORDriveRaw(1,21);
			MOTORDriveRaw(2,-19);
            
		} while (abs(ENCODERRead(2)) < 218);
        
		MOTORDriveRaw(1,0);
		MOTORDriveRaw(2,0);
    }
    else if (turn == 1)    //左转
    {
        ENCODERReset(1);
		ENCODERReset(2);
		do 
		{
			MOTORDriveRaw(1,-21);
			MOTORDriveRaw(2,19);

		} while (abs(ENCODERRead(2)) < 240);
		
		MOTORDriveRaw(1,0);
		MOTORDriveRaw(2,0);
	}
    else if (turn == 2)     //掉头
    {
        ENCODERReset(1);
		ENCODERReset(2);
		do 
		{
			MOTORDriveRaw(1,21);
			MOTORDriveRaw(2,-19);
		
		} while (abs(ENCODERRead(2)) < 500);
		MOTORDriveRaw(1,0);
		MOTORDriveRaw(2,0);
    }
    else 
    {
        cout << "errer" << endl;
    }
}