/*------------------------------------------------------------------------------------------*\ \*------------------------------------------------------------------------------------------*/ #include #include #include #include #include #include #include #include #include #include #include #include static struct _ur8_gpio_power_bits { unsigned int Bit_Mask; unsigned int Polarity_Mask; } ur8_gpio_power_bits; static spinlock_t ur8_power_spinlock; /*------------------------------------------------------------------------------------------*\ \*------------------------------------------------------------------------------------------*/ int ur8_power_down_init(void) { spin_lock_init(&ur8_power_spinlock); return 0; } /*------------------------------------------------------------------------------------------*\ \*------------------------------------------------------------------------------------------*/ int ur8_put_device_into_power_down(unsigned int Bit) { struct _hw_clock *clock = (struct _hw_clock *)UR8_CLOCK_BASE; if(Bit < UR8_POWER_START_GPIO) { unsigned int flags; spin_lock_irqsave(&ur8_power_spinlock, flags); clock->PDCR.Register |= (1 << Bit); spin_unlock_irqrestore(&ur8_power_spinlock, flags); return 0; } if(Bit < UR8_POWER_END_GPIO) { Bit -= UR8_POWER_START_GPIO; ur8_gpio_out_bit(Bit, (ur8_gpio_power_bits.Polarity_Mask & (1 << Bit)) ? 1 : 0); return 0; } #if defined(CONFIG_VLYNQ_SUPPORT) if(Bit < UR8_POWER_END_VIRTUAL) { return 0; } #endif /*--- #if defined(CONFIG_VLYNQ_SUPPORT) ---*/ return 1; } /*------------------------------------------------------------------------------------------*\ \*------------------------------------------------------------------------------------------*/ int ur8_take_device_out_of_power_down(unsigned int Bit) { struct _hw_clock *clock = (struct _hw_clock *)UR8_CLOCK_BASE; if(Bit < UR8_POWER_START_GPIO) { unsigned int flags; spin_lock_irqsave(&ur8_power_spinlock, flags); clock->PDCR.Register &= ~(1 << Bit); spin_unlock_irqrestore(&ur8_power_spinlock, flags); return 0; } if(Bit < UR8_POWER_END_GPIO) { Bit -= UR8_POWER_START_GPIO; ur8_gpio_out_bit(Bit, (ur8_gpio_power_bits.Polarity_Mask & (1 << Bit)) ? 0 : 1); return 0; } #if defined(CONFIG_VLYNQ_SUPPORT) if(Bit < UR8_POWER_END_VIRTUAL) { return 0; } #endif /*--- #if defined(CONFIG_VLYNQ_SUPPORT) ---*/ return 1; } /*------------------------------------------------------------------------------------------*\ \*------------------------------------------------------------------------------------------*/ int ur8_register_power_down_gpio(unsigned int gpio_pin, unsigned int Polarity) { if(gpio_pin >= 32) return (unsigned int)-1; if(ur8_gpio_power_bits.Bit_Mask & (1 << gpio_pin)) return (unsigned int)-1; ur8_gpio_power_bits.Bit_Mask |= (1 << gpio_pin); if(Polarity) ur8_gpio_power_bits.Polarity_Mask |= (1 << Polarity); else ur8_gpio_power_bits.Polarity_Mask &= ~(1 << Polarity); ur8_gpio_ctrl(gpio_pin, GPIO_PIN, GPIO_OUTPUT_PIN); return gpio_pin + UR8_POWER_START_GPIO; } /*------------------------------------------------------------------------------------------*\ \*------------------------------------------------------------------------------------------*/ int ur8_release_power_down_gpio(unsigned int Bit) { unsigned int gpio_pin = Bit - UR8_POWER_START_GPIO; if(gpio_pin >= 32) return (unsigned int)-1; if(!(ur8_gpio_power_bits.Bit_Mask & (1 << gpio_pin))) return (unsigned int)-1; ur8_gpio_power_bits.Bit_Mask &= ~(1 << gpio_pin); return 0; } /*------------------------------------------------------------------------------------------*\ \*------------------------------------------------------------------------------------------*/ unsigned int ur8_power_down_status(void) { struct _hw_clock *clock = (struct _hw_clock *)UR8_CLOCK_BASE; return (unsigned int)clock->PDCR.Register; } EXPORT_SYMBOL(ur8_put_device_into_power_down); EXPORT_SYMBOL(ur8_take_device_out_of_power_down); EXPORT_SYMBOL(ur8_register_power_down_gpio); EXPORT_SYMBOL(ur8_release_power_down_gpio); EXPORT_SYMBOL(ur8_power_down_status);