/*
 *   Motor Check Program (LegOS)
 *
 *   Mortor => A , Rotation Sensor => 1
 */

#include <conio.h>
#include <dmotor.h>
#include <unistd.h>
#include <dsensor.h>
#include <time.h>

int main(void) 
{
	int time1 = 0;
	int time2 = 0;
	
	ds_active(&SENSOR_1);
	ds_rotation_set(&SENSOR_1,0);
	ds_rotation_on(&SENSOR_1);
	motor_a_speed(MAX_SPEED);

	time1 = sys_time;

	while (time2 < 10000){
		lcd_int(ROTATION_1);
		motor_a_dir(rev);
		time2 = sys_time;
		time2 -= time1;
	}
	motor_a_dir(brake);
	ds_rotation_off(&SENSOR_1);
	return 0;
}