/*===========================================================================*/
|
/*===========================================================================*/
|
/* Copyright (C) 2001 Authors */
|
/* Copyright (C) 2001 Authors */
|
/* */
|
/* */
|
/* This source file may be used and distributed without restriction provided */
|
/* This source file may be used and distributed without restriction provided */
|
/* that this copyright statement is not removed from the file and that any */
|
/* that this copyright statement is not removed from the file and that any */
|
/* derivative work contains the original copyright notice and the associated */
|
/* derivative work contains the original copyright notice and the associated */
|
/* disclaimer. */
|
/* disclaimer. */
|
/* */
|
/* */
|
/* This source file is free software; you can redistribute it and/or modify */
|
/* This source file is free software; you can redistribute it and/or modify */
|
/* it under the terms of the GNU Lesser General Public License as published */
|
/* it under the terms of the GNU Lesser General Public License as published */
|
/* by the Free Software Foundation; either version 2.1 of the License, or */
|
/* by the Free Software Foundation; either version 2.1 of the License, or */
|
/* (at your option) any later version. */
|
/* (at your option) any later version. */
|
/* */
|
/* */
|
/* This source is distributed in the hope that it will be useful, but WITHOUT*/
|
/* This source is distributed in the hope that it will be useful, but WITHOUT*/
|
/* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or */
|
/* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or */
|
/* FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public */
|
/* FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public */
|
/* License for more details. */
|
/* License for more details. */
|
/* */
|
/* */
|
/* You should have received a copy of the GNU Lesser General Public License */
|
/* You should have received a copy of the GNU Lesser General Public License */
|
/* along with this source; if not, write to the Free Software Foundation, */
|
/* along with this source; if not, write to the Free Software Foundation, */
|
/* Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA */
|
/* Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA */
|
/* */
|
/* */
|
/*===========================================================================*/
|
/*===========================================================================*/
|
/* HARDWARE MULTIPLIER */
|
/* HARDWARE MULTIPLIER */
|
/*---------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
/* Test the hardware multiplier: */
|
/* Test the hardware multiplier: */
|
/* - MACS mode. */
|
/* - MACS mode. */
|
/* */
|
/* */
|
/* Author(s): */
|
/* Author(s): */
|
/* - Olivier Girard, olgirard@gmail.com */
|
/* - Olivier Girard, olgirard@gmail.com */
|
/* */
|
/* */
|
/*---------------------------------------------------------------------------*/
|
/*---------------------------------------------------------------------------*/
|
/* $Rev: 18 $ */
|
/* $Rev: 18 $ */
|
/* $LastChangedBy: olivier.girard $ */
|
/* $LastChangedBy: olivier.girard $ */
|
/* $LastChangedDate: 2009-08-04 23:44:12 +0200 (Tue, 04 Aug 2009) $ */
|
/* $LastChangedDate: 2009-08-04 23:44:12 +0200 (Tue, 04 Aug 2009) $ */
|
/*===========================================================================*/
|
/*===========================================================================*/
|
|
|
.global main
|
.include "pmem_defs.asm"
|
|
|
.set WDTCTL, 0x0120
|
|
|
|
.set MPY, 0x0130
|
|
.set MPYS, 0x0132
|
|
.set MAC, 0x0134
|
|
.set MACS, 0x0136
|
|
.set OP2, 0x0138
|
|
.set RESLO, 0x013A
|
|
.set RESHI, 0x013C
|
|
.set SUMEXT, 0x013E
|
|
|
|
|
.global main
|
|
|
main:
|
main:
|
|
|
/* -------------- SIGNED MULTIPLY ACCUMULATE --------------- */
|
/* -------------- SIGNED MULTIPLY ACCUMULATE --------------- */
|
|
|
;; Disable watchdog
|
;; Disable watchdog
|
mov #0x5A80, &WDTCTL
|
mov #0x5A80, &WDTCTL
|
|
|
;; Initialize variables
|
;; Initialize variables
|
mov #0x0000, R15
|
mov #0x0000, R15
|
mov #0x0000, R8
|
mov #0x0000, R8
|
mov #0x0000, R9
|
mov #0x0000, R9
|
|
|
mpy_loop:
|
mpy_loop:
|
|
|
;; Initialize RESLO and RESHI to make sure it is added
|
;; Initialize RESLO and RESHI to make sure it is added
|
mov #0x0000, &RESLO
|
mov #0x0000, &RESLO
|
mov #0xC000, &RESHI
|
mov #0xC000, &RESHI
|
|
|
;; Perform unsigned R8*R9
|
;; Perform unsigned R8*R9
|
mov R8, &MACS
|
mov R8, &MACS
|
mov R9, &OP2
|
mov R9, &OP2
|
|
|
;; Read result
|
;; Read result
|
mov &RESLO, R10
|
mov &RESLO, R10
|
mov &RESHI, R11
|
mov &RESHI, R11
|
mov &SUMEXT, R12
|
mov &SUMEXT, R12
|
|
|
;; Notify verilog checker
|
;; Notify verilog checker
|
add #1, R15
|
add #1, R15
|
|
|
;; Update next OP1 (R8)
|
;; Update next OP1 (R8)
|
cmp #0xF0F0, R8
|
cmp #0xF0F0, R8
|
jeq op2_update
|
jeq op2_update
|
|
|
mov #0x00FF, R7
|
mov #0x00FF, R7
|
and R8, R7
|
and R8, R7
|
cmp #0x00F0, R7
|
cmp #0x00F0, R7
|
jeq op1_hi_update
|
jeq op1_hi_update
|
|
|
add #0x0010, R8
|
add #0x0010, R8
|
jmp mpy_loop
|
jmp mpy_loop
|
op1_hi_update:
|
op1_hi_update:
|
and #0xff00, R8
|
and #0xff00, R8
|
add #0x1000, R8
|
add #0x1000, R8
|
jmp mpy_loop
|
jmp mpy_loop
|
|
|
|
|
;; Update next OP2 (R9)
|
;; Update next OP2 (R9)
|
op2_update:
|
op2_update:
|
cmp #0xF0F0, R9
|
cmp #0xF0F0, R9
|
jeq end_of_test
|
jeq end_of_test
|
|
|
mov #0x0000, R8
|
mov #0x0000, R8
|
|
|
mov #0x00FF, R7
|
mov #0x00FF, R7
|
and R9, R7
|
and R9, R7
|
cmp #0x00F0, R7
|
cmp #0x00F0, R7
|
jeq op2_hi_update
|
jeq op2_hi_update
|
|
|
add #0x0010, R9
|
add #0x0010, R9
|
jmp mpy_loop
|
jmp mpy_loop
|
op2_hi_update:
|
op2_hi_update:
|
and #0xff00, R9
|
and #0xff00, R9
|
add #0x1000, R9
|
add #0x1000, R9
|
jmp mpy_loop
|
jmp mpy_loop
|
|
|
|
|
|
|
/* ---------------------- END OF TEST --------------- */
|
/* ---------------------- END OF TEST --------------- */
|
end_of_test:
|
end_of_test:
|
nop
|
nop
|
br #0xffff
|
br #0xffff
|
|
|
|
|
|
|
|
|
/* ---------------------- INTERRUPT VECTORS --------------- */
|
/* ---------------------- INTERRUPT VECTORS --------------- */
|
|
|
.section .vectors, "a"
|
.section .vectors, "a"
|
.word end_of_test ; Interrupt 0 (lowest priority)
|
.word end_of_test ; Interrupt 0 (lowest priority)
|
.word end_of_test ; Interrupt 1
|
.word end_of_test ; Interrupt 1
|
.word end_of_test ; Interrupt 2
|
.word end_of_test ; Interrupt 2
|
.word end_of_test ; Interrupt 3
|
.word end_of_test ; Interrupt 3
|
.word end_of_test ; Interrupt 4
|
.word end_of_test ; Interrupt 4
|
.word end_of_test ; Interrupt 5
|
.word end_of_test ; Interrupt 5
|
.word end_of_test ; Interrupt 6
|
.word end_of_test ; Interrupt 6
|
.word end_of_test ; Interrupt 7
|
.word end_of_test ; Interrupt 7
|
.word end_of_test ; Interrupt 8
|
.word end_of_test ; Interrupt 8
|
.word end_of_test ; Interrupt 9
|
.word end_of_test ; Interrupt 9
|
.word end_of_test ; Interrupt 10 Watchdog timer
|
.word end_of_test ; Interrupt 10 Watchdog timer
|
.word end_of_test ; Interrupt 11
|
.word end_of_test ; Interrupt 11
|
.word end_of_test ; Interrupt 12
|
.word end_of_test ; Interrupt 12
|
.word end_of_test ; Interrupt 13
|
.word end_of_test ; Interrupt 13
|
.word end_of_test ; Interrupt 14 NMI
|
.word end_of_test ; Interrupt 14 NMI
|
.word main ; Interrupt 15 (highest priority) RESET
|
.word main ; Interrupt 15 (highest priority) RESET
|
|
|