| /******************************************************************************* |
| Copyright (C) Marvell International Ltd. and its affiliates |
| |
| This software file (the "File") is owned and distributed by Marvell |
| International Ltd. and/or its affiliates ("Marvell") under the following |
| alternative licensing terms. Once you have made an election to distribute the |
| File under one of the following license alternatives, please (i) delete this |
| introductory statement regarding license alternatives, (ii) delete the two |
| license alternatives that you have not elected to use and (iii) preserve the |
| Marvell copyright notice above. |
| |
| ******************************************************************************** |
| Marvell Commercial License Option |
| |
| If you received this File from Marvell and you have entered into a commercial |
| license agreement (a "Commercial License") with Marvell, the File is licensed |
| to you under the terms of the applicable Commercial License. |
| |
| ******************************************************************************** |
| Marvell GPL License Option |
| |
| If you received this File from Marvell, you may opt to use, redistribute and/or |
| modify this File in accordance with the terms and conditions of the General |
| Public License Version 2, June 1991 (the "GPL License"), a copy of which is |
| available along with the File in the license.txt file or by writing to the Free |
| Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 or |
| on the worldwide web at http://www.gnu.org/licenses/gpl.txt. |
| |
| THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE IMPLIED |
| WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE ARE EXPRESSLY |
| DISCLAIMED. The GPL License provides additional details about this warranty |
| disclaimer. |
| ******************************************************************************** |
| Marvell BSD License Option |
| |
| If you received this File from Marvell, you may opt to use, redistribute and/or |
| modify this File under the following licensing terms. |
| Redistribution and use in source and binary forms, with or without modification, |
| are permitted provided that the following conditions are met: |
| |
| * Redistributions of source code must retain the above copyright notice, |
| this list of conditions and the following disclaimer. |
| |
| * Redistributions in binary form must reproduce the above copyright |
| notice, this list of conditions and the following disclaimer in the |
| documentation and/or other materials provided with the distribution. |
| |
| * Neither the name of Marvell nor the names of its contributors may be |
| used to endorse or promote products derived from this software without |
| specific prior written permission. |
| |
| THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
| ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
| DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR |
| ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
| (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
| LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON |
| ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
| SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| |
| ******************************************************************************/ |
| |
| /****************************************************************************** |
| ** FILE : eponOnuLnxKsMI.c ** |
| ** ** |
| ** DESCRIPTION : This file implements ONU GPON Management Interface ** |
| ******************************************************************************* |
| * * |
| * MODIFICATION HISTORY: * |
| * * |
| * 29Oct06 Oren Ben Hayun created * |
| * =========================================================================== * |
| ******************************************************************************/ |
| |
| /* Include Files |
| ------------------------------------------------------------------------------*/ |
| #include <linux/version.h> |
| #include "eponOnuHeader.h" |
| |
| /* Local Constant |
| ------------------------------------------------------------------------------*/ |
| #define __FILE_DESC__ "mv_pon/perf/epon/eponOnuLnxKsMI.c" |
| |
| /* Global Variables |
| ------------------------------------------------------------------------------*/ |
| extern spinlock_t onuPonIrqLock; |
| |
| /* Local Variables |
| ------------------------------------------------------------------------------*/ |
| static S_EponIoctlTdmQueue ioctlTdmQueue; |
| static S_EponIoctlDba ioctlDba; |
| |
| /* Export Functions |
| ------------------------------------------------------------------------------*/ |
| |
| /* Local Functions |
| ------------------------------------------------------------------------------*/ |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiInfoGet |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function return onu info |
| ** |
| ** PARAMETERS: S_IoctlInfo *info |
| ** MV_U32 macId |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: MV_OK or MV_ERROR |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiInfoGet(S_EponIoctlInfo *info, MV_U32 macId) |
| { |
| return(onuEponApiInformationGet(info, macId)); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiPm |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function return onu pm info |
| ** |
| ** PARAMETERS: S_IoctlPm *ioctlPm |
| ** MV_U32 macId |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: MV_OK or MV_ERROR |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiPm(S_EponIoctlPm *ioctlPm, MV_U32 macId) |
| { |
| switch (ioctlPm->section) |
| { |
| case E_EPON_IOCTL_PM_RX: |
| return(onuEponApiRxPmGet((&(ioctlPm->rxCnt)), MV_TRUE, 0)); |
| break; |
| case E_EPON_IOCTL_PM_TX: |
| return(onuEponApiTxPmGet((&(ioctlPm->txCnt)), MV_TRUE, macId)); |
| break; |
| case E_EPON_IOCTL_PM_SW: |
| return(onuEponApiSwPmGet((&(ioctlPm->swCnt)), MV_TRUE, macId)); |
| break; |
| case E_EPON_IOCTL_PM_GPM: |
| return(onuEponApiGpmPmGet((&(ioctlPm->gpmCnt)), MV_TRUE, macId)); |
| break; |
| } |
| |
| return(MV_OK); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiFecConfig |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function configure onu FEC |
| ** |
| ** PARAMETERS: MV_U32 rxGenFecEn |
| ** MV_U32 txGenFecEn |
| ** MV_U32 txMacFecEn[8] |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiFecConfig(MV_U32 rxGenFecEn, MV_U32 txGenFecEn, MV_U32 *txMacFecEn) |
| { |
| return(onuEponApiFecConfig(rxGenFecEn, txGenFecEn, txMacFecEn, ONU_FEC_CFG_INIT)); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiEncConfig |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function configure onu ENC |
| ** |
| ** PARAMETERS: MV_U32 onuEncryptCfg |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiEncConfig(MV_U32 onuEncryptCfg) |
| { |
| MV_STATUS status; |
| |
| status = onuEponApiEncryptionConfig(onuEncryptCfg); |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiEncConfig |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function configure onu ENC |
| ** |
| ** PARAMETERS: MV_U32 encryptKey |
| ** MV_U32 encryptKeyIndex |
| ** MV_U32 macId |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiEncKey(MV_U32 encryptKey, MV_U32 encryptKeyIndex, MV_U32 macId) |
| { |
| MV_STATUS status; |
| |
| status = onuEponApiEncryptionKeyConfig(encryptKey, encryptKeyIndex, macId); |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiDbaConfig |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function configure onu DBA report |
| ** |
| ** PARAMETERS: S_EponIoctlDba *ioctlDba |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiDbaConfig(S_EponIoctlDba *ioctlDba) |
| { |
| MV_STATUS status = MV_OK; |
| MV_U32 validReportQueueBitMap; |
| MV_U32 highestReportQueue; |
| MV_U32 llidIdx; |
| MV_U32 queueSetIdx; |
| MV_U32 queueIdx; |
| MV_U32 numOfQueues; |
| MV_U32 numOfQueueSets; |
| |
| MV_U32 reportLimit[4] = {/* Queueset, Queues */ |
| /* 1 */ 8, |
| /* 2 */ 8, |
| /* 3 */ 5, |
| /* 4 */ 3}; |
| |
| for (llidIdx = 0; llidIdx < EPON_MAX_MAC_NUM; llidIdx++) { |
| validReportQueueBitMap = 0; |
| highestReportQueue = 0; |
| |
| /* LLID */ |
| /* ==== */ |
| if (!ioctlDba->validLlid[llidIdx]) { |
| onuEponDbOnuDbaLlidActiveStatusSet(ONU_DBA_NON_ACTIVE_LLID, llidIdx); |
| continue; |
| } |
| |
| onuEponDbOnuDbaLlidActiveStatusSet(ONU_DBA_UPDATE_LLID, llidIdx); |
| |
| numOfQueues = ioctlDba->dbaLlid[llidIdx].numOfQueues; |
| numOfQueueSets = ioctlDba->dbaLlid[llidIdx].numOfQueueSets; |
| |
| /* Queue Set */ |
| /* ========= */ |
| if (ioctlDba->dbaLlid[llidIdx].numOfQueueSets == 0) |
| continue; |
| |
| /* support up to 4 queuesets */ |
| if (numOfQueueSets > EPON_MAX_QUEUE_SET_NUMBER) |
| numOfQueueSets = EPON_MAX_QUEUE_SET_NUMBER; |
| |
| for (queueSetIdx = 0; queueSetIdx < numOfQueueSets; queueSetIdx++) { |
| /* Queue Id */ |
| /* ======== */ |
| for (queueIdx = 0; queueIdx < EPON_MAX_QUEUE; queueIdx++) { |
| |
| if (ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].state != 0) { |
| |
| validReportQueueBitMap |= 1 << queueIdx; |
| highestReportQueue = queueIdx; |
| |
| onuEponDbOnuDbaQueueThresholdSet( |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].threshold, |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].state, |
| queueIdx, |
| queueSetIdx, |
| llidIdx); |
| printk("onuEponMiDbaConfig Qset(%d) queue(%d) state(%d) thres(%d)\n", |
| queueSetIdx, |
| queueIdx, |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].state, |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].threshold); |
| |
| } else { |
| |
| onuEponDbOnuDbaQueueThresholdSet(0, /* threshold */ |
| 0, /* state */ |
| queueIdx, |
| queueSetIdx, |
| llidIdx); |
| printk("onuEponMiDbaConfig Qset(%d) queue(%d) state(%d) thres(%d)\n", |
| queueSetIdx, |
| queueIdx, |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].state, |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].threshold); |
| |
| } |
| } /* for each queueIdx */ |
| } /* for each queueIdx */ |
| |
| /* Report Validation Check */ |
| /* ======================= */ |
| /* Number of bytes for queue report = 39 bytes (64 - mac, type, fcs, etc') */ |
| /* Formula - Number of Queueset X */ |
| /* Number of Queues X */ |
| /* Queue bytes [2] + */ |
| /* Number of reports ( == Number of Queueset) */ |
| /* */ |
| /* SW REPORT via EPON REGS is limited to 34 bytes */ |
| /* ======== */ |
| /* */ |
| /* QueueSet 1 2 3 4 */ |
| /* Report 1b 1b - - */ |
| /* Queue0 2b 2b */ |
| /* Queue1 2b 2b */ |
| /* Queue2 2b 2b */ |
| /* Queue3 2b 2b */ |
| /* Queue4 2b 2b */ |
| /* Queue5 2b 2b */ |
| /* Queue6 2b 2b */ |
| /* Queue7 2b 2b = 2 X 8 X 2 + 2 = 34bytes */ |
| /* */ |
| /* QueueSet 1 2 3 4 */ |
| /* Report 1b 1b 1b - */ |
| /* Queue0 2b 2b 2b */ |
| /* Queue1 2b 2b 2b */ |
| /* Queue2 2b 2b 2b */ |
| /* Queue3 2b 2b 2b */ |
| /* Queue4 2b 2b 2b */ |
| /* Queue5 */ |
| /* Queue6 */ |
| /* Queue7 = 3 X 5 X 2 + 3 = 33bytes */ |
| /* */ |
| /* QueueSet 1 2 3 4 */ |
| /* Report 1b 1b 1b 1b */ |
| /* Queue0 2b 2b 2b 2b */ |
| /* Queue1 2b 2b 2b 2b */ |
| /* Queue2 */ |
| /* Queue3 */ |
| /* Queue4 */ |
| /* Queue5 */ |
| /* Queue6 */ |
| /* Queue7 = 4 X 3 X 2 + 4 = 28bytes */ |
| /* */ |
| /* MV_U32 reportLimit[4] = {Queueset, Queues */ |
| /* 1 8, */ |
| /* 2 8, */ |
| /* 3 5, */ |
| /* 4 3}; */ |
| |
| printk("numOfQueues(%d), numOfQueueSets(%d), reportLimit[numOfQueueSets](%d)\n", |
| numOfQueues, numOfQueueSets, reportLimit[numOfQueueSets - 1]); |
| |
| while (numOfQueues > reportLimit[numOfQueueSets - 1]) |
| numOfQueueSets--; |
| |
| onuEponDbOnuDbaHighestReportQueueSet(highestReportQueue, llidIdx); |
| onuEponDbOnuDbaNumOfQueuesSet(numOfQueues, llidIdx); |
| onuEponDbOnuDbaNumOfQueuesetSet(numOfQueueSets, llidIdx); |
| onuEponDbOnuDbaQueuesBitMapSet(validReportQueueBitMap, llidIdx); |
| |
| printk("highestReportQueue(%d), numOfQueues(%d, bit map 0x%08x), numOfQueueSets(%d)\n", |
| highestReportQueue, numOfQueues, validReportQueueBitMap, numOfQueueSets); |
| |
| onuEponDbaInfoUpdate(llidIdx); |
| |
| onuEponDbOnuDbaLlidActiveStatusSet(ONU_DBA_ACTIVE_LLID, llidIdx); |
| |
| /* ==================================== */ |
| /* == HW REPORT MODE == */ |
| /* ==================================== */ |
| if (onuEponDbOnuDbaModeGet() == ONU_DBA_HW_RPRT_MODE) { |
| status = mvOnuEponMacTxmCppReportUpdate(validReportQueueBitMap, highestReportQueue, llidIdx); |
| if (status != MV_OK) |
| return(status); |
| } |
| |
| } /* for each llidIdx */ |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiDbaRprt |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function return onu DBA report |
| ** |
| ** PARAMETERS: S_EponIoctlDba *ioctlDba |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiDbaRprt(S_EponIoctlDba *ioctlDba) |
| { |
| MV_STATUS status = MV_OK; |
| MV_U32 llidIdx; |
| MV_U32 queueSetIdx; |
| MV_U32 queueIdx; |
| MV_U32 queueState; |
| MV_U32 queueThreshold; |
| |
| for (llidIdx = 0; llidIdx < EPON_MAX_MAC_NUM; llidIdx++) |
| { |
| /* LLID */ |
| /* ==== */ |
| if (ioctlDba->validLlid[llidIdx]) |
| { |
| ioctlDba->dbaLlid[llidIdx].numOfQueues = onuEponDbOnuDbaNumOfQueuesGet(llidIdx); |
| ioctlDba->dbaLlid[llidIdx].numOfQueueSets = onuEponDbOnuDbaNumOfQueuesetGet(llidIdx); |
| |
| /* Queue Set */ |
| /* ========= */ |
| for (queueSetIdx = 0; queueSetIdx < ioctlDba->dbaLlid[llidIdx].numOfQueueSets; queueSetIdx++) |
| { |
| /* Queue Id */ |
| /* ======== */ |
| for (queueIdx = 0; queueIdx < ioctlDba->dbaLlid[llidIdx].numOfQueues; queueIdx++) |
| { |
| onuEponDbOnuDbaQueueThresholdGet(&(queueThreshold), |
| &(queueState), |
| queueIdx, |
| queueSetIdx, |
| llidIdx); |
| |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].threshold = (MV_U16)queueThreshold; |
| ioctlDba->dbaLlid[llidIdx].threshold[queueSetIdx][queueIdx].state = (MV_U8)queueState; |
| } |
| } |
| } |
| } |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiHoldoverConfig |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function configure onu Holdover time |
| ** |
| ** PARAMETERS: S_EponIoctlHoldOver *ioctlHoldover |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiHoldoverConfig(S_EponIoctlHoldOver *ioctlHoldover) |
| { |
| MV_STATUS status = MV_OK; |
| |
| onuEponDbOnuHoldoverStateSet(ioctlHoldover->holdoverState); |
| onuEponDbOnuHoldoverTimeSet(ioctlHoldover->holdoverTime); |
| |
| onuEponIsrTimerHoldoverIntervalSet(ioctlHoldover->holdoverTime, 0); |
| |
| mvPonPrint(PON_PRINT_INFO, PON_API_MODULE, |
| "DEBUG: Holdover config, state(%d), time(%d))\n", |
| ioctlHoldover->holdoverState, ioctlHoldover->holdoverTime); |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiHoldoverReport |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function return onu Holdover parameters |
| ** |
| ** PARAMETERS: S_EponIoctlHoldOver *ioctlHoldover |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiHoldoverReport(S_EponIoctlHoldOver *ioctlHoldover) |
| { |
| MV_STATUS status = MV_OK; |
| |
| ioctlHoldover->holdoverState = onuEponDbOnuHoldoverStateGet(); |
| ioctlHoldover->holdoverTime = onuEponDbOnuHoldoverTimeGet(); |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiSilenceConfig |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function configure onu silence state |
| ** |
| ** PARAMETERS: S_EponIoctlSilence *ioctlSilence |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiSilenceConfig(S_EponIoctlSilence *ioctlSilence) |
| { |
| MV_STATUS status = MV_OK; |
| |
| onuEponDbOnuSilenceStateSet(ioctlSilence->silenceState); |
| |
| mvPonPrint(PON_PRINT_INFO, PON_API_MODULE, |
| "DEBUG: Silence config, state(%d)\n", ioctlSilence->silenceState); |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiAlarmGet |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function get EPON alarm(PON LOS) |
| ** |
| ** PARAMETERS: None |
| ** |
| ** OUTPUTS: alarm bit0:XVR LoS, alarm bit1:SERDES Los. |
| ** bit8: XVR ON, bit9: SERDES ON |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiAlarmGet(MV_U32 *alarm) |
| { |
| MV_STATUS status = MV_OK; |
| |
| onuEponLosAlarmGet(alarm); |
| |
| /* |
| mvPonPrint(PON_PRINT_INFO, PON_API_MODULE, |
| "DEBUG: EPON Alarm[%x], bit0: XVR LoS, bit1:SERDES LoS, bit8: XVR ON, bit9:SERDES ON\n", *alarm); |
| */ |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiTdmQueueConfig |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function configure onu tdm queue params |
| ** |
| ** PARAMETERS: S_EponIoctlTdmQueue *ioctlTdm |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: None |
| ** |
| *******************************************************************************/ |
| MV_STATUS onuEponMiTdmQueueConfig(S_EponIoctlTdmQueue *ioctlTdm) |
| { |
| MV_STATUS status = MV_OK; |
| MV_U32 llidIdx; |
| MV_U32 queueIdx; |
| MV_U32 numOfQueues; |
| |
| for (llidIdx = 0; llidIdx < EPON_MAX_MAC_NUM; llidIdx++) |
| { |
| if (onuEponDbOnuDbaLlidActiveStatusGet(llidIdx) == ONU_DBA_ACTIVE_LLID) |
| { |
| numOfQueues = onuEponDbOnuDbaNumOfQueuesGet(llidIdx); |
| |
| for (queueIdx = 0; queueIdx < numOfQueues; queueIdx++) |
| { |
| onuEponPmDbaAddBytePerLlidAndQueue(llidIdx, queueIdx, ioctlTdm->tdmQueCnt[llidIdx][queueIdx]); |
| } |
| } |
| } |
| |
| return(status); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** onuEponMiCfgMacTxEn |
| ** ____________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function config onu mac TX enable |
| ** |
| ** PARAMETERS: enable - enable [1] or disable [0] TX |
| ** |
| ** OUTPUTS: |
| ** |
| ** RETURNS: void |
| ** |
| *******************************************************************************/ |
| void onuEponMiCfgMacTxEn(MV_U32 enable, MV_U32 macId) |
| { |
| onuPonTxPowerOn(enable == 1 ? MV_TRUE : MV_FALSE); |
| onuEponForceTxDownStateSet(enable, macId); |
| mvOnuEponMacOnuTxEnableSet(enable, macId); |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** mvEponCdevIoctl |
| ** ___________________________________________________________________________ |
| ** |
| ** DESCRIPTION: The function execute IO commands |
| ** |
| ** PARAMETERS: struct inode *inode |
| ** struct file *filp |
| ** unsigned int cmd |
| ** unsigned long arg |
| ** |
| ** OUTPUTS: None |
| ** |
| ** RETURNS: (0) |
| ** |
| *******************************************************************************/ |
| int mvEponCdevIoctl(struct inode *inode, struct file *filp, unsigned int cmd, |
| unsigned long arg) |
| { |
| MV_STATUS status; |
| S_EponIoctlInit ioctlInit; |
| S_EponIoctlInfo ioctlInfo; |
| S_EponIoctlPm ioctlPm; |
| S_EponIoctlFec ioctlFec; |
| S_EponIoctlEnc ioctlEnc; |
| S_EponIoctlOamTx ioctlTxOam; |
| S_EponIoctlHoldOver ioctlHoldover; |
| S_EponIoctlSilence ioctlSilence; |
| MV_U32 ioctlState; |
| MV_U32 ioctlAlarm; |
| S_EponIoctlRogueOnu ioctlRogueOnu; |
| unsigned long flags; |
| int ret = -EINVAL; |
| |
| |
| |
| switch(cmd) |
| { |
| /* ====== MVEPON_IOCTL_INIT ======= */ |
| case MVEPON_IOCTL_INIT: |
| if(copy_from_user(&ioctlInit, (S_EponIoctlInit*)arg, sizeof(S_EponIoctlInit))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| onuEponInit(&ioctlInit); |
| |
| ret = 0; |
| break; |
| |
| |
| /* ====== MVEPON_IOCTL_FEC_CONFIG ======= */ |
| case MVEPON_IOCTL_FEC_CONFIG: |
| if(copy_from_user(&ioctlFec, (S_EponIoctlFec*)arg, sizeof(S_EponIoctlFec))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponMiFecConfig(ioctlFec.rxGenFecEn, |
| ioctlFec.txGenFecEn, |
| ioctlFec.txMacFecEn); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| if(status != MV_OK) |
| goto ioctlErr; |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_ENC_CONFIG ======== */ |
| case MVEPON_IOCTL_ENC_CONFIG: |
| if(copy_from_user(&ioctlEnc, (S_EponIoctlEnc*)arg, sizeof(S_EponIoctlEnc))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponMiEncConfig(ioctlEnc.encEnable); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| if(status != MV_OK) |
| goto ioctlErr; |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_ENC_KEY ======== */ |
| case MVEPON_IOCTL_ENC_KEY: |
| if(copy_from_user(&ioctlEnc, (S_EponIoctlEnc*)arg, sizeof(S_EponIoctlEnc))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponMiEncKey(ioctlEnc.encKey, |
| ioctlEnc.encKeyIndex & 0x1, |
| ioctlEnc.macId); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| if(status != MV_OK) |
| goto ioctlErr; |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_INFO ==================== */ |
| case MVEPON_IOCTL_INFO: |
| if(copy_from_user(&ioctlInfo, (S_EponIoctlInfo*)arg, sizeof(S_EponIoctlInfo))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| status = onuEponMiInfoGet(&ioctlInfo, ioctlInfo.macId); |
| if(status != MV_OK) |
| goto ioctlErr; |
| |
| if(copy_to_user((S_EponIoctlInfo*)arg, &ioctlInfo, sizeof(S_EponIoctlInfo))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_to_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_PM ==================== */ |
| case MVEPON_IOCTL_PM: |
| if(copy_from_user(&ioctlPm, (S_EponIoctlPm*)arg, sizeof(S_EponIoctlPm))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| status = onuEponMiPm(&ioctlPm, ioctlPm.macId); |
| if(status != MV_OK) |
| goto ioctlErr; |
| |
| if(copy_to_user((S_EponIoctlPm*)arg, &ioctlPm, sizeof(S_EponIoctlPm))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_to_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_OAM_TX ==================== */ |
| case MVEPON_IOCTL_OAM_TX: |
| if(copy_from_user(&ioctlTxOam, (S_EponIoctlOamTx*)arg, sizeof(S_EponIoctlOamTx))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponApiTransmitOamFrame((S_OnuEponCtrlBuffer*)&(ioctlTxOam.oamFrame), ioctlTxOam.macId); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| if (status != MV_OK) |
| { |
| mvPonPrint(PON_PRINT_DEBUG, PON_MNG_OAM_TX_MODULE, |
| "ERROR: (%s:%d) onuEponSendCtrlFrameData\n\r", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_DBA_CFG ==================== */ |
| case MVEPON_IOCTL_DBA_CFG: |
| if(copy_from_user(&ioctlDba, (S_EponIoctlDba*)arg, sizeof(S_EponIoctlDba))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponMiDbaConfig((S_EponIoctlDba*)&(ioctlDba)); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_DBA_RPRT =================== */ |
| case MVEPON_IOCTL_DBA_RPRT: |
| if(copy_from_user(&ioctlDba, (S_EponIoctlDba*)arg, sizeof(S_EponIoctlDba))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| status = onuEponMiDbaRprt((S_EponIoctlDba*)&(ioctlDba)); |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| if(copy_to_user((S_EponIoctlDba*)arg, &ioctlDba, sizeof(S_EponIoctlDba))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_to_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_HOLDOVER_CFG ==================== */ |
| case MVEPON_IOCTL_HOLDOVER_CFG: |
| if(copy_from_user(&ioctlHoldover, (S_EponIoctlHoldOver*)arg, sizeof(S_EponIoctlHoldOver))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponMiHoldoverConfig((S_EponIoctlHoldOver*)&(ioctlHoldover)); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_HOLDOVER_RPRT ==================== */ |
| case MVEPON_IOCTL_HOLDOVER_RPRT: |
| status = onuEponMiHoldoverReport((S_EponIoctlHoldOver*)&(ioctlHoldover)); |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| if(copy_to_user((S_EponIoctlHoldOver*)arg, &ioctlHoldover, sizeof(S_EponIoctlHoldOver))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_to_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_SILENCE ==================== */ |
| case MVEPON_IOCTL_SILENCE: |
| if(copy_from_user(&ioctlSilence, (S_EponIoctlSilence*)arg, sizeof(S_EponIoctlSilence))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponMiSilenceConfig((S_EponIoctlSilence*)&(ioctlSilence)); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_P2P_SET ==================== */ |
| case MVEPON_IOCTL_P2P_SET: |
| if(copy_from_user(&ioctlState, (MV_U32*)arg, sizeof(MV_U32))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| if (ioctlState) |
| { |
| status = mvP2PStart(); |
| } |
| else |
| { |
| status = mvP2PStop(); |
| } |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_P2P_ FORCE_MODE_SET ==================== */ |
| case MVEPON_IOCTL_P2P_FORCE_MODE_SET: |
| if (copy_from_user(&ioctlState, (MV_U32*)arg, sizeof(MV_U32))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| |
| status = onuEponDbP2PForceModeSet(ioctlState); |
| |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| |
| if (status != MV_OK) |
| { |
| goto ioctlErr; |
| } |
| |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_TDM_QUE_CFG ==================== */ |
| case MVEPON_IOCTL_TDM_QUE_CFG: |
| if(copy_from_user(&ioctlTdmQueue, (S_EponIoctlTdmQueue*)arg, sizeof(S_EponIoctlTdmQueue))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| spin_lock_irqsave(&onuPonIrqLock, flags); |
| status = onuEponMiTdmQueueConfig((S_EponIoctlTdmQueue*)&(ioctlTdmQueue)); |
| spin_unlock_irqrestore(&onuPonIrqLock, flags); |
| |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_ALARM_GET ==================== */ |
| case MVEPON_IOCTL_ALARM_GET: |
| status = onuEponMiAlarmGet(&ioctlAlarm); |
| if (status != MV_OK) |
| goto ioctlErr; |
| |
| if(copy_to_user((MV_U32 *)arg, &ioctlAlarm, sizeof(MV_U32))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_to_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| ret = 0; |
| break; |
| |
| /* ====== MVEPON_IOCTL_ROGUE_ONU_SET ==================== */ |
| case MVEPON_IOCTL_ROGUE_ONU_SET: |
| if(copy_from_user(&ioctlRogueOnu, (S_EponIoctlRogueOnu*)arg, sizeof(S_EponIoctlRogueOnu))) |
| { |
| mvPonPrint(PON_PRINT_ERROR, PON_API_MODULE, |
| "ERROR: (%s:%d) copy_from_user failed\n", __FILE_DESC__, __LINE__); |
| goto ioctlErr; |
| } |
| |
| onuEponMiCfgMacTxEn(ioctlRogueOnu.enable, ioctlRogueOnu.macId); |
| |
| ret = 0; |
| break; |
| |
| default: |
| ret = -EINVAL; |
| } |
| |
| ioctlErr: |
| |
| |
| return(ret); |
| } |
