view code_part1/OSTC_code_asm_part1/spbrgselect.inc @ 132:49bb155ddfbf

Fix altimeter after simulator (zero divide -> 32767m)
author JeanDo
date Wed, 05 Jan 2011 00:14:44 +0100
parents 96a35aeda5f2
children
line wrap: on
line source

RoundResult SET 0				; Rounding function.  RoundResult = Round(aa/bb)

Round	macro aa,bb

	LOCAL rr = aa/bb

	LOCAL d1 = aa - rr*bb

	LOCAL d2 = (rr+1)*bb - aa

RoundResult = rr

	if d1 >= d2

RoundResult++

	endif

	endm



AbsResult SET 0

Abs		macro nr

	if nr>=0

AbsResult = nr

	else

AbsResult = -nr

	endif

	endm

		

	Round xtal,(16*baud)

spbrg_value EQU RoundResult-1



	Round xtal,(16*(spbrg_value+1))

baud_real EQU RoundResult

	Abs(baud_real-baud)

errpercent EQU AbsResult*100/baud

	if errpercent > 4

		ERROR big error in baudrate: #v(errpercent)%

	endif

	if errpercent >= 2

		messg baudrate not exact: #v(errpercent)%

	endif