Sfoglia il codice sorgente

Modify sysctl func

zhaozhongxiang 7 anni fa
parent
commit
a9fbd46d28

+ 0 - 2
lib/bsp/entry_user.c

@@ -61,8 +61,6 @@ void _init_bsp(int core_id, int number_of_cores)
     {
         /* Initialize bss data to 0 */
         init_bss();
-        /* Init FPIOA */
-//        fpioa_init();
         /* Init UART */
         uarths_init();
         /* Register finalization function */

+ 1 - 1
lib/drivers/clint.c

@@ -60,7 +60,7 @@ int clint_timer_stop(void)
 uint64_t clint_timer_get_freq(void)
 {
     /* The clock is divided by CLINT_CLOCK_DIV */
-    return sysctl_get_freq() / CLINT_CLOCK_DIV;
+    return sysctl_clock_get_freq(SYSCTL_CLOCK_CPU) / CLINT_CLOCK_DIV;
 }
 
 int clint_timer_start(uint64_t interval, int single_shot)

+ 1 - 1
lib/drivers/dvp.c

@@ -114,7 +114,7 @@ static void dvp_io_init(void)
     fpioa_set_function(21, FUNC_CMOS_PCLK);
     fpioa_set_function(22, FUNC_SCCB_SCLK);
     fpioa_set_function(23, FUNC_SCCB_SDA);
-    sysctl_spi0_dvp_data_set(1);
+    sysctl_set_spi0_dvp_data(1);
 }
 
 static void dvp_reset(void)

+ 47 - 74
lib/drivers/include/sysctl.h

@@ -176,6 +176,7 @@ typedef enum _sysctl_clock_t
     SYSCTL_CLOCK_RTC,
     SYSCTL_CLOCK_ACLK = 40,
     SYSCTL_CLOCK_HCLK,
+    SYSCTL_CLOCK_IN0,
     SYSCTL_CLOCK_MAX
 } sysctl_clock_t;
 
@@ -235,7 +236,7 @@ typedef enum _sysctl_threshold_t
 /**
  * @brief      System controller reset control id
  */
-typedef enum _sysctl_reset_e
+typedef enum _sysctl_reset_t
 {
     SYSCTL_RESET_SOC,
     SYSCTL_RESET_ROM,
@@ -269,10 +270,26 @@ typedef enum _sysctl_reset_e
     SYSCTL_RESET_MAX = 31
 } sysctl_reset_t;
 
+typedef enum _sysctl_power_bank
+{
+    SYSCTL_POWER_BANK0,
+    SYSCTL_POWER_BANK1,
+    SYSCTL_POWER_BANK2,
+    SYSCTL_POWER_BANK3,
+    SYSCTL_POWER_BANK4,
+    SYSCTL_POWER_BANK5,
+    SYSCTL_POWER_BANK6,
+    SYSCTL_POWER_BANK7,
+    SYSCTL_POWER_BANK_MAX,
+} sysctl_power_mode_t;
+
+/**
+ * @brief      System controller reset control id
+ */
 typedef enum _io_power_mode
 {
-    POWER_V33,
-    POWER_V18
+    SYSCTL_POWER_V33,
+    SYSCTL_POWER_V18
 } sysctl_io_power_mode_t;
 
 /**
@@ -739,7 +756,6 @@ typedef struct _sysctl_power_sel
     uint32_t reserved : 24;
 } __attribute__((packed, aligned(4))) sysctl_power_sel_t;
 
-
 /**
  * @brief       System controller object
  *
@@ -819,6 +835,25 @@ typedef struct _sysctl
     uint32_t resv31;
 } __attribute__((packed, aligned(4))) sysctl_t;
 
+/**
+ * @brief       Abstruct PLL struct
+ */
+typedef struct _sysctl_general_pll
+{
+    uint32_t clkr : 4;
+    uint32_t clkf : 6;
+    uint32_t clkod : 4;
+    uint32_t bwadj : 6;
+    uint32_t pll_reset : 1;
+    uint32_t pll_pwrd : 1;
+    uint32_t pll_intfb : 1;
+    uint32_t pll_bypass : 1;
+    uint32_t pll_test : 1;
+    uint32_t pll_out_en : 1;
+    uint32_t pll_ckin_sel : 2;
+    uint32_t reserved : 4;
+} __attribute__((packed, aligned(4))) sysctl_general_pll_t;
+
 /**
  * @brief       System controller object instanse
  */
