
;Symbols 
{
symbol varA = b0
symbol varB = b1
symbol varC = b2
symbol varD = b3
symbol varE = b4
symbol varF = b5
symbol varG = b6
symbol varH = b7
symbol varI = b14
symbol varJ = b15
symbol varK = b16
symbol varL = b17
symbol varM = b18
symbol varN = b19
symbol varO = b20
symbol varP = b21
symbol varQ = b22
symbol varR = b23
symbol varS = b24
symbol varT = b25
symbol timer = time
}


let dirsC = %00000111


main:
	symbol SMA_pin     = 1
	symbol SMA_stop    = 150
	symbol SMA_speed   = 60
	symbol SMA_forward = SMA_stop - SMA_speed
	symbol SMA_back    = SMA_stop + SMA_speed
	symbol SMB_pin     = 2
	symbol SMB_stop    = 150
	symbol SMB_speed   = 60
	symbol SMB_forward = SMB_stop + SMB_speed
	symbol SMB_back    = SMB_stop - SMB_speed

		servo SMA_pin, SMA_stop
		servo SMB_pin, SMB_stop

		servopos SMA_pin , SMA_forward
		servopos SMB_pin , SMB_forward

label_331:
		if pinC.3 = 1 then label_334	'Decision command
		if pinC.4 = 1 then label_319	'Decision command
		goto label_331

label_319:		servopos SMA_pin , SMA_back
		servopos SMB_pin , SMB_back

		pause 200	'Wait command
			servopos SMA_pin , SMA_forward
		servopos SMB_pin , SMB_back

label_330:	pause 200	'Wait command
		goto label_331

label_334:		servopos SMA_pin , SMA_back
		servopos SMB_pin , SMB_back

		pause 200	'Wait command
			servopos SMA_pin , SMA_back
		servopos SMB_pin , SMB_forward

		goto label_330



