bk_bishe_pi/bot_code/maze_func_turn.cpp

#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)
    {
        MOTORDriveRaw(1,24);
        MOTORDriveRaw(2,-22);

        OSWait(1985);

        MOTORDriveRaw(1,0);
        MOTORDriveRaw(2,0);
    }
    else if (turn == -1)
    {
        MOTORDriveRaw(1,-24);
        MOTORDriveRaw(2,22);

        OSWait(1985);

        MOTORDriveRaw(1,0);
        MOTORDriveRaw(2,0);
    }
    else if (turn == 2)
    {
        MOTORDriveRaw(1,24);
        MOTORDriveRaw(2,-22);

        OSWait(2985);

        MOTORDriveRaw(1,0);
        MOTORDriveRaw(2,0);
    }
    else 
    {
        cout << "errer" << endl;
    }
}