; --------------------------------------------------------------------------------
; @Title: pSOS+ Demo for TRACE32 OS Awareness
; @Description:
;
;   This batchfile loads all necessary files to demonstrate
;   the RTOS-Debugger for pSOS+2.2.2 in stand-alone-mode.
;
;
; @Keywords: psos, RTOS, v22x
; @Author: DIE
; @Copyright: (C) 1989-2014 Lauterbach GmbH, licensed for use with TRACE32(R) only
; --------------------------------------------------------------------------------
; $Id: psos.cmm 13125 2018-09-11 14:03:01Z rdienstbeck $

;   Created by Matthias Hecht, Christine Sontheim /
;   Lauterbach GmbH at 12.03.99

LOCAL &base
GLOBAL &addr

 PRINT "resetting ..."
 RESet
 WinCLEAR

 SCREEN.ON

 IF ICE()
 (
   PRINT "demo only available for ICD"
   ENDDO
 )

 IF CPU()!="MPC860"
 (
   PRINT "demo only available for MPC860"
   ENDDO
 )

 ;Chip Selects
 IF ICD()
 (
   PRINT "initializing ..."
   SYStem.Up
   &base=Data.Long(spr:638.)

   ;disable watchdog
   Data.Set &base+0x004 %Long 0x0ffffff88

   ; ???
   Data.Set spr:638. %Long 0x02200000
   &base=0x2200000

   ;SIUMCR
   Data.Set &base+0x000 %Long 0x0602000

   ;TBSCR
   Data.Set &base+0x200 %Long 0x0966b0002

   ;RTCSC
   Data.Set &base+0x220 %Long 0x08a6b0002

   ;PISCR
   Data.Set &base+0x240 %Long 0x0a66b0002

   GOSUB MBXUPM

   ;MPTPR
   Data.Set &base+0x17a %Word 0x0200

   ;MAMR
   Data.Set &base+0x170 %Long 0x013821000

   ;OR0
   Data.Set &base+0x104 %Long 0x0FFF00ff4

   ;BR0
   Data.Set &base+0x100 %Long 0x020000001

   ;OR1
   Data.Set &base+0x10c %Long 0x0FFC00500

   ;BR1
   Data.Set &base+0x108 %Long 0x000000081

   ;BR7 (Dummy)
    Data.Set C:&base+0x138 %Long 0x02100001

   ;OR7 (Dummy)
   Data.Set C:&base+0x13c %Long  0x0FFF00120
 )


 ; load sample application
 PRINT "loading sample application..."
 Data.LOAD.Elf ram.elf /LPATH /StripPATH
 Register.Set ip START
 Register.Set r1 Initial_Sp

 ; initialize mutitasking support
 PRINT "initializing RTOS support..."
 task.ext.debug 0x1
 TASK.CONFIG psos

 ;additional psos menu
 PRINT "initializing psos menu ..."
 MENU.ReProgram psos

 PRINT "load complete."
 ENDDO







MBXUPM:

&addr=4100

; single read

GOSUB setupm 0x0ffffe004
GOSUB setupm 0x00fffe004
GOSUB setupm 0x00fffe404
GOSUB setupm 0x00cafac04

GOSUB setupm 0x000af2c04
GOSUB setupm 0x00faf2c08
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
; burst read
GOSUB setupm 0x0ffffe004
GOSUB setupm 0x00fffe004
GOSUB setupm 0x00fffe404
GOSUB setupm 0x00cafac04

GOSUB setupm 0x000af2c04
GOSUB setupm 0x00faf2c08
GOSUB setupm 0x00caf2c04
GOSUB setupm 0x000af2c04

GOSUB setupm 0x00faf2c08
GOSUB setupm 0x00caf2c04
GOSUB setupm 0x000af2c04
GOSUB setupm 0x00faf2c04

GOSUB setupm 0x00caf2c04
GOSUB setupm 0x000af2c04
GOSUB setupm 0x00faf2c08
GOSUB setupm 0x0ffffec07

; single write
GOSUB setupm 0x0ffffe004
GOSUB setupm 0x00fffe004
GOSUB setupm 0x00fffa404
GOSUB setupm 0x00cff2c04

GOSUB setupm 0x000ff2c00
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
; burst write
GOSUB setupm 0x0ffffe004
GOSUB setupm 0x00fffe004
GOSUB setupm 0x00fffa404
GOSUB setupm 0x00cff2c04

GOSUB setupm 0x000ff2c00
GOSUB setupm 0x00fff2c08
GOSUB setupm 0x00cff2c04
GOSUB setupm 0x000ff2c00

GOSUB setupm 0x00fff2c08
GOSUB setupm 0x00cff2c04
GOSUB setupm 0x000ff2c00
GOSUB setupm 0x00fff2c08

GOSUB setupm 0x00cff2c04
GOSUB setupm 0x000ff2c00
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07

;refresh
GOSUB setupm 0x0f0ffec04
GOSUB setupm 0x0c0ffec04
GOSUB setupm 0x000ffec04
GOSUB setupm 0x00fffec04

GOSUB setupm 0x01fffec07
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07

GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07

;exception
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07
GOSUB setupm 0x0ffffec07




RETURN
; --------------------------------------------------------------------------------

setupm:
 LOCAL &datum
 ENTRY &datum
Data.Set &base+0x17c %Long &datum
Data.Set &base+0x168 %Long &addr
&addr=&addr+1
RETURN