Ich würde das Problem anders angehen: Die Vorgsben nehmen und den Roboter anpassen! Zum Beispiel die RoboCup Regeln (robocup-german-open.de) hernehmen und dann schauen, wie du deinen Roboter verädnern musst.

lg skg-rob