[avrcpm.git] / avr / dsk_mgr.asm

;    Various Management functions for the Interaction with the File-
;    systems
;
;    Copyright (C) 2010 Frank Zoll
;
;    This file is part of avrcpm.
;
;    avrcpm is free software: you can redistribute it and/or modify it
;    under the terms of the GNU General Public License as published by
;    the Free Software Foundation, either version 3 of the License, or
;    (at your option) any later version.
;
;    avrcpm is distributed in the hope that it will be useful,
;    but WITHOUT ANY WARRANTY; without even the implied warranty of
;    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
;    GNU General Public License for more details.
;
;    You should have received a copy of the GNU General Public License
;    along with avrcpm.  If not, see <http://www.gnu.org/licenses/>.
;
;    $Id$
;


; -------------------------- Defines for the disk management Structures

; Partition Table Structures

#define PART_TYPE   4
#define PART_START  8
#define PART_SIZE  12

/*
 *  Partition table id 
 *	(see http://www.win.tue.nl/~aeb/partitions/partition_types-1.html)
 */	
#define PARTID1_FAT16 0x0E
#define PARTID2_FAT16 0x06
#define PARTID_CPM    0x52


; ------------------------------------------------ Start of Code Segment
	.cseg

; ====================================================================
; Function: Scans a Disk for CP/M Partions
; ====================================================================
; Parameters
; --------------------------------------------------------------------
; 
; Registers  : [w] temp	    Number of disk images (raw and fat16) found.
;			    + 0x80 if sd card changes. (not used, doesn't work)
; SREG	:	   Z 	    according to temp
; --------------------------------------------------------------------
; Description:
; This Function scans an SD-Cards Boot-Sector for valid Partitions.
; First all original CP/M Partitions will be usesed as Drives for
; the CPM-System. Wenn all CP/M Partitions are found, a second
; scann will be made. In the second Scan, the first FAT16 Partition
; on the Disk will be used for a detailed analyses. If there
; are any Files like "cpm_x.img" are found, these Files will be
; used as Disks by the CP/M- System. ( x must be in the Range A to D )
; ====================================================================	
mgr_init_partitions:

	sts	ndisks,_0		; Set Number of Disks to 0

; Initialize partition table
	ldiw	y,hostparttbl
	ldi	temp2,PARTENTRY_SIZE*MAXDISKS
mgr_picl:
	st	y+,_0
	dec	temp2
	brne	mgr_picl

; Start mmc Card interaction
	lcall	mmcInit
	andi	temp,MMCST_NOINIT & MMCST_NODISK
	brne	mgr_pierr
	
;Load first sector from MMC (boot sector)
	ldiw	y,0			; Sector 0
	movw	x,y
	lcall	mmcReadSect
	tst	temp
	breq	mgr_check_bootsektor

mgr_pierr:
	clr	temp
	ret

mgr_check_bootsektor:
;Pointer to first table entry
	ldiw	y,hostparttbl
	ldi	temp3,0			;temp3 holds number of found disks (paritions)

;Test, if it has a valid MBR

	lds	temp,hostbuf+510	;MBR signature (0xAA55)  at and of sector?
	lds	temp2,hostbuf+510+1
	ldi	temp4,0xAA
	cpi	temp,0x55		
	cpc	temp2,temp4
	breq	mgr_search

;No MBR, no partition table ...

	inc	temp3			;pretend we have one.
	sts	ndisks,temp3
	ldi	temp,high((1<<16) * 128/512)
	ldi     temp2,dskType_CPM
	std	y+0,temp2
	std	y+1,_0			;start at beginning of card
	std	y+2,_0
	std	y+3,_0
	std	y+4,_0
	std	y+5,_0			;max CP/M 2.2 disk size
	std	y+6,temp		;

	ldi	temp3,0
	rcall	dpb_imgdata_get

	rjmp	mgr_pend

; Search for valid Partitions and ImageFiles 
mgr_search:
	ldiw	z,hostbuf+510-64	;Point to  first byte of partition table
	ldi	temp4,4			;Partition table has 4 entries.

mgr_ploop:

;	Get Partitiontype
	ldd	temp,z+PART_TYPE

;   Test for CP/M Partition
	cpi	temp,PARTID_CPM
	brne	mgr_nextp
	
	rcall	cpm_add_partition
	inc	temp3
	sts	ndisks,temp3
	adiw	y,PARTENTRY_SIZE
	cpi	temp3,MAXDISKS
	breq	mgr_pend
	
mgr_nextp:
	adiw	z,16
	dec	temp4
	brne	mgr_ploop

#if FAT16_SUPPORT

; Test for FAT16 Partition
	ldiw	z,hostbuf+510-64	;Point to  first byte of partition table
	ldi	temp4,4

mgr_ploop2:
;	Get Partitiontype
	ldd	temp,z+PART_TYPE

;   Test for FAT Partition Type 1
	cpi	temp,PARTID1_FAT16
	breq	mgr_fatfound

;   Test for FAT Partition Type 2
	cpi	temp,PARTID2_FAT16
	brne	mgr_nextp2

mgr_fatfound:
	rcall	fat_add_partition
	rcall	fat_scan_partition
	rcall	fat_reset_cache
	rjmp	mgr_pend		;Stop after first FAT16 partition found.

mgr_nextp2:
	adiw	zl,16
	dec	temp4
	brne	mgr_ploop2
#endif

mgr_pend:
	lds	temp4,ndisks
	clr	temp3
mgr_imgd_lp:
	tst	temp4
	breq	mgr_pend2
	rcall	dpb_imgdata_get
	inc	temp3
	dec	temp4
	rjmp	mgr_imgd_lp

mgr_pend2:
	lds	temp,ndisks	;return # of "disks"
	tst	temp
	ret


; ====================================================================
; Function: Print partition table info
; ====================================================================
; Parameters
; --------------------------------------------------------------------
; Registers  :  none
; Variables  :  [r] hostparttbl		Table with Partitioninformations
;               [r] hostparttbltop	Pointer to the Top of the Table
; --------------------------------------------------------------------
; Description:
; ====================================================================

mgr_prnt_parttbl:
	ldiw	z,hostparttbl
	lds	yl,ndisks
	ldi	xh,'A'

pprl:
	ldd	temp ,z+1		;Get partition start
	ldd	temp2,z+2
	ldd	temp3,z+3
	ldd	temp4,z+4

	printnewline

	cp	temp,_0			;If zero ...
	cpc	temp2,_0
	cpc	temp3,_0
	cpc	temp4,_0
	breq	mgr_prnop		;... no partition table at 0

; Partitiontype examining
	ldd 	xl,z+0
	andi	xl,dskType_MASK
; CP/M ?
	cpi	xl,dskType_CPM
	brne 	mgr_prtb_nocpm
	rcall   mgr_prnt_diskname
	rcall	mgr_prnt_table_cpm
	rjmp	mgr_prnt_size

mgr_prtb_nocpm:
#if FAT16_SUPPORT
; FAT16 ?
	cpi	xl,dskType_FAT
	brne 	mgr_prtb_nofat
	rcall   mgr_prnt_diskname
	rcall	mgr_prnt_table_fat
	rjmp	mgr_prnt_size
mgr_prtb_nofat:
#endif
#if 0					/* RAMDISK is not on SD card */
; RAMDISK ?
	cpi	xl,dskType_RAM
	brne 	mgr_prnt_err
	rcall   mgr_prnt_diskname
	rcall	mgr_prnt_table_ram
	rjmp	mgr_prnt_size
#endif
mgr_prnt_err:	
; Entry Error
	rcall	mgr_prnt_table_err
	rjmp	mgr_prnt_size

mgr_prnop:
	rcall   mgr_prnt_diskname
	rcall	mgr_prnt_image

mgr_prnt_size:
	lcall	print_ultoa
	printstring ", size: "

	ldd	temp ,z+5		;Get partition size
	ldd	temp2,z+6
	ldi	temp3,0
	ldi	temp4,0

	lsr	temp4
	ror	temp3
	ror	temp2
	ror	temp
	lcall	print_ultoa
	printstring "KB."

mgr_goto_next_part:	
	adiw	z,PARTENTRY_SIZE
	inc	xh
	dec	yl
	brne	pprl

mgr_pppre:
	ret
	

mgr_prnt_diskname:
	push	temp
	mov	temp,xh
	lcall	uartputc
	ldi	temp,':'
	lcall	uartputc
	pop	temp
	ret

mgr_prnt_table_cpm:
	printstring "CP/M partition at: "
	ret

mgr_prnt_table_fat:
	printstring "FAT16 File-Image at: "
	ret

mgr_prnt_table_ram:
	printstring "Ramdisk at: "
	ret

mgr_prnt_table_err:
	printstring "Unknown Entry at: "
	ret

mgr_prnt_image:
	printstring "Assuming CP/M image at: "
	ret
Commit	Line	Data
92202636 L	1	; Various Management functions for the Interaction with the File-
	2	; systems
	3	;
	4	; Copyright (C) 2010 Frank Zoll
	5	;
	6	; This file is part of avrcpm.
	7	;
	8	; avrcpm is free software: you can redistribute it and/or modify it
	9	; under the terms of the GNU General Public License as published by
	10	; the Free Software Foundation, either version 3 of the License, or
	11	; (at your option) any later version.
	12	;
	13	; avrcpm is distributed in the hope that it will be useful,
	14	; but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	; GNU General Public License for more details.
	17	;
	18	; You should have received a copy of the GNU General Public License
	19	; along with avrcpm. If not, see <http://www.gnu.org/licenses/>.
	20	;
	21	; $Id$
	22	;
	23
	24
637689de	25	; -------------------------- Defines for the disk management Structures
92202636	26
637689de	27	; Partition Table Structures
92202636	28
637689de L	29	#define PART_TYPE 4
	30	#define PART_START 8
	31	#define PART_SIZE 12
92202636	32
637689de L	33	/*
	34	* Partition table id
	35	* (see http://www.win.tue.nl/~aeb/partitions/partition_types-1.html)
	36	*/
	37	#define PARTID1_FAT16 0x0E
	38	#define PARTID2_FAT16 0x06
	39	#define PARTID_CPM 0x52
	40
	41
	42	; ------------------------------------------------ Start of Code Segment
92202636 L	43	.cseg
	44
	45	; ====================================================================
	46	; Function: Scans a Disk for CP/M Partions
	47	; ====================================================================
	48	; Parameters
	49	; --------------------------------------------------------------------
	50	;
	51	; Registers : [w] temp Number of disk images (raw and fat16) found.
	52	; + 0x80 if sd card changes. (not used, doesn't work)
	53	; SREG : Z according to temp
	54	; --------------------------------------------------------------------
	55	; Description:
	56	; This Function scans an SD-Cards Boot-Sector for valid Partitions.
	57	; First all original CP/M Partitions will be usesed as Drives for
	58	; the CPM-System. Wenn all CP/M Partitions are found, a second
	59	; scann will be made. In the second Scan, the first FAT16 Partition
	60	; on the Disk will be used for a detailed analyses. If there
	61	; are any Files like "cpm_x.img" are found, these Files will be
	62	; used as Disks by the CP/M- System. ( x must be in the Range A to D )
	63	; ====================================================================
	64	mgr_init_partitions:
	65
	66	sts ndisks,_0 ; Set Number of Disks to 0
	67
	68	; Initialize partition table
	69	ldiw y,hostparttbl
	70	ldi temp2,PARTENTRY_SIZE*MAXDISKS
	71	mgr_picl:
	72	st y+,_0
	73	dec temp2
	74	brne mgr_picl
	75
	76	; Start mmc Card interaction
	77	lcall mmcInit
	78	andi temp,MMCST_NOINIT & MMCST_NODISK
	79	brne mgr_pierr
	80
	81	;Load first sector from MMC (boot sector)
	82	ldiw y,0 ; Sector 0
	83	movw x,y
	84	lcall mmcReadSect
	85	tst temp
	86	breq mgr_check_bootsektor
	87
	88	mgr_pierr:
	89	clr temp
	90	ret
	91
	92	mgr_check_bootsektor:
	93	;Pointer to first table entry
	94	ldiw y,hostparttbl
	95	ldi temp3,0 ;temp3 holds number of found disks (paritions)
	96
	97	;Test, if it has a valid MBR
	98
	99	lds temp,hostbuf+510 ;MBR signature (0xAA55) at and of sector?
	100	lds temp2,hostbuf+510+1
	101	ldi temp4,0xAA
	102	cpi temp,0x55
	103	cpc temp2,temp4
	104	breq mgr_search
	105
	106	;No MBR, no partition table ...
107
108	inc temp3 ;pretend we have one.
109	sts ndisks,temp3
110	ldi temp,high((1<<16) * 128/512)
111	ldi temp2,dskType_CPM
112	std y+0,temp2
113	std y+1,_0 ;start at beginning of card
114	std y+2,_0
115	std y+3,_0
116	std y+4,_0
117	std y+5,_0 ;max CP/M 2.2 disk size
118	std y+6,temp ;
5482d75f L	119
	120	ldi temp3,0
	121	rcall dpb_imgdata_get
	122
92202636 L	123	rjmp mgr_pend
	124
	125	; Search for valid Partitions and ImageFiles
	126	mgr_search:
	127	ldiw z,hostbuf+510-64 ;Point to first byte of partition table
	128	ldi temp4,4 ;Partition table has 4 entries.
	129
	130	mgr_ploop:
	131
	132	; Get Partitiontype
	133	ldd temp,z+PART_TYPE
	134
	135	; Test for CP/M Partition
	136	cpi temp,PARTID_CPM
	137	brne mgr_nextp
	138
5482d75f	139	rcall cpm_add_partition
92202636 L	140	inc temp3
92202636 L	141	sts ndisks,temp3
637689de	142	adiw y,PARTENTRY_SIZE
92202636 L	143	cpi temp3,MAXDISKS
	144	breq mgr_pend
	145
	146	mgr_nextp:
5482d75f	147	adiw z,16
92202636 L	148	dec temp4
	149	brne mgr_ploop
	150
	151	#if FAT16_SUPPORT
	152
	153	; Test for FAT16 Partition
	154	ldiw z,hostbuf+510-64 ;Point to first byte of partition table
	155	ldi temp4,4
	156
	157	mgr_ploop2:
	158	; Get Partitiontype
	159	ldd temp,z+PART_TYPE
	160
	161	; Test for FAT Partition Type 1
	162	cpi temp,PARTID1_FAT16
	163	breq mgr_fatfound
	164
	165	; Test for FAT Partition Type 2
	166	cpi temp,PARTID2_FAT16
	167	brne mgr_nextp2
	168
	169	mgr_fatfound:
	170	rcall fat_add_partition
	171	rcall fat_scan_partition
	172	rcall fat_reset_cache
	173	rjmp mgr_pend ;Stop after first FAT16 partition found.
	174
	175	mgr_nextp2:
	176	adiw zl,16
	177	dec temp4
	178	brne mgr_ploop2
	179	#endif
	180
	181	mgr_pend:
5482d75f L	182	lds temp4,ndisks
	183	clr temp3
	184	mgr_imgd_lp:
	185	tst temp4
	186	breq mgr_pend2
	187	rcall dpb_imgdata_get
	188	inc temp3
	189	dec temp4
	190	rjmp mgr_imgd_lp
	191
	192	mgr_pend2:
	193	lds temp,ndisks ;return # of "disks"
92202636 L	194	tst temp
	195	ret
	196
	197
	198	; ====================================================================
	199	; Function: Print partition table info
	200	; ====================================================================
	201	; Parameters
	202	; --------------------------------------------------------------------
	203	; Registers : none
	204	; Variables : [r] hostparttbl Table with Partitioninformations
	205	; [r] hostparttbltop Pointer to the Top of the Table
	206	; --------------------------------------------------------------------
	207	; Description:
	208	; ====================================================================
	209
	210	mgr_prnt_parttbl:
	211	ldiw z,hostparttbl
	212	lds yl,ndisks
	213	ldi xh,'A'
	214
	215	pprl:
	216	ldd temp ,z+1 ;Get partition start
	217	ldd temp2,z+2
	218	ldd temp3,z+3
	219	ldd temp4,z+4
	220
	221	printnewline
	222
	223	cp temp,_0 ;If zero ...
	224	cpc temp2,_0
	225	cpc temp3,_0
	226	cpc temp4,_0
	227	breq mgr_prnop ;... no partition table at 0
	228
	229	; Partitiontype examining
	230	ldd xl,z+0
637689de	231	andi xl,dskType_MASK
92202636 L	232	; CP/M ?
	233	cpi xl,dskType_CPM
	234	brne mgr_prtb_nocpm
	235	rcall mgr_prnt_diskname
	236	rcall mgr_prnt_table_cpm
	237	rjmp mgr_prnt_size
	238
	239	mgr_prtb_nocpm:
	240	#if FAT16_SUPPORT
	241	; FAT16 ?
	242	cpi xl,dskType_FAT
	243	brne mgr_prtb_nofat
	244	rcall mgr_prnt_diskname
	245	rcall mgr_prnt_table_fat
	246	rjmp mgr_prnt_size
	247	mgr_prtb_nofat:
	248	#endif
	249	#if 0 /* RAMDISK is not on SD card */
	250	; RAMDISK ?
	251	cpi xl,dskType_RAM
	252	brne mgr_prnt_err
	253	rcall mgr_prnt_diskname
	254	rcall mgr_prnt_table_ram
	255	rjmp mgr_prnt_size
	256	#endif
	257	mgr_prnt_err:
	258	; Entry Error
	259	rcall mgr_prnt_table_err
	260	rjmp mgr_prnt_size
	261
	262	mgr_prnop:
	263	rcall mgr_prnt_diskname
	264	rcall mgr_prnt_image
	265
	266	mgr_prnt_size:
	267	lcall print_ultoa
	268	printstring ", size: "
	269
	270	ldd temp ,z+5 ;Get partition size
	271	ldd temp2,z+6
637689de L	272	ldi temp3,0
637689de L	273	ldi temp4,0
92202636 L	274
	275	lsr temp4
	276	ror temp3
	277	ror temp2
	278	ror temp
	279	lcall print_ultoa
	280	printstring "KB."
	281
	282	mgr_goto_next_part:
	283	adiw z,PARTENTRY_SIZE
	284	inc xh
	285	dec yl
	286	brne pprl
	287
	288	mgr_pppre:
	289	ret
	290
	291
92202636 L	292	mgr_prnt_diskname:
	293	push temp
	294	mov temp,xh
	295	lcall uartputc
	296	ldi temp,':'
	297	lcall uartputc
	298	pop temp
	299	ret
	300
	301	mgr_prnt_table_cpm:
	302	printstring "CP/M partition at: "
	303	ret
	304
	305	mgr_prnt_table_fat:
	306	printstring "FAT16 File-Image at: "
	307	ret
	308
	309	mgr_prnt_table_ram:
	310	printstring "Ramdisk at: "
	311	ret
	312
	313	mgr_prnt_table_err:
	314	printstring "Unknown Entry at: "
	315	ret
	316
	317	mgr_prnt_image:
	318	printstring "Assuming CP/M image at: "
	319	ret
	320
	321