Working IR + encoder autonomous
Resolve merge