mida 14
;-------------------------------------------------------------
;Aplicación 	-> 
;Fecha		-> 
;-------------------------------------------------------------

scan		equ	99

;programa principal---------------------------------------

&ini		ld	scan
		jz	&lea
		jmp	ini0
&lea		call	&leavar

ini0		nop

		call	disp

		ld	arr
		and	izq
		jnz	ini2
		jmp	ini4

ini2		call	cali

ini4		

inif		end

;--------------------------------------
;disp.

disp		ink	ent		;scroll de variables segun
		jnz	disp1		;valor de scro
		jmp	disp2

disp1		inc	scro	1
		movri	scro
		movci	4
		cpgi	disp11
		jmp	disp2

disp11	movci	0
		stoi	scro

disp2		movri	scro		;scro=0 muestra voltajes
		movci	0
		cpei	disp21
		jmp	disp3

disp21	set	118
		reset	119
		reset	120
		reset	121
		reset	122

		movif	v1i
		movrf	v1k
		mulf
		stof	v1o
		movrf	v1o
		movrf	v1b
		addf
		stof	v1o
		clear
		disrf	v1o	41
		com	0

		movif	v2i
		movrf	v2k
		mulf
		stof	v2o
		movrf	v2o
		movrf	v2b
		addf
		stof	v2o
		clear
		disrf	v2o	41
		com	1

		movif	v3i
		movrf	v3k
		mulf
		stof	v3o
		movrf	v3o
		movrf	v3b
		addf
		stof	v3o
		clear
		disrf	v3o	41
		com	2

disp3		movri	scro		;scro=1 muestra corrientes
		movci	1
		cpei	disp31
		jmp	disp4 

disp31	reset	118
		set	119
		reset	120
		reset	121
		reset	122

		movif	i1i
		movrf	i1k
		mulf
		stof	i1o
		movrf	i1o
		movrf	i1b
		addf
		stof	i1o
		clear
		disrf	i1o	41
		com	0

		movif	i2i
		movrf	i2k
		mulf
		stof	i2o
		movrf	i2o
		movrf	i2b
		addf
		stof	i2o
		clear
		disrf	i2o	41
		com	1

		movif	i3i
		movrf	i3k
		mulf
		stof	i3o
		movrf	i3o
		movrf	i3b
		addf
		stof	i3o
		clear
		disrf	i3o	41
		com	2

disp4		movri	scro		;scro=2 muestra t y h y p
		movci	2
		cpei	disp41
		jmp	disp5

disp41	reset	118		
		reset	119
		set	120
		reset	121
		reset	122

		clear
		disrf	teo	41
		com	0

		clear
		disrf	huo	41
		com	1


		movif	v1i		;recalculo voltajes
		movrf	v1k
		mulf
		stof	v1o
		movrf	v1o
		movrf	v1b
		addf
		stof	v1o

		movif	v2i
		movrf	v2k
		mulf
		stof	v2o
		movrf	v2o
		movrf	v2b
		addf
		stof	v2o

		movif	v3i
		movrf	v3k
		mulf
		stof	v3o
		movrf	v3o
		movrf	v3b
		addf
		stof	v3o

		movif	i1i		;recalculo corrientes
		movrf	i1k
		mulf
		stof	i1o
		movrf	i1o
		movrf	i1b
		addf
		stof	i1o

		movif	i2i
		movrf	i2k
		mulf
		stof	i2o
		movrf	i2o
		movrf	i2b
		addf
		stof	i2o

		movif	i3i
		movrf	i3k
		mulf
		stof	i3o
		movrf	i3o
		movrf	i3b
		addf
		stof	i3o

		movrf	v1o		;potencia 1
		movrf	i1o
		mulf
		stof	p1o

		movrf	v2o		;potencia2
		movrf	i2o
		mulf
		stof	p2o

		movrf	v3o		;potencia3
		movrf	i3o
		mulf
		stof	p3o

		movrf	p1o		;potencia total
		movrf	p2o
		addf
		movrf	p3o
		addf
		stof	pt
		
		clear
		disrf	pt	4
		com	2

