#include <isrg_robot2006.h>
#include <math.h>
#include <stdio.h>

void my_move (double distance, double angle);

int main()
{
	isrg_robot_init ();
	isrg_robot_set_easy_mode (1);
	
	while  (1)
	{
		printf("Here we go\n");
		my_move(0.5 , M_PI/2);
	}

}

void my_move (double distance, double angle)
{
	while (isrg_robot_move_finished () == 0)
	{
	}
	isrg_robot_move (distance, angle);
}