/* part1: read sensor values */
.global main
main:
	.equ ADDR_JP1, 0x10000060 /* address GPIO JP1 */
	movia r8, ADDR_JP1
	movia r10, 0x07f557ff /* set direction for motors and sensors to output and sensor data register to inputs */
	stwio r10, 4(r8)

POLL:
	movia r11, 0xfffffbff /* enable sensor 0, disable all motors */
	stwio r11, 0(r9)

	movia r12, 0xffffefff /* enable sensor 1, disable all motors */
	stwio r12, 0(r13)

	bgtu r11, r12, RIGHT
	bgtu r12, r11, LEFT
	beq r11, r12, turn_off_motor

RIGHT:
	movia  r16, 0xfffffffc
	stwio  r16, 0(r8)
	br POLL

LEFT:
	movia  r16, 0xfffffffc
  	stwio  r16, 0(r8)
	br POLL

turn_off_motor:
	movia  r16, 0xffffffff
	stwio  r16, 0(r8)
	br POLL