]> git.sur5r.net Git - u-boot/blob - board/esd/ocrtc/cmd_ocrtc.c
e113d5cab6aa75f8ff810e90bdf23f66836330da
[u-boot] / board / esd / ocrtc / cmd_ocrtc.c
1 /*
2  * (C) Copyright 2003
3  * Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com
4  *
5  * See file CREDITS for list of people who contributed to this
6  * project.
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of
11  * the License, or (at your option) any later version.
12  *
13  * This program 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 this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
21  * MA 02111-1307 USA
22  */
23
24 #include <common.h>
25 #include <command.h>
26 #include <pci.h>
27 #include <405gp_pci.h>
28
29
30 #if (CONFIG_COMMANDS & CFG_CMD_BSP)
31
32 #define AMCC_VENDOR_ID          0x1014
33 #define PPC405_DEVICE_ID        0x0156
34
35
36 /*
37  * Set device number on pci board
38  */
39 int do_setdevice(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
40 {
41         int idx = 1;      /* start at 1 (skip device 0) */
42         pci_dev_t bdf = 0;
43         u32 addr;
44
45         while (bdf >= 0) {
46                 if ((bdf = pci_find_device(AMCC_VENDOR_ID, PPC405_DEVICE_ID, idx++)) < 0) {
47                         break;
48                 }
49                 printf("Found device nr %d at %x!\n", idx-1, bdf);
50                 pci_read_config_dword(bdf, PCI_BASE_ADDRESS_1, &addr);
51                 addr &= ~0xf;
52                 *(u32 *)addr = (bdf & 0x0000f800) >> 11;
53                 printf("Wrote %x at %x!\n", (bdf & 0x0000f800) >> 11, addr);
54         }
55
56         return 0;
57 }
58 U_BOOT_CMD(
59         setdevice,      1,      1,      do_setdevice,
60         "setdevice - Set device number on pci adapter boards\n",
61         NULL
62 );
63
64
65 /*
66  * Get device number on pci board
67  */
68 int do_getdevice(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
69 {
70         u32 device;
71         char str[32];
72
73         device = *(u32 *)0x0;
74         device = 0x16 - device;      /* calculate vxworks bp slot id */
75         sprintf(str, "%d", device);
76         setenv("slot", str);
77         printf("Variabel slot set to %x\n", device);
78
79         return 0;
80 }
81 U_BOOT_CMD(
82         getdevice,      1,      1,      do_getdevice,
83         "getdevice - Get device number and set slot env variable\n",
84         NULL
85 );
86
87 #endif