git.openwrt.org Git - openwrt/staging/blogic.git/blob

1 /*

3 *

4 * Marek Lindner

5 *

6 * This program is free software; you can redistribute it and/or

7 * modify it under the terms of version 2 of the GNU General Public

8 * License as published by the Free Software Foundation.

9 *

10 * This program is distributed in the hope that it will be useful, but

11 * WITHOUT ANY WARRANTY; without even the implied warranty of

12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU

13 * General Public License for more details.

14 *

15 * You should have received a copy of the GNU General Public License

16 * along with this program; if not, write to the Free Software

17 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA

18 * 02110-1301, USA

19 *

20 */

22 #include "main.h"

24 #include <linux/debugfs.h>

26 #include "bat_debugfs.h"

27 #include "translation-table.h"

28 #include "originator.h"

29 #include "hard-interface.h"

30 #include "gateway_common.h"

31 #include "gateway_client.h"

32 #include "soft-interface.h"

33 #include "vis.h"

34 #include "icmp_socket.h"

36 static struct dentry *bat_debugfs;

38 #ifdef CONFIG_BATMAN_ADV_DEBUG

39 #define LOG_BUFF_MASK (log_buff_len-1)

40 #define LOG_BUFF(idx) (debug_log->log_buff[(idx) & LOG_BUFF_MASK])

42 static int log_buff_len = LOG_BUF_LEN;

44 static void emit_log_char(struct debug_log *debug_log, char c)

45 {

46 LOG_BUFF(debug_log->log_end) = c;

47 debug_log->log_end++;

49 if (debug_log->log_end - debug_log->log_start > log_buff_len)

50 debug_log->log_start = debug_log->log_end - log_buff_len;

51 }

53 static int fdebug_log(struct debug_log *debug_log, char *fmt, ...)

54 {

55 int printed_len;

56 va_list args;

57 static char debug_log_buf[256];

58 char *p;

60 if (!debug_log)

61 return 0;

63 spin_lock_bh(&debug_log->lock);

64 va_start(args, fmt);

65 printed_len = vscnprintf(debug_log_buf, sizeof(debug_log_buf),

66 fmt, args);

67 va_end(args);

69 for (p = debug_log_buf; *p != 0; p++)

70 emit_log_char(debug_log, *p);

72 spin_unlock_bh(&debug_log->lock);

74 wake_up(&debug_log->queue_wait);

76 return 0;

77 }

79 int debug_log(struct bat_priv *bat_priv, char *fmt, ...)

80 {

81 va_list args;

82 char tmp_log_buf[256];

84 va_start(args, fmt);

85 vscnprintf(tmp_log_buf, sizeof(tmp_log_buf), fmt, args);

86 fdebug_log(bat_priv->debug_log, "[%10u] %s",

87 (jiffies / HZ), tmp_log_buf);

88 va_end(args);

90 return 0;

91 }

93 static int log_open(struct inode *inode, struct file *file)

94 {

95 nonseekable_open(inode, file);

96 file->private_data = inode->i_private;

97 inc_module_count();

98 return 0;

99 }

100

101 static int log_release(struct inode *inode, struct file *file)

102 {

103 dec_module_count();

104 return 0;

105 }

106

107 static ssize_t log_read(struct file *file, char __user *buf,

108 size_t count, loff_t *ppos)

