-static void bwfilter_table(struct b44 *bp, u8 *pp, u32 bytes, u32 table_offset)
-{
- u32 i;
- u32 *pattern = (u32 *) pp;
-
- for (i = 0; i < bytes; i += sizeof(u32)) {
- bw32(bp, B44_FILT_ADDR, table_offset + i);
- bw32(bp, B44_FILT_DATA, pattern[i / sizeof(u32)]);
- }
-}
-
-static int b44_magic_pattern(u8 *macaddr, u8 *ppattern, u8 *pmask, int offset)
-{
- int magicsync = 6;
- int k, j, len = offset;
- int ethaddr_bytes = ETH_ALEN;
-
- memset(ppattern + offset, 0xff, magicsync);
- for (j = 0; j < magicsync; j++)
- set_bit(len++, (unsigned long *) pmask);
-
- for (j = 0; j < B44_MAX_PATTERNS; j++) {
- if ((B44_PATTERN_SIZE - len) >= ETH_ALEN)
- ethaddr_bytes = ETH_ALEN;
- else
- ethaddr_bytes = B44_PATTERN_SIZE - len;
- if (ethaddr_bytes <=0)
- break;
- for (k = 0; k< ethaddr_bytes; k++) {
- ppattern[offset + magicsync +
- (j * ETH_ALEN) + k] = macaddr[k];
- len++;
- set_bit(len, (unsigned long *) pmask);
- }
- }
- return len - 1;
-}
-
-/* Setup magic packet patterns in the b44 WOL
- * pattern matching filter.
- */
-static void b44_setup_pseudo_magicp(struct b44 *bp)
-{
-
- u32 val;
- int plen0, plen1, plen2;
- u8 *pwol_pattern;
- u8 pwol_mask[B44_PMASK_SIZE];
-
- pwol_pattern = kmalloc(B44_PATTERN_SIZE, GFP_KERNEL);
- if (!pwol_pattern) {
- printk(KERN_ERR PFX "Memory not available for WOL\n");
- return;
- }
-
- /* Ipv4 magic packet pattern - pattern 0.*/
- memset(pwol_pattern, 0, B44_PATTERN_SIZE);
- memset(pwol_mask, 0, B44_PMASK_SIZE);
- plen0 = b44_magic_pattern(bp->dev->dev_addr, pwol_pattern, pwol_mask,
- B44_ETHIPV4UDP_HLEN);
-
- bwfilter_table(bp, pwol_pattern, B44_PATTERN_SIZE, B44_PATTERN_BASE);
- bwfilter_table(bp, pwol_mask, B44_PMASK_SIZE, B44_PMASK_BASE);
-
- /* Raw ethernet II magic packet pattern - pattern 1 */
- memset(pwol_pattern, 0, B44_PATTERN_SIZE);
- memset(pwol_mask, 0, B44_PMASK_SIZE);
- plen1 = b44_magic_pattern(bp->dev->dev_addr, pwol_pattern, pwol_mask,
- ETH_HLEN);
-
- bwfilter_table(bp, pwol_pattern, B44_PATTERN_SIZE,
- B44_PATTERN_BASE + B44_PATTERN_SIZE);
- bwfilter_table(bp, pwol_mask, B44_PMASK_SIZE,
- B44_PMASK_BASE + B44_PMASK_SIZE);
-
- /* Ipv6 magic packet pattern - pattern 2 */
- memset(pwol_pattern, 0, B44_PATTERN_SIZE);
- memset(pwol_mask, 0, B44_PMASK_SIZE);
- plen2 = b44_magic_pattern(bp->dev->dev_addr, pwol_pattern, pwol_mask,
- B44_ETHIPV6UDP_HLEN);
-
- bwfilter_table(bp, pwol_pattern, B44_PATTERN_SIZE,
- B44_PATTERN_BASE + B44_PATTERN_SIZE + B44_PATTERN_SIZE);
- bwfilter_table(bp, pwol_mask, B44_PMASK_SIZE,
- B44_PMASK_BASE + B44_PMASK_SIZE + B44_PMASK_SIZE);
-
- kfree(pwol_pattern);
-
- /* set these pattern's lengths: one less than each real length */
- val = plen0 | (plen1 << 8) | (plen2 << 16) | WKUP_LEN_ENABLE_THREE;
- bw32(bp, B44_WKUP_LEN, val);
-
- /* enable wakeup pattern matching */
- val = br32(bp, B44_DEVCTRL);
- bw32(bp, B44_DEVCTRL, val | DEVCTRL_PFE);
-
-}
-
-static void b44_setup_wol(struct b44 *bp)
-{
- u32 val;
- u16 pmval;
-
- bw32(bp, B44_RXCONFIG, RXCONFIG_ALLMULTI);
-
- if (bp->flags & B44_FLAG_B0_ANDLATER) {
-
- bw32(bp, B44_WKUP_LEN, WKUP_LEN_DISABLE);
-
- val = bp->dev->dev_addr[2] << 24 |
- bp->dev->dev_addr[3] << 16 |
- bp->dev->dev_addr[4] << 8 |
- bp->dev->dev_addr[5];
- bw32(bp, B44_ADDR_LO, val);
-
- val = bp->dev->dev_addr[0] << 8 |
- bp->dev->dev_addr[1];
- bw32(bp, B44_ADDR_HI, val);
-
- val = br32(bp, B44_DEVCTRL);
- bw32(bp, B44_DEVCTRL, val | DEVCTRL_MPM | DEVCTRL_PFE);
-
- } else {
- b44_setup_pseudo_magicp(bp);
- }
-
- val = br32(bp, B44_SBTMSLOW);
- bw32(bp, B44_SBTMSLOW, val | SBTMSLOW_PE);
-
- pci_read_config_word(bp->pdev, SSB_PMCSR, &pmval);
- pci_write_config_word(bp->pdev, SSB_PMCSR, pmval | SSB_PE);
-
-}
-