[TG3]: Add nvram lock-out support for 5752 TPM

Add support for the NVRAM lock-out feature for TPM in 5752. If lock-out
is enabled, certain NVRAM registers cannot be written to.

Signed-off-by: Michael Chan <mchan@broadcom.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/tg3.c b/drivers/net/tg3.c
index dbdd3ecafdc1a003e1a74415f89d88f955d895a1..30154642573644f8c49ca0c39ff7c294f9ec806a 100644 (file)
--- a/drivers/net/tg3.c
+++ b/drivers/net/tg3.c
@@ -3731,6 +3731,28 @@ static void tg3_nvram_unlock(struct tg3 *tp)
                tw32_f(NVRAM_SWARB, SWARB_REQ_CLR1);
 }
 
+/* tp->lock is held. */
+static void tg3_enable_nvram_access(struct tg3 *tp)
+{
+       if ((tp->tg3_flags2 & TG3_FLG2_5750_PLUS) &&
+           !(tp->tg3_flags2 & TG3_FLG2_PROTECTED_NVRAM)) {
+               u32 nvaccess = tr32(NVRAM_ACCESS);
+
+               tw32(NVRAM_ACCESS, nvaccess | ACCESS_ENABLE);
+       }
+}
+
+/* tp->lock is held. */
+static void tg3_disable_nvram_access(struct tg3 *tp)
+{
+       if ((tp->tg3_flags2 & TG3_FLG2_5750_PLUS) &&
+           !(tp->tg3_flags2 & TG3_FLG2_PROTECTED_NVRAM)) {
+               u32 nvaccess = tr32(NVRAM_ACCESS);
+
+               tw32(NVRAM_ACCESS, nvaccess & ~ACCESS_ENABLE);
+       }
+}
+
 /* tp->lock is held. */
 static void tg3_write_sig_pre_reset(struct tg3 *tp, int kind)
 {
@@ -7102,6 +7124,10 @@ static void __devinit tg3_get_5752_nvram_info(struct tg3 *tp)
 
        nvcfg1 = tr32(NVRAM_CFG1);
 
+       /* NVRAM protection for TPM */
+       if (nvcfg1 & (1 << 27))
+               tp->tg3_flags2 |= TG3_FLG2_PROTECTED_NVRAM;
+
        switch (nvcfg1 & NVRAM_CFG1_5752VENDOR_MASK) {
                case FLASH_5752VENDOR_ATMEL_EEPROM_64KHZ:
                case FLASH_5752VENDOR_ATMEL_EEPROM_376KHZ:
@@ -7179,11 +7205,7 @@ static void __devinit tg3_nvram_init(struct tg3 *tp)
            GET_ASIC_REV(tp->pci_chip_rev_id) != ASIC_REV_5701) {
                tp->tg3_flags |= TG3_FLAG_NVRAM;
 
-               if (tp->tg3_flags2 & TG3_FLG2_5750_PLUS) {
-                       u32 nvaccess = tr32(NVRAM_ACCESS);
-
-                       tw32(NVRAM_ACCESS, nvaccess | ACCESS_ENABLE);
-               }
+               tg3_enable_nvram_access(tp);
 
                if (GET_ASIC_REV(tp->pci_chip_rev_id) == ASIC_REV_5752)
                        tg3_get_5752_nvram_info(tp);
@@ -7192,11 +7214,7 @@ static void __devinit tg3_nvram_init(struct tg3 *tp)
 
                tg3_get_nvram_size(tp);
 
-               if (tp->tg3_flags2 & TG3_FLG2_5750_PLUS) {
-                       u32 nvaccess = tr32(NVRAM_ACCESS);
-
-                       tw32(NVRAM_ACCESS, nvaccess & ~ACCESS_ENABLE);
-               }
+               tg3_disable_nvram_access(tp);
 
        } else {
                tp->tg3_flags &= ~(TG3_FLAG_NVRAM | TG3_FLAG_NVRAM_BUFFERED);
@@ -7285,11 +7303,7 @@ static int tg3_nvram_read(struct tg3 *tp, u32 offset, u32 *val)
 
        tg3_nvram_lock(tp);
 
-       if (tp->tg3_flags2 & TG3_FLG2_5750_PLUS) {
-               u32 nvaccess = tr32(NVRAM_ACCESS);
-
-               tw32_f(NVRAM_ACCESS, nvaccess | ACCESS_ENABLE);
-       }
+       tg3_enable_nvram_access(tp);
 
        tw32(NVRAM_ADDR, offset);
        ret = tg3_nvram_exec_cmd(tp, NVRAM_CMD_RD | NVRAM_CMD_GO |
@@ -7300,11 +7314,7 @@ static int tg3_nvram_read(struct tg3 *tp, u32 offset, u32 *val)
 
        tg3_nvram_unlock(tp);
 
-       if (tp->tg3_flags2 & TG3_FLG2_5750_PLUS) {
-               u32 nvaccess = tr32(NVRAM_ACCESS);
-
-               tw32_f(NVRAM_ACCESS, nvaccess & ~ACCESS_ENABLE);
-       }
+       tg3_disable_nvram_access(tp);
 
        return ret;
 }
@@ -7367,7 +7377,7 @@ static int tg3_nvram_write_block_unbuffered(struct tg3 *tp, u32 offset, u32 len,
 
        while (len) {
                int j;
-               u32 phy_addr, page_off, size, nvaccess;
+               u32 phy_addr, page_off, size;
 
                phy_addr = offset & ~pagemask;
        
@@ -7390,8 +7400,7 @@ static int tg3_nvram_write_block_unbuffered(struct tg3 *tp, u32 offset, u32 len,
 
                offset = offset + (pagesize - page_off);
 
-               nvaccess = tr32(NVRAM_ACCESS);
-               tw32_f(NVRAM_ACCESS, nvaccess | ACCESS_ENABLE);
+               tg3_enable_nvram_access(tp);
 
                /*
                 * Before we can erase the flash page, we need
@@ -7528,13 +7537,10 @@ static int tg3_nvram_write_block(struct tg3 *tp, u32 offset, u32 len, u8 *buf)
 
                tg3_nvram_lock(tp);
 
-               if (tp->tg3_flags2 & TG3_FLG2_5750_PLUS) {
-                       u32 nvaccess = tr32(NVRAM_ACCESS);
-
-                       tw32(NVRAM_ACCESS, nvaccess | ACCESS_ENABLE);
-
+               tg3_enable_nvram_access(tp);
+               if ((tp->tg3_flags2 & TG3_FLG2_5750_PLUS) &&
+                   !(tp->tg3_flags2 & TG3_FLG2_PROTECTED_NVRAM))
                        tw32(NVRAM_WRITE1, 0x406);
-               }
 
                grc_mode = tr32(GRC_MODE);
                tw32(GRC_MODE, grc_mode | GRC_MODE_NVRAM_WR_ENABLE);
@@ -7553,11 +7559,7 @@ static int tg3_nvram_write_block(struct tg3 *tp, u32 offset, u32 len, u8 *buf)
                grc_mode = tr32(GRC_MODE);
                tw32(GRC_MODE, grc_mode & ~GRC_MODE_NVRAM_WR_ENABLE);
 
-               if (tp->tg3_flags2 & TG3_FLG2_5750_PLUS) {
-                       u32 nvaccess = tr32(NVRAM_ACCESS);
-
-                       tw32(NVRAM_ACCESS, nvaccess & ~ACCESS_ENABLE);
-               }
+               tg3_disable_nvram_access(tp);
                tg3_nvram_unlock(tp);
        }
 

diff --git a/drivers/net/tg3.h b/drivers/net/tg3.h
index 261c2db7ce17c27d71c6e196e6e8a7b4c8d15d05..d3f03f0f4c46dba038884f893b5385ff9c6e9070 100644 (file)
--- a/drivers/net/tg3.h
+++ b/drivers/net/tg3.h
@@ -2122,6 +2122,7 @@ struct tg3 {
 #define TG3_FLG2_SERDES_PREEMPHASIS    0x00020000
 #define TG3_FLG2_5705_PLUS             0x00040000
 #define TG3_FLG2_5750_PLUS             0x00080000
+#define TG3_FLG2_PROTECTED_NVRAM       0x00100000
 
        u32                             split_mode_max_reqs;
 #define SPLIT_MODE_5704_MAX_REQ                3