Add TEST definition

Signed-off-by: Eduardo L. Buratti <elb09@c3sl.ufpr.br>
Fix scale of IR sensors distance

Signed-off-by: Eduardo L. Buratti <elb09@c3sl.ufpr.br>