disp5		movri	scro		;scro=0 muestra voltajesxtap
		movci	3
		cpei	disp51
		jmp	disp6

disp51	reset	118
		reset	119
		reset	120
		set	121
		reset	122

		movif	v1i
		movrf	v1k
		mulf
		stof	v1o
		movrf	v1o
		movrf	v1b
		addf
		stof	v1o
		
		movrf	vtap
		movrf	vmax
		divf
		movcf	2
		divf
		movrf	v1o
		mulf
		stof	v1otap
		clear
		disrf	v1otap	41
		com	0

		movif	v2i
		movrf	v2k
		mulf
		stof	v2o
		movrf	v2o
		movrf	v2b
		addf
		stof	v2o

		movrf	vtap
		movrf	vmax
		divf
		movcf	2
		divf
		movrf	v2o
		mulf
		stof	v2otap
		clear
		disrf	v2otap	41
		com	1

		movif	v3i
		movrf	v3k
		mulf
		stof	v3o
		movrf	v3o
		movrf	v3b
		addf
		stof	v3o

		movrf	vtap
		movrf	vmax
		divf
		movcf	2
		divf
		movrf	v3o
		mulf
		stof	v3otap
		clear
		disrf	v3otap	41
		com	2

disp6		movri	scro		;scro=1 muestra corrientes
		movci	4
		cpei	disp61
		jmp	dispf

disp61	reset	118
		reset	119
		reset	120
		reset	121
		set	122

		movif	i1i
		movrf	i1k
		mulf
		stof	i1o
		movrf	i1o
		movrf	i1b
		addf
		stof	i1o

		movrf	itap
		movrf	imax
		divf
		movcf	2
		divf
		movrf	i1o
		mulf
		stof	i1otap
		clear
		disrf	i1otap	41
		com	0

		movif	i2i
		movrf	i2k
		mulf
		stof	i2o
		movrf	i2o
		movrf	i2b
		addf
		stof	i2o

		movrf	itap
		movrf	imax
		divf
		movcf	2
		divf
		movrf	i2o
		mulf
		stof	i2otap
		clear
		disrf	i2otap	41
		com	1

		movif	i3i
		movrf	i3k
		mulf
		stof	i3o
		movrf	i3o
		movrf	i3b
		addf
		stof	i3o

		movrf	itap
		movrf	imax
		divf
		movcf	2
		divf
		movrf	i3o
		mulf
		stof	i3otap
		clear
		disrf	i3otap	41
		com	2

dispf		ret

;--------------------------------------
;cali.

cali		clear
		disl	calib
		com	0
		clear
		disl	e-c
		com	1
		ink	ent
		jnz	cali1

		ink	cle
		jnz	calif
		jmp	cali

cali1		clear
		disl	cien
		com	0
		clear
		disl	e-c
		com	1
		clear
		com	2

		ink	ent
		jnz	cali11

		ink	cle
		jnz	calif
		jmp	cali1


cali11	movri	v1i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	v2i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	v3i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	i1i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	i2i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	i3i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

cali2		movif	v1i
		stof	v1xh
		
		movif	v2i
		stof	v2xh

		movif	v3i
		stof	v3xh

		movif	i1i
		stof	i1xh

		movif	i2i
		stof	i2xh

		movif	i3i
		stof	i3xh


cali3		clear
		disl	cincu
		com	0
		clear
		disl	e-c
		com	1
		clear
		com	2

		ink	ent
		jnz	cali31

		ink	cle
		jnz	calif
		jmp	cali3

cali31	movri	v1i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	v2i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	v3i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	i1i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	i2i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

		movri	i3i		;si es 0 el valor fuera....
		movci	0
		cpei	calif

cali4		movif	v1i
		stof	v1xl
		
		movif	v2i
		stof	v2xl

		movif	v3i
		stof	v3xl

		movif	i1i
		stof	i1xl

		movif	i2i
		stof	i2xl

		movif	i3i
		stof	i3xl