109 {

110 struct bat_priv *bat_priv = file->private_data;

111 struct debug_log *debug_log = bat_priv->debug_log;

112 int error, i = 0;

113 char c;

114

115 if ((file->f_flags & O_NONBLOCK) &&

116 !(debug_log->log_end - debug_log->log_start))

117 return -EAGAIN;

118

119 if ((!buf) || (count < 0))

120 return -EINVAL;

121

122 if (count == 0)

123 return 0;

124

125 if (!access_ok(VERIFY_WRITE, buf, count))

126 return -EFAULT;

127

128 error = wait_event_interruptible(debug_log->queue_wait,

129 (debug_log->log_start - debug_log->log_end));

130

131 if (error)

132 return error;

133

134 spin_lock_bh(&debug_log->lock);

135

136 while ((!error) && (i < count) &&

137 (debug_log->log_start != debug_log->log_end)) {

138 c = LOG_BUFF(debug_log->log_start);

139

140 debug_log->log_start++;

141

142 spin_unlock_bh(&debug_log->lock);

143

144 error = __put_user(c, buf);

145

146 spin_lock_bh(&debug_log->lock);

147

148 buf++;

149 i++;

150

151 }

152

153 spin_unlock_bh(&debug_log->lock);

154

155 if (!error)

156 return i;

157

158 return error;

159 }

160

161 static unsigned int log_poll(struct file *file, poll_table *wait)

162 {

163 struct bat_priv *bat_priv = file->private_data;

164 struct debug_log *debug_log = bat_priv->debug_log;

165

166 poll_wait(file, &debug_log->queue_wait, wait);

167

168 if (debug_log->log_end - debug_log->log_start)

169 return POLLIN | POLLRDNORM;

170

171 return 0;

172 }

173

174 static const struct file_operations log_fops = {

175 .open = log_open,

176 .release = log_release,

177 .read = log_read,

178 .poll = log_poll,

179 .llseek = no_llseek,

180 };

181

182 static int debug_log_setup(struct bat_priv *bat_priv)

183 {

184 struct dentry *d;

185

186 if (!bat_priv->debug_dir)

187 goto err;

188

189 bat_priv->debug_log = kzalloc(sizeof(struct debug_log), GFP_ATOMIC);

190 if (!bat_priv->debug_log)

191 goto err;

192

193 spin_lock_init(&bat_priv->debug_log->lock);

194 init_waitqueue_head(&bat_priv->debug_log->queue_wait);

195

196 d = debugfs_create_file("log", S_IFREG | S_IRUSR,

197 bat_priv->debug_dir, bat_priv, &log_fops);

198 if (d)

199 goto err;

200

201 return 0;

202

203 err:

204 return 1;

205 }

206

207 static void debug_log_cleanup(struct bat_priv *bat_priv)

208 {

209 kfree(bat_priv->debug_log);

210 bat_priv->debug_log = NULL;

211 }

212 #else /* CONFIG_BATMAN_ADV_DEBUG */

213 static int debug_log_setup(struct bat_priv *bat_priv)

214 {

215 bat_priv->debug_log = NULL;

216 return 0;

217 }

218

219 static void debug_log_cleanup(struct bat_priv *bat_priv)

220 {

221 return;

222 }

223 #endif

224

225 static int originators_open(struct inode *inode, struct file *file)

226 {

227 struct net_device *net_dev = (struct net_device *)inode->i_private;

228 return single_open(file, orig_seq_print_text, net_dev);

229 }

230

231 static int gateways_open(struct inode *inode, struct file *file)

232 {

233 struct net_device *net_dev = (struct net_device *)inode->i_private;

234 return single_open(file, gw_client_seq_print_text, net_dev);

235 }

236

237 static int softif_neigh_open(struct inode *inode, struct file *file)

238 {

239 struct net_device *net_dev = (struct net_device *)inode->i_private;

240 return single_open(file, softif_neigh_seq_print_text, net_dev);

241 }

242

243 static int transtable_global_open(struct inode *inode, struct file *file)

244 {

245 struct net_device *net_dev = (struct net_device *)inode->i_private;

246 return single_open(file, hna_global_seq_print_text, net_dev);

247 }

248

249 static int transtable_local_open(struct inode *inode, struct file *file)

250 {

251 struct net_device *net_dev = (struct net_device *)inode->i_private;

252 return single_open(file, hna_local_seq_print_text, net_dev);

253 }

254

255 static int vis_data_open(struct inode *inode, struct file *file)

