HI

This is very good!
You implimated the PWM (Pulse Width Modultaion ?? ) very well!

How do you calculate the radien in the wall-following-algorithm, and how do you convert them into PWM?

have fun,
Tobi