Partea de motricitate - Saptamana a 9-a

Am incercat (si am si reusit) sa implementam un o parte din "modul de gandire" a lui Fryan. Fryan are 3 motorase - unul care realizeaza "invartirea" pamatufului (cuplat in momentrul de fata pe portul C), unul care realizeaza coborarea bratului care va lua obiectele (in acest moment conectat pe portul B), si unul care va prinde obiectul respectiv(inca neconectat). Motorasul care invarte pamatuful se afla in miscare. In momentul in care senzorul Sonar gaseste un obiect aflat la o distanta mai mica de o anumita valoare (momentan ea are valoarea 30, dar in cel mai scurt timo va fi ajustata in functie de lungimea bratului), motorasul C se opreste si incepe coborarea bratului (motorul B intra in functiune). Va urma ca motorul B, dupa ce a coborat bratul, sa induca o miscare de sens invers care sa readuca bratul in pozitia initiala. In acel moment, robotelul va inainta, va sterge praful de sub obiectul respectiv si va aseza din nou obiectul in pozitia din care l-a luat (sau mai exact o pozitie apropiata). Acest lucru va fi implementat in saptamanile ce vor veni.