LXR linux/arch/arm/mach-s3c24xx/setup-camif.c

   1// SPDX-License-Identifier: GPL-2.0
   2//
   3// Copyright (C) 2012 Sylwester Nawrocki <sylvester.nawrocki@gmail.com>
   4//
   5// Helper functions for S3C24XX/S3C64XX SoC series CAMIF driver
   6
   7#include <linux/gpio.h>
   8#include <plat/gpio-cfg.h>
   9#include <mach/gpio-samsung.h>
  10
  11/* Number of camera port pins, without FIELD */
  12#define S3C_CAMIF_NUM_GPIOS     13
  13
  14/* Default camera port configuration helpers. */
  15
  16static void camif_get_gpios(int *gpio_start, int *gpio_reset)
  17{
  18#ifdef CONFIG_ARCH_S3C24XX
  19        *gpio_start = S3C2410_GPJ(0);
  20        *gpio_reset = S3C2410_GPJ(12);
  21#else
  22        /* s3c64xx */
  23        *gpio_start = S3C64XX_GPF(0);
  24        *gpio_reset = S3C64XX_GPF(3);
  25#endif
  26}
  27
  28int s3c_camif_gpio_get(void)
  29{
  30        int gpio_start, gpio_reset;
  31        int ret, i;
  32
  33        camif_get_gpios(&gpio_start, &gpio_reset);
  34
  35        for (i = 0; i < S3C_CAMIF_NUM_GPIOS; i++) {
  36                int gpio = gpio_start + i;
  37
  38                if (gpio == gpio_reset)
  39                        continue;
  40
  41                ret = gpio_request(gpio, "camif");
  42                if (!ret)
  43                        ret = s3c_gpio_cfgpin(gpio, S3C_GPIO_SFN(2));
  44                if (ret) {
  45                        pr_err("failed to configure GPIO %d\n", gpio);
  46                        for (--i; i >= 0; i--)
  47                                gpio_free(gpio--);
  48                        return ret;
  49                }
  50                s3c_gpio_setpull(gpio, S3C_GPIO_PULL_NONE);
  51        }
  52
  53        return 0;
  54}
  55
  56void s3c_camif_gpio_put(void)
  57{
  58        int i, gpio_start, gpio_reset;
  59
  60        camif_get_gpios(&gpio_start, &gpio_reset);
  61
  62        for (i = 0; i < S3C_CAMIF_NUM_GPIOS; i++) {
  63                int gpio = gpio_start + i;
  64                if (gpio != gpio_reset)
  65                        gpio_free(gpio);
  66        }
  67}
  68