source: UsbWattMeter/trunk/lwip-1.4.1/ports/grsakura/ether_phy.c

Last change on this file was 327, checked in by coas-nagasima, 6 years ago

Ethernetのリンク確立までの手順を修正
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc; charset=SHIFT_JIS
File size: 10.4 KB
Line 
1/*
2 * TINET (TCP/IP Protocol Stack)
3 *
4 * Copyright (C) 2001-2009 by Dep. of Computer Science and Engineering
5 * Tomakomai National College of Technology, JAPAN
6 * Copyright (C) 2014 Cores Co., Ltd. Japan
7 *
8 * 上記著作権者は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
9 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
10 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
11 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
12 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
13 * スコード中に含まれていること．
14 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
15 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
16 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
17 * の無保証規定を掲載すること．
18 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
19 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
20 * と．
21 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
22 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
23 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
24 * 報告すること．
25 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
26 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
27 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
28 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
29 * 免責すること．
30 *
31 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
32 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
33 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
34 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
35 * の責任を負わない．
36 *
37 * @(#) $Id: ether_phy.c 327 2017-11-27 04:24:02Z coas-nagasima $
38 */
39
40#include "ether_phy.h"
41#include <kernel.h>
42#include <sil.h>
43
44#define PHY_CONTROL_REGISTER 0x00
45
46#define PHY_CONTROL_RESET 0x8000
47#define PHY_CONTROL_LOOPBACK 0x4000
48#define PHY_CONTROL_SPEED_SELECT 0x2000
49#define PHY_CONTROL_A_N_ENABLE 0x1000
50#define PHY_CONTROL_POWER_DOWN 0x0800
51#define PHY_CONTROL_ISOLATE 0x0400
52#define PHY_CONTROL_RESTART_A_N 0x0200
53#define PHY_CONTROL_DUPLEX_MODE 0x0100
54#define PHY_CONTROL_COLLISION_TEST 0x0080
55
56#define PHY_STATUS_REGISTER 0x01
57
58#define PHY_STATUS_100BASE_T4 0x8000
59#define PHY_STATUS_100BASE_TX_FULL_DUPLEX 0x4000
60#define PHY_STATUS_100BASE_TX_HALF_DUPLEX 0x2000
61#define PHY_STATUS_10BASE_T_FULL_DUPLEX 0x1000
62#define PHY_STATUS_10BASE_T_HALF_DUPLEX 0x0800
63#define PHY_STATUS_A_N_COMPLETE 0x0020
64#define PHY_STATUS_REMOTE_FAULT 0x0010
65#define PHY_STATUS_A_N_ABILITY 0x0008
66#define PHY_STATUS_LINK_STATUS 0x0004
67#define PHY_STATUS_JABBER_DETECT 0x0002
68#define PHY_STATUS_EXTENDED_CAPABILITY 0x0001
69
70#define PHY_AN_ADVERTISEMENT_REGISTER 0x04
71
72#define PHY_AN_AD_100BASE_T4 0x0200
73#define PHY_AN_AD_100BASE_TX_FULL_DUPLEX 0x0100
74#define PHY_AN_AD_100BASE_TX_HALF_DUPLEX 0x0080
75#define PHY_AN_AD_10BASE_T_FULL_DUPLEX 0x0040
76#define PHY_AN_AD_10BASE_T_HALF_DUPLEX 0x0020
77#define PHY_AN_AD_SELECTOR_FIELD 0x0001
78
79#define PHY_AN_STATUS_REGISTER 0x05
80
81#define PHY_AN_STATUS_100BASE_T4 0x0200
82#define PHY_AN_STATUS_100BASE_TX_FULL_DUPLEX 0x0100
83#define PHY_AN_STATUS_100BASE_TX_HALF_DUPLEX 0x0080
84#define PHY_AN_STATUS_10BASE_T_FULL_DUPLEX 0x0040
85#define PHY_AN_STATUS_10BASE_T_HALF_DUPLEX 0x0020
86
87static void phy_write_bit(bool_t bit);
88static void phy_release_bus();
89static bool_t phy_read_bit();
90static void phy_single_rel_bus();
91
92PHY_STATE_T phy_reset(PHY_STATE_T state, uint8_t phy_addr)
93{
94 switch(state){
95 case PHY_STATE_UNINIT:
96 /* PHYのリセット */
97 phy_write_reg(phy_addr, PHY_CONTROL_REGISTER, PHY_CONTROL_RESET);
98
99 /* 500ms待つ */
100 /* tslp_tsk(500); 不要？ */
101 /* continue; */
102 case PHY_STATE_RESETING:
103 /* リセット完了の確認 */
104 if((phy_read_reg(phy_addr, PHY_CONTROL_REGISTER) & PHY_CONTROL_RESET) != 0)
105 return PHY_STATE_RESETING;
106
107 return PHY_STATE_RESET;
108 default:
109 return state;
110 }
111}
112
113PHY_STATE_T phy_initialize(PHY_STATE_T state, uint8_t phy_addr, PHY_MODE_T *mode)
114{
115#ifndef __RX
116 static int reset = 0;
117#endif
118 uint16_t status;
119 *mode = (PHY_MODE_T)0;
120
121 switch(state){
122 case PHY_STATE_RESET:
123 /* オートネゴシエーションのお知らせを有効に設定 */
124 phy_write_reg(phy_addr, PHY_AN_ADVERTISEMENT_REGISTER,
125 PHY_AN_AD_100BASE_T4 | PHY_AN_AD_100BASE_TX_FULL_DUPLEX | PHY_AN_AD_100BASE_TX_HALF_DUPLEX
126 | PHY_AN_AD_10BASE_T_FULL_DUPLEX | PHY_AN_AD_10BASE_T_HALF_DUPLEX | PHY_AN_AD_SELECTOR_FIELD);
127
128 /* オートネゴシエーションを有効に設定 */
129 phy_write_reg(phy_addr, PHY_CONTROL_REGISTER, PHY_CONTROL_SPEED_SELECT | PHY_CONTROL_A_N_ENABLE);
130
131 /* continue; */
132 case PHY_STATE_LINKE_WAIT:
133#ifndef __RX
134 reset++;
135 if(reset < 2){
136#endif
137 /* リンク完了の確認 */
138 if(!phy_is_link(phy_addr))
139 return PHY_STATE_LINKE_WAIT;
140#ifndef __RX
141 }
142 reset = 0;
143#endif
144 /* continue; */
145 case PHY_STATE_LINKED:
146#ifndef __RX
147 reset++;
148 if(reset < 2){
149#endif
150 /* オートネゴシエーション完了の確認 */
151 if((phy_read_reg(phy_addr, PHY_STATUS_REGISTER) & PHY_STATUS_A_N_COMPLETE) == 0)
152 return PHY_STATE_LINKED;
153#ifndef __RX
154 }
155#endif
156 status = phy_read_reg(phy_addr, PHY_AN_STATUS_REGISTER);
157
158 if ((status & (PHY_AN_STATUS_100BASE_T4 | PHY_AN_STATUS_10BASE_T_FULL_DUPLEX | PHY_AN_STATUS_100BASE_TX_FULL_DUPLEX)) != 0)
159 *mode = (PHY_MODE_T)(((int)*mode) | 0x01);
160
161 if ((status & (PHY_AN_STATUS_100BASE_T4 | PHY_AN_STATUS_100BASE_TX_FULL_DUPLEX | PHY_AN_STATUS_100BASE_TX_HALF_DUPLEX)) != 0)
162 *mode = (PHY_MODE_T)(((int)*mode) | 0x02);
163
164 return PHY_STATE_NEGOTIATED;
165 }
166
167 return state;
168}
169
170bool_t phy_is_link(uint8_t phy_addr)
171{
172#ifdef __RX
173 /* リンクの確認 */
174 return (phy_read_reg(phy_addr, PHY_STATUS_REGISTER) & PHY_STATUS_LINK_STATUS) != 0;
175#else
176 return true;
177#endif
178}
179
180uint16_t phy_read_reg(uint8_t phy_addr, uint8_t reg_addr)
181{
182 uint16_t result = 0, bit;
183 int i;
184
185 /* PRE ：32個の連続した1b */
186 for (i = 0; i < 32; i++)
187 phy_write_bit(true);
188
189 /* ST ：フレームの先頭を示す01bのライト */
190 phy_write_bit(false);
191 phy_write_bit(true);
192
193 /* OP ：アクセス種別を示すコードのライト */
194 phy_write_bit(true);
195 phy_write_bit(false);
196
197 /* PHYAD ：PHY-LSIのアドレスが1番の場合、00001bをライト（MSB から順次ライト）。 */
198 phy_write_bit((phy_addr & 0x10) != 0);
199 phy_write_bit((phy_addr & 0x08) != 0);
200 phy_write_bit((phy_addr & 0x04) != 0);
201 phy_write_bit((phy_addr & 0x02) != 0);
202 phy_write_bit((phy_addr & 0x01) != 0);
203
204 /* REGAD ：レジスタアドレスが1番の場合、00001bをライト（MSBから順次ライト）。 */
205 phy_write_bit((reg_addr & 0x10) != 0);
206 phy_write_bit((reg_addr & 0x08) != 0);
207 phy_write_bit((reg_addr & 0x04) != 0);
208 phy_write_bit((reg_addr & 0x02) != 0);
209 phy_write_bit((reg_addr & 0x01) != 0);
210
211 /* TA ：MII/RMIIインタフェース上でデータの送信元を切り替える時間 */
212 /* 「バス解放」（Z0と表記）を行う */
213 phy_release_bus();
214
215 /* DATA ：16ビットのデータ。MSBから順次リード */
216 for (bit = 0x8000; bit != 0; bit >>= 1) {
217 if(phy_read_bit())
218 result |= bit;
219 }
220
221 /* IDLE ：次のMII管理フォーマット入力までの待機時間 */
222 /* すでにTA時にバス解放済みであり制御不要 */
223 phy_release_bus();
224
225 return result;
226}
227
228void phy_write_reg(uint8_t phy_addr, uint8_t reg_addr, uint16_t reg_data)
229{
230 int i;
231 uint16_t bit;
232
233 /* PRE ：32個の連続した1b */
234 for (i = 0; i < 32; i++)
235 phy_write_bit(true);
236
237 /* ST ：フレームの先頭を示す01bのライト */
238 phy_write_bit(false);
239 phy_write_bit(true);
240
241 /* OP ：アクセス種別を示すコードのライト */
242 phy_write_bit(false);
243 phy_write_bit(true);
244
245 /* PHYAD ：PHY-LSIのアドレスが1番の場合、00001bをライト（MSB から順次ライト）。 */
246 phy_write_bit((phy_addr & 0x10) != 0);
247 phy_write_bit((phy_addr & 0x08) != 0);
248 phy_write_bit((phy_addr & 0x04) != 0);
249 phy_write_bit((phy_addr & 0x02) != 0);
250 phy_write_bit((phy_addr & 0x01) != 0);
251
252 /* REGAD ：レジスタアドレスが1番の場合、00001bをライト（MSBから順次ライト）。 */
253 phy_write_bit((reg_addr & 0x10) != 0);
254 phy_write_bit((reg_addr & 0x08) != 0);
255 phy_write_bit((reg_addr & 0x04) != 0);
256 phy_write_bit((reg_addr & 0x02) != 0);
257 phy_write_bit((reg_addr & 0x01) != 0);
258
259 /* TA ：MII/RMIIインタフェース上でデータの送信元を切り替える時間 */
260 /* 10bをライト */
261 phy_write_bit(true);
262 phy_write_bit(false);
263
264 /* DATA ：16ビットのデータ。MSBから順次ライト */
265 for (bit = 0x8000; bit != 0; bit >>= 1) {
266 phy_write_bit((reg_data & bit) != 0);
267 }
268
269 /* IDLE ：次のMII管理フォーマット入力までの待機時間 */
270 /* 「単独バス解放」（Xと表記）を行う */
271 phy_single_rel_bus();
272}
273
274#define ETHERC_PIR_WAIT 4
275
276/*
277 * 1 ビットデータのライト
278 */
279static void phy_write_bit(bool_t bit)
280{
281 int i;
282 uint32_t data = bit ? ETHERC_PIR_MDO : 0;
283
284 /* PHY部インタフェースレジスタへのライト */
285 sil_wrw_mem(ETHERC_PIR, data | ETHERC_PIR_MMD | 0/*ETHERC_PIR_MDC*/);
286
287 for(i = ETHERC_PIR_WAIT; i > 0; i--);
288
289 /* PHY部インタフェースレジスタへのライト */
290 sil_wrw_mem(ETHERC_PIR, data | ETHERC_PIR_MMD | ETHERC_PIR_MDC);
291
292 for(i = 2 * ETHERC_PIR_WAIT; i > 0; i--);
293
294 /* PHY部インタフェースレジスタへのライト */
295 sil_wrw_mem(ETHERC_PIR, data | ETHERC_PIR_MMD | 0/*ETHERC_PIR_MDC*/);
296
297 for(i = ETHERC_PIR_WAIT; i > 0; i--);
298}
299
300/*
301 * バス解放
302 */
303static void phy_release_bus()
304{
305 int i;
306
307 /* PHY部インタフェースレジスタへのライト */
308 sil_wrw_mem(ETHERC_PIR, 0/*ETHERC_PIR_MMD*/ | 0/*ETHERC_PIR_MDC*/);
309
310 for(i = ETHERC_PIR_WAIT; i > 0; i--);
311
312 /* PHY部インタフェースレジスタへのライト */
313 sil_wrw_mem(ETHERC_PIR, 0/*ETHERC_PIR_MMD*/ | ETHERC_PIR_MDC);
314
315 for(i = 2 * ETHERC_PIR_WAIT; i > 0; i--);
316
317 /* PHY部インタフェースレジスタへのライト */
318 sil_wrw_mem(ETHERC_PIR, 0/*ETHERC_PIR_MMD*/ | 0/*ETHERC_PIR_MDC*/);
319
320 for(i = ETHERC_PIR_WAIT; i > 0; i--);
321}
322
323/*
324 * 1 ビットデータのリード
325 */
326static bool_t phy_read_bit()
327{
328 bool_t bit;
329 int i;
330
331 for(i = ETHERC_PIR_WAIT; i > 0; i--);
332
333 /* PHY部インタフェースレジスタへのライト */
334 sil_wrw_mem(ETHERC_PIR, 0/*ETHERC_PIR_MMD*/ | ETHERC_PIR_MDC);
335
336 for(i = ETHERC_PIR_WAIT; i > 0; i--);
337
338 /* PHY部インタフェースレジスタへのライト */
339 bit = (sil_rew_mem(ETHERC_PIR) & ETHERC_PIR_MDI) != 0;
340
341 for(i = ETHERC_PIR_WAIT; i > 0; i--);
342
343 /* PHY部インタフェースレジスタへのライト */
344 sil_wrw_mem(ETHERC_PIR, 0/*ETHERC_PIR_MMD*/ | 0/*ETHERC_PIR_MDC*/);
345
346 for(i = ETHERC_PIR_WAIT; i > 0; i--);
347
348 return bit;
349}
350
351/*
352 * 単独バス解放
353 */
354static void phy_single_rel_bus()
355{
356 int i;
357
358 for(i = ETHERC_PIR_WAIT; i > 0; i--);
359
360 /* PHY部インタフェースレジスタへのライト */
361 sil_wrw_mem(ETHERC_PIR, ETHERC_PIR_MMD | ETHERC_PIR_MDC);
362
363 for(i = 2 * ETHERC_PIR_WAIT; i > 0; i--);
364
365 /* PHY部インタフェースレジスタへのライト */
366 sil_wrw_mem(ETHERC_PIR, 0/*ETHERC_PIR_MMD*/ | 0/*ETHERC_PIR_MDC*/);
367
368 for(i = ETHERC_PIR_WAIT; i > 0; i--);
369}
Note: See TracBrowser for help on using the repository browser.