نوشتن برنامه ربات مسیریاب

[skh1300]

با عرض سلام و خسته نباشید خدمت اساتیدمحترم
من با یکی از دوستان شروع به ساخت یک ربات مسیریاب کردیم حالا مرحله الکترونیک و مکانیک تمام شده حالا می خوام برنامه اش بنویسیم
توضیحات:ما یه میکرو Atmega 32 را که Port aبرای سنسورها , port b برای چرخها می باشد
(سنسور ها را به صورت ^ بستیم) حالا می خوام برنامه اش را بنویسیم راسیتش زبان c را خیلی بلد نیستم (تا حالا کلاس نرفتم و فقط چند تا pdf در مورد نوشتن دستورات خوندم)با کد ویژن تا حدودی کار کردم اما خیلی خوب بلد نیستم حالا می خواستم کمکم کنید که چگونه باید برنامه اش را بنویسم
کمک کنید چگونه برنامش را بنویسم
شکل سنور ها را ضمیمه کردم

[ALI cv-c]

شما باید یک هوش مصنویی با یک سری if درست کنی که مثلا اگه پایه ی وسط جلو و وسط عقب سیاه بود یا سرعت بالا،وسط جلو سیاه و وسط عقب سفید با سرعت کم و ...
من با سی کار میکنم ولی کد ویژن یکم سخته...