tseg1 = bt->prop_seg + bt->phase_seg1 - 1;
        tseg2 = bt->phase_seg2 - 1;
 
-       if (priv->can.ctrlmode & CAN_CTRLMODE_FD) {
-               /* CAN FD only mode */
+       if ((priv->can.ctrlmode & CAN_CTRLMODE_FD) || gpriv->info->shared_can_regs) {
                cfg = (RCANFD_NCFG_NTSEG1(gpriv, tseg1) | RCANFD_NCFG_NBRP(brp) |
                       RCANFD_NCFG_NSJW(gpriv, sjw) | RCANFD_NCFG_NTSEG2(gpriv, tseg2));
+       } else {
+               cfg = (RCANFD_CFG_TSEG1(tseg1) | RCANFD_CFG_BRP(brp) |
+                      RCANFD_CFG_SJW(sjw) | RCANFD_CFG_TSEG2(tseg2));
+       }
 
-               rcar_canfd_write(priv->base, RCANFD_CCFG(ch), cfg);
+       rcar_canfd_write(priv->base, RCANFD_CCFG(ch), cfg);
 
+       if (priv->can.ctrlmode & CAN_CTRLMODE_FD) {
                /* Data bit timing settings */
                brp = dbt->brp - 1;
                sjw = dbt->sjw - 1;
                       RCANFD_DCFG_DSJW(gpriv, sjw) | RCANFD_DCFG_DTSEG2(gpriv, tseg2));
 
                rcar_canfd_write(priv->base, rcar_canfd_f_dcfg(gpriv, ch), cfg);
-       } else {
-               /* Classical CAN only mode */
-               if (gpriv->info->shared_can_regs) {
-                       cfg = (RCANFD_NCFG_NTSEG1(gpriv, tseg1) |
-                              RCANFD_NCFG_NBRP(brp) |
-                              RCANFD_NCFG_NSJW(gpriv, sjw) |
-                              RCANFD_NCFG_NTSEG2(gpriv, tseg2));
-               } else {
-                       cfg = (RCANFD_CFG_TSEG1(tseg1) |
-                              RCANFD_CFG_BRP(brp) |
-                              RCANFD_CFG_SJW(sjw) |
-                              RCANFD_CFG_TSEG2(tseg2));
-               }
-
-               rcar_canfd_write(priv->base, RCANFD_CCFG(ch), cfg);
        }
 }