Path finding MSP430 IR sensor robot