File: soundbus.c

package info (click to toggle)
oflib 0git20070620-4
  • links: PTS
  • area: main
  • in suites: lenny, squeeze
  • size: 104 kB
  • ctags: 78
  • sloc: ansic: 751; makefile: 83
file content (112 lines) | stat: -rw-r--r-- 1,932 bytes parent folder | download | duplicates (5)
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
#include <ofapi/of_api.h>




void print_resources(struct device_node *node)
{
	void *property;
	int plen;
	int ranges = 0;
	int x = 0;
	uint32_t start, end;
	int rsrc = 0;
	
	property = of_find_property(node, "reg", &plen);
	if(!property)
		return;
	
	ranges = plen/4;
	
	puts("Resources: ");
	for(x = 1; x <= ranges;x+=2 ) {
	
		of_property_to_n_uint32(&start, property, plen, x);
		of_property_to_n_uint32(&end, property, plen, x+1);
		
		end += start + 0x80000000; start += 0x80000000;
		
		printf(" rsrc[%d] 0x%08x - 0x%08x\n", rsrc++, start, end);
	}

	free(property);
}

void print_model(struct device_node *node)
{
	void *property;
	char *str;
	int plen;
	
	property = of_find_property(node, "model", &plen);
	if(!property)
		return;
	
	str = property;
	str[plen-1] = '\0';
	
	printf("Model: %s\n", str);

	free(property);
}

void print_sound(struct device_node *node)
{
	void *property;
	char *str;
	int plen;
	uint32_t layout_id;
	
	property = of_find_property(node, "compatible", &plen);
	if(!property)
		return;
	
	str = property;
	
	str[plen-1]='\0';
	
	printf("Compatible: %s\n", str);
	
	free(property);
	
	property = of_find_property(node, "layout-id", &plen);
	if(!property)
		return;
		
	of_property_to_int(&layout_id, property, plen);
	
	printf("Layout ID: %d\n", layout_id);
	
	free(property);
}

int main(int argc, char **argv)
{
	struct device_node *root;
	struct device_node *sound;
	struct device_node *soundbus;
	
	if(argc == 1)
		of_init();
	else
		of_init_root(argv[1]);

	if((root = of_find_node_by_path("/")) == NULL) 
		of_error("Could not find node");

	if((sound = of_find_node_by_name("sound", 0)) == NULL) 
		of_error("Could not find sound");
	
	if((soundbus = of_get_parent(sound)) == NULL) 
		of_error("Could not find soundbus");
	
	print_model(root);
	print_sound(sound);
	print_resources(soundbus);

	of_free_node(root);
	of_free_node(sound);
	of_free_node(soundbus);
	
	return EXIT_SUCCESS;
}