Subversion Repositories signed_unsigned_multiplier_and_divider

' ============================================================================

'

' {$STAMP BS2}

' {$PBASIC 2.5}

' ============================================================================

' -----[ Pins/Constants/Variables ]-------------------------------------------

SDA            PIN      14  'P0 transceives to/from SDA

SCL            PIN      15  'P1 sends clock pulses

START          PIN      13  'Button to select true/magnetic north mode

DRDY           PIN      12  'Indicates data is ready

' ---------- DL1414 constants and variables ---------------------

D0  PIN 0

D1  PIN 1

D2  PIN 2

D3  PIN 3

D4  PIN 4

D5  PIN 5

D6  PIN 6

nWE74 PIN 9

nWE30 PIN 8

A0    PIN 10

A1    PIN 11

char VAR Byte

led VAR Byte

i VAR Byte

Arg0 VAR Word

Arg1 VAR Word

N     VAR Word

M     VAR Word

Digits DATA "0123456789ABCDEF"

'LedBufferLen CON 8

'LedBuffer VAR Byte(LedBufferLen)

' -----[ Main Routine ]-------------------------------------------------------

  DIRS = %0000111101111111

  GOSUB ClearDisplay

  GOSUB TestAll

WaitForStart:

  'DEBUG CLS

  DEBUG CR, "From:" : DEBUGIN DEC5 Arg0

  DEBUG CR, "  To:" : DEBUGIN DEC5 Arg1

  'IF (START = 1) THEN GOTO WaitForStart

  i = 0

  n = Arg0

LoopN:

  IF (n > Arg1) THEN GOTO WaitForStart

  IF (n < 2) THEN GOTO NextN

  IF (n < 4) THEN GOTO FoundPrime '2, 3

  m = 1

NextM:

  m = m + 1

  'DEBUG CR, "Trying n = ", DEC n, " m = ", DEC m

  IF (n // m = 0) THEN GOTO NextN

  IF (m * m >= n) THEN GOTO FoundPrime

  GOTO NextM

FoundPrime:

  GOSUB PrintN

NextN:

  n = n + 1

  GOTO LoopN

PrintN:

  i = i + 1

  DEBUG CR, "(", DEC i, ") PRIME = ", DEC N

  RETURN

' ----- Display on 2 DL1414 LEDs ------------------------------------------

DisplayCharOnLed:

    char = char & %01111111 ' only 7 pins for character data

    IF (char >= "a") AND (char <="z") THEN   ' convert lowercase to uppercase

      char = char - 32

    ENDIF

    OUTL = char ' put code to data lines

    LOOKUP (led & %00000011), [%11110011, %11110111, %11111011, %11111111], OUTH ' put out address for digits

    IF ((led & 7) > 3) THEN

      'DEBUG "displayed '", STR char,"' on lower DL1414 position ",DEC pos,CR

      LOW nWE74

      HIGH nWE74

    ELSE

      'DEBUG "displayed '", STR char,"' on upper DL1414 position ",DEC pos,CR

      LOW nWE30

      HIGH nWE30

    ENDIF

    'led = led - 1

RETURN

TestAll:

  FOR char = %00100000 TO %01011111

    FOR led = 0 TO 7

      GOSUB DisplayCharOnLed

    NEXT

    'PAUSE 100

  NEXT

  GOSUB ClearDisplay

RETURN

ClearDisplay:

  char = " "

  led = 7

  FOR i = 0 TO 7

    'LedBuffer(led) = char

    GOSUB DisplayCharOnLed

  NEXT

RETURN