1 /*
2 * Copyright 2008-2013 Freescale Semiconductor Inc.
3 *
4 * Redistribution and use in source and binary forms, with or without
5 * modification, are permitted provided that the following conditions are met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above copyright
9 * notice, this list of conditions and the following disclaimer in the
10 * documentation and/or other materials provided with the distribution.
11 * * Neither the name of Freescale Semiconductor nor the
12 * names of its contributors may be used to endorse or promote products
13 * derived from this software without specific prior written permission.
14 *
15 *
16 * ALTERNATIVELY, this software may be distributed under the terms of the
17 * GNU General Public License ("GPL") as published by the Free Software
18 * Foundation, either version 2 of that License or (at your option) any
19 * later version.
20 *
21 * THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``AS IS'' AND ANY
22 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
23 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
24 * DISCLAIMED. IN NO EVENT SHALL Freescale Semiconductor BE LIABLE FOR ANY
25 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
28 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
30 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 */
32
33
34 /******************************************************************************
35 @File dtsec_mii_acc.c
36
37 @Description FM dtsec MII register access MAC ...
38 *//***************************************************************************/
39
40 #include "error_ext.h"
41 #include "std_ext.h"
42 #include "fm_mac.h"
43 #include "dtsec.h"
44 #include "fsl_fman_dtsec_mii_acc.h"
45
46
47 /*****************************************************************************/
DTSEC_MII_WritePhyReg(t_Handle h_Dtsec,uint8_t phyAddr,uint8_t reg,uint16_t data)48 t_Error DTSEC_MII_WritePhyReg(t_Handle h_Dtsec,
49 uint8_t phyAddr,
50 uint8_t reg,
51 uint16_t data)
52 {
53 t_Dtsec *p_Dtsec = (t_Dtsec *)h_Dtsec;
54 struct dtsec_mii_reg *miiregs;
55 uint16_t dtsec_freq;
56 t_Error err;
57
58 SANITY_CHECK_RETURN_ERROR(p_Dtsec, E_INVALID_HANDLE);
59 SANITY_CHECK_RETURN_ERROR(p_Dtsec->p_MiiMemMap, E_INVALID_HANDLE);
60
61 dtsec_freq = (uint16_t)(p_Dtsec->fmMacControllerDriver.clkFreq >> 1);
62 miiregs = p_Dtsec->p_MiiMemMap;
63
64 err = (t_Error)fman_dtsec_mii_write_reg(miiregs, phyAddr, reg, data, dtsec_freq);
65
66 return err;
67 }
68
69 /*****************************************************************************/
DTSEC_MII_ReadPhyReg(t_Handle h_Dtsec,uint8_t phyAddr,uint8_t reg,uint16_t * p_Data)70 t_Error DTSEC_MII_ReadPhyReg(t_Handle h_Dtsec,
71 uint8_t phyAddr,
72 uint8_t reg,
73 uint16_t *p_Data)
74 {
75 t_Dtsec *p_Dtsec = (t_Dtsec *)h_Dtsec;
76 struct dtsec_mii_reg *miiregs;
77 uint16_t dtsec_freq;
78 t_Error err;
79
80 SANITY_CHECK_RETURN_ERROR(p_Dtsec, E_INVALID_HANDLE);
81 SANITY_CHECK_RETURN_ERROR(p_Dtsec->p_MiiMemMap, E_INVALID_HANDLE);
82
83 dtsec_freq = (uint16_t)(p_Dtsec->fmMacControllerDriver.clkFreq >> 1);
84 miiregs = p_Dtsec->p_MiiMemMap;
85
86 err = fman_dtsec_mii_read_reg(miiregs, phyAddr, reg, p_Data, dtsec_freq);
87
88 if (*p_Data == 0xffff)
89 RETURN_ERROR(MINOR, E_NO_DEVICE,
90 ("Read wrong data (0xffff): phyAddr 0x%x, reg 0x%x",
91 phyAddr, reg));
92 if (err)
93 RETURN_ERROR(MINOR, (t_Error)err, NO_MSG);
94
95 return E_OK;
96 }
97
98