board: cssi: Initialise port F on MIAE

When equipped with the SRSA audio board, MIAE equipment
has an additional port called port F.

Initialise that port just like other ports of the board, so
that it is already configured when starting Linux kernel.

Signed-off-by: Hugo Dubois <hugo.dubois.ext@csgroup.eu>
Reviewed-by: CASAUBON Jean Michel <jean-michel.casaubon@csgroup.eu>
Signed-off-by: Christophe Leroy <christophe.leroy@csgroup.eu>

diff --git a/board/cssi/common/common.c b/board/cssi/common/common.c
index 7ecf7726209c72837b12ccb23321d92f32a23c19..6848efd43be51c39e53d3048842cbc424e259991 100644 (file)
--- a/board/cssi/common/common.c
+++ b/board/cssi/common/common.c
@@ -208,12 +208,44 @@ void misc_init_r_common(void)
        }
 }
 
+static void iop_setup_fpgam_common(void)
+{
+       u8 far_id = in_8(ADDR_FPGA_R_BASE + 0x43) >> 5;
+
+       if (far_id == FAR_CASRSA) {
+               /*
+                * PFDIR[15]  = 0 [0x01]
+                * PFDIR[14]  = 1 [0x02]
+                * PFDIR[13]  = 1 [0x04]
+                */
+               clrsetbits_8(ADDR_FPGA_R_BASE + 0x37, 0x01, 0x06);
+               /*
+                * PFODR[15]  = 1 [0x01]
+                * PFODR[14]  = 0 [0x02]
+                * PFODR[13]  = 0 [0x04]
+                */
+               clrsetbits_8(ADDR_FPGA_R_BASE + 0x39, 0x06, 0x01);
+               /*
+                * PFDAT[15]  = 0 [0x01]
+                * PFDAT[14]  = 1 [0x02]
+                * PFDAT[13]  = 1 [0x04]
+                * PFDAT[12]  = 1 [0x08]
+                */
+               clrsetbits_8(ADDR_FPGA_R_BASE + 0x3B, 0x01, 0x0E);
+
+               /* Setup TOR_OUT */
+               out_8(ADDR_FPGA_R_BASE + 0x32, 0x2A);
+       }
+}
+
 void iop_setup_common(void)
 {
        u8 type = in_8(ADDR_FPGA_R_BASE);
 
-       if (type == TYPE_MCR)
+       if (type == TYPE_MCR) {
                iop_setup_mcr();
-       else if (type == TYPE_MIAE)
+       } else if (type == TYPE_MIAE) {
                iop_setup_miae();
+               iop_setup_fpgam_common();
+       }
 }