256 {

257 struct net_device *net_dev = (struct net_device *)inode->i_private;

258 return single_open(file, vis_seq_print_text, net_dev);

259 }

260

261 struct bat_debuginfo {

262 struct attribute attr;

263 const struct file_operations fops;

264 };

265

266 #define BAT_DEBUGINFO(_name, _mode, _open) \

267 struct bat_debuginfo bat_debuginfo_##_name = { \

268 .attr = { .name = __stringify(_name), \

269 .mode = _mode, }, \

270 .fops = { .owner = THIS_MODULE, \

271 .open = _open, \

272 .read = seq_read, \

273 .llseek = seq_lseek, \

274 .release = single_release, \

275 } \

276 };

277

278 static BAT_DEBUGINFO(originators, S_IRUGO, originators_open);

279 static BAT_DEBUGINFO(gateways, S_IRUGO, gateways_open);

280 static BAT_DEBUGINFO(softif_neigh, S_IRUGO, softif_neigh_open);

281 static BAT_DEBUGINFO(transtable_global, S_IRUGO, transtable_global_open);

282 static BAT_DEBUGINFO(transtable_local, S_IRUGO, transtable_local_open);

283 static BAT_DEBUGINFO(vis_data, S_IRUGO, vis_data_open);

284

285 static struct bat_debuginfo *mesh_debuginfos[] = {

286 &bat_debuginfo_originators,

287 &bat_debuginfo_gateways,

288 &bat_debuginfo_softif_neigh,

289 &bat_debuginfo_transtable_global,

290 &bat_debuginfo_transtable_local,

291 &bat_debuginfo_vis_data,

292 NULL,

293 };

294

295 void debugfs_init(void)

296 {

297 bat_debugfs = debugfs_create_dir(DEBUGFS_BAT_SUBDIR, NULL);

298 if (bat_debugfs == ERR_PTR(-ENODEV))

299 bat_debugfs = NULL;

300 }

301

302 void debugfs_destroy(void)

303 {

304 if (bat_debugfs) {

305 debugfs_remove_recursive(bat_debugfs);

306 bat_debugfs = NULL;

307 }

308 }

309

310 int debugfs_add_meshif(struct net_device *dev)

311 {

312 struct bat_priv *bat_priv = netdev_priv(dev);

313 struct bat_debuginfo **bat_debug;

314 struct dentry *file;

315

316 if (!bat_debugfs)

317 goto out;

318

319 bat_priv->debug_dir = debugfs_create_dir(dev->name, bat_debugfs);

320 if (!bat_priv->debug_dir)

321 goto out;

322

323 bat_socket_setup(bat_priv);

324 debug_log_setup(bat_priv);

325

326 for (bat_debug = mesh_debuginfos; *bat_debug; ++bat_debug) {

327 file = debugfs_create_file(((*bat_debug)->attr).name,

328 S_IFREG | ((*bat_debug)->attr).mode,

329 bat_priv->debug_dir,

330 dev, &(*bat_debug)->fops);

331 if (!file) {

332 bat_err(dev, "Can't add debugfs file: %s/%s\n",

333 dev->name, ((*bat_debug)->attr).name);

334 goto rem_attr;

335 }

336 }

337

338 return 0;

339 rem_attr:

340 debugfs_remove_recursive(bat_priv->debug_dir);

341 bat_priv->debug_dir = NULL;

342 out:

343 #ifdef CONFIG_DEBUG_FS

344 return -ENOMEM;

345 #else

346 return 0;

347 #endif /* CONFIG_DEBUG_FS */

348 }

349

350 void debugfs_del_meshif(struct net_device *dev)

351 {

352 struct bat_priv *bat_priv = netdev_priv(dev);

353

354 debug_log_cleanup(bat_priv);

355

356 if (bat_debugfs) {

357 debugfs_remove_recursive(bat_priv->debug_dir);

358 bat_priv->debug_dir = NULL;

359 }

360 }