Diff: targets/TARGET_NUVOTON/TARGET_NUC472/device/StdDriver/nuc472_ps2.c

Revision:

149:156823d33999

Parent:

144:ef7eb2e8f9f7

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/targets/TARGET_NUVOTON/TARGET_NUC472/device/StdDriver/nuc472_ps2.c	Fri Oct 28 11:17:30 2016 +0100
@@ -0,0 +1,183 @@
+/******************************************************************************
+ * @file     ps2.c
+ * @version  V1.00
+ * $Revision: 5 $
+ * $Date: 14/10/03 11:59a $
+ * @brief    NUC472/NUC442 PS2 driver source file
+ *
+ * @note
+ * Copyright (C) 2013 Nuvoton Technology Corp. All rights reserved.
+*****************************************************************************/
+
+#include <stdio.h>
+#include "NUC472_442.h"
+
+/*---------------------------------------------------------------------------------------------------------*/
+/* Includes of local headers                                                                               */
+/*---------------------------------------------------------------------------------------------------------*/
+//#include "ps2.h"
+
+
+/** @addtogroup NUC472_442_Device_Driver NUC472/NUC442 Device Driver
+  @{
+*/
+
+/** @addtogroup NUC472_442_PS2_Driver PS2 Driver
+  @{
+*/
+
+
+/** @addtogroup NUC472_442_PS2_EXPORTED_FUNCTIONS PS2 Exported Functions
+  @{
+*/
+
+
+/**
+ *  @brief    The function is used to enable PS2 specified interrupt.
+ *
+ *  @param[in]    u32Mask    The specified interrupt of PS2 module:
+ *                               - \ref PS2_CTL_TXIEN_Msk : PS2 Tx interrupt
+ *                               - \ref PS2_CTL_RXIEN_Msk : PS2 Rx interrupt
+ *
+ *  @return   None
+ */
+void PS2_EnableInt(uint32_t u32Mask)
+{
+    PS2->CTL |= u32Mask;
+}
+
+/**
+ *  @brief    The function is used to disable PS2 specified interrupt.
+ *
+ *  @param[in]    u32Mask    The specified interrupt of PS2 module:
+ *                               - \ref PS2_CTL_TXIEN_Msk : PS2 Tx interrupt
+ *                               - \ref PS2_CTL_RXIEN_Msk : PS2 Rx interrupt
+ *
+ *  @return   None
+ */
+void PS2_DisableInt(uint32_t u32Mask)
+{
+    PS2->CTL &= ~u32Mask;
+}
+
+/**
+ *  @brief    This function use to enable PS2 function and set one byte per trnasfer.
+ *
+ *  @param    None
+ *
+ *  @return   None
+ */
+void PS2_Open(void)
+{
+    /* Reset PS2 device */
+    SYS->IPRST1 |=  SYS_IPRST1_PS2RST_Msk;
+    SYS->IPRST1 &= ~SYS_IPRST1_PS2RST_Msk;
+
+    /* Enable PS2 module */
+    PS2->CTL |= PS2_CTL_PS2EN_Msk;
+
+    /* Set One byte per trnasfer */
+    PS2->CTL &= ~PS2_CTL_TXFDEPTH_Msk;
+
+    /* Clear Tx FIFO */
+    PS2->CTL |= PS2_CTL_CLRFIFO_Msk;
+    PS2->CTL &= (~PS2_CTL_CLRFIFO_Msk);
+}
+
+/**
+ *  @brief    This function use to disable PS2 function.
+ *
+ *  @param    None
+ *
+ *  @return   None
+ */
+void PS2_Close(void)
+{
+    /* Enable PS2 module */
+    PS2->CTL &= ~PS2_CTL_PS2EN_Msk;
+}
+
+/**
+ *  @brief    This function use to read PS2 Rx data.
+ *
+ *  @param    None
+ *
+ *  @return   Rx data
+ */
+uint8_t PS2_Read(void)
+{
+    return (uint8_t)(PS2->RXDAT & PS2_RXDAT_DAT_Msk);
+}
+
+/**
+ *  @brief   This function use to transmit PS2 data.
+ *
+ *  @param[in]   pu32Buf        The buffer to send the data to PS2 transmission FIFO.
+ *  @param[in]   u32ByteCount   The byte number of data.
+ *
+ *  @return  FALSE: transmit data time-out
+ *           TRUE:  transmit data successful
+ */
+int32_t PS2_Write(uint32_t *pu32Buf, uint32_t u32ByteCount)
+{
+    uint32_t u32TxFIFO_Depth = 16;
+    uint32_t u32delayno, txcnt, remainder;
+    uint8_t i=0;
+
+    txcnt = u32ByteCount / u32TxFIFO_Depth;
+
+    remainder = u32ByteCount % u32TxFIFO_Depth;
+    if(remainder) txcnt++;
+
+    u32delayno = 0;
+    while (!(PS2->STATUS & PS2_STATUS_TXEMPTY_Msk)) {
+        u32delayno++;
+        if (u32delayno >= 0xF0000000)
+            return FALSE; // Time Out
+    }
+
+    if(u32ByteCount >= u32TxFIFO_Depth)//Tx fifo is 16 bytes
+        PS2_SET_TX_BYTE_CNT(u32TxFIFO_Depth);
+
+    do {
+        u32delayno = 0;
+        while (!(PS2->STATUS & PS2_STATUS_TXEMPTY_Msk)) {
+            u32delayno++;
+            if(u32delayno >= 0xF0000000)
+                return FALSE; // Time Out
+        }
+
+        if((txcnt == 1) && (remainder != 0))
+            PS2_SET_TX_BYTE_CNT(u32ByteCount);
+
+        PS2->TXDAT0 = pu32Buf[i];
+        PS2->TXDAT1 = pu32Buf[i+1];
+        PS2->TXDAT2 = pu32Buf[i+2];
+        PS2->TXDAT3 = pu32Buf[i+3];
+
+        i = i + 4;
+
+    } while(--txcnt);
+
+    u32delayno = 0;
+    while(!(PS2->STATUS & PS2_STATUS_TXEMPTY_Msk)) {
+        u32delayno++;
+        if(u32delayno >= 0xF0000000)
+            return FALSE; // Time Out
+    }
+
+    return TRUE;
+
+}
+
+
+/*@}*/ /* end of group NUC472_442_PS2_EXPORTED_FUNCTIONS */
+
+/*@}*/ /* end of group NUC472_442_PS2_Driver */
+
+/*@}*/ /* end of group NUC472_442_Device_Driver */
+
+/*** (C) COPYRIGHT 2013 Nuvoton Technology Corp. ***/
+
+
+