Blame view

kernel/linux-imx6_3.14.28/drivers/mfd/arizona-spi.c 2.39 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
  /*
   * arizona-spi.c  --  Arizona SPI bus interface
   *
   * Copyright 2012 Wolfson Microelectronics plc
   *
   * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   */
  
  #include <linux/err.h>
  #include <linux/module.h>
  #include <linux/pm_runtime.h>
  #include <linux/regmap.h>
  #include <linux/regulator/consumer.h>
  #include <linux/slab.h>
  #include <linux/spi/spi.h>
  #include <linux/of.h>
  
  #include <linux/mfd/arizona/core.h>
  
  #include "arizona.h"
  
  static int arizona_spi_probe(struct spi_device *spi)
  {
  	const struct spi_device_id *id = spi_get_device_id(spi);
  	struct arizona *arizona;
  	const struct regmap_config *regmap_config;
  	int ret, type;
  
  	if (spi->dev.of_node)
  		type = arizona_of_get_type(&spi->dev);
  	else
  		type = id->driver_data;
  
  	switch (type) {
  #ifdef CONFIG_MFD_WM5102
  	case WM5102:
  		regmap_config = &wm5102_spi_regmap;
  		break;
  #endif
  #ifdef CONFIG_MFD_WM5110
  	case WM5110:
  		regmap_config = &wm5110_spi_regmap;
  		break;
  #endif
  	default:
  		dev_err(&spi->dev, "Unknown device type %ld
  ",
  			id->driver_data);
  		return -EINVAL;
  	}
  
  	arizona = devm_kzalloc(&spi->dev, sizeof(*arizona), GFP_KERNEL);
  	if (arizona == NULL)
  		return -ENOMEM;
  
  	arizona->regmap = devm_regmap_init_spi(spi, regmap_config);
  	if (IS_ERR(arizona->regmap)) {
  		ret = PTR_ERR(arizona->regmap);
  		dev_err(&spi->dev, "Failed to allocate register map: %d
  ",
  			ret);
  		return ret;
  	}
  
  	arizona->type = id->driver_data;
  	arizona->dev = &spi->dev;
  	arizona->irq = spi->irq;
  
  	return arizona_dev_init(arizona);
  }
  
  static int arizona_spi_remove(struct spi_device *spi)
  {
  	struct arizona *arizona = spi_get_drvdata(spi);
  	arizona_dev_exit(arizona);
  	return 0;
  }
  
  static const struct spi_device_id arizona_spi_ids[] = {
  	{ "wm5102", WM5102 },
  	{ "wm5110", WM5110 },
  	{ },
  };
  MODULE_DEVICE_TABLE(spi, arizona_spi_ids);
  
  static struct spi_driver arizona_spi_driver = {
  	.driver = {
  		.name	= "arizona",
  		.owner	= THIS_MODULE,
  		.pm	= &arizona_pm_ops,
  		.of_match_table	= of_match_ptr(arizona_of_match),
  	},
  	.probe		= arizona_spi_probe,
  	.remove		= arizona_spi_remove,
  	.id_table	= arizona_spi_ids,
  };
  
  module_spi_driver(arizona_spi_driver);
  
  MODULE_DESCRIPTION("Arizona SPI bus interface");
  MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
  MODULE_LICENSE("GPL");