Commit 6e2daa49 authored by Benjamin Herrenschmidt's avatar Benjamin Herrenschmidt Committed by Nicolas Pitre
Browse files

[ARM] orion5x: Base support for DNS-323 rev C1 



This patch adds the base support for this new HW revision to the existing
dns323-setup.c file. The SoC seems to be the same as rev B1, the GPIOs
are all wired differently though and the fan control isn't i2c based
anymore.

Signed-off-by: default avatarBenjamin Herrenschmidt <benh@kernel.crashing.org>
Signed-off-by: default avatarNicolas Pitre <nico@fluxnic.net>
parent 2f495c39

arch/arm/mach-orion5x/dns323-setup.c

+305 −62
Original line number Diff line number Diff line
@@ -3,6 +3,10 @@ 
 *

 * Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org>

 *

 * Support for HW Rev C1:

 *

 * Copyright (C) 2010 Benjamin Herrenschmidt <benh@kernel.crashing.org>

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU Lesser General Public License as

 * published by the Free Software Foundation; either version 2 of the
@@ -23,6 +27,8 @@ 
#include <linux/input.h>

#include <linux/i2c.h>

#include <linux/ata_platform.h>

#include <linux/phy.h>

#include <linux/marvell_phy.h>

#include <asm/mach-types.h>

#include <asm/gpio.h>

#include <asm/mach/arch.h>
@@ -31,6 +37,7 @@ 
#include "common.h"

#include "mpp.h"



/* Rev A1 and B1 */

#define DNS323_GPIO_LED_RIGHT_AMBER	1

#define DNS323_GPIO_LED_LEFT_AMBER	2

#define DNS323_GPIO_SYSTEM_UP		3
@@ -42,6 +49,23 @@ 
#define DNS323_GPIO_KEY_POWER		9

#define DNS323_GPIO_KEY_RESET		10



/* Rev C1 */

#define DNS323C_GPIO_KEY_POWER		1

#define DNS323C_GPIO_POWER_OFF		2

#define DNS323C_GPIO_LED_RIGHT_AMBER	8

#define DNS323C_GPIO_LED_LEFT_AMBER	9

#define DNS323C_GPIO_LED_POWER		17

#define DNS323C_GPIO_FAN_BIT1		18

#define DNS323C_GPIO_FAN_BIT0		19



/* Exposed to userspace, do not change */

enum {

	DNS323_REV_A1,	/* 0 */

	DNS323_REV_B1,	/* 1 */

	DNS323_REV_C1,	/* 2 */

};





/****************************************************************************

 * PCI setup

 */
@@ -68,21 +92,12 @@ static struct hw_pci dns323_pci __initdata = { 
	.map_irq	= dns323_pci_map_irq,

};



static int __init dns323_dev_id(void)

{

	u32 dev, rev;



	orion5x_pcie_id(&dev, &rev);



	return dev;

}



static int __init dns323_pci_init(void)

{

	/* The 5182 doesn't really use its PCI bus, and initialising PCI

	/* Rev B1 and C1 doesn't really use its PCI bus, and initialising PCI

	 * gets in the way of initialising the SATA controller.

	 */

	if (machine_is_dns323() && dns323_dev_id() != MV88F5182_DEV_ID)

	if (machine_is_dns323() && system_rev == DNS323_REV_A1)

		pci_common_init(&dns323_pci);



	return 0;
@@ -221,7 +236,7 @@ static int __init dns323_read_mac_addr(void) 
	}



	iounmap(mac_page);

	printk("DNS323: Found ethernet MAC address: ");

	printk("DNS-323: Found ethernet MAC address: ");

	for (i = 0; i < 6; i++)

		printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");
@@ -259,7 +274,7 @@ static int dns323_gpio_blink_set(unsigned gpio, int state, 
	return 0;

}



static struct gpio_led dns323_leds[] = {

static struct gpio_led dns323ab_leds[] = {

	{

		.name = "power:blue",

		.gpio = DNS323_GPIO_LED_POWER2,
@@ -275,9 +290,34 @@ static struct gpio_led dns323_leds[] = { 
	},

};



static struct gpio_led_platform_data dns323_led_data = {

	.num_leds	= ARRAY_SIZE(dns323_leds),

	.leds		= dns323_leds,



static struct gpio_led dns323c_leds[] = {

	{

		.name = "power:blue",

		.gpio = DNS323C_GPIO_LED_POWER,

		.default_trigger = "timer",

		.active_low = 1,

	}, {

		.name = "right:amber",

		.gpio = DNS323C_GPIO_LED_RIGHT_AMBER,

		.active_low = 1,

	}, {

		.name = "left:amber",

		.gpio = DNS323C_GPIO_LED_LEFT_AMBER,

		.active_low = 1,

	},

};





static struct gpio_led_platform_data dns323ab_led_data = {

	.num_leds	= ARRAY_SIZE(dns323ab_leds),

	.leds		= dns323ab_leds,

	.gpio_blink_set = dns323_gpio_blink_set,

};



static struct gpio_led_platform_data dns323c_led_data = {

	.num_leds	= ARRAY_SIZE(dns323c_leds),

	.leds		= dns323c_leds,

	.gpio_blink_set = dns323_gpio_blink_set,

};
@@ -285,7 +325,7 @@ static struct platform_device dns323_gpio_leds = { 
	.name		= "leds-gpio",

	.id		= -1,

	.dev		= {

		.platform_data	= &dns323_led_data,

		.platform_data	= &dns323ab_led_data,

	},

};
@@ -293,7 +333,7 @@ static struct platform_device dns323_gpio_leds = { 
 * GPIO Attached Keys

 */



static struct gpio_keys_button dns323_buttons[] = {

static struct gpio_keys_button dns323ab_buttons[] = {

	{

		.code		= KEY_RESTART,

		.gpio		= DNS323_GPIO_KEY_RESET,
@@ -307,9 +347,23 @@ static struct gpio_keys_button dns323_buttons[] = { 
	},

};



static struct gpio_keys_platform_data dns323_button_data = {

	.buttons	= dns323_buttons,

	.nbuttons	= ARRAY_SIZE(dns323_buttons),

static struct gpio_keys_platform_data dns323ab_button_data = {

	.buttons	= dns323ab_buttons,

	.nbuttons	= ARRAY_SIZE(dns323ab_buttons),

};



static struct gpio_keys_button dns323c_buttons[] = {

	{

		.code		= KEY_POWER,

		.gpio		= DNS323C_GPIO_KEY_POWER,

		.desc		= "Power Button",

		.active_low	= 1,

	},

};



static struct gpio_keys_platform_data dns323c_button_data = {

	.buttons	= dns323c_buttons,

	.nbuttons	= ARRAY_SIZE(dns323c_buttons),

};



static struct platform_device dns323_button_device = {
@@ -317,7 +371,7 @@ static struct platform_device dns323_button_device = { 
	.id		= -1,

	.num_resources	= 0,

	.dev		= {

		.platform_data	= &dns323_button_data,

		.platform_data	= &dns323ab_button_data,

	},

};
@@ -331,7 +385,7 @@ static struct mv_sata_platform_data dns323_sata_data = { 
/****************************************************************************

 * General Setup

 */

static struct orion5x_mpp_mode dns323_mv88f5181_mpp_modes[] __initdata = {

static struct orion5x_mpp_mode dns323a_mpp_modes[] __initdata = {

	{  0, MPP_PCIE_RST_OUTn },

	{  1, MPP_GPIO },		/* right amber LED (sata ch0) */

	{  2, MPP_GPIO },		/* left amber LED (sata ch1) */
@@ -355,7 +409,7 @@ static struct orion5x_mpp_mode dns323_mv88f5181_mpp_modes[] __initdata = { 
	{ -1 },

};



static struct orion5x_mpp_mode dns323_mv88f5182_mpp_modes[] __initdata = {

static struct orion5x_mpp_mode dns323b_mpp_modes[] __initdata = {

	{  0, MPP_UNUSED },

	{  1, MPP_GPIO },		/* right amber LED (sata ch0) */

	{  2, MPP_GPIO },		/* left amber LED (sata ch1) */
@@ -379,15 +433,57 @@ static struct orion5x_mpp_mode dns323_mv88f5182_mpp_modes[] __initdata = { 
	{ -1 },

};



static struct orion5x_mpp_mode dns323c_mpp_modes[] __initdata = {

	{  0, MPP_GPIO },		/* ? input */

	{  1, MPP_GPIO },		/* input power switch (0 = pressed) */

	{  2, MPP_GPIO },		/* output power off */

	{  3, MPP_UNUSED },		/* ? output */

	{  4, MPP_UNUSED },		/* ? output */

	{  5, MPP_UNUSED },		/* ? output */

	{  6, MPP_UNUSED },		/* ? output */

	{  7, MPP_UNUSED },		/* ? output */

	{  8, MPP_GPIO },		/* i/o right amber LED */

	{  9, MPP_GPIO },		/* i/o left amber LED */

	{ 10, MPP_GPIO },		/* input */

	{ 11, MPP_UNUSED },

	{ 12, MPP_SATA_LED },

	{ 13, MPP_SATA_LED },

	{ 14, MPP_SATA_LED },

	{ 15, MPP_SATA_LED },

	{ 16, MPP_UNUSED },

	{ 17, MPP_GPIO },		/* power button LED */

	{ 18, MPP_GPIO },		/* fan speed bit 0 */

	{ 19, MPP_GPIO },		/* fan speed bit 1 */

	{ -1 },

};



/* Rev C1 Fan speed notes:

 *

 * The fan is controlled by 2 GPIOs on this board. The settings

 * of the bits is as follow:

 *

 *  GPIO 18    GPIO 19    Fan

 *

 *    0          0        stopped

 *    0          1        low speed

 *    1          0        high speed

 *    1          1        don't do that (*)

 *

 * (*) I think the two bits control two feed-in resistors into a fixed

 *     PWN circuit, setting both bits will basically go a 'bit' faster

 *     than high speed, but d-link doesn't do it and you may get out of

 *     HW spec so don't do it.

 */



/*

 * On the DNS-323 the following devices are attached via I2C:

 * On the DNS-323 A1 and B1 the following devices are attached via I2C:

 *

 *  i2c addr | chip        | description

 *  0x3e     | GMT G760Af  | fan speed PWM controller

 *  0x48     | GMT G751-2f | temp. sensor and therm. watchdog (LM75 compatible)

 *  0x68     | ST M41T80   | RTC w/ alarm

 */

static struct i2c_board_info __initdata dns323_i2c_devices[] = {

static struct i2c_board_info __initdata dns323ab_i2c_devices[] = {

	{

		I2C_BOARD_INFO("g760a", 0x3e),

	}, {
@@ -397,36 +493,140 @@ static struct i2c_board_info __initdata dns323_i2c_devices[] = { 
	},

};



/*

 * On the DNS-323 C1 the following devices are attached via I2C:

 *

 *  i2c addr | chip        | description

 *  0x48     | GMT G751-2f | temp. sensor and therm. watchdog (LM75 compatible)

 *  0x68     | ST M41T80   | RTC w/ alarm

 */

static struct i2c_board_info __initdata dns323c_i2c_devices[] = {

	{

		I2C_BOARD_INFO("lm75", 0x48),

	}, {

		I2C_BOARD_INFO("m41t80", 0x68),

	},

};



/* DNS-323 rev. A specific power off method */

static void dns323a_power_off(void)

{

	pr_info("%s: triggering power-off...\n", __func__);

	pr_info("DNS-323: Triggering power-off...\n");

	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);

}



/* DNS-323 rev B specific power off method */

static void dns323b_power_off(void)

{

	pr_info("%s: triggering power-off...\n", __func__);

	pr_info("DNS-323: Triggering power-off...\n");

	/* Pin has to be changed to 1 and back to 0 to do actual power off. */

	gpio_set_value(DNS323_GPIO_POWER_OFF, 1);

	mdelay(100);

	gpio_set_value(DNS323_GPIO_POWER_OFF, 0);

}



/* DNS-323 rev. C specific power off method */

static void dns323c_power_off(void)

{

	pr_info("DNS-323: Triggering power-off...\n");

	gpio_set_value(DNS323C_GPIO_POWER_OFF, 1);

}



static int dns323c_phy_fixup(struct phy_device *phy)

{

	phy->dev_flags |= MARVELL_PHY_M1118_DNS323_LEDS;



	return 0;

}



static int __init dns323_identify_rev(void)

{

	u32 dev, rev, i, reg;



	pr_debug("DNS-323: Identifying board ... \n");



	/* Rev A1 has a 5181 */

	orion5x_pcie_id(&dev, &rev);

	if (dev == MV88F5181_DEV_ID) {

		pr_debug("DNS-323: 5181 found, board is A1\n");

		return DNS323_REV_A1;

	}

	pr_debug("DNS-323: 5182 found, board is B1 or C1, checking PHY...\n");



	/* Rev B1 and C1 both have 5182, let's poke at the eth PHY. This is

	 * a bit gross but we want to do that without links into the eth

	 * driver so let's poke at it directly. We default to rev B1 in

	 * case the accesses fail

	 */



#define ETH_SMI_REG		(ORION5X_ETH_VIRT_BASE + 0x2000 + 0x004)

#define  SMI_BUSY		0x10000000

#define  SMI_READ_VALID		0x08000000

#define  SMI_OPCODE_READ	0x04000000

#define  SMI_OPCODE_WRITE	0x00000000



	for (i = 0; i < 1000; i++) {

		reg = readl(ETH_SMI_REG);

		if (!(reg & SMI_BUSY))

			break;

	}

	if (i >= 1000) {

		pr_warning("DNS-323: Timeout accessing PHY, assuming rev B1\n");

		return DNS323_REV_B1;

	}

	writel((3 << 21)	/* phy ID reg */ |

	       (8 << 16)	/* phy addr */ |

	       SMI_OPCODE_READ, ETH_SMI_REG);

	for (i = 0; i < 1000; i++) {

		reg = readl(ETH_SMI_REG);

		if (reg & SMI_READ_VALID)

			break;

	}

	if (i >= 1000) {

		pr_warning("DNS-323: Timeout reading PHY, assuming rev B1\n");

		return DNS323_REV_B1;

	}

	pr_debug("DNS-323: Ethernet PHY ID 0x%x\n", reg & 0xffff);



	/* Note: the Marvell tools mask the ID with 0x3f0 before comparison

	 * but I don't see that making a difference here, at least with

	 * any known Marvell PHY ID

	 */

	switch(reg & 0xfff0) {

	case 0x0cc0: /* MV88E1111 */

		return DNS323_REV_B1;

	case 0x0e10: /* MV88E1118 */

		return DNS323_REV_C1;

	default:

		pr_warning("DNS-323: Unknown PHY ID 0x%04x, assuming rev B1\n",

			   reg & 0xffff);

	}

	return DNS323_REV_B1;

}



static void __init dns323_init(void)

{

	/* Setup basic Orion functions. Need to be called early. */

	orion5x_init();



	/* Identify revision */

	system_rev = dns323_identify_rev();

	pr_info("DNS-323: Identified HW revision %c1\n", 'A' + system_rev);



	/* Just to be tricky, the 5182 has a completely different

	 * set of MPP modes to the 5181.

	 */

	if (dns323_dev_id() == MV88F5182_DEV_ID)

		orion5x_mpp_conf(dns323_mv88f5182_mpp_modes);

	else {

		orion5x_mpp_conf(dns323_mv88f5181_mpp_modes);

	switch(system_rev) {

	case DNS323_REV_A1:

		orion5x_mpp_conf(dns323a_mpp_modes);

		writel(0, MPP_DEV_CTRL);		/* DEV_D[31:16] */

		break;

	case DNS323_REV_B1:

		orion5x_mpp_conf(dns323b_mpp_modes);

		break;

	case DNS323_REV_C1:

		orion5x_mpp_conf(dns323c_mpp_modes);

		break;

	}



	/* setup flash mapping
@@ -435,53 +635,96 @@ static void __init dns323_init(void) 
	orion5x_setup_dev_boot_win(DNS323_NOR_BOOT_BASE, DNS323_NOR_BOOT_SIZE);

	platform_device_register(&dns323_nor_flash);



	/* Sort out LEDs, Buttons and i2c devices */

	switch(system_rev) {

	case DNS323_REV_A1:

		/* The 5181 power LED is active low and requires

		 * DNS323_GPIO_LED_POWER1 to also be low.

		 */

	if (dns323_dev_id() == MV88F5181_DEV_ID) {

		dns323_leds[0].active_low = 1;

		 dns323ab_leds[0].active_low = 1;

		 gpio_request(DNS323_GPIO_LED_POWER1, "Power Led Enable");

		 gpio_direction_output(DNS323_GPIO_LED_POWER1, 0);

		/* Fall through */

	case DNS323_REV_B1:

		i2c_register_board_info(0, dns323ab_i2c_devices,

				ARRAY_SIZE(dns323ab_i2c_devices));

		break;

	case DNS323_REV_C1:

		/* Hookup LEDs & Buttons */

		dns323_gpio_leds.dev.platform_data = &dns323c_led_data;

		dns323_button_device.dev.platform_data = &dns323c_button_data;



		/* Hookup i2c devices and fan driver */

		i2c_register_board_info(0, dns323c_i2c_devices,

				ARRAY_SIZE(dns323c_i2c_devices));

		platform_device_register_simple("dns323c-fan", 0, NULL, 0);



		/* Register fixup for the PHY LEDs */

		phy_register_fixup_for_uid(MARVELL_PHY_ID_88E1118,

					   MARVELL_PHY_ID_MASK,

					   dns323c_phy_fixup);

	}



	platform_device_register(&dns323_gpio_leds);



	platform_device_register(&dns323_button_device);



	i2c_register_board_info(0, dns323_i2c_devices,

				ARRAY_SIZE(dns323_i2c_devices));



	/*

	 * Configure peripherals.

	 */

	if (dns323_read_mac_addr() < 0)

		printk("DNS323: Failed to read MAC address\n");



		printk("DNS-323: Failed to read MAC address\n");

	orion5x_ehci0_init();

	orion5x_eth_init(&dns323_eth_data);

	orion5x_i2c_init();

	orion5x_uart0_init();



	/* The 5182 has its SATA controller on-chip, and needs its own little

	 * init routine.

	 */

	if (dns323_dev_id() == MV88F5182_DEV_ID)

	/* Remaining GPIOs */

	switch(system_rev) {

	case DNS323_REV_A1:

		/* Poweroff GPIO */

		if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 ||

		    gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0)

			pr_err("DNS-323: failed to setup power-off GPIO\n");

		pm_power_off = dns323a_power_off;

		break;

	case DNS323_REV_B1:

		/* 5182 built-in SATA init */

		orion5x_sata_init(&dns323_sata_data);



	/* The 5182 has flag to indicate the system is up. Without this flag

	 * set, power LED will flash and cannot be controlled via leds-gpio.

		/* The DNS323 rev B1 has flag to indicate the system is up.

		 * Without this flag set, power LED will flash and cannot be

		 * controlled via leds-gpio.

		 */

	if (dns323_dev_id() == MV88F5182_DEV_ID)

		gpio_set_value(DNS323_GPIO_SYSTEM_UP, 1);

		if (gpio_request(DNS323_GPIO_SYSTEM_UP, "SYS_READY") == 0)

			gpio_direction_output(DNS323_GPIO_SYSTEM_UP, 1);



	/* Register dns323 specific power-off method */

		/* Poweroff GPIO */

		if (gpio_request(DNS323_GPIO_POWER_OFF, "POWEROFF") != 0 ||

		    gpio_direction_output(DNS323_GPIO_POWER_OFF, 0) != 0)

		pr_err("DNS323: failed to setup power-off GPIO\n");

	if (dns323_dev_id() == MV88F5182_DEV_ID)

			pr_err("DNS-323: failed to setup power-off GPIO\n");

		pm_power_off = dns323b_power_off;

	else

		pm_power_off = dns323a_power_off;

		break;

	case DNS323_REV_C1:

		/* 5182 built-in SATA init */

		orion5x_sata_init(&dns323_sata_data);



		/* Poweroff GPIO */

		if (gpio_request(DNS323C_GPIO_POWER_OFF, "POWEROFF") != 0 ||

		    gpio_direction_output(DNS323C_GPIO_POWER_OFF, 0) != 0)

			pr_err("DNS-323: failed to setup power-off GPIO\n");

		pm_power_off = dns323c_power_off;



		/* Now, -this- should theorically be done by the sata_mv driver

		 * once I figure out what's going on there. Maybe the behaviour

		 * of the LEDs should be somewhat passed via the platform_data.

		 * for now, just whack the register and make the LEDs happy

		 *

		 * Note: AFAIK, rev B1 needs the same treatement but I'll let

		 * somebody else test it.

		 */

		writel(0x5, ORION5X_SATA_VIRT_BASE | 0x2c);

		break;

	}

}



/* Warning: D-Link uses a wrong mach-type (=526) in their bootloader */

CRA Git | Maintained and supported by SUSTech CRA and CCSE