@@ -892,15 +927,6 @@ int sysctl_clock_set_clock_select(sysctl_clock_select_t which, int select);
  */
 int sysctl_clock_get_clock_select(sysctl_clock_select_t which);
 
-/**
- * @brief       Get clock source frequency
- *
- * @param[in]   input       The input clock source
- *
- * @return      The frequency of clock source
- */
-uint32_t sysctl_clock_source_get_freq(sysctl_clock_source_t input);
-
 /**
  * @brief       Get PLL frequency
  *
@@ -910,17 +936,6 @@ uint32_t sysctl_clock_source_get_freq(sysctl_clock_source_t input);
  */
 uint32_t sysctl_pll_get_freq(sysctl_pll_t pll);
 
-/**
- * @brief       Set PLL frequency and input clock
- *
- * @param[in]   pll     The PLL id
- * @param[in]   sel     The selected PLL input clock
- * @param[in]   freq    The frequency
- *
- * @return      The frequency of PLL
- */
-uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uint32_t freq);
-
 /**
  * @brief       Get base clock frequency by clock id
  *
@@ -937,42 +952,6 @@ uint32_t sysctl_clock_get_freq(sysctl_clock_t clock);
  */
 void sysctl_reset(sysctl_reset_t reset);
 
-/**
- * @brief       Get git commit id
- *
- * @return      The 4 bytes git commit id
- */
-uint32_t sysctl_get_git_id(void);
-
-/**
- * @brief       Get base clock frequency, default is 26MHz
- *
- * @return      The base clock frequency
- */
-uint32_t sysctl_get_freq(void);
-
-/**
- * @brief       Get pll lock status
- *
- * @param[in]   pll     The pll id
- *
- * @return      The lock status
- *     - 1      Pll is lock
- *     - 0      Pll have lost lock
- */
-int sysctl_pll_is_lock(sysctl_pll_t pll);
-
-/**
- * @brief       Clear pll lock status
- *
- * @param[in]   pll     The pll id
- *
- * @return      Result
- *     - 0      Success
- *     - Other  Fail
- */
-int sysctl_pll_clear_slip(sysctl_pll_t pll);
-
 /**
  * @brief       Enable the PLL and power on with reset
  *
@@ -1007,15 +986,6 @@ int sysctl_pll_disable(sysctl_pll_t pll);
  */
 int sysctl_dma_select(sysctl_dma_channel_t channel, sysctl_dma_select_t select);
 
-/**
- * @brief       Fast set all PLL and CPU clock
- *
- * @return      Result
- *     - 0      Success
- *     - Other  Fail
- */
-uint32_t sysctl_pll_fast_enable_pll(void);
-
 /**
  * @brief       Set SPI0_D0-D7 DVP_D0-D7 as spi and dvp data pin
  *
@@ -1025,7 +995,7 @@ uint32_t sysctl_pll_fast_enable_pll(void);
  *     - 0      Success
  *     - Other  Fail
  */
-uint32_t sysctl_spi0_dvp_data_set(uint8_t en);
+uint32_t sysctl_set_spi0_dvp_data(uint8_t en);
 
 /**
  * @brief       Set io power mode
@@ -1037,20 +1007,23 @@ uint32_t sysctl_spi0_dvp_data_set(uint8_t en);
  *     - 0      Success
  *     - Other  Fail
  */
-uint32_t sysctl_power_mode_sel(uint8_t power_bank, sysctl_io_power_mode_t io_power_mode);
+void sysctl_set_power_mode(sysctl_power_mode_t power_bank, sysctl_io_power_mode_t io_power_mode);
 
 /**
  * @brief       Set frequency of CPU
- * @param[in]   frequency       The desired frequency in Hz
+ * @param[in]   freq       The desired frequency in Hz
  *
  * @return      The actual frequency of CPU after set
  */
-uint32_t sysctl_set_cpu_frequency(uint32_t frequency);
+uint32_t sysctl_cpu_set_freq(uint32_t freq);
 
 /**
  * @brief       Init PLL freqency
+ * @param[in]   pll            The PLL id
+ * @param[in]   pll_freq       The desired frequency in Hz
+
  */
-void sysctl_set_pll_frequency(uint64_t pll0, uint64_t pll1, uint64_t pll2);
+uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, uint32_t pll_freq);
 
 /**
  * @brief       Enable interrupt

+ 1 - 1
lib/drivers/rtc.c

@@ -577,7 +577,7 @@ int rtc_init(void)
     rtc_protect_set(0);
     /* Set RTC clock frequency */
     rtc_timer_set_clock_frequency(
-        sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0)
+        sysctl_clock_get_freq(SYSCTL_CLOCK_IN0)
     );
     rtc_timer_set_clock_count_value(1);
 

+ 87 - 119
lib/drivers/sysctl.c

@@ -403,8 +403,16 @@ int sysctl_clock_disable(sysctl_clock_t clock)
 
 int sysctl_clock_set_threshold(sysctl_threshold_t which, int threshold)
 {
+    int result = 0;
     switch (which)
     {
+        /*
+         * These threshold is 2 bit width
+         */
+        case SYSCTL_THRESHOLD_ACLK:
+            sysctl->clk_sel0.aclk_divider_sel = (uint8_t)threshold & 0x03;
+            break;
+
         /*
          * These threshold is 3 bit width
          */
@@ -500,10 +508,10 @@ int sysctl_clock_set_threshold(sysctl_threshold_t which, int threshold)
             break;
 
         default:
+            result = -1;
             break;
     }
-
-    return 0;
+    return result;
 }
 
 int sysctl_clock_get_threshold(sysctl_threshold_t which)
@@ -606,6 +614,7 @@ int sysctl_clock_get_threshold(sysctl_threshold_t which)
 
 int sysctl_clock_set_clock_select(sysctl_clock_select_t which, int select)
 {
+    int result = 0;
     switch (which)
     {
         /*
@@ -647,10 +656,11 @@ int sysctl_clock_set_clock_select(sysctl_clock_select_t which, int select)
             break;
 
         default:
+            result = -1;
             break;
     }
 
-    return 0;
+    return result;
 }
 
 int sysctl_clock_get_clock_select(sysctl_clock_select_t which)
@@ -721,7 +731,6 @@ uint32_t sysctl_clock_source_get_freq(sysctl_clock_source_t input)
         case SYSCTL_SOURCE_ACLK:
             result = sysctl_clock_get_freq(SYSCTL_CLOCK_ACLK);
             break;
-
         default:
             result = 0;
             break;
@@ -729,7 +738,7 @@ uint32_t sysctl_clock_source_get_freq(sysctl_clock_source_t input)
     return result;
 }
 
-int sysctl_pll_is_lock(sysctl_pll_t pll)
+static int sysctl_pll_is_lock(sysctl_pll_t pll)
 {
     /*
      * All bit enable means PLL lock
@@ -772,7 +781,7 @@ int sysctl_pll_is_lock(sysctl_pll_t pll)
     return 0;
 }
 
-int sysctl_pll_clear_slip(sysctl_pll_t pll)
+static int sysctl_pll_clear_slip(sysctl_pll_t pll)
 {
     if (pll >= SYSCTL_PLL_MAX)
         return -1;
@@ -960,7 +969,7 @@ uint32_t sysctl_pll_get_freq(sysctl_pll_t pll)
 
         case SYSCTL_PLL2:
             /*
-             * Get input frequency accroding select register
+             * Get input freq accroding select register
              */
             select = sysctl->pll2.pll_ckin_sel2;
             if (select < sizeof(get_source_pll2))
@@ -978,14 +987,14 @@ uint32_t sysctl_pll_get_freq(sysctl_pll_t pll)
     }
 
     /*
-     * Get final PLL output frequency
+     * Get final PLL output freq
      * FOUT = FIN / NR * NF / OD
      */
     freq_out = (double)freq_in / (double)nr * (double)nf / (double)od;
     return freq_out;
 }
 
-uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uint32_t freq)
+static uint32_t sysctl_pll_source_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uint32_t freq)
 {
     uint32_t freq_in = 0;
 
@@ -1006,7 +1015,7 @@ uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uin
                 return 0;
             freq_in = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
             /*
-             * Check input clock frequency
+             * Check input clock freq
              */
             if (freq_in == 0)
                 return 0;
@@ -1019,7 +1028,7 @@ uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uin
             if (source < sizeof(get_select_pll2))
                 freq_in = sysctl_clock_source_get_freq(source);
             /*
-             * Check input clock frequency
+             * Check input clock freq
              */
             if (freq_in == 0)
                 return 0;
@@ -1076,12 +1085,7 @@ uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uin
     val   = fout / fin;
     terr  = 0.5 / ((double)(nf_max / 2));
     first = firstx = 1;
-    if (terr == -1)
-    {
-        printf("NR\tNF\tOD\tNB\tFvco\t\terror\n");
-        printf("------------------------------------------------------\n");
-    }
-    else if (terr != -2)
+    if (terr != -2)
     {
         first = 0;
         if (terr == 0)
@@ -1183,16 +1187,14 @@ uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uin
             x_nb   = nb;
             x_fvco = fvco;
             x_err  = err;
-            first = firstx = 0;
-            merr       = fabs(err);
+            first  = firstx = 0;
+            merr   = fabs(err);
             if (terr != -1)
                 continue;
-            printf("%d\t%lld\t%d\t%d\t%e\t%#+g\n", nrx, nfx, no, nb, fvco, err);
         }
     }
     if (!found)
     {
-        printf("Error:  No workable settings found.\n");
         return 0;
     }
 
@@ -1204,29 +1206,9 @@ uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, sysctl_clock_source_t source, uin
     err  = x_err;
     if ((terr != -2) && (fabs(err) >= terr * (1 - 1e-6)))
     {
-        printf("Error:  No appropriate ratio found.\n");
         return 0;
     }
 
-#ifdef CONFIG_PLL_DEBUG_ENABLE
-    printf("NR = %d\n", nrx);
-    printf("NF = %lld\n", nfx);
-    printf("OD = %d\n", no);
-    printf("NB = %d\n", nb);
-
-    printf("\n");
-    printf("Fin  = %g\n", fin);
-    printf("Fvco = %g\n", fvco);
-    printf("Fout = %g\n", fvco / no);
-    printf("error = %+g\n", err);
-
-    printf("\n");
-    printf("CLKR[3:0] = %02x\n", nrx - 1);
-    printf("CLKF[5:0] = %02x\n", (unsigned int)nfx - 1);
-    printf("CLKOD[3:0] = %02x\n", no - 1);
-    printf("BWADJ[5:0] = %02x\n", nb - 1);
-#endif /* CONFIG_PLL_DEBUG_ENABLE */
-
     /*
      * Begin write PLL registers' value,
      * Using atomic write method.
@@ -1290,6 +1272,13 @@ uint32_t sysctl_clock_get_freq(sysctl_clock_t clock)
 
     switch (clock)
     {
+        /*
+         * The clock IN0
+         */
+        case SYSCTL_CLOCK_IN0:
+            source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
+            break;
+
         /*
          * These clock directly under PLL clock domain
          * They are using gated divider.
@@ -1604,7 +1593,7 @@ uint32_t sysctl_clock_get_freq(sysctl_clock_t clock)
             result = source;
             break;
         case SYSCTL_CLOCK_RTC:
-            source = sysctl_clock_get_freq(SYSCTL_CLOCK_APB1);
+            source = sysctl_clock_source_get_freq(SYSCTL_SOURCE_IN0);
             result = source;
             break;
 
@@ -1727,111 +1716,90 @@ uint32_t sysctl_pll_fast_enable_pll(void)
     return 0;
 }
 
-uint32_t sysctl_spi0_dvp_data_set(uint8_t en)
+uint32_t sysctl_set_spi0_dvp_data(uint8_t en)
 {
     sysctl->misc.spi_dvp_data_enable = en;
     return 0;
 }
 
-uint32_t sysctl_power_mode_sel(uint8_t power_bank, sysctl_io_power_mode_t io_power_mode)
+void sysctl_set_power_mode(sysctl_power_mode_t power_bank, sysctl_io_power_mode_t io_power_mode)
 {
     if(io_power_mode)
         *((uint32_t *)(&sysctl->power_sel)) |= (1 << power_bank);
     else
         *((uint32_t *)(&sysctl->power_sel)) &= ~(1 << power_bank);
-    return 0;
 }
 
-void sysctl_set_pll_frequency(uint64_t pll0, uint64_t pll1, uint64_t pll2)
+uint32_t sysctl_pll_set_freq(sysctl_pll_t pll, uint32_t pll_freq)
 {
-    if (pll0 != 0U) {
-        /* We need to check PLL0 is enable before we change PLL0's frequency */
-        sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_IN0);
+    if(pll_freq == 0)
+        return 0;
 
-        if (sysctl->pll0.pll_out_en0 == 1 && sysctl->pll0.pll_pwrd0 == 1) {
-            /* PLL0 is enabled, we should disable it first */
-            /* Disable PLL0 output */
-            sysctl->pll0.pll_out_en0 = 0;
-            /* Turn off PLL0 */
-            sysctl->pll0.pll_pwrd0 = 0;
-        }
+    volatile sysctl_general_pll_t *v_pll_t;
+    switch(pll)
+    {
+        case SYSCTL_PLL0:
+            v_pll_t = (sysctl_general_pll_t *)(&sysctl->pll0);
+            break;
+        case SYSCTL_PLL1:
+            v_pll_t = (sysctl_general_pll_t *)(&sysctl->pll1);
+            break;
+        case SYSCTL_PLL2:
+            v_pll_t = (sysctl_general_pll_t *)(&sysctl->pll2);
+            break;
+        default:
+            return 0;
+            break;
+    }
 
-        sysctl_pll_set_freq(SYSCTL_PLL0, SYSCTL_SOURCE_IN0, pll0);
+    /* 1. Change CPU CLK to XTAL */
+    if(pll == SYSCTL_PLL0)
+        sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_IN0);
 
-        /* Power on PLL0 */
-        sysctl->pll0.pll_pwrd0 = 1;
+    /* 2. Disable PLL output */
+    v_pll_t->pll_out_en = 0;
 
-        /* Reset PLL0 */
-        /* Release Reset */
-        sysctl->pll0.pll_reset0 = 0;
-        sysctl->pll0.pll_reset0 = 1;
-        sysctl->pll0.pll_reset0 = 0;
+    /* 3. Turn off PLL */
+    v_pll_t->pll_pwrd = 0;
 
-        /* 7. Get lock status, wait PLL0 stable */
-        while (sysctl_pll_is_lock(SYSCTL_PLL0) == 0)
-            sysctl_pll_clear_slip(SYSCTL_PLL0);
+    /* 4. Set PLL new value */
+    uint32_t result;
+    if(pll == SYSCTL_PLL2)
+        result = sysctl_pll_source_set_freq(pll, v_pll_t->pll_ckin_sel, pll_freq);
+    else
+        result = sysctl_pll_source_set_freq(pll, SYSCTL_SOURCE_IN0, pll_freq);
 
-        /* 8. Enable PLL0 output */
-        sysctl->pll0.pll_out_en0 = 1;
+    /* 5. Power on PLL */
+    v_pll_t->pll_pwrd = 1;
 
-        sysctl_clock_enable(SYSCTL_CLOCK_PLL0);
-        sysctl->clk_sel0.aclk_divider_sel = 0;
-        sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_PLL0);
-    }
+    /* 6. Reset PLL then Release Reset*/
+    v_pll_t->pll_reset = 0;
+    v_pll_t->pll_reset = 1;
+    /* wait 100ns */
+    asm volatile ("nop");
+    asm volatile ("nop");
+    v_pll_t->pll_reset = 0;
 
-    if (pll1 != 0U) {
-        sysctl_pll_enable(SYSCTL_PLL1);
-        sysctl_pll_set_freq(SYSCTL_PLL1, SYSCTL_SOURCE_IN0, pll1);
-        while (sysctl_pll_is_lock(SYSCTL_PLL1) == 0)
-            sysctl_pll_clear_slip(SYSCTL_PLL1);
-        sysctl_clock_enable(SYSCTL_CLOCK_PLL1);
-    }
+    /* 7. Get lock status, wait PLL stable */
+    while (sysctl_pll_is_lock(pll) == 0)
+        sysctl_pll_clear_slip(pll);
 
-    if (pll2 != 0U) {
-        sysctl_pll_enable(SYSCTL_PLL2);
-        sysctl_pll_set_freq(SYSCTL_PLL2, SYSCTL_SOURCE_IN0, pll2);
-        while (sysctl_pll_is_lock(SYSCTL_PLL2) == 0)
-            sysctl_pll_clear_slip(SYSCTL_PLL2);
-        sysctl_clock_enable(SYSCTL_CLOCK_PLL2);
-    }
+    /* 8. Enable PLL output */
+    v_pll_t->pll_out_en = 1;
 
+    /* 9. Change CPU CLK to PLL */
+    if(pll == SYSCTL_PLL0)
+        sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_PLL0);
 
+    return result;
 }
 
-uint32_t sysctl_set_cpu_frequency(uint32_t frequency)
+uint32_t sysctl_cpu_set_freq(uint32_t freq)
 {
-    /* 1. Change CPU CLK to XTAL */
-    sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_IN0);
-
-    /* 2. Disable PLL0 output */
-    sysctl->pll0.pll_out_en0 = 0;
-
-    /* 3. Turn off PLL0 */
-    sysctl->pll0.pll_pwrd0 = 0;
-
-    /* 4. Set PLL0 new value */
-    uint32_t result = sysctl_pll_set_freq(SYSCTL_PLL0, SYSCTL_SOURCE_IN0, frequency * 2);
-
-    /* 5. Power on PLL0 */
-    sysctl->pll0.pll_pwrd0 = 1;
-
-    /* 6. Reset PLL0 */
-    /* 6. Release Reset */
-    sysctl->pll0.pll_reset0 = 0;
-    sysctl->pll0.pll_reset0 = 1;
-    sysctl->pll0.pll_reset0 = 0;
-
-    /* 7. Get lock status, wait PLL0 stable */
-    while (sysctl_pll_is_lock(SYSCTL_PLL0) == 0)
-        sysctl_pll_clear_slip(SYSCTL_PLL0);
-
-    /* 8. Enable PLL0 output */
-    sysctl->pll0.pll_out_en0 = 1;
-
-    /* 9. Change CPU CLK to PLL0 */
-    sysctl_clock_set_clock_select(SYSCTL_CLOCK_SELECT_ACLK, SYSCTL_SOURCE_PLL0);
+    if(freq == 0)
+        return 0;
 
-    return result;
+    return sysctl_pll_set_freq(SYSCTL_PLL0, (sysctl->clk_sel0.aclk_divider_sel + 1) * 2 * freq);
 }
 
 void sysctl_enable_irq(void)

+ 6 - 0
lib/firmware/include/nt35310.h

@@ -95,7 +95,13 @@
 #define DIGITAL_GAMMA_CTL2      0xE3
 #define INTERFACE_CTL           0xF6
 
+/*#define BOARD_KD233*/
+
+#ifdef BOARD_KD233
 #define     DCX_IO          (8)
+#else
+#define     DCX_IO          (34)
+#endif
 #define     RESET_IO        (30)
 #define     RESET_GPIONUM   (3)
 #define     DCX_GPIONUM     (2)

+ 3 - 5
lib/firmware/nt35310.c

@@ -31,14 +31,12 @@
 #define _SPI(x, y)          __SPI(x, y)
 #define SPI(x)              _SPI(SPI_CHANNEL, x)
 
-#define TEST2_0
-
 void  init_dcx(void)
 {
     fpioa_set_function(DCX_IO, FUNC_GPIOHS0 + DCX_GPIONUM);/*dcx*/
     gpiohs_set_drive_mode(DCX_GPIONUM, GPIO_DM_OUTPUT);
     gpiohs_set_pin(DCX_GPIONUM, GPIO_PV_HIGH);
-#ifndef TEST2_0
+#ifndef BOARD_KD233
     fpioa_set_function(RESET_IO, FUNC_GPIOHS0 + RESET_GPIONUM);/*reset*/
     gpiohs_set_drive_mode(RESET_GPIONUM, GPIO_DM_OUTPUT);
     gpiohs_set_pin(RESET_GPIONUM, GPIO_PV_HIGH);
@@ -57,14 +55,14 @@ void set_dcx_data(void)
 
 void pin_mux_init(void)
 {
-#ifndef TEST2_0
+#ifndef BOARD_KD233
     fpioa_set_function(31, SPI_SS);
     fpioa_set_function(32, SPI(SCLK));
 #else
     fpioa_set_function(6, SPI_SS);
     fpioa_set_function(7, SPI(SCLK));
 #endif
-    sysctl_spi0_dvp_data_set(1);
+    sysctl_set_spi0_dvp_data(1);
 }
 
 void tft_hard_init(void)