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 /*****************************************************************************/ 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 /*****************************************************************************/ 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