self balance robot code for dead spot help needed