[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?
	cpi	temp,0x55		
	lds	temp,hostbuf+510+1
	ldi	temp2,0xAA
	cpc	temp,temp2
	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

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
	cpi	zl,low(hostbuf+510)	;End of partition table reached?
	brne	mgr_ploop

#if FAT16_SUPPORT

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

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
	cpi	zl,low(hostbuf+510)
	brne	mgr_ploop2
#endif

mgr_pend:
	clr	temp3
mgr_imgd_lp:
	lds	temp,ndisks
	cp	temp3,temp
	breq	mgr_pend2
	rcall	dpb_imgdata_get
	inc	temp3
	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:
	push	r15
	push	r14
	ldiw	z,hostparttbl
	lds	yl,ndisks
	ldi	xh,'A'

pprl:
	printnewline

	ldd	temp ,z+1		;Get partition start
	ldd	temp2,z+2
	ldd	r14,z+3
	ldd	r15,z+4

	cp	temp,_0			;If zero ...
	cpc	temp2,_0
	cpc	r14,_0
	cpc	r15,_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
	clr	r14
	clr	r15
	lsr	temp2
	ror	temp
	lcall	print_ultoa
	printstring "KB."

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

mgr_pppre:
	pop	r14
	pop	r15
	ret
	

mgr_prnt_diskname:
	push	temp
	mov	temp,xh
	lcall	uartputc
	printstring ": "
	pop	temp
	ret

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

mgr_prnt_table_fat:
	printstring "FAT16 File-Image '"
	push	temp
	mov	temp,r14
	lcall	uartputc
	clr	r14
	pop	temp
	printstring "' 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
dc705dc0	78	andi temp,MMCST_NOINIT \| MMCST_NODISK
92202636 L	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?
92202636	100	cpi temp,0x55
825ecc9d L	101	lds temp,hostbuf+510+1
	102	ldi temp2,0xAA
	103	cpc temp,temp2
92202636 L	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
92202636 L	128
	129	mgr_ploop:
	130
	131	; Get Partitiontype
	132	ldd temp,z+PART_TYPE
	133
	134	; Test for CP/M Partition
	135	cpi temp,PARTID_CPM
	136	brne mgr_nextp
	137
5482d75f	138	rcall cpm_add_partition
92202636 L	139	inc temp3
92202636 L	140	sts ndisks,temp3
637689de	141	adiw y,PARTENTRY_SIZE
92202636 L	142	cpi temp3,MAXDISKS
	143	breq mgr_pend
	144
	145	mgr_nextp:
5482d75f	146	adiw z,16
825ecc9d	147	cpi zl,low(hostbuf+510) ;End of partition table reached?
92202636 L	148	brne mgr_ploop
	149
	150	#if FAT16_SUPPORT
	151
	152	; Test for FAT16 Partition
	153	ldiw z,hostbuf+510-64 ;Point to first byte of partition table
92202636 L	154
	155	mgr_ploop2:
	156	; Get Partitiontype
	157	ldd temp,z+PART_TYPE
	158
	159	; Test for FAT Partition Type 1
	160	cpi temp,PARTID1_FAT16
	161	breq mgr_fatfound
	162
	163	; Test for FAT Partition Type 2
	164	cpi temp,PARTID2_FAT16
	165	brne mgr_nextp2
	166
	167	mgr_fatfound:
	168	rcall fat_add_partition
	169	rcall fat_scan_partition
	170	rcall fat_reset_cache
	171	rjmp mgr_pend ;Stop after first FAT16 partition found.
	172
	173	mgr_nextp2:
	174	adiw zl,16
825ecc9d	175	cpi zl,low(hostbuf+510)
92202636 L	176	brne mgr_ploop2
	177	#endif
	178
	179	mgr_pend:
5482d75f L	180	clr temp3
5482d75f L	181	mgr_imgd_lp:
dcd7e502 L	182	lds temp,ndisks
dcd7e502 L	183	cp temp3,temp
5482d75f L	184	breq mgr_pend2
	185	rcall dpb_imgdata_get
	186	inc temp3
5482d75f L	187	rjmp mgr_imgd_lp
	188
	189	mgr_pend2:
	190	lds temp,ndisks ;return # of "disks"
92202636 L	191	tst temp
	192	ret
	193
	194
	195	; ====================================================================
	196	; Function: Print partition table info
	197	; ====================================================================
	198	; Parameters
	199	; --------------------------------------------------------------------
	200	; Registers : none
	201	; Variables : [r] hostparttbl Table with Partitioninformations
	202	; [r] hostparttbltop Pointer to the Top of the Table
	203	; --------------------------------------------------------------------
	204	; Description:
	205	; ====================================================================
	206
	207	mgr_prnt_parttbl:
dc705dc0 L	208	push r15
dc705dc0 L	209	push r14
92202636 L	210	ldiw z,hostparttbl
	211	lds yl,ndisks
	212	ldi xh,'A'
	213
	214	pprl:
92202636 L	215	printnewline
92202636 L	216
825ecc9d L	217	ldd temp ,z+1 ;Get partition start
825ecc9d L	218	ldd temp2,z+2
dc705dc0 L	219	ldd r14,z+3
	220	ldd r15,z+4
	221
	222	cp temp,_0 ;If zero ...
	223	cpc temp2,_0
	224	cpc r14,_0
	225	cpc r15,_0
92202636 L	226	breq mgr_prnop ;... no partition table at 0
	227
	228	; Partitiontype examining
	229	ldd xl,z+0
637689de	230	andi xl,dskType_MASK
92202636 L	231	; CP/M ?
	232	cpi xl,dskType_CPM
	233	brne mgr_prtb_nocpm
	234	rcall mgr_prnt_diskname
	235	rcall mgr_prnt_table_cpm
	236	rjmp mgr_prnt_size
	237
	238	mgr_prtb_nocpm:
	239	#if FAT16_SUPPORT
	240	; FAT16 ?
	241	cpi xl,dskType_FAT
	242	brne mgr_prtb_nofat
	243	rcall mgr_prnt_diskname
	244	rcall mgr_prnt_table_fat
	245	rjmp mgr_prnt_size
	246	mgr_prtb_nofat:
	247	#endif
	248	#if 0 /* RAMDISK is not on SD card */
	249	; RAMDISK ?
	250	cpi xl,dskType_RAM
	251	brne mgr_prnt_err
	252	rcall mgr_prnt_diskname
	253	rcall mgr_prnt_table_ram
	254	rjmp mgr_prnt_size
	255	#endif
	256	mgr_prnt_err:
	257	; Entry Error
	258	rcall mgr_prnt_table_err
	259	rjmp mgr_prnt_size
	260
	261	mgr_prnop:
	262	rcall mgr_prnt_diskname
	263	rcall mgr_prnt_image
	264
	265	mgr_prnt_size:
	266	lcall print_ultoa
	267	printstring ", size: "
	268
	269	ldd temp ,z+5 ;Get partition size
	270	ldd temp2,z+6
825ecc9d L	271	clr r14
	272	clr r15
	273	lsr temp2
92202636 L	274	ror temp
	275	lcall print_ultoa
	276	printstring "KB."
	277
	278	mgr_goto_next_part:
	279	adiw z,PARTENTRY_SIZE
	280	inc xh
	281	dec yl
	282	brne pprl
	283
	284	mgr_pppre:
dc705dc0 L	285	pop r14
dc705dc0 L	286	pop r15
92202636 L	287	ret
	288
	289
92202636 L	290	mgr_prnt_diskname:
	291	push temp
	292	mov temp,xh
	293	lcall uartputc
96a054ef	294	printstring ": "
92202636 L	295	pop temp
	296	ret
	297
	298	mgr_prnt_table_cpm:
	299	printstring "CP/M partition at: "
	300	ret
	301
	302	mgr_prnt_table_fat:
96a054ef L	303	printstring "FAT16 File-Image '"
	304	push temp
	305	mov temp,r14
	306	lcall uartputc
	307	clr r14
	308	pop temp
	309	printstring "' at: "
92202636 L	310	ret
	311
	312	mgr_prnt_table_ram:
	313	printstring "Ramdisk at: "
	314	ret
	315
	316	mgr_prnt_table_err:
	317	printstring "Unknown Entry at: "
	318	ret
	319
	320	mgr_prnt_image:
	321	printstring "Assuming CP/M image at: "
	322	ret
	323
	324