How to make code for robot like R-Hex