G I D 4 0 6 1
Model Name: Rockhopper-46/62
G I D 4 0 6 1
Model Name: Rockhopper-46/62
Origin Detection Sequence
Origin Detection Sequence
[Moves 10 mm towards B]
[Moves (50 mm) towards A until origin sensor goes off]
No
< Moved 50 mm without sensor going off ? >
Yes
[Faulty sensor error]
[Let current position be "a"]
[Moves 5 mm towards A]
[Moves (35 mm) towards B until origin sensor goes off]
< Moved 35 mm without sensor going off ? >
Yes
No
[Let current position be "b"]
[Set the origin between points "a" and "b"]
[Moves to origin]
[End]
