blob: ffbb4adddcd5e9ae4a1daa0d5f90a19748dffd6d [file] [log] [blame]
stroeseb762b9f2003-07-11 08:14:14 +00001/*
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>
Wolfgang Denk9ea4b582005-09-23 13:12:15 +020027#include <pci_ids.h>
stroeseb762b9f2003-07-11 08:14:14 +000028#include <405gp_pci.h>
29
30
31#if (CONFIG_COMMANDS & CFG_CMD_BSP)
32
stroeseb762b9f2003-07-11 08:14:14 +000033/*
34 * Set device number on pci board
35 */
36int do_setdevice(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
37{
38 int idx = 1; /* start at 1 (skip device 0) */
39 pci_dev_t bdf = 0;
40 u32 addr;
41
42 while (bdf >= 0) {
Wolfgang Denk9ea4b582005-09-23 13:12:15 +020043 if ((bdf = pci_find_device(PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_405GP, idx++)) < 0) {
stroeseb762b9f2003-07-11 08:14:14 +000044 break;
45 }
46 printf("Found device nr %d at %x!\n", idx-1, bdf);
47 pci_read_config_dword(bdf, PCI_BASE_ADDRESS_1, &addr);
48 addr &= ~0xf;
49 *(u32 *)addr = (bdf & 0x0000f800) >> 11;
50 printf("Wrote %x at %x!\n", (bdf & 0x0000f800) >> 11, addr);
51 }
52
53 return 0;
54}
55U_BOOT_CMD(
56 setdevice, 1, 1, do_setdevice,
57 "setdevice - Set device number on pci adapter boards\n",
58 NULL
59);
60
61
62/*
63 * Get device number on pci board
64 */
65int do_getdevice(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
66{
67 u32 device;
68 char str[32];
69
70 device = *(u32 *)0x0;
71 device = 0x16 - device; /* calculate vxworks bp slot id */
72 sprintf(str, "%d", device);
73 setenv("slot", str);
74 printf("Variabel slot set to %x\n", device);
75
76 return 0;
77}
78U_BOOT_CMD(
79 getdevice, 1, 1, do_getdevice,
80 "getdevice - Get device number and set slot env variable\n",
81 NULL
82);
83
84#endif