target/linux/ar71xx/files/arch/mips/ath79/dev-m25p80.c

   1 /*
   2  *  Copyright (C) 2009-2012 Gabor Juhos <juhosg@openwrt.org>
   3  *
   4  *  This program is free software; you can redistribute it and/or modify it
   5  *  under the terms of the GNU General Public License version 2 as published
   6  *  by the Free Software Foundation.
   7  */
   8
   9 #include <linux/init.h>
  10 #include <linux/spi/spi.h>
  11 #include <linux/spi/flash.h>
  12 #include <linux/mtd/mtd.h>
  13 #include <linux/mtd/partitions.h>
  14 #include <linux/mtd/concat.h>
  15
  16 #include "dev-spi.h"
  17 #include "dev-m25p80.h"
  18
  19 static struct ath79_spi_controller_data ath79_spi0_cdata =
  20 {
  21         .cs_type = ATH79_SPI_CS_TYPE_INTERNAL,
  22         .cs_line = 0,
  23 };
  24
  25 static struct ath79_spi_controller_data ath79_spi1_cdata =
  26 {
  27         .cs_type = ATH79_SPI_CS_TYPE_INTERNAL,
  28         .cs_line = 1,
  29 };
  30
  31 static struct spi_board_info ath79_spi_info[] = {
  32         {
  33                 .bus_num        = 0,
  34                 .chip_select    = 0,
  35                 .max_speed_hz   = 25000000,
  36                 .modalias       = "m25p80",
  37                 .controller_data = &ath79_spi0_cdata,
  38         },
  39         {
  40                 .bus_num        = 0,
  41                 .chip_select    = 1,
  42                 .max_speed_hz   = 25000000,
  43                 .modalias       = "m25p80",
  44                 .controller_data = &ath79_spi1_cdata,
  45         }
  46 };
  47
  48 static struct ath79_spi_platform_data ath79_spi_data;
  49
  50 void __init ath79_register_m25p80(struct flash_platform_data *pdata)
  51 {
  52         ath79_spi_data.bus_num = 0;
  53         ath79_spi_data.num_chipselect = 1;
  54         ath79_spi0_cdata.is_flash = true;
  55         ath79_spi_info[0].platform_data = pdata;
  56         ath79_register_spi(&ath79_spi_data, ath79_spi_info, 1);
  57 }
  58
  59 static struct flash_platform_data *multi_pdata;
  60
  61 static struct mtd_info *concat_devs[2] = { NULL, NULL };
  62 static struct work_struct mtd_concat_work;
  63
  64 static void mtd_concat_add_work(struct work_struct *work)
  65 {
  66         struct mtd_info *mtd;
  67
  68         mtd = mtd_concat_create(concat_devs, ARRAY_SIZE(concat_devs), "flash");
  69
  70         mtd_device_register(mtd, multi_pdata->parts, multi_pdata->nr_parts);
  71 }
  72
  73 static void mtd_concat_add(struct mtd_info *mtd)
  74 {
  75         static bool registered = false;
  76
  77         if (registered)
  78                 return;
  79
  80         if (!strcmp(mtd->name, "spi0.0"))
  81                 concat_devs[0] = mtd;
  82         else if (!strcmp(mtd->name, "spi0.1"))
  83                 concat_devs[1] = mtd;
  84         else
  85                 return;
  86
  87         if (!concat_devs[0] || !concat_devs[1])
  88                 return;
  89
  90         registered = true;
  91         INIT_WORK(&mtd_concat_work, mtd_concat_add_work);
  92         schedule_work(&mtd_concat_work);
  93 }
  94
  95 static void mtd_concat_remove(struct mtd_info *mtd)
  96 {
  97 }
  98
  99 static void add_mtd_concat_notifier(void)
 100 {
 101         static struct mtd_notifier not = {
 102                 .add = mtd_concat_add,
 103                 .remove = mtd_concat_remove,
 104         };
 105
 106         register_mtd_user(&not);
 107 }
 108
 109
 110 void __init ath79_register_m25p80_multi(struct flash_platform_data *pdata)
 111 {
 112         multi_pdata = pdata;
 113         add_mtd_concat_notifier();
 114         ath79_spi_data.bus_num = 0;
 115         ath79_spi_data.num_chipselect = 2;
 116         ath79_spi0_cdata.is_flash = true;
 117         ath79_register_spi(&ath79_spi_data, ath79_spi_info, 2);
 118 }