Go to reference, switches and dog detect origin, combine with pulse from encoder