Nibobee Servo Ansteuerung für US

[radbruch]

Eines meiner vielen unfertigen Projekte:
https://www.roboternetz.de/community...l=1#post436013


Echo ist ein Array in das ich die Sharpwerte der Positionen speichere:

	uint16_t echo[16];

	while(1)
	{
	   servo=35+servopos*10;
	   delay(100);
	   echo[14-servopos]=analog_getValue(ANALOG_EXT3);
	   if((servopos==0) || (servopos==14))
		{
			for(c=0; c<15; c++)
			{
				writeInteger(echo[c], 10);
			   writeString("-");
			}
			writeString("\n\r");
	   }
	   servopos+=schwenk;
	   if(!servopos) schwenk=1; else if(servopos==14) schwenk=-1;
	}

Nach jedem Schwenk werden die Daten gesendet.