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 19static struct ath79_spi_controller_data ath79_spi0_cdata = 20{ 21 .cs_type = ATH79_SPI_CS_TYPE_INTERNAL, 22 .cs_line = 0, 23}; 24 25static struct ath79_spi_controller_data ath79_spi1_cdata = 26{ 27 .cs_type = ATH79_SPI_CS_TYPE_INTERNAL, 28 .cs_line = 1, 29}; 30 31static 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 48struct ath79_spi_platform_data ath79_spi_data; 49 50void ath79_init_m25p80_pdata(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} 57 58void __init ath79_register_m25p80(struct flash_platform_data *pdata) 59{ 60 ath79_init_m25p80_pdata(pdata); 61 ath79_register_spi(&ath79_spi_data, ath79_spi_info, 1); 62} 63 64static struct flash_platform_data *multi_pdata; 65 66static struct mtd_info *concat_devs[2] = { NULL, NULL }; 67static struct work_struct mtd_concat_work; 68 69static void mtd_concat_add_work(struct work_struct *work) 70{ 71 struct mtd_info *mtd; 72 73 mtd = mtd_concat_create(concat_devs, ARRAY_SIZE(concat_devs), "flash"); 74 75 mtd_device_register(mtd, multi_pdata->parts, multi_pdata->nr_parts); 76} 77 78static void mtd_concat_add(struct mtd_info *mtd) 79{ 80 static bool registered = false; 81 82 if (registered) 83 return; 84 85 if (!strcmp(mtd->name, "spi0.0")) 86 concat_devs[0] = mtd; 87 else if (!strcmp(mtd->name, "spi0.1")) 88 concat_devs[1] = mtd; 89 else 90 return; 91 92 if (!concat_devs[0] || !concat_devs[1]) 93 return; 94 95 registered = true; 96 INIT_WORK(&mtd_concat_work, mtd_concat_add_work); 97 schedule_work(&mtd_concat_work); 98} 99 100static void mtd_concat_remove(struct mtd_info *mtd) 101{ 102} 103 104static void add_mtd_concat_notifier(void) 105{ 106 static struct mtd_notifier not = { 107 .add = mtd_concat_add, 108 .remove = mtd_concat_remove, 109 }; 110 111 register_mtd_user(¬); 112} 113 114 115void __init ath79_register_m25p80_multi(struct flash_platform_data *pdata) 116{ 117 multi_pdata = pdata; 118 add_mtd_concat_notifier(); 119 ath79_spi_data.bus_num = 0; 120 ath79_spi_data.num_chipselect = 2; 121 ath79_register_spi(&ath79_spi_data, ath79_spi_info, 2); 122} 123