1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
|
/***************************************************************************
* __________ __ ___.
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
* \/ \/ \/ \/ \/
* $Id$
*
* Copyright (C) 2014 by Amaury Pouly
*
* This program 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 2
* of the License, or (at your option) any later version.
*
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
* KIND, either express or implied.
*
****************************************************************************/
#include "stddef.h"
#include "target.h"
#include "system.h"
#include "logf.h"
#include "memory.h"
/**
*
* Global
*
*/
enum pp_family_t
{
UNKNOWN,
PP502x,
PP611x
};
static enum pp_family_t g_pp_family = UNKNOWN;
#define USEC_TIMER (*(volatile unsigned long *)(0x60005010))
// NOTE only valid for PP502x and above */
#define PP_VER1 (*(volatile unsigned long *)(0x70000000))
#define PP_VER2 (*(volatile unsigned long *)(0x70000004))
struct hwstub_target_desc_t __attribute__((aligned(2))) target_descriptor =
{
sizeof(struct hwstub_target_desc_t),
HWSTUB_DT_TARGET,
HWSTUB_TARGET_PP,
"PP502x / PP611x"
};
static struct hwstub_pp_desc_t __attribute__((aligned(2))) pp_descriptor =
{
sizeof(struct hwstub_pp_desc_t),
HWSTUB_DT_PP,
0, {' ', ' '},
};
static uint16_t char2hex(uint8_t c)
{
if(c >= '0' && c <= '9')
return c - '0';
else
return 0xf;
}
void target_init(void)
{
/* try to read version for PP502x */
if(PP_VER2 >> 16 != ('P' | 'P' << 8))
{
logf("unidentified PP family");
g_pp_family = UNKNOWN;
}
else
{
pp_descriptor.wChipID = char2hex((PP_VER2 >> 8) & 0xff) << 12 |
char2hex(PP_VER2 & 0xff) << 8 |
char2hex((PP_VER1 >> 24) & 0xff) << 4 |
char2hex((PP_VER1 >> 16) & 0xff);
pp_descriptor.bRevision[0] = (PP_VER1 >> 8) & 0xff;
pp_descriptor.bRevision[1] = PP_VER1 & 0xff;
if(pp_descriptor.wChipID >= 0x6110)
{
logf("identified PP611x family");
g_pp_family = PP611x;
}
else
{
logf("identified PP502x family");
g_pp_family = PP502x;
}
}
}
void target_get_desc(int desc, void **buffer)
{
if(desc == HWSTUB_DT_PP)
*buffer = &pp_descriptor;
else
*buffer = NULL;
}
void target_get_config_desc(void *buffer, int *size)
{
memcpy(buffer, &pp_descriptor, sizeof(pp_descriptor));
*size += sizeof(pp_descriptor);
}
void target_udelay(int us)
{
uint32_t end = USEC_TIMER + us;
while(USEC_TIMER <= end);
}
void target_mdelay(int ms)
{
return target_udelay(ms * 1000);
}
|