cali5		movrf	v1xh
		movrf	v1xl
		subf
		stof	v1x
		movrf	vmax
		movrf	v1x
		divf
		stof	v1k
		
		movrf	v1k
		movrf	v1xl
		mulf
		stof	v1mx
		movrf	vmax
		movrf	v1mx
		subf
		stof	v1b


		movrf	v2xh
		movrf	v2xl
		subf
		stof	v2x
		movrf	vmax
		movrf	v2x
		divf
		stof	v2k

		movrf	v2k
		movrf	v2xl
		mulf
		stof	v2mx
		movrf	vmax
		movrf	v2mx
		subf
		stof	v2b



		movrf	v3xh
		movrf	v3xl
		subf
		stof	v3x
		movrf	vmax
		movrf	v3x
		divf
		stof	v3k

		movrf	v3k
		movrf	v3xl
		mulf
		stof	v3mx
		movrf	vmax
		movrf	v3mx
		subf
		stof	v3b


		movrf	i1xh
		movrf	i1xl
		subf
		stof	i1x
		movrf	imax
		movrf	i1x
		divf
		stof	i1k

		movrf	i1k
		movrf	i1xl
		mulf
		stof	i1mx
		movrf	imax
		movrf	i1mx
		subf
		stof	i1b


		movrf	i2xh
		movrf	i2xl
		subf
		stof	i2x
		movrf	imax
		movrf	i2x
		divf
		stof	i2k

		movrf	i2k
		movrf	i2xl
		mulf
		stof	i2mx
		movrf	imax
		movrf	i2mx
		subf
		stof	i2b


		movrf	i3xh
		movrf	i3xl
		subf
		stof	i3x
		movrf	imax
		movrf	i3x
		divf
		stof	i3k

		movrf	i3k
		movrf	i3xl
		mulf
		stof	i3mx
		movrf	imax
		movrf	i3mx
		subf
		stof	i3b


		
calif		ret
;-------------------------------------------

&leavar
;[REG_RELAYS]

ent		equ	30
cle		equ	31
arr		equ	32
izq		equ	33
 
;[REG_INTEGERS] 

v1i		equ	110
v2i		equ	111
v3i		equ	112
i1i		equ	113
i2i		equ	114
i3i		equ	115
tei		equ	116
hui		equ	117

scro		equ	120	;scroll para display

;[REG_FLOATS]

i1o		equ	120	;corriente 1 entregada
i2o		equ	121
i3o		equ	122
v1o		equ	123
v2o		equ	124
v3o		equ	125
teo		equ	126
huo		equ	127

v1k		equ	130	;factor de v1
v2k		equ	131
v3k		equ	132
i1k		equ	133
i2k		equ	134
i3k		equ	135
tek		equ	136
huk		equ	137

v1xl		equ	140
v2xl		equ	141
v3xl		equ	142
i1xl		equ	143
i2xl		equ	144
i3xl		equ	145

v1xh		equ	150
v2xh		equ	151
v3xh		equ	152
i1xh		equ	153
i2xh		equ	154
i3xh		equ	155

v1x		equ	160
v2x		equ	161
v3x		equ	162
i1x		equ	163
i2x		equ	164
i3x		equ	165

v1b 		equ	170
v2b		equ	171
v3b		equ	172
i1b		equ	173
i2b		equ	174
i3b		equ	175

v1mx		equ	180
v2mx		equ	181
v3mx		equ	182
i1mx		equ	183
i2mx		equ	184
i3mx		equ	185

p1o		equ	190
p2o		equ	191
p3o		equ	192
pt		equ	193

vtap		equ	200
itap		equ	201

vmax		equ	202	;vmax patron
imax		equ	203	;imax patron

v1otap	equ	210
v2otap	equ	211
v3otap	equ	212
i1otap	equ	213
i2otap	equ	214
i3otap	equ	215

;[TIM] 

;[CNT] 

;[NOP]

calib		lite	"V-I"
e-c		lite	"E-C?"
cien		lite	"100"
cincu		lite	"50"

;inicio variables

		movcf	60
		stof	vmax

		movcf	2.5
		stof	imax

&leavarf		ret


;-----------------------------------------------
INICIO		nop
FIN		end