m68k/kernel/head.S

55  * 3) Increase readability of the code
292 /* #define FONT_6x11 */	/* 3rd choice */
308 CPUTYPE_0460	= 3	/* if either above are set, this is set */
475 func_define	console_plot_pixel,3
546 #define is_040_or_060(lab)	btst &CPUTYPE_0460,%pc@(L(cputype)+3); jne lab
547 #define is_not_040_or_060(lab)	btst &CPUTYPE_0460,%pc@(L(cputype)+3); jeq lab
548 #define is_040(lab)		btst &CPUTYPE_040,%pc@(L(cputype)+3); jne lab
549 #define is_060(lab)		btst &CPUTYPE_060,%pc@(L(cputype)+3); jne lab
550 #define is_not_060(lab)		btst &CPUTYPE_060,%pc@(L(cputype)+3); jeq lab
551 #define is_020(lab)		btst &CPUTYPE_020,%pc@(L(cputype)+3); jne lab
552 #define is_not_020(lab)		btst &CPUTYPE_020,%pc@(L(cputype)+3); jeq lab
671 	clrl	%d1
678 	bset	#CPUTYPE_060,%d1
679 	bset	#CPUTYPE_0460,%d1
680 	jra	3f
687 	bset	#CPUTYPE_040,%d1
688 	bset	#CPUTYPE_0460,%d1
689 	jra	3f
695 	jeq	3f
696 	bset	#CPUTYPE_020,%d1
697 	jra	3f
698 3:
703 	movel	%d1,%a0@
721 	clrl	%d1
727 	 * d1 := cacheable write-through
746 	movel	#_PAGE_CACHE040W,%d1
754 	movel	%d1,%a0@
926 	movel	#16*1024*1024,%d1
927 	cmpl	%d0,%d1
929 	lsrl	#1,%d1
930 	cmpl	%d0,%d1
932 	lsrl	#1,%d1
935 	movel	%d1,%a0@
936 	mmu_map	#PAGE_OFFSET,%pc@(L(phys_kernel_start)),%d1,\
1213 	moveq	#ROOT_INDEX_SHIFT, %d1
1214 	lsrl	%d1,%d0
1218 	moveq	#PTR_INDEX_SHIFT, %d1
1219 	lsrl	%d1,%d0
1224 	moveq	#PAGE_INDEX_SHIFT, %d1
1225 	lsrl	%d1,%d0
1233 	movel	#((0x200000 >> 13)-1), %d1
1241 	dbra	%d1,1b
1536 func_start	get_bi_record,%d1
1541 	jeq	3f
1550 3:	moveq	#-1,%d0
1678 3:	tstl	%d4
1683 	jbeq	3b
1713 	jbra	3b
1733 	movel	#0,%d1
1757 	moveml	%d0-%d1,%sp@-
1759 	movel	%d6,%d1
1760 	andil	#0xfffff4e0,%d1
1763 	moveml	%sp@+,%d0-%d1
1771 	addq	#1,%d1
1772 	cmpib	#128,%d1
1782 	movel	%d0,%d1
1783 	andiw	#0x8000,%d1		/* is it valid ? */
1786 	movel	%d0,%d1
1787 	andil	#0xff000000,%d1		/* Get the address */
1788 	putn	%d1
1790 	putn	%d1
1796 	movel	%d0,%d1
1797 	andiw	#0x8000,%d1		/* is it valid ? */
1800 	movel	%d0,%d1
1801 	andil	#0xff000000,%d1		/* Get the address */
1802 	putn	%d1
1804 	putn	%d1
1820 	jbne	3f
1825 3:
1861 	movel	#0,%d1
1898 	addq	#1,%d1
1899 	cmpib	#128,%d1
1914 	moveml	%d0-%d1,%sp@-
1916 	movel	%d6,%d1
1919 	moveml	%sp@+,%d0-%d1
1948 	cmpl	%a0@(mmu_next_physical),%d1
1954 	putn	%d1
1956 	movel	%d1,%d6
1962 	movel	%d1,%a0@(mmu_next_physical)
1984 	is_not_mac(3f)
1987 3:	puts	"unknown"
1998 2:	putc	'3'
2014 func_start	mmu_map_tt,%d0/%d1/%a0,4
2027 	bfffo	ARG3{#0,#32},%d1
2028 	cmpw	#8,%d1
2034 	lsrl	%d1,%d0
2039 	movel	%d0,%d1
2040 	notl	%d1
2041 	andl	ARG2,%d1
2046 	orl	%d0,%d1
2047 	clrw	%d1
2054 	orw	#TTR_ENABLE+TTR_RWM+TTR_FCB2+TTR_FCM1+TTR_FCM0,%d1
2058 	orw	#TTR_CI,%d1
2061 	dputn	%d1
2062 	movel	%d1,%a0@
2075 	orw	#TTR_ENABLE+TTR_KERNELMODE,%d1
2076 	orl	ARG4,%d1
2077 	dputn	%d1
2082 	movec	%d1,%itt0
2083 	movec	%d1,%dtt0
2085 1:	movec	%d1,%itt1
2086 	movec	%d1,%dtt1
2176 	moveq	#ROOT_INDEX_SHIFT,%d1
2177 	lsrl	%d1,%d0
2183 	moveq	#PTR_INDEX_SHIFT,%d1
2184 	lsrl	%d1,%d0
2191 	moveq	#PAGE_INDEX_SHIFT,%d1
2192 	lsrl	%d1,%d0
2219 	moveq	#ROOT_INDEX_SHIFT,%d1
2220 	lsrl	%d1,%d0
2259 	moveq	#PTR_INDEX_SHIFT,%d1
2260 	lsrl	%d1,%d0
2314 	moveq	#ROOT_INDEX_SHIFT,%d1
2315 	lsrl	%d1,%d0
2321 	moveq	#PTR_INDEX_SHIFT,%d1
2322 	lsrl	%d1,%d0
2329 	moveq	#PAGE_INDEX_SHIFT,%d1
2330 	lsrl	%d1,%d0
2350 func_start	mmu_temp_map,%d0/%d1/%a0/%a1
2362 	moveq	#ROOT_INDEX_SHIFT,%d1
2363 	lsrl	%d1,%d0
2389 	moveq	#PTR_INDEX_SHIFT,%d1
2390 	lsrl	%d1,%d0
2419 	moveq	#PAGE_INDEX_SHIFT,%d1
2420 	lsrl	%d1,%d0
2758 	.byte	3,0xc0		/* receiver: 8 bpc */
2764 	.byte	3,0xc1		/* enable receiver */
2782 	.byte	3,0xc0		/* receiver: 8 bpc */
2787 	.byte	14,2,14,3	/* use master clock for BRG, enable */
2788 	.byte	3,0xc1		/* enable receiver */
2834 func_start	serial_init,%d0/%d1/%a0/%a1
2894 	jmi	3f
2898 3:	clrb	%a0@
3003 func_start	serial_putc,%d0/%d1/%a0/%a1
3032 3:	btst	#2,%a1@(mac_scc_cha_a_ctrl_offset)
3033 	jeq	3b
3049 3:	btst	#0,%a1@(LSTMFP_GPIP)
3050 	jne	3b
3062 3:	btst	#2,%a1@(LSCC_CTRL)
3063 	jeq	3b
3066 3:	btst	#7,%a1@(LMFP_TSR)
3067 	jeq	3b
3093 	movel	vme_brdtype,%d1
3095 	cmpi	#VME_TYPE_MVME162,%d1
3097 	cmpi	#VME_TYPE_MVME172,%d1
3110 	jra	3f
3119 	moveb	M167_PCTPIACKR,%d1
3120 	moveb	M167_CYLICR,%d1
3128 	jra	3f
3133 3:
3186 	is_not_hp300(3f)
3189 	movel	%pc@(L(uart_scode)),%d1	/* Check the scode */
3190 	jmi	3f			/* Unset? Exit */
3191 	cmpi	#256,%d1		/* APCI scode? */
3193 1:      moveb   %a1@(DCALSR),%d1	/* Output to DCA */
3194 	andb	#0x20,%d1
3198 2:	moveb	%a1@(APCILSR),%d1	/* Output to APCI */
3199 	andb	#0x20,%d1
3203 3:
3245 	moveq	#7,%d1
3260 	dbra	%d1,1b
3277 	moveml	%d0/%d1/%a0,%sp@-
3281 	movel	%sp@(22),%d1		/* fetch parameter */
3290 	subq	#1,%d1
3291 2:	jeq	3f
3294 3:
3296 	moveml	%sp@+,%d0/%d1/%a0
3405 	movel	%d4,%d1				/* screen height in pixels */
3406 	divul	%a0@(FONT_DESC_HEIGHT),%d1	/* d1 = max num rows */
3409 	movel	%d1,%a2@(Lconsole_struct_num_rows)
3434 	clrl	%d1		/* start at the top */
3442 	console_plot_pixel %d0,%d1,%d2
3445 	console_plot_pixel %d0,%d1,%d2
3450 	addq	#1,%d1
3555 	movel	%a0@(Lconsole_struct_num_rows),%d1
3556 	cmpl	%d1,%d0
3583  *		d1 = cursor row to draw the character
3589 	movel	%a0@(Lconsole_struct_num_columns),%d1
3590 	cmpl	%d1,%d0
3594 	movel	%a0@(Lconsole_struct_cur_row),%d1
3610 	 *	d1 = pixel coordinate, y
3618 	mulul	%a0@(FONT_DESC_HEIGHT),%d1
3631 	console_plot_pixel %d0,%d1,%d2
3637 	addq	#1,%d1
3646 	 *		d1 = y coordinate
3655 	movel	ARG2,%d1
3656 	mulul	%pc@(L(mac_rowbytes)),%d1
3662 	 *		d1 = y coord
3670 	movel	%d0,%d4		/* we need the low order 3 bits! */
3673 	addal	%d1,%a1
3690 	addal	%d1,%a1
3691 	andb	#3,%d4
3692 	eorb	#3,%d4		/* reverse the x-coordinate w/ screen-bit # */
3712 	addal	%d1,%a1
3740 	addal	%d1,%a1
3754 	addal	%d1,%a1