Self balancing robot Part3 – Sketch

Before finishing robot , recommanded prepare main board and test everything.  You can download arduino sketch with library.