Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
torvalds
GitHub Repository: torvalds/linux
 Path: blob/master/arch/mips/lantiq/falcon/prom.c
26535 views
1
// SPDX-License-Identifier: GPL-2.0-only

2
/*

3
 *

4
 * Copyright (C) 2012 Thomas Langer <[email protected]>

5
 * Copyright (C) 2012 John Crispin <[email protected]>

6
 */

7


8
#include <linux/kernel.h>

9
#include <asm/cacheflush.h>

10
#include <asm/traps.h>

11
#include <asm/io.h>

12


13
#include <lantiq_soc.h>

14


15
#include "../prom.h"

16


17
#define SOC_FALCON	"Falcon"

18
#define SOC_FALCON_D	"Falcon-D"

19
#define SOC_FALCON_V	"Falcon-V"

20
#define SOC_FALCON_M	"Falcon-M"

21


22
#define COMP_FALCON	"lantiq,falcon"

23


24
#define PART_SHIFT	12

25
#define PART_MASK	0x0FFFF000

26
#define REV_SHIFT	28

27
#define REV_MASK	0xF0000000

28
#define SREV_SHIFT	22

29
#define SREV_MASK	0x03C00000

30
#define TYPE_SHIFT	26

31
#define TYPE_MASK	0x3C000000

32


33
/* reset, nmi and ejtag exception vectors */

34
#define BOOT_REG_BASE	(KSEG1 | 0x1F200000)

35
#define BOOT_RVEC	(BOOT_REG_BASE | 0x00)

36
#define BOOT_NVEC	(BOOT_REG_BASE | 0x04)

37
#define BOOT_EVEC	(BOOT_REG_BASE | 0x08)

38


39
static void __init ltq_soc_nmi_setup(void)

40
{

41
	extern void (*nmi_handler)(void);

42


43
	ltq_w32((unsigned long)&nmi_handler, (void *)BOOT_NVEC);

44
}

45


46
static void __init ltq_soc_ejtag_setup(void)

47
{

48
	extern void (*ejtag_debug_handler)(void);

49


50
	ltq_w32((unsigned long)&ejtag_debug_handler, (void *)BOOT_EVEC);

51
}

52


53
void __init ltq_soc_detect(struct ltq_soc_info *i)

54
{

55
	u32 type;

56
	i->partnum = (ltq_r32(FALCON_CHIPID) & PART_MASK) >> PART_SHIFT;

57
	i->rev = (ltq_r32(FALCON_CHIPID) & REV_MASK) >> REV_SHIFT;

58
	i->srev = ((ltq_r32(FALCON_CHIPCONF) & SREV_MASK) >> SREV_SHIFT);

59
	i->compatible = COMP_FALCON;

60
	i->type = SOC_TYPE_FALCON;

61
	sprintf(i->rev_type, "%c%d%d", (i->srev & 0x4) ? ('B') : ('A'),

62
		i->rev & 0x7, (i->srev & 0x3) + 1);

63


64
	switch (i->partnum) {

65
	case SOC_ID_FALCON:

66
		type = (ltq_r32(FALCON_CHIPTYPE) & TYPE_MASK) >> TYPE_SHIFT;

67
		switch (type) {

68
		case 0:

69
			i->name = SOC_FALCON_D;

70
			break;

71
		case 1:

72
			i->name = SOC_FALCON_V;

73
			break;

74
		case 2:

75
			i->name = SOC_FALCON_M;

76
			break;

77
		default:

78
			i->name = SOC_FALCON;

79
			break;

80
		}

81
		break;

82


83
	default:

84
		unreachable();

85
		break;

86
	}

87


88
	board_nmi_handler_setup = ltq_soc_nmi_setup;

89
	board_ejtag_handler_setup = ltq_soc_ejtag_setup;

90
}

91


92