[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:
	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:
	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	clr temp3
5482d75f L	183	mgr_imgd_lp:
dcd7e502 L	184	lds temp,ndisks
dcd7e502 L	185	cp temp3,temp
5482d75f L	186	breq mgr_pend2
	187	rcall dpb_imgdata_get
	188	inc temp3
5482d75f L	189	rjmp mgr_imgd_lp
	190
	191	mgr_pend2:
	192	lds temp,ndisks ;return # of "disks"
92202636 L	193	tst temp
	194	ret
	195
	196
	197	; ====================================================================
	198	; Function: Print partition table info
	199	; ====================================================================
	200	; Parameters
	201	; --------------------------------------------------------------------
	202	; Registers : none
	203	; Variables : [r] hostparttbl Table with Partitioninformations
	204	; [r] hostparttbltop Pointer to the Top of the Table
	205	; --------------------------------------------------------------------
	206	; Description:
	207	; ====================================================================
	208
	209	mgr_prnt_parttbl:
	210	ldiw z,hostparttbl
	211	lds yl,ndisks
	212	ldi xh,'A'
	213
	214	pprl:
	215	ldd temp ,z+1 ;Get partition start
	216	ldd temp2,z+2
	217	ldd temp3,z+3
	218	ldd temp4,z+4
	219
	220	printnewline
	221
	222	cp temp,_0 ;If zero ...
	223	cpc temp2,_0
	224	cpc temp3,_0
	225	cpc temp4,_0
	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
637689de L	271	ldi temp3,0
637689de L	272	ldi temp4,0
92202636 L	273
	274	lsr temp4
	275	ror temp3
	276	ror temp2
	277	ror temp
	278	lcall print_ultoa
	279	printstring "KB."
	280
	281	mgr_goto_next_part:
	282	adiw z,PARTENTRY_SIZE
	283	inc xh
	284	dec yl
	285	brne pprl
	286
	287	mgr_pppre:
	288	ret
	289
	290
92202636 L	291	mgr_prnt_diskname:
	292	push temp
	293	mov temp,xh
	294	lcall uartputc
	295	ldi temp,':'
	296	lcall uartputc
	297	pop temp
	298	ret
	299
	300	mgr_prnt_table_cpm:
	301	printstring "CP/M partition at: "
	302	ret
	303
	304	mgr_prnt_table_fat:
	305	printstring "FAT16 File-Image at: "
	306	ret
	307
	308	mgr_prnt_table_ram:
	309	printstring "Ramdisk at: "
	310	ret
	311
	312	mgr_prnt_table_err:
	313	printstring "Unknown Entry at: "
	314	ret
	315
	316	mgr_prnt_image:
	317	printstring "Assuming CP/M image at: "
	318	ret
	319
	320