added class robot and improuve reduce angle