Me ? Help ? I was just suggesting a way to avoid the post length limit 8)
Seriously, though... I'll have a look at the code. I've never used a servo, let alone built a self-sustaining robot (very nice project of your, btw!). I hope I can be of some help nonetheless.
