matthew/sonic-buildimage
1
0
Fork 0
Code Issues Pull Requests Actions 1 Packages Projects Releases Wiki Activity
054f5b7a53
sonic-buildimage/platform/innovium/sonic-platform-modules-cel/midstone-200i/modules/200i_wdt.c
Tony Titus 91510a7742 [innovium]: Initial commit (#3243) 
[build] Add ipmitool
[dockers] Add innovium platform in orchagent + ipmitool in snmp
[platform/innovium] Add innovium platform
[device/celestica] Add x86_64-cel_midstone-r0 device for innovium
[device/delta] Add x86_64-delta_et-c032if-r0 device for innovium
[sonic-slave-stretch] Add texi2html

Signed-off-by: Tony Titus ttitus@innovium.com
2019-08-14 10:40:55 -07:00

364 lines
9.6 KiB
C
Executable File
Raw Blame History

/*
* Watchdog driver for the Midstone 200i
*
* Copyright (C) 2017 Celestica Corp.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version
* 2 of the License, or (at your option) any later version.
*/
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/platform_device.h>
#include <linux/watchdog.h>
#include <linux/uaccess.h>
#include <linux/gpio.h>
#include <linux/io.h>
#include <linux/delay.h>
#define DRIVER_NAME "ms200i_wdt"
#define CONF_GPIOBASE 0x8000F848
#define PCI_CONFIG_ADDRESS 0x0CF8
#define PCI_CONFIG_DATA 0x0CFC
// WDT_CTRL is GPIO 32
// GPIOBUS: 2 ,bit: 0th
#define WDT_CTRL_ENB_REG 0x30
#define WDT_CTRL_DIR_REG 0x34
#define WDT_CTRL_LVL_REG 0x38
#define WDT_CTRL_MASK (unsigned long)(1<<(32%32))
// WDT_FEED is GPIO 15
// GPIOBUS: 1 ,bit: 15th
#define WDT_FEED_ENB_REG 0x00
#define WDT_FEED_DIR_REG 0x04
#define WDT_FEED_LVL_REG 0x0C
#define WDT_FEED_MASK (unsigned long)(1<<(15%32))
static bool nowayout = WATCHDOG_NOWAYOUT;
// For enabling Debug message
//#define ENAB_DEBUG
//#define ENAB_DEBUG_GPIO
struct ms200i_wdt_drvdata {
struct watchdog_device wdt;
struct mutex lock;
unsigned int gpiobase;
};
static struct resource ms200i_wdt_resources[] = {
{
.flags = IORESOURCE_IO,
},
};
static void ms200i_wdt_dev_release( struct device * dev)
{
return;
}
static struct platform_device ms200i_wdt_dev = {
.name = DRIVER_NAME,
.id = -1,
.num_resources = ARRAY_SIZE(ms200i_wdt_resources),
.resource = ms200i_wdt_resources,
.dev = {
.release = ms200i_wdt_dev_release,
}
};
static int ms200i_wdt_start(struct watchdog_device *wdt_dev)
{
struct ms200i_wdt_drvdata *drvdata = watchdog_get_drvdata(wdt_dev);
unsigned char reset_ctrl = 0x00;
unsigned long enab, gpio ,dir;
unsigned int base_addr;
#ifdef ENAB_DEBUG
printk(KERN_INFO "WDT Start");
#endif
mutex_lock(&drvdata->lock);
base_addr = drvdata->gpiobase;
enab = inl(base_addr + WDT_CTRL_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl enab %16X",enab);
#endif
enab |= WDT_CTRL_MASK;
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl enab %16X",enab);
#endif
outl(enab, base_addr + WDT_CTRL_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
enab = inl(base_addr + WDT_CTRL_ENB_REG);
printk(KERN_INFO "ctrl enab %16X",enab);
#endif
enab = inl(base_addr + WDT_FEED_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed enab %16X",enab);
#endif
enab |= WDT_FEED_MASK;
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed enab %16X",enab);
#endif
outl(enab, base_addr + WDT_FEED_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
enab = inl(base_addr + WDT_FEED_ENB_REG);
printk(KERN_INFO "feed enab %16X",enab);
#endif
dir = inl(base_addr + WDT_CTRL_DIR_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl dir %16X",dir);
#endif
dir &= ~WDT_FEED_MASK;
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl dir %16X",dir);
#endif
outl(dir, base_addr + WDT_CTRL_DIR_REG);
#ifdef ENAB_DEBUG_GPIO
dir = inl(base_addr + WDT_CTRL_DIR_REG);
printk(KERN_INFO "ctrl dir %16X",dir);
#endif
dir = inl(base_addr + WDT_FEED_DIR_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed dir %16X",dir);
#endif
dir &= ~WDT_FEED_MASK;
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed dir %16X",dir);
#endif
outl(dir, base_addr + WDT_FEED_DIR_REG);
#ifdef ENAB_DEBUG_GPIO
dir = inl(base_addr + WDT_FEED_DIR_REG);
printk(KERN_INFO "feed dir %16X",dir);
#endif
gpio = inl(base_addr + WDT_CTRL_LVL_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl gpio %16X",gpio);
#endif
gpio &= ~WDT_CTRL_MASK;
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl gpio %16X",gpio);
#endif
outl_p( gpio, base_addr + WDT_CTRL_LVL_REG);
#ifdef ENAB_DEBUG_GPIO
gpio = inl(base_addr + WDT_CTRL_LVL_REG);
printk(KERN_INFO "ctrl gpio %16X",gpio);
#endif
mutex_unlock(&drvdata->lock);
printk(KERN_INFO "WDT Start Finish");
return 0;
}
static int ms200i_wdt_stop(struct watchdog_device *wdt_dev)
{
struct ms200i_wdt_drvdata *drvdata = watchdog_get_drvdata(wdt_dev);
unsigned long gpio;
unsigned long base_addr;
#ifdef ENAB_DEBUG
printk(KERN_INFO "WDT Stop");
#endif
mutex_lock(&drvdata->lock);
base_addr = drvdata->gpiobase;
gpio = inl(base_addr + WDT_CTRL_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl gpio %16X",gpio);
#endif
gpio &= ~(WDT_CTRL_MASK);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "ctrl gpio %16X",gpio);
#endif
outl_p(gpio, base_addr + WDT_CTRL_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
gpio = inl(base_addr + WDT_CTRL_ENB_REG);
printk(KERN_INFO "ctrl gpio %16X",gpio);
#endif
gpio = inl(base_addr + WDT_FEED_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
gpio &= ~(WDT_CTRL_MASK);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
outl_p(gpio, base_addr + WDT_FEED_ENB_REG);
#ifdef ENAB_DEBUG_GPIO
gpio = inl(base_addr + WDT_FEED_ENB_REG);
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
mutex_unlock(&drvdata->lock);
return 0;
}
static int ms200i_wdt_ping(struct watchdog_device *wdt_dev)
{
struct ms200i_wdt_drvdata *drvdata = watchdog_get_drvdata(wdt_dev);
unsigned long gpio;
unsigned long base_addr;
#ifdef ENAB_DEBUG
printk(KERN_INFO "WDT PING");
#endif
mutex_lock(&drvdata->lock);
base_addr = drvdata->gpiobase;
gpio = inl(base_addr + WDT_FEED_LVL_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
gpio &= ~WDT_FEED_MASK;
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
outl_p( gpio, base_addr + WDT_FEED_LVL_REG);
#ifdef ENAB_DEBUG_GPIO
gpio = inl(base_addr + WDT_FEED_LVL_REG);
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
mdelay(10);
gpio = inl(base_addr + WDT_FEED_LVL_REG);
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
gpio |= WDT_FEED_MASK;
#ifdef ENAB_DEBUG_GPIO
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
outl_p( gpio, base_addr + WDT_FEED_LVL_REG);
#ifdef ENAB_DEBUG_GPIO
gpio = inl(base_addr + WDT_FEED_LVL_REG);
printk(KERN_INFO "feed gpio %16X",gpio);
#endif
mutex_unlock(&drvdata->lock);
#ifdef ENAB_DEBUG
printk(KERN_INFO "WDT PING FINISH");
#endif
return 0;
}
static const struct watchdog_info ms200i_wdt_info = {
.options = WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE,
.identity = "MS200i Watchdog",
};
static const struct watchdog_ops ms200i_wdt_ops = {
.owner = THIS_MODULE,
.start = ms200i_wdt_start,
.stop = ms200i_wdt_stop,
.ping = ms200i_wdt_ping,
};
static int ms200i_wdt_probe(struct platform_device *pdev)
{
struct ms200i_wdt_drvdata *drvdata;
int ret;
unsigned int base_addr;
drvdata = devm_kzalloc(&pdev->dev, sizeof(*drvdata),
GFP_KERNEL);
if (!drvdata) {
ret = -ENOMEM;
goto err;
}
outl(CONF_GPIOBASE, PCI_CONFIG_ADDRESS);
base_addr = inl(PCI_CONFIG_DATA);
// remove last bit , that is hardware inditcate.
base_addr &= ~(0x01);
if(base_addr == 0){
printk(KERN_INFO "can't get gpio base address");
}else{
printk(KERN_INFO "gpio base address : %8.8X",base_addr);
}
mutex_init(&drvdata->lock);
drvdata->gpiobase = base_addr;
drvdata->wdt.info = &ms200i_wdt_info;
drvdata->wdt.ops = &ms200i_wdt_ops;
watchdog_set_nowayout(&drvdata->wdt, nowayout);
watchdog_set_drvdata(&drvdata->wdt, drvdata);
ret = watchdog_register_device(&drvdata->wdt);
if (ret != 0) {
dev_err(&pdev->dev, "watchdog_register_device() failed: %d\n",
ret);
goto err;
}
platform_set_drvdata(pdev, drvdata);
err:
return ret;
}
static int ms200i_wdt_remove(struct platform_device *pdev)
{
struct ms200i_wdt_drvdata *drvdata = platform_get_drvdata(pdev);
watchdog_unregister_device(&drvdata->wdt);
#ifdef ENAB_DEBUG
printk(KERN_INFO "MS200i WDT Remove");
#endif
return 0;
}
static struct platform_driver ms200i_wdt_drv = {
.probe = ms200i_wdt_probe,
.remove = ms200i_wdt_remove,
.driver = {
.name = DRIVER_NAME,
},
};
int ms200i_wdt_init(void)
{
#ifdef ENAB_DEBUG
printk(KERN_INFO "MS200i WDT Init");
#endif
platform_device_register(&ms200i_wdt_dev);
platform_driver_register(&ms200i_wdt_drv);
return 0;
}
void ms200i_wdt_exit(void)
{
#ifdef ENAB_DEBUG
printk(KERN_INFO "MS200i WDT Exit");
#endif
platform_driver_unregister(&ms200i_wdt_drv);
platform_device_unregister(&ms200i_wdt_dev);
}
module_init(ms200i_wdt_init);
module_exit(ms200i_wdt_exit);
MODULE_AUTHOR("Sittisak Sinprem <ssinprem@celestica.com>");
MODULE_DESCRIPTION("Midstone ms200i Watchdog");
MODULE_LICENSE("GPL");
MODULE_ALIAS("platform:ms200i-watchdog");
Reference in New Issue View Git Blame Copy Permalink