Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
idtcps.c
Go to the documentation of this file.
1 /*
2  * IDT CPS RapidIO switches support
3  *
4  * Copyright 2009-2010 Integrated Device Technology, Inc.
5  * Alexandre Bounine <[email protected]>
6  *
7  * This program is free software; you can redistribute it and/or modify it
8  * under the terms of the GNU General Public License as published by the
9  * Free Software Foundation; either version 2 of the License, or (at your
10  * option) any later version.
11  */
12 
13 #include <linux/rio.h>
14 #include <linux/rio_drv.h>
15 #include <linux/rio_ids.h>
16 #include "../rio.h"
17 
18 #define CPS_DEFAULT_ROUTE 0xde
19 #define CPS_NO_ROUTE 0xdf
20 
21 #define IDTCPS_RIO_DOMAIN 0xf20020
22 
23 static int
24 idtcps_route_add_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
25  u16 table, u16 route_destid, u8 route_port)
26 {
27  u32 result;
28 
29  if (route_port == RIO_INVALID_ROUTE)
30  route_port = CPS_DEFAULT_ROUTE;
31 
32  if (table == RIO_GLOBAL_TABLE) {
33  rio_mport_write_config_32(mport, destid, hopcount,
34  RIO_STD_RTE_CONF_DESTID_SEL_CSR, route_destid);
35 
36  rio_mport_read_config_32(mport, destid, hopcount,
38 
39  result = (0xffffff00 & result) | (u32)route_port;
40  rio_mport_write_config_32(mport, destid, hopcount,
42  }
43 
44  return 0;
45 }
46 
47 static int
48 idtcps_route_get_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
49  u16 table, u16 route_destid, u8 *route_port)
50 {
51  u32 result;
52 
53  if (table == RIO_GLOBAL_TABLE) {
54  rio_mport_write_config_32(mport, destid, hopcount,
55  RIO_STD_RTE_CONF_DESTID_SEL_CSR, route_destid);
56 
57  rio_mport_read_config_32(mport, destid, hopcount,
59 
60  if (CPS_DEFAULT_ROUTE == (u8)result ||
61  CPS_NO_ROUTE == (u8)result)
62  *route_port = RIO_INVALID_ROUTE;
63  else
64  *route_port = (u8)result;
65  }
66 
67  return 0;
68 }
69 
70 static int
71 idtcps_route_clr_table(struct rio_mport *mport, u16 destid, u8 hopcount,
72  u16 table)
73 {
74  u32 i;
75 
76  if (table == RIO_GLOBAL_TABLE) {
77  for (i = 0x80000000; i <= 0x800000ff;) {
78  rio_mport_write_config_32(mport, destid, hopcount,
80  rio_mport_write_config_32(mport, destid, hopcount,
82  (CPS_DEFAULT_ROUTE << 24) |
83  (CPS_DEFAULT_ROUTE << 16) |
85  i += 4;
86  }
87  }
88 
89  return 0;
90 }
91 
92 static int
93 idtcps_set_domain(struct rio_mport *mport, u16 destid, u8 hopcount,
94  u8 sw_domain)
95 {
96  /*
97  * Switch domain configuration operates only at global level
98  */
99  rio_mport_write_config_32(mport, destid, hopcount,
100  IDTCPS_RIO_DOMAIN, (u32)sw_domain);
101  return 0;
102 }
103 
104 static int
105 idtcps_get_domain(struct rio_mport *mport, u16 destid, u8 hopcount,
106  u8 *sw_domain)
107 {
108  u32 regval;
109 
110  /*
111  * Switch domain configuration operates only at global level
112  */
113  rio_mport_read_config_32(mport, destid, hopcount,
114  IDTCPS_RIO_DOMAIN, &regval);
115 
116  *sw_domain = (u8)(regval & 0xff);
117 
118  return 0;
119 }
120 
121 static int idtcps_switch_init(struct rio_dev *rdev, int do_enum)
122 {
123  pr_debug("RIO: %s for %s\n", __func__, rio_name(rdev));
124  rdev->rswitch->add_entry = idtcps_route_add_entry;
125  rdev->rswitch->get_entry = idtcps_route_get_entry;
126  rdev->rswitch->clr_table = idtcps_route_clr_table;
127  rdev->rswitch->set_domain = idtcps_set_domain;
128  rdev->rswitch->get_domain = idtcps_get_domain;
129  rdev->rswitch->em_init = NULL;
130  rdev->rswitch->em_handle = NULL;
131 
132  if (do_enum) {
133  /* set TVAL = ~50us */
134  rio_write_config_32(rdev,
135  rdev->phys_efptr + RIO_PORT_LINKTO_CTL_CSR, 0x8e << 8);
136  /* Ensure that default routing is disabled on startup */
137  rio_write_config_32(rdev,
139  }
140 
141  return 0;
142 }
143