#include enc_test 

#include "stdio.h"
#include "unistd.h"
#include "func_extern.h"
//#include "pwm_enc.h"
 
int main()
{
	float alw,arw;
	int br;

	FILE *fp;

//	pwm_cm_data(thetal,thetar);
	pwm_both_data(0, 0);
	pwm_enco_start(10000);

	//usleep(5000);

	while(1){
		encoder_data2(&alw,&arw,&br);
		printf("%f %f \n",alw,arw);
	}
	fclose(fp);
	pwm_both_data(0, 0);
	usleep(1000);
	pwm_enco_stop();
	printf("Program stopped\n");
	return 0;
}