Code Review / kvmfornfv.git / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | review | tree
raw | inline | side by side
These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / drivers / staging / sm750fb / ddk750_power.c
diff --git a/kernel/drivers/staging/sm750fb/ddk750_power.c b/kernel/drivers/staging/sm750fb/ddk750_power.c
index cbb9767..667e4f8 100644 (file)
--- a/kernel/drivers/staging/sm750fb/ddk750_power.c
+++ b/kernel/drivers/staging/sm750fb/ddk750_power.c
@@ -5,21 +5,23 @@
 void ddk750_setDPMS(DPMS_t state)
 {
        unsigned int value;
-       if(getChipType() == SM750LE){
+
+       if (getChipType() == SM750LE) {
                value = PEEK32(CRT_DISPLAY_CTRL);
-               POKE32(CRT_DISPLAY_CTRL,FIELD_VALUE(value,CRT_DISPLAY_CTRL,DPMS,state));
-       }else{
+               POKE32(CRT_DISPLAY_CTRL, FIELD_VALUE(value, CRT_DISPLAY_CTRL,
+                                                    DPMS, state));
+       } else {
                value = PEEK32(SYSTEM_CTRL);
-               value= FIELD_VALUE(value,SYSTEM_CTRL,DPMS,state);
+               value = FIELD_VALUE(value, SYSTEM_CTRL, DPMS, state);
                POKE32(SYSTEM_CTRL, value);
        }
 }
 
-unsigned int getPowerMode(void)
+static unsigned int getPowerMode(void)
 {
-       if(getChipType() == SM750LE)
+       if (getChipType() == SM750LE)
                return 0;
-    return (FIELD_GET(PEEK32(POWER_MODE_CTRL), POWER_MODE_CTRL, MODE));
+       return FIELD_GET(PEEK32(POWER_MODE_CTRL), POWER_MODE_CTRL, MODE);
 }
 
 
@@ -29,160 +31,109 @@ unsigned int getPowerMode(void)
  */
 void setPowerMode(unsigned int powerMode)
 {
-    unsigned int control_value = 0;
+       unsigned int control_value = 0;
 
-    control_value = PEEK32(POWER_MODE_CTRL);
+       control_value = PEEK32(POWER_MODE_CTRL);
 
-       if(getChipType() == SM750LE)
+       if (getChipType() == SM750LE)
                return;
 
-    switch (powerMode)
-    {
-        case POWER_MODE_CTRL_MODE_MODE0:
-            control_value = FIELD_SET(control_value, POWER_MODE_CTRL, MODE, MODE0);
-            break;
+       switch (powerMode) {
+       case POWER_MODE_CTRL_MODE_MODE0:
+               control_value = FIELD_SET(control_value, POWER_MODE_CTRL, MODE,
+                                         MODE0);
+               break;
 
-        case POWER_MODE_CTRL_MODE_MODE1:
-            control_value = FIELD_SET(control_value, POWER_MODE_CTRL, MODE, MODE1);
-            break;
+       case POWER_MODE_CTRL_MODE_MODE1:
+               control_value = FIELD_SET(control_value, POWER_MODE_CTRL, MODE,
+                                         MODE1);
+               break;
 
-        case POWER_MODE_CTRL_MODE_SLEEP:
-            control_value = FIELD_SET(control_value, POWER_MODE_CTRL, MODE, SLEEP);
-            break;
+       case POWER_MODE_CTRL_MODE_SLEEP:
+               control_value = FIELD_SET(control_value, POWER_MODE_CTRL, MODE,
+                                         SLEEP);
+               break;
 
-        default:
-            break;
-    }
+       default:
+               break;
+       }
 
-    /* Set up other fields in Power Control Register */
-    if (powerMode == POWER_MODE_CTRL_MODE_SLEEP)
-    {
-        control_value =
+       /* Set up other fields in Power Control Register */
+       if (powerMode == POWER_MODE_CTRL_MODE_SLEEP) {
+               control_value =
 #ifdef VALIDATION_CHIP
-            FIELD_SET(  control_value, POWER_MODE_CTRL, 336CLK, OFF) |
+               FIELD_SET(control_value, POWER_MODE_CTRL, 336CLK, OFF) |
 #endif
-            FIELD_SET(  control_value, POWER_MODE_CTRL, OSC_INPUT,  OFF);
-    }
-    else
-    {
-        control_value =
+               FIELD_SET(control_value, POWER_MODE_CTRL, OSC_INPUT,  OFF);
+       } else {
+               control_value =
 #ifdef VALIDATION_CHIP
-            FIELD_SET(  control_value, POWER_MODE_CTRL, 336CLK, ON) |
+               FIELD_SET(control_value, POWER_MODE_CTRL, 336CLK, ON) |
 #endif
-            FIELD_SET(  control_value, POWER_MODE_CTRL, OSC_INPUT,  ON);
-    }
+               FIELD_SET(control_value, POWER_MODE_CTRL, OSC_INPUT,  ON);
+       }
 
-    /* Program new power mode. */
-    POKE32(POWER_MODE_CTRL, control_value);
+       /* Program new power mode. */
+       POKE32(POWER_MODE_CTRL, control_value);
 }
 
 void setCurrentGate(unsigned int gate)
 {
-    unsigned int gate_reg;
-    unsigned int mode;
-
-    /* Get current power mode. */
-    mode = getPowerMode();
-
-    switch (mode)
-    {
-        case POWER_MODE_CTRL_MODE_MODE0:
-            gate_reg = MODE0_GATE;
-            break;
-
-        case POWER_MODE_CTRL_MODE_MODE1:
-            gate_reg = MODE1_GATE;
-            break;
-
-        default:
-            gate_reg = MODE0_GATE;
-            break;
-    }
-    POKE32(gate_reg, gate);
-}
+       unsigned int gate_reg;
+       unsigned int mode;
 
+       /* Get current power mode. */
+       mode = getPowerMode();
 
+       switch (mode) {
+       case POWER_MODE_CTRL_MODE_MODE0:
+               gate_reg = MODE0_GATE;
+               break;
 
-/*
- * This function enable/disable the 2D engine.
- */
-void enable2DEngine(unsigned int enable)
-{
-    uint32_t gate;
-
-    gate = PEEK32(CURRENT_GATE);
-    if (enable)
-    {
-        gate = FIELD_SET(gate, CURRENT_GATE, DE,  ON);
-        gate = FIELD_SET(gate, CURRENT_GATE, CSC, ON);
-    }
-    else
-    {
-        gate = FIELD_SET(gate, CURRENT_GATE, DE,  OFF);
-        gate = FIELD_SET(gate, CURRENT_GATE, CSC, OFF);
-    }
-
-    setCurrentGate(gate);
+       case POWER_MODE_CTRL_MODE_MODE1:
+               gate_reg = MODE1_GATE;
+               break;
+
+       default:
+               gate_reg = MODE0_GATE;
+               break;
+       }
+       POKE32(gate_reg, gate);
 }
 
 
+
 /*
- * This function enable/disable the ZV Port.
+ * This function enable/disable the 2D engine.
  */
-void enableZVPort(unsigned int enable)
-{
-    uint32_t gate;
-
-    /* Enable ZV Port Gate */
-    gate = PEEK32(CURRENT_GATE);
-    if (enable)
-    {
-        gate = FIELD_SET(gate, CURRENT_GATE, ZVPORT, ON);
-#if 1
-        /* Using Software I2C */
-        gate = FIELD_SET(gate, CURRENT_GATE, GPIO, ON);
-#else
-        /* Using Hardware I2C */
-        gate = FIELD_SET(gate, CURRENT_GATE, I2C,    ON);
-#endif
-    }
-    else
-    {
-        /* Disable ZV Port Gate. There is no way to know whether the GPIO pins are being used
-           or not. Therefore, do not disable the GPIO gate. */
-        gate = FIELD_SET(gate, CURRENT_GATE, ZVPORT, OFF);
-    }
-
-    setCurrentGate(gate);
-}
-
-
-void enableSSP(unsigned int enable)
+void enable2DEngine(unsigned int enable)
 {
-    uint32_t gate;
-
-    /* Enable SSP Gate */
-    gate = PEEK32(CURRENT_GATE);
-    if (enable)
-        gate = FIELD_SET(gate, CURRENT_GATE, SSP, ON);
-    else
-        gate = FIELD_SET(gate, CURRENT_GATE, SSP, OFF);
+       u32 gate;
+
+       gate = PEEK32(CURRENT_GATE);
+       if (enable) {
+               gate = FIELD_SET(gate, CURRENT_GATE, DE,  ON);
+               gate = FIELD_SET(gate, CURRENT_GATE, CSC, ON);
+       } else {
+               gate = FIELD_SET(gate, CURRENT_GATE, DE,  OFF);
+               gate = FIELD_SET(gate, CURRENT_GATE, CSC, OFF);
+       }
 
-    setCurrentGate(gate);
+       setCurrentGate(gate);
 }
 
 void enableDMA(unsigned int enable)
 {
-    uint32_t gate;
+       u32 gate;
 
-    /* Enable DMA Gate */
-    gate = PEEK32(CURRENT_GATE);
-    if (enable)
-        gate = FIELD_SET(gate, CURRENT_GATE, DMA, ON);
-    else
-        gate = FIELD_SET(gate, CURRENT_GATE, DMA, OFF);
+       /* Enable DMA Gate */
+       gate = PEEK32(CURRENT_GATE);
+       if (enable)
+               gate = FIELD_SET(gate, CURRENT_GATE, DMA, ON);
+       else
+               gate = FIELD_SET(gate, CURRENT_GATE, DMA, OFF);
 
-    setCurrentGate(gate);
+       setCurrentGate(gate);
 }
 
 /*
@@ -190,33 +141,16 @@ void enableDMA(unsigned int enable)
  */
 void enableGPIO(unsigned int enable)
 {
-    uint32_t gate;
-
-    /* Enable GPIO Gate */
-    gate = PEEK32(CURRENT_GATE);
-    if (enable)
-        gate = FIELD_SET(gate, CURRENT_GATE, GPIO, ON);
-    else
-        gate = FIELD_SET(gate, CURRENT_GATE, GPIO, OFF);
-
-    setCurrentGate(gate);
-}
-
-/*
- * This function enable/disable the PWM Engine
- */
-void enablePWM(unsigned int enable)
-{
-    uint32_t gate;
+       u32 gate;
 
-    /* Enable PWM Gate */
-    gate = PEEK32(CURRENT_GATE);
-    if (enable)
-        gate = FIELD_SET(gate, CURRENT_GATE, PWM, ON);
-    else
-        gate = FIELD_SET(gate, CURRENT_GATE, PWM, OFF);
+       /* Enable GPIO Gate */
+       gate = PEEK32(CURRENT_GATE);
+       if (enable)
+               gate = FIELD_SET(gate, CURRENT_GATE, GPIO, ON);
+       else
+               gate = FIELD_SET(gate, CURRENT_GATE, GPIO, OFF);
 
-    setCurrentGate(gate);
+       setCurrentGate(gate);
 }
 
 /*
@@ -224,16 +158,16 @@ void enablePWM(unsigned int enable)
  */
 void enableI2C(unsigned int enable)
 {
-    uint32_t gate;
+       u32 gate;
 
-    /* Enable I2C Gate */
-    gate = PEEK32(CURRENT_GATE);
-    if (enable)
-        gate = FIELD_SET(gate, CURRENT_GATE, I2C, ON);
-    else
-        gate = FIELD_SET(gate, CURRENT_GATE, I2C, OFF);
+       /* Enable I2C Gate */
+       gate = PEEK32(CURRENT_GATE);
+       if (enable)
+               gate = FIELD_SET(gate, CURRENT_GATE, I2C, ON);
+       else
+       gate = FIELD_SET(gate, CURRENT_GATE, I2C, OFF);
 
-    setCurrentGate(gate);
+       setCurrentGate(gate);
 }