Alle 4 Erkennugnsmethoden implementiert
TODO: Test
TODO: Umrechnung auf Nao Raum (einfache addition/subtraktion mit 180° bzw. 90°)
TODO: Programm beendet sich nicht richtig beim Debuggen