]> git.dujemihanovic.xyz Git - u-boot.git/commitdiff
arm64: zynqmp: Switch SOM to shared psu configuration
authorMichal Simek <michal.simek@xilinx.com>
Thu, 18 Nov 2021 11:58:15 +0000 (12:58 +0100)
committerMichal Simek <michal.simek@xilinx.com>
Wed, 5 Jan 2022 09:22:02 +0000 (10:22 +0100)
Previous psu init was targeting SOM + KV260 carrier card and also contain
configurations for other devices on carrier card. This config is removing
all expected configurations for CC and let U-Boot to handle all of it self.
This configuration is designed for SOM itself (and I would bet without
eMMC).

Signed-off-by: Michal Simek <michal.simek@xilinx.com>
Link: https://lore.kernel.org/r/5782131058dc372befd3fdb4dceabeea5ba56606.1637236693.git.michal.simek@xilinx.com
board/xilinx/zynqmp/zynqmp-sm-k26-revA/psu_init_gpl.c

index c448f2abb1a5f31c732137eb58eaee0ec843fa58..ed025790bc3a58c5fbb7369d0ffa2598bc1ad63f 100644 (file)
@@ -9,33 +9,31 @@
 static unsigned long psu_pll_init_data(void)
 {
        psu_mask_write(0xFF5E0034, 0xFE7FEDEFU, 0x7E4B0C62U);
-       psu_mask_write(0xFF5E0030, 0x00717F00U, 0x00014600U);
+       psu_mask_write(0xFF5E0030, 0x00717F00U, 0x00014000U);
        psu_mask_write(0xFF5E0030, 0x00000008U, 0x00000008U);
        psu_mask_write(0xFF5E0030, 0x00000001U, 0x00000001U);
        psu_mask_write(0xFF5E0030, 0x00000001U, 0x00000000U);
        mask_poll(0xFF5E0040, 0x00000002U);
        psu_mask_write(0xFF5E0030, 0x00000008U, 0x00000000U);
-       psu_mask_write(0xFF5E0048, 0x00003F00U, 0x00000300U);
-       psu_mask_write(0xFF5E0038, 0x8000FFFFU, 0x00000000U);
+       psu_mask_write(0xFF5E0048, 0x00003F00U, 0x00000200U);
        psu_mask_write(0xFF5E0108, 0x013F3F07U, 0x01012300U);
-       psu_mask_write(0xFF5E0024, 0xFE7FEDEFU, 0x7E672C6CU);
-       psu_mask_write(0xFF5E0020, 0x00717F00U, 0x00002D00U);
+       psu_mask_write(0xFF5E0024, 0xFE7FEDEFU, 0x7E4E2C62U);
+       psu_mask_write(0xFF5E0020, 0x00717F00U, 0x00013C00U);
        psu_mask_write(0xFF5E0020, 0x00000008U, 0x00000008U);
        psu_mask_write(0xFF5E0020, 0x00000001U, 0x00000001U);
        psu_mask_write(0xFF5E0020, 0x00000001U, 0x00000000U);
        mask_poll(0xFF5E0040, 0x00000001U);
        psu_mask_write(0xFF5E0020, 0x00000008U, 0x00000000U);
-       psu_mask_write(0xFF5E0044, 0x00003F00U, 0x00000300U);
-       psu_mask_write(0xFF5E0028, 0x8000FFFFU, 0x00000000U);
+       psu_mask_write(0xFF5E0044, 0x00003F00U, 0x00000200U);
        psu_mask_write(0xFD1A0024, 0xFE7FEDEFU, 0x7E4B0C62U);
-       psu_mask_write(0xFD1A0020, 0x00717F00U, 0x00014800U);
+       psu_mask_write(0xFD1A0020, 0x00717F00U, 0x00015000U);
        psu_mask_write(0xFD1A0020, 0x00000008U, 0x00000008U);
        psu_mask_write(0xFD1A0020, 0x00000001U, 0x00000001U);
        psu_mask_write(0xFD1A0020, 0x00000001U, 0x00000000U);
        mask_poll(0xFD1A0044, 0x00000001U);
        psu_mask_write(0xFD1A0020, 0x00000008U, 0x00000000U);
        psu_mask_write(0xFD1A0048, 0x00003F00U, 0x00000300U);
-       psu_mask_write(0xFD1A0028, 0x8000FFFFU, 0x00000000U);
+       psu_mask_write(0xFD1A0028, 0x8000FFFFU, 0x80000033U);
        psu_mask_write(0xFD1A0030, 0xFE7FEDEFU, 0x7E4B0C62U);
        psu_mask_write(0xFD1A002C, 0x00717F00U, 0x00014000U);
        psu_mask_write(0xFD1A002C, 0x00000008U, 0x00000008U);
@@ -43,58 +41,43 @@ static unsigned long psu_pll_init_data(void)
        psu_mask_write(0xFD1A002C, 0x00000001U, 0x00000000U);
        mask_poll(0xFD1A0044, 0x00000002U);
        psu_mask_write(0xFD1A002C, 0x00000008U, 0x00000000U);
-       psu_mask_write(0xFD1A004C, 0x00003F00U, 0x00000300U);
-       psu_mask_write(0xFD1A0034, 0x8000FFFFU, 0x00000000U);
-       psu_mask_write(0xFD1A003C, 0xFE7FEDEFU, 0x7E4B0C62U);
-       psu_mask_write(0xFD1A0038, 0x00717F00U, 0x00014700U);
+       psu_mask_write(0xFD1A004C, 0x00003F00U, 0x00000200U);
+       psu_mask_write(0xFD1A003C, 0xFE7FEDEFU, 0x7E4B0C82U);
+       psu_mask_write(0xFD1A0038, 0x00717F00U, 0x00015A00U);
        psu_mask_write(0xFD1A0038, 0x00000008U, 0x00000008U);
        psu_mask_write(0xFD1A0038, 0x00000001U, 0x00000001U);
        psu_mask_write(0xFD1A0038, 0x00000001U, 0x00000000U);
        mask_poll(0xFD1A0044, 0x00000004U);
        psu_mask_write(0xFD1A0038, 0x00000008U, 0x00000000U);
        psu_mask_write(0xFD1A0050, 0x00003F00U, 0x00000300U);
-       psu_mask_write(0xFD1A0040, 0x8000FFFFU, 0x00000000U);
 
        return 1;
 }
 
 static unsigned long psu_clock_init_data(void)
 {
-       psu_mask_write(0xFF5E005C, 0x063F3F07U, 0x06010C00U);
-       psu_mask_write(0xFF5E0100, 0x013F3F07U, 0x01010600U);
-       psu_mask_write(0xFF5E0060, 0x023F3F07U, 0x02010600U);
-       psu_mask_write(0xFF5E004C, 0x023F3F07U, 0x020F0500U);
-       psu_mask_write(0xFF5E0068, 0x013F3F07U, 0x01010C00U);
-       psu_mask_write(0xFF5E006C, 0x013F3F07U, 0x01010800U);
-       psu_mask_write(0xFF5E0070, 0x013F3F07U, 0x01010800U);
-       psu_mask_write(0xFF18030C, 0x00020003U, 0x00000000U);
-       psu_mask_write(0xFF5E0078, 0x013F3F07U, 0x01010F00U);
-       psu_mask_write(0xFF5E0124, 0x013F3F07U, 0x01010F00U);
-       psu_mask_write(0xFF5E0080, 0x013F3F07U, 0x01010800U);
-       psu_mask_write(0xFF5E0090, 0x01003F07U, 0x01000302U);
-       psu_mask_write(0xFF5E009C, 0x01003F07U, 0x01000602U);
-       psu_mask_write(0xFF5E00A4, 0x01003F07U, 0x01000800U);
-       psu_mask_write(0xFF5E00A8, 0x01003F07U, 0x01000302U);
-       psu_mask_write(0xFF5E00AC, 0x01003F07U, 0x01000F02U);
-       psu_mask_write(0xFF5E00B0, 0x01003F07U, 0x01000602U);
-       psu_mask_write(0xFF5E00B8, 0x01003F07U, 0x01000302U);
-       psu_mask_write(0xFF5E00C0, 0x013F3F07U, 0x01010F00U);
-       psu_mask_write(0xFF5E00C4, 0x013F3F07U, 0x01040F00U);
-       psu_mask_write(0xFF5E00C8, 0x013F3F07U, 0x01010500U);
-       psu_mask_write(0xFF5E00CC, 0x013F3F07U, 0x01010400U);
-       psu_mask_write(0xFF5E0108, 0x013F3F07U, 0x01011D02U);
+       psu_mask_write(0xFF5E0068, 0x013F3F07U, 0x01010800U);
+       psu_mask_write(0xFF5E0078, 0x013F3F07U, 0x01010A00U);
+       psu_mask_write(0xFF5E0124, 0x013F3F07U, 0x01010A00U);
+       psu_mask_write(0xFF5E0080, 0x013F3F07U, 0x01010500U);
+       psu_mask_write(0xFF5E0090, 0x01003F07U, 0x01000200U);
+       psu_mask_write(0xFF5E009C, 0x01003F07U, 0x01000402U);
+       psu_mask_write(0xFF5E00A4, 0x01003F07U, 0x01000500U);
+       psu_mask_write(0xFF5E00A8, 0x01003F07U, 0x01000202U);
+       psu_mask_write(0xFF5E00AC, 0x01003F07U, 0x01000A02U);
+       psu_mask_write(0xFF5E00B0, 0x01003F07U, 0x01000402U);
+       psu_mask_write(0xFF5E00B8, 0x01003F07U, 0x01000202U);
+       psu_mask_write(0xFF5E00C0, 0x013F3F07U, 0x01010A00U);
+       psu_mask_write(0xFF5E00C4, 0x013F3F07U, 0x01010A00U);
+       psu_mask_write(0xFF5E0108, 0x013F3F07U, 0x01011402U);
        psu_mask_write(0xFF5E0104, 0x00000007U, 0x00000000U);
-       psu_mask_write(0xFF5E0128, 0x01003F07U, 0x01000F00U);
-       psu_mask_write(0xFD1A00A0, 0x01003F07U, 0x01000200U);
-       psu_mask_write(0xFD1A0070, 0x013F3F07U, 0x01010400U);
-       psu_mask_write(0xFD1A0074, 0x013F3F07U, 0x01011003U);
-       psu_mask_write(0xFD1A007C, 0x013F3F07U, 0x01010F03U);
+       psu_mask_write(0xFF5E0128, 0x01003F07U, 0x01000A00U);
        psu_mask_write(0xFD1A0060, 0x03003F07U, 0x03000100U);
        psu_mask_write(0xFD1A0068, 0x01003F07U, 0x01000200U);
        psu_mask_write(0xFD1A0080, 0x00003F07U, 0x00000200U);
        psu_mask_write(0xFD1A0084, 0x07003F07U, 0x07000100U);
-       psu_mask_write(0xFD1A00B8, 0x01003F07U, 0x01000200U);
-       psu_mask_write(0xFD1A00BC, 0x01003F07U, 0x01000200U);
+       psu_mask_write(0xFD1A00B8, 0x01003F07U, 0x01000203U);
+       psu_mask_write(0xFD1A00BC, 0x01003F07U, 0x01000300U);
        psu_mask_write(0xFD1A00C0, 0x01003F07U, 0x01000203U);
        psu_mask_write(0xFD1A00C4, 0x01003F07U, 0x01000502U);
        psu_mask_write(0xFD1A00F8, 0x00003F07U, 0x00000200U);
@@ -133,8 +116,8 @@ static unsigned long psu_ddr_init_data(void)
        psu_mask_write(0xFD0700EC, 0xFFFF0000U, 0x08190000U);
        psu_mask_write(0xFD0700F0, 0x0000003FU, 0x00000010U);
        psu_mask_write(0xFD0700F4, 0x00000FFFU, 0x0000066FU);
-       psu_mask_write(0xFD070100, 0x7F3F7F3FU, 0x11102411U);
-       psu_mask_write(0xFD070104, 0x001F1F7FU, 0x00040419U);
+       psu_mask_write(0xFD070100, 0x7F3F7F3FU, 0x11102412U);
+       psu_mask_write(0xFD070104, 0x001F1F7FU, 0x0004041AU);
        psu_mask_write(0xFD070108, 0x3F3F3F3FU, 0x0708060DU);
        psu_mask_write(0xFD07010C, 0x3FF3F3FFU, 0x0050400CU);
        psu_mask_write(0xFD070110, 0x1F0F0F1FU, 0x08030409U);
@@ -234,14 +217,14 @@ static unsigned long psu_ddr_init_data(void)
        psu_mask_write(0xFD080068, 0xFFFFFFFFU, 0x01100000U);
        psu_mask_write(0xFD080090, 0xFFFFFFFFU, 0x02A04161U);
        psu_mask_write(0xFD0800C0, 0xFFFFFFFFU, 0x00000000U);
-       psu_mask_write(0xFD0800C4, 0xFFFFFFFFU, 0x000000E3U);
+       psu_mask_write(0xFD0800C4, 0xFFFFFFFFU, 0x000000E4U);
        psu_mask_write(0xFD080100, 0xFFFFFFFFU, 0x0800040CU);
-       psu_mask_write(0xFD080110, 0xFFFFFFFFU, 0x07221008U);
+       psu_mask_write(0xFD080110, 0xFFFFFFFFU, 0x07241008U);
        psu_mask_write(0xFD080114, 0xFFFFFFFFU, 0x28200008U);
        psu_mask_write(0xFD080118, 0xFFFFFFFFU, 0x000F0300U);
        psu_mask_write(0xFD08011C, 0xFFFFFFFFU, 0x83000800U);
        psu_mask_write(0xFD080120, 0xFFFFFFFFU, 0x01762B07U);
-       psu_mask_write(0xFD080124, 0xFFFFFFFFU, 0x00311008U);
+       psu_mask_write(0xFD080124, 0xFFFFFFFFU, 0x00331008U);
        psu_mask_write(0xFD080128, 0xFFFFFFFFU, 0x00000E10U);
        psu_mask_write(0xFD080140, 0xFFFFFFFFU, 0x08400020U);
        psu_mask_write(0xFD080144, 0xFFFFFFFFU, 0x00000C80U);
@@ -407,90 +390,63 @@ static unsigned long psu_mio_init_data(void)
        psu_mask_write(0xFF180028, 0x000000FEU, 0x00000080U);
        psu_mask_write(0xFF18002C, 0x000000FEU, 0x00000080U);
        psu_mask_write(0xFF180030, 0x000000FEU, 0x00000000U);
-       psu_mask_write(0xFF180034, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF180038, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF18003C, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF180040, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF180044, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF180048, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF18004C, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF180050, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF180054, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF180058, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF18005C, 0x000000FEU, 0x00000008U);
+       psu_mask_write(0xFF180034, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180038, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF18003C, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180040, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180044, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180048, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF18004C, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180050, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180054, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180058, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF18005C, 0x000000FEU, 0x00000000U);
        psu_mask_write(0xFF180060, 0x000000FEU, 0x00000040U);
        psu_mask_write(0xFF180064, 0x000000FEU, 0x00000040U);
        psu_mask_write(0xFF180068, 0x000000FEU, 0x00000008U);
-       psu_mask_write(0xFF18006C, 0x000000FEU, 0x00000018U);
-       psu_mask_write(0xFF180070, 0x000000FEU, 0x00000018U);
-       psu_mask_write(0xFF180074, 0x000000FEU, 0x00000018U);
-       psu_mask_write(0xFF180078, 0x000000FEU, 0x00000018U);
+       psu_mask_write(0xFF18006C, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180070, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180074, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180078, 0x000000FEU, 0x00000000U);
        psu_mask_write(0xFF18007C, 0x000000FEU, 0x00000008U);
        psu_mask_write(0xFF180080, 0x000000FEU, 0x00000008U);
        psu_mask_write(0xFF180084, 0x000000FEU, 0x00000008U);
        psu_mask_write(0xFF180090, 0x000000FEU, 0x000000C0U);
        psu_mask_write(0xFF180094, 0x000000FEU, 0x000000C0U);
        psu_mask_write(0xFF180098, 0x000000FEU, 0x00000000U);
-       psu_mask_write(0xFF18009C, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800A0, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800A4, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800A8, 0x000000FEU, 0x00000010U);
+       psu_mask_write(0xFF18009C, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800A0, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800A4, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800A8, 0x000000FEU, 0x00000000U);
        psu_mask_write(0xFF1800AC, 0x000000FEU, 0x00000000U);
        psu_mask_write(0xFF1800B0, 0x000000FEU, 0x00000000U);
-       psu_mask_write(0xFF1800B4, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800B8, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800BC, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800C0, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800C4, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800C8, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800CC, 0x000000FEU, 0x00000010U);
-       psu_mask_write(0xFF1800D0, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800D4, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800D8, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800DC, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800E0, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800E4, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800E8, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800EC, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800F0, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800F4, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800F8, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF1800FC, 0x000000FEU, 0x00000004U);
-       psu_mask_write(0xFF180100, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180104, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180108, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF18010C, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180110, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180114, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180118, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF18011C, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180120, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180124, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180128, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF18012C, 0x000000FEU, 0x00000002U);
-       psu_mask_write(0xFF180130, 0x000000FEU, 0x000000C0U);
-       psu_mask_write(0xFF180134, 0x000000FEU, 0x000000C0U);
-       psu_mask_write(0xFF180204, 0xFFFFFFFFU, 0xD4000000U);
-       psu_mask_write(0xFF180208, 0xFFFFFFFFU, 0x00B02020U);
-       psu_mask_write(0xFF18020C, 0x00003FFFU, 0x00000FC0U);
-       psu_mask_write(0xFF180138, 0x03FFFFFFU, 0x03FFFFFFU);
+       psu_mask_write(0xFF1800B4, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800B8, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800BC, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800C0, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800C4, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800C8, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF1800CC, 0x000000FEU, 0x00000000U);
+       psu_mask_write(0xFF180204, 0xFFFFFFFFU, 0x84000000U);
+       psu_mask_write(0xFF180208, 0x000FFFFFU, 0x00000020U);
+       psu_mask_write(0xFF180138, 0x03FFFFFFU, 0x00000000U);
        psu_mask_write(0xFF18013C, 0x03FFFFFFU, 0x03FFFFFFU);
        psu_mask_write(0xFF180140, 0x03FFFFFFU, 0x00000000U);
        psu_mask_write(0xFF180144, 0x03FFFFFFU, 0x03FFFFFFU);
        psu_mask_write(0xFF180148, 0x03FFFFFFU, 0x03FFFFFFU);
-       psu_mask_write(0xFF18014C, 0x03FFFFFFU, 0x00000000U);
-       psu_mask_write(0xFF180154, 0x03FFFFFFU, 0x03FFFFFFU);
+       psu_mask_write(0xFF18014C, 0x03FFFFFFU, 0x03FFFFFFU);
+       psu_mask_write(0xFF180154, 0x03FFFFFFU, 0x00080835U);
        psu_mask_write(0xFF180158, 0x03FFFFFFU, 0x03FFFFFFU);
        psu_mask_write(0xFF18015C, 0x03FFFFFFU, 0x00000000U);
        psu_mask_write(0xFF180160, 0x03FFFFFFU, 0x03FFFFFFU);
        psu_mask_write(0xFF180164, 0x03FFFFFFU, 0x03FFFFFFU);
-       psu_mask_write(0xFF180168, 0x03FFFFFFU, 0x00000000U);
-       psu_mask_write(0xFF180170, 0x03FFFFFFU, 0x03FFFFFFU);
+       psu_mask_write(0xFF180168, 0x03FFFFFFU, 0x03F7F7CAU);
+       psu_mask_write(0xFF180170, 0x03FFFFFFU, 0x00FC000BU);
        psu_mask_write(0xFF180174, 0x03FFFFFFU, 0x03FFFFFFU);
        psu_mask_write(0xFF180178, 0x03FFFFFFU, 0x00000000U);
        psu_mask_write(0xFF18017C, 0x03FFFFFFU, 0x03FFFFFFU);
-       psu_mask_write(0xFF180180, 0x03FFFFFFU, 0x0357FFFFU);
-       psu_mask_write(0xFF180184, 0x03FFFFFFU, 0x00000000U);
+       psu_mask_write(0xFF180180, 0x03FFFFFFU, 0x03FFFFFFU);
+       psu_mask_write(0xFF180184, 0x03FFFFFFU, 0x0303FFF4U);
        psu_mask_write(0xFF180200, 0x0000000FU, 0x00000000U);
 
        return 1;
@@ -506,24 +462,15 @@ static unsigned long psu_peripherals_pre_init_data(void)
 
 static unsigned long psu_peripherals_init_data(void)
 {
-       psu_mask_write(0xFD1A0100, 0x0001007EU, 0x00000000U);
+       psu_mask_write(0xFD1A0100, 0x0000807CU, 0x00000000U);
        psu_mask_write(0xFF5E0238, 0x001A0000U, 0x00000000U);
        psu_mask_write(0xFF5E023C, 0x0093C018U, 0x00000000U);
-       psu_mask_write(0xFF5E0230, 0x00000008U, 0x00000000U);
        psu_mask_write(0xFF5E0238, 0x00000001U, 0x00000000U);
        psu_mask_write(0xFF180390, 0x00000004U, 0x00000004U);
-       psu_mask_write(0xFF5E023C, 0x00000400U, 0x00000000U);
-       psu_mask_write(0xFF5E0238, 0x00000060U, 0x00000000U);
-       psu_mask_write(0xFF180310, 0x00008001U, 0x00000001U);
-       psu_mask_write(0xFF180320, 0x33843384U, 0x02841284U);
-       psu_mask_write(0xFF18031C, 0x00007FFEU, 0x00006450U);
-       psu_mask_write(0xFF180358, 0x00080000U, 0x00080000U);
-       psu_mask_write(0xFF18031C, 0x7FFE0000U, 0x64500000U);
-       psu_mask_write(0xFF180358, 0x00000008U, 0x00000008U);
-       psu_mask_write(0xFF180324, 0x000003C0U, 0x00000000U);
-       psu_mask_write(0xFF180324, 0x03C00000U, 0x00000000U);
        psu_mask_write(0xFF5E0238, 0x00000400U, 0x00000000U);
+       psu_mask_write(0xFF5E0238, 0x00008000U, 0x00000000U);
        psu_mask_write(0xFF5E0238, 0x00000010U, 0x00000000U);
+       psu_mask_write(0xFF5E0238, 0x00007800U, 0x00000000U);
        psu_mask_write(0xFF5E0238, 0x00000004U, 0x00000000U);
        psu_mask_write(0xFF010034, 0x000000FFU, 0x00000006U);
        psu_mask_write(0xFF010018, 0x0000FFFFU, 0x0000007CU);
@@ -536,13 +483,6 @@ static unsigned long psu_peripherals_init_data(void)
        psu_mask_write(0xFFA60040, 0x80000000U, 0x80000000U);
        psu_mask_write(0xFF260020, 0xFFFFFFFFU, 0x05F5DD18U);
        psu_mask_write(0xFF260000, 0x00000001U, 0x00000001U);
-       psu_mask_write(0xFF0A0244, 0x03FFFFFFU, 0x00040000U);
-       psu_mask_write(0xFF0A0248, 0x03FFFFFFU, 0x00040000U);
-       psu_mask_write(0xFF0A000C, 0x03FF03FFU, 0x03FB0004U);
-       mask_delay(1);
-       psu_mask_write(0xFF0A000C, 0x03FF03FFU, 0x03FB0000U);
-       mask_delay(5);
-       psu_mask_write(0xFF0A000C, 0x03FF03FFU, 0x03FB0004U);
        return 1;
 }