diff mbox

Input: psxpad-spi - Add PlayStation 1/2 joypads via SPI interface Driver

Message ID 20170506184157.8549-1-sylph23k@gmail.com (mailing list archive)
State Accepted
Headers show

Commit Message

Tomohiro Yoshidomi May 6, 2017, 6:41 p.m. UTC
PlayStation 1/2 joypads can be connected directly to the SPI interface.

Signed-off-by: Tomohiro Yoshidomi <sylph23k@gmail.com>
Reviewed-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
Acked-by: David Herrmann <dh.herrmann@gmail.com>
---
 drivers/input/joystick/Kconfig      |  22 ++
 drivers/input/joystick/Makefile     |   1 +
 drivers/input/joystick/psxpad-spi.c | 438 ++++++++++++++++++++++++++++++++++++
 3 files changed, 461 insertions(+)
 create mode 100644 drivers/input/joystick/psxpad-spi.c

Comments

Tomohiro Yoshidomi May 6, 2017, 6:43 p.m. UTC | #1
Mr.Torokhov
Mr.Herrmann

Sorry,
I sent Playstation 1/2 joypads patch again.
Mr.Torokhov's Reviewed-by added.

Best regard.

2017-05-07 3:41 GMT+09:00 Tomohiro Yoshidomi <sylph23k@gmail.com>:
> PlayStation 1/2 joypads can be connected directly to the SPI interface.
>
> Signed-off-by: Tomohiro Yoshidomi <sylph23k@gmail.com>
> Reviewed-by: Dmitry Torokhov <dmitry.torokhov@gmail.com>
> Acked-by: David Herrmann <dh.herrmann@gmail.com>
> ---
>  drivers/input/joystick/Kconfig      |  22 ++
>  drivers/input/joystick/Makefile     |   1 +
>  drivers/input/joystick/psxpad-spi.c | 438 ++++++++++++++++++++++++++++++++++++
>  3 files changed, 461 insertions(+)
>  create mode 100644 drivers/input/joystick/psxpad-spi.c
>
> diff --git a/drivers/input/joystick/Kconfig b/drivers/input/joystick/Kconfig
> index 4215b538..cbcb9a6e 100644
> --- a/drivers/input/joystick/Kconfig
> +++ b/drivers/input/joystick/Kconfig
> @@ -330,4 +330,26 @@ config JOYSTICK_MAPLE
>           To compile this as a module choose M here: the module will be called
>           maplecontrol.
>
> +config JOYSTICK_PSXPAD_SPI
> +       tristate "PlayStation 1/2 joypads via SPI interface"
> +       depends on SPI
> +       select INPUT_POLLDEV
> +       help
> +         Say Y here if you wish to connect PlayStation 1/2 joypads
> +         via SPI interface.
> +
> +         To compile this driver as a module, choose M here: the
> +         module will be called psxpad-spi.
> +
> +config JOYSTICK_PSXPAD_SPI_FF
> +       bool "PlayStation 1/2 joypads force feedback (rumble) support"
> +       depends on JOYSTICK_PSXPAD_SPI
> +       select INPUT_FF_MEMLESS
> +       help
> +         Say Y here if you want to take advantage of
> +         PlayStation 1/2 joypads rumble features.
> +
> +         To drive rumble motor,
> +         a dedicated power supply is required.
> +
>  endif
> diff --git a/drivers/input/joystick/Makefile b/drivers/input/joystick/Makefile
> index 92dc0de9..496fd56b 100644
> --- a/drivers/input/joystick/Makefile
> +++ b/drivers/input/joystick/Makefile
> @@ -21,6 +21,7 @@ obj-$(CONFIG_JOYSTICK_INTERACT)               += interact.o
>  obj-$(CONFIG_JOYSTICK_JOYDUMP)         += joydump.o
>  obj-$(CONFIG_JOYSTICK_MAGELLAN)                += magellan.o
>  obj-$(CONFIG_JOYSTICK_MAPLE)           += maplecontrol.o
> +obj-$(CONFIG_JOYSTICK_PSXPAD_SPI)      += psxpad-spi.o
>  obj-$(CONFIG_JOYSTICK_SIDEWINDER)      += sidewinder.o
>  obj-$(CONFIG_JOYSTICK_SPACEBALL)       += spaceball.o
>  obj-$(CONFIG_JOYSTICK_SPACEORB)                += spaceorb.o
> diff --git a/drivers/input/joystick/psxpad-spi.c b/drivers/input/joystick/psxpad-spi.c
> new file mode 100644
> index 00000000..2627aecb
> --- /dev/null
> +++ b/drivers/input/joystick/psxpad-spi.c
> @@ -0,0 +1,438 @@
> +/*
> + * PlayStation 1/2 joypads via SPI interface Driver
> + *
> + * Copyright (C) 2017 Tomohiro Yoshidomi <sylph23k@gmail.com>
> + * Licensed under the GPL-2 or later.
> + *
> + * PlayStation 1/2 joypad's plug (not socket)
> + *  123 456 789
> + * (...|...|...)
> + *
> + * 1: DAT -> MISO (pullup with 1k owm to 3.3V)
> + * 2: CMD -> MOSI
> + * 3: 9V (for motor, if not use N.C.)
> + * 4: GND
> + * 5: 3.3V
> + * 6: Attention -> CS(SS)
> + * 7: SCK -> SCK
> + * 8: N.C.
> + * 9: ACK -> N.C.
> + */
> +
> +#include <linux/kernel.h>
> +#include <linux/device.h>
> +#include <linux/input.h>
> +#include <linux/input-polldev.h>
> +#include <linux/module.h>
> +#include <linux/spi/spi.h>
> +#include <linux/types.h>
> +#include <linux/pm.h>
> +#include <linux/pm_runtime.h>
> +
> +#define REVERSE_BIT(x) ((((x) & 0x80) >> 7) | (((x) & 0x40) >> 5) | \
> +       (((x) & 0x20) >> 3) | (((x) & 0x10) >> 1) | (((x) & 0x08) << 1) | \
> +       (((x) & 0x04) << 3) | (((x) & 0x02) << 5) | (((x) & 0x01) << 7))
> +
> +/* PlayStation 1/2 joypad command and response are LSBFIRST. */
> +
> +/*     0x01, 0x42, 0x00, 0x00, 0x00,
> + *     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + *     0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
> + */
> +static const u8 PSX_CMD_POLL[] = {
> +       0x80, 0x42, 0x00, 0x00, 0x00,
> +       0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> +       0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
> +};
> +/*     0x01, 0x43, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00 */
> +static const u8 PSX_CMD_ENTER_CFG[] = {
> +       0x80, 0xC2, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00
> +};
> +/*     0x01, 0x43, 0x00, 0x00, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A */
> +static const u8 PSX_CMD_EXIT_CFG[] = {
> +       0x80, 0xC2, 0x00, 0x00, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A
> +};
> +/*     0x01, 0x4D, 0x00, 0x00, 0x01, 0xFF, 0xFF, 0xFF, 0xFF */
> +static const u8 PSX_CMD_ENABLE_MOTOR[] = {
> +       0x80, 0xB2, 0x00, 0x00, 0x80, 0xFF, 0xFF, 0xFF, 0xFF
> +};
> +
> +struct psxpad {
> +       struct spi_device *spi;
> +       struct input_polled_dev *pdev;
> +       struct input_dev *idev;
> +       char phys[0x20];
> +       bool motor1enable;
> +       bool motor2enable;
> +       u8 motor1level;
> +       u8 motor2level;
> +       u8 sendbuf[0x20] ____cacheline_aligned;
> +       u8 response[sizeof(PSX_CMD_POLL)] ____cacheline_aligned;
> +};
> +
> +static int psxpad_command(struct psxpad *pad, const u8 sendcmdlen)
> +{
> +       struct spi_transfer xfers = {
> +               .tx_buf         = pad->sendbuf,
> +               .rx_buf         = pad->response,
> +               .len            = sendcmdlen,
> +       };
> +       int err;
> +
> +       err = spi_sync_transfer(pad->spi, &xfers, 1);
> +       if (err) {
> +               dev_err(&pad->spi->dev,
> +                       "%s: failed to SPI xfers mode: %d\n",
> +                       __func__, err);
> +               return err;
> +       }
> +
> +       return 0;
> +}
> +
> +#ifdef CONFIG_JOYSTICK_PSXPAD_SPI_FF
> +static void psxpad_setenablemotor(
> +       struct psxpad *pad, bool motor1enable, bool motor2enable)
> +{
> +       int err;
> +
> +       pad->motor1enable = motor1enable;
> +       pad->motor2enable = motor2enable;
> +
> +       memcpy(pad->sendbuf, PSX_CMD_ENTER_CFG, sizeof(PSX_CMD_ENTER_CFG));
> +       err = psxpad_command(pad, sizeof(PSX_CMD_ENTER_CFG));
> +       if (err) {
> +               dev_err(&pad->spi->dev,
> +                       "%s: failed to enter config mode: %d\n",
> +                       __func__, err);
> +               return;
> +       }
> +       memcpy(pad->sendbuf,
> +               PSX_CMD_ENABLE_MOTOR, sizeof(PSX_CMD_ENABLE_MOTOR));
> +       pad->sendbuf[3] = pad->motor1enable ? 0x00 : 0xFF;
> +       pad->sendbuf[4] = pad->motor2enable ? 0x80 : 0xFF;
> +       err = psxpad_command(pad, sizeof(PSX_CMD_ENABLE_MOTOR));
> +       if (err) {
> +               dev_err(&pad->spi->dev,
> +                       "%s: failed to enable motor mode: %d\n",
> +                       __func__, err);
> +               return;
> +       }
> +       memcpy(pad->sendbuf, PSX_CMD_EXIT_CFG, sizeof(PSX_CMD_EXIT_CFG));
> +       err = psxpad_command(pad, sizeof(PSX_CMD_EXIT_CFG));
> +       if (err) {
> +               dev_err(&pad->spi->dev,
> +                       "%s: failed to exit config mode: %d\n",
> +                       __func__, err);
> +               return;
> +       }
> +}
> +
> +static void psxpad_set_motor_level(
> +       struct psxpad *pad, u8 motor1level, u8 motor2level)
> +{
> +       pad->motor1level = motor1level ? 0xFF : 0x00;
> +       pad->motor2level = REVERSE_BIT(motor2level);
> +}
> +#else  /* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
> +static void psxpad_setenablemotor(
> +       struct psxpad *pad, bool motor1enable, bool motor2enable) { }
> +
> +static void psxpad_set_motor_level(
> +       struct psxpad *pad, u8 motor1level, u8 motor2level) { }
> +#endif /* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
> +
> +static void psxpad_spi_poll_open(struct input_polled_dev *pdev)
> +{
> +       struct psxpad *pad = pdev->private;
> +
> +       pm_runtime_get_sync(&pad->spi->dev);
> +}
> +
> +static void psxpad_spi_poll_close(struct input_polled_dev *pdev)
> +{
> +       struct psxpad *pad = pdev->private;
> +
> +       pm_runtime_put_sync(&pad->spi->dev);
> +}
> +
> +static void psxpad_spi_poll(struct input_polled_dev *pdev)
> +{
> +       struct psxpad *pad = pdev->private;
> +       int err;
> +
> +       psxpad_setenablemotor(pad, true, true);
> +
> +       memcpy(pad->sendbuf, PSX_CMD_POLL, sizeof(PSX_CMD_POLL));
> +       pad->sendbuf[3] = pad->motor1enable ? pad->motor1level : 0x00;
> +       pad->sendbuf[4] = pad->motor2enable ? pad->motor2level : 0x00;
> +       err = psxpad_command(pad, sizeof(PSX_CMD_POLL));
> +       if (err) {
> +               dev_err(&pad->spi->dev,
> +                       "%s: failed to poll cmd mode: %d\n",
> +                       __func__, err);
> +               return;
> +       }
> +
> +       switch (pad->response[1]) {
> +       case 0xCE:      /* 0x73 : analog 1 */
> +               input_report_abs(pad->idev,
> +                       ABS_X,          REVERSE_BIT(pad->response[7]));
> +               input_report_abs(pad->idev,
> +                       ABS_Y,          REVERSE_BIT(pad->response[8]));
> +               input_report_abs(pad->idev,
> +                       ABS_RX,         REVERSE_BIT(pad->response[5]));
> +               input_report_abs(pad->idev,
> +                       ABS_RY,         REVERSE_BIT(pad->response[6]));
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_UP,    !(pad->response[3] & BIT(3)));
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_DOWN,  !(pad->response[3] & BIT(1)));
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_LEFT,  !(pad->response[3] & BIT(0)));
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_RIGHT, !(pad->response[3] & BIT(2)));
> +               input_report_key(pad->idev,
> +                       BTN_X,          !(pad->response[4] & BIT(3)));
> +               input_report_key(pad->idev,
> +                       BTN_A,          !(pad->response[4] & BIT(2)));
> +               input_report_key(pad->idev,
> +                       BTN_B,          !(pad->response[4] & BIT(1)));
> +               input_report_key(pad->idev,
> +                       BTN_Y,          !(pad->response[4] & BIT(0)));
> +               input_report_key(pad->idev,
> +                       BTN_TL,         !(pad->response[4] & BIT(5)));
> +               input_report_key(pad->idev,
> +                       BTN_TR,         !(pad->response[4] & BIT(4)));
> +               input_report_key(pad->idev,
> +                       BTN_TL2,        !(pad->response[4] & BIT(7)));
> +               input_report_key(pad->idev,
> +                       BTN_TR2,        !(pad->response[4] & BIT(6)));
> +               input_report_key(pad->idev,
> +                       BTN_THUMBL,     !(pad->response[3] & BIT(6)));
> +               input_report_key(pad->idev,
> +                       BTN_THUMBR,     !(pad->response[3] & BIT(5)));
> +               input_report_key(pad->idev,
> +                       BTN_SELECT,     !(pad->response[3] & BIT(7)));
> +               input_report_key(pad->idev,
> +                       BTN_START,      !(pad->response[3] & BIT(4)));
> +               break;
> +
> +       case 0x82:      /* 0x41 : digital */
> +               input_report_abs(pad->idev,
> +                       ABS_X,          0x80);
> +               input_report_abs(pad->idev,
> +                       ABS_Y,          0x80);
> +               input_report_abs(pad->idev,
> +                       ABS_RX,         0x80);
> +               input_report_abs(pad->idev,
> +                       ABS_RY,         0x80);
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_UP,    !(pad->response[3] & BIT(3)));
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_DOWN,  !(pad->response[3] & BIT(1)));
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_LEFT,  !(pad->response[3] & BIT(0)));
> +               input_report_key(pad->idev,
> +                       BTN_DPAD_RIGHT, !(pad->response[3] & BIT(2)));
> +               input_report_key(pad->idev,
> +                       BTN_X,          !(pad->response[4] & BIT(3)));
> +               input_report_key(pad->idev,
> +                       BTN_A,          !(pad->response[4] & BIT(2)));
> +               input_report_key(pad->idev,
> +                       BTN_B,          !(pad->response[4] & BIT(1)));
> +               input_report_key(pad->idev,
> +                       BTN_Y,          !(pad->response[4] & BIT(0)));
> +               input_report_key(pad->idev,
> +                       BTN_TL,         !(pad->response[4] & BIT(5)));
> +               input_report_key(pad->idev,
> +                       BTN_TR,         !(pad->response[4] & BIT(4)));
> +               input_report_key(pad->idev,
> +                       BTN_TL2,        !(pad->response[4] & BIT(7)));
> +               input_report_key(pad->idev,
> +                       BTN_TR2,        !(pad->response[4] & BIT(6)));
> +               input_report_key(pad->idev,
> +                       BTN_THUMBL,     false);
> +               input_report_key(pad->idev,
> +                       BTN_THUMBR,     false);
> +               input_report_key(pad->idev,
> +                       BTN_SELECT,     !(pad->response[3] & BIT(7)));
> +               input_report_key(pad->idev,
> +                       BTN_START,      !(pad->response[3] & BIT(4)));
> +               break;
> +       }
> +
> +       input_sync(pad->idev);
> +}
> +
> +#ifdef CONFIG_JOYSTICK_PSXPAD_SPI_FF
> +static int psxpad_spi_ff(
> +       struct input_dev *idev, void *data, struct ff_effect *effect)
> +{
> +       struct input_polled_dev *pdev = input_get_drvdata(idev);
> +       struct psxpad *pad = pdev->private;
> +
> +       switch (effect->type) {
> +       case FF_RUMBLE:
> +               psxpad_set_motor_level(pad,
> +                       (effect->u.rumble.weak_magnitude >> 8) & 0xFFU,
> +                       (effect->u.rumble.strong_magnitude >> 8) & 0xFFU);
> +               break;
> +       }
> +
> +       return 0;
> +}
> +
> +static int psxpad_spi_init_ff(struct psxpad *pad)
> +{
> +       int err;
> +
> +       input_set_capability(pad->idev, EV_FF, FF_RUMBLE);
> +       err = input_ff_create_memless(pad->idev, NULL, psxpad_spi_ff);
> +       if (err) {
> +               dev_err(&pad->spi->dev,
> +                       "%s: failed to ff alloc mode: %d\n",
> +                       __func__, err);
> +       }
> +
> +       return err;
> +}
> +#else  /* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
> +static inline int psxpad_spi_init_ff(struct psxpad *pad)
> +{
> +       return 0;
> +}
> +#endif /* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
> +
> +static int psxpad_spi_probe(struct spi_device *spi)
> +{
> +       struct psxpad *pad;
> +       struct input_polled_dev *pdev;
> +       struct input_dev *idev;
> +       int err;
> +
> +       pad = devm_kzalloc(&spi->dev, sizeof(struct psxpad), GFP_KERNEL);
> +       if (!pad)
> +               return -ENOMEM;
> +       pdev = input_allocate_polled_device();
> +       if (!pdev) {
> +               dev_err(&spi->dev,
> +                       "%s: failed to pdev alloc\n",
> +                       __func__);
> +               return -ENOMEM;
> +       }
> +
> +       /* input poll device settings */
> +       pad->pdev = pdev;
> +       pad->spi = spi;
> +       pad->motor1enable = false;
> +       pad->motor2enable = false;
> +       pdev->private = pad;
> +       pdev->open = psxpad_spi_poll_open;
> +       pdev->close = psxpad_spi_poll_close;
> +       pdev->poll = psxpad_spi_poll;
> +       /* poll interval is about 60fps */
> +       pdev->poll_interval = 16;
> +       pdev->poll_interval_min = 8;
> +       pdev->poll_interval_max = 32;
> +
> +       /* input device settings */
> +       idev = pdev->input;
> +       pad->idev = idev;
> +       idev->name = "PlayStation 1/2 joypad";
> +       snprintf(pad->phys, sizeof(pad->phys), "%s/input", dev_name(&spi->dev));
> +       idev->id.bustype = BUS_SPI;
> +
> +       /* key/value map settings */
> +       input_set_abs_params(idev, ABS_X,       0, 255, 0, 0);
> +       input_set_abs_params(idev, ABS_Y,       0, 255, 0, 0);
> +       input_set_abs_params(idev, ABS_RX,      0, 255, 0, 0);
> +       input_set_abs_params(idev, ABS_RY,      0, 255, 0, 0);
> +       input_set_capability(idev, EV_KEY,      BTN_DPAD_UP);
> +       input_set_capability(idev, EV_KEY,      BTN_DPAD_DOWN);
> +       input_set_capability(idev, EV_KEY,      BTN_DPAD_LEFT);
> +       input_set_capability(idev, EV_KEY,      BTN_DPAD_RIGHT);
> +       input_set_capability(idev, EV_KEY,      BTN_A);
> +       input_set_capability(idev, EV_KEY,      BTN_B);
> +       input_set_capability(idev, EV_KEY,      BTN_X);
> +       input_set_capability(idev, EV_KEY,      BTN_Y);
> +       input_set_capability(idev, EV_KEY,      BTN_TL);
> +       input_set_capability(idev, EV_KEY,      BTN_TR);
> +       input_set_capability(idev, EV_KEY,      BTN_TL2);
> +       input_set_capability(idev, EV_KEY,      BTN_TR2);
> +       input_set_capability(idev, EV_KEY,      BTN_THUMBL);
> +       input_set_capability(idev, EV_KEY,      BTN_THUMBR);
> +       input_set_capability(idev, EV_KEY,      BTN_SELECT);
> +       input_set_capability(idev, EV_KEY,      BTN_START);
> +
> +       /* force feedback */
> +       err = psxpad_spi_init_ff(pad);
> +       if (err) {
> +               dev_err(&spi->dev,
> +                       "%s: failed to init ff mode: %d\n",
> +                       __func__, err);
> +               return err;
> +       }
> +
> +       /* SPI settings */
> +       spi->mode = SPI_MODE_3;
> +       spi->bits_per_word = 8;
> +       /* (PlayStation 1/2 joypad might be possible works 250kHz/500kHz) */
> +       spi->master->min_speed_hz = 125000;
> +       spi->master->max_speed_hz = 125000;
> +       spi_setup(spi);
> +
> +       /* pad settings */
> +       psxpad_set_motor_level(pad, 0, 0);
> +
> +       /* register input poll device */
> +       err = input_register_polled_device(pdev);
> +       if (err) {
> +               dev_err(&spi->dev,
> +                       "%s: failed to register input poll device: %d\n",
> +                       __func__, err);
> +               return err;
> +       }
> +
> +       pm_runtime_enable(&spi->dev);
> +
> +       return 0;
> +}
> +
> +static int __maybe_unused psxpad_spi_suspend(struct device *dev)
> +{
> +       struct spi_device *spi = to_spi_device(dev);
> +       struct psxpad *pad = spi_get_drvdata(spi);
> +
> +       psxpad_set_motor_level(pad, 0, 0);
> +
> +       return 0;
> +}
> +
> +static int __maybe_unused psxpad_spi_resume(struct device *dev)
> +{
> +       return 0;
> +}
> +
> +static SIMPLE_DEV_PM_OPS(psxpad_spi_pm, psxpad_spi_suspend, psxpad_spi_resume);
> +
> +static const struct spi_device_id psxpad_spi_id[] = {
> +       { "psxpad-spi", 0 },
> +       { }
> +};
> +MODULE_DEVICE_TABLE(spi, psxpad_spi_id);
> +
> +static struct spi_driver psxpad_spi_driver = {
> +       .driver = {
> +               .name = "psxpad-spi",
> +               .pm = &psxpad_spi_pm,
> +       },
> +       .id_table = psxpad_spi_id,
> +       .probe   = psxpad_spi_probe,
> +};
> +
> +module_spi_driver(psxpad_spi_driver);
> +
> +MODULE_AUTHOR("Tomohiro Yoshidomi <sylph23k@gmail.com>");
> +MODULE_DESCRIPTION("PlayStation 1/2 joypads via SPI interface Driver");
> +MODULE_LICENSE("GPL");
> --
> 2.11.0
>
--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
diff mbox

Patch

diff --git a/drivers/input/joystick/Kconfig b/drivers/input/joystick/Kconfig
index 4215b538..cbcb9a6e 100644
--- a/drivers/input/joystick/Kconfig
+++ b/drivers/input/joystick/Kconfig
@@ -330,4 +330,26 @@  config JOYSTICK_MAPLE
 	  To compile this as a module choose M here: the module will be called
 	  maplecontrol.
 
+config JOYSTICK_PSXPAD_SPI
+	tristate "PlayStation 1/2 joypads via SPI interface"
+	depends on SPI
+	select INPUT_POLLDEV
+	help
+	  Say Y here if you wish to connect PlayStation 1/2 joypads
+	  via SPI interface.
+
+	  To compile this driver as a module, choose M here: the
+	  module will be called psxpad-spi.
+
+config JOYSTICK_PSXPAD_SPI_FF
+	bool "PlayStation 1/2 joypads force feedback (rumble) support"
+	depends on JOYSTICK_PSXPAD_SPI
+	select INPUT_FF_MEMLESS
+	help
+	  Say Y here if you want to take advantage of
+	  PlayStation 1/2 joypads rumble features.
+
+	  To drive rumble motor,
+	  a dedicated power supply is required.
+
 endif
diff --git a/drivers/input/joystick/Makefile b/drivers/input/joystick/Makefile
index 92dc0de9..496fd56b 100644
--- a/drivers/input/joystick/Makefile
+++ b/drivers/input/joystick/Makefile
@@ -21,6 +21,7 @@  obj-$(CONFIG_JOYSTICK_INTERACT)		+= interact.o
 obj-$(CONFIG_JOYSTICK_JOYDUMP)		+= joydump.o
 obj-$(CONFIG_JOYSTICK_MAGELLAN)		+= magellan.o
 obj-$(CONFIG_JOYSTICK_MAPLE)		+= maplecontrol.o
+obj-$(CONFIG_JOYSTICK_PSXPAD_SPI)	+= psxpad-spi.o
 obj-$(CONFIG_JOYSTICK_SIDEWINDER)	+= sidewinder.o
 obj-$(CONFIG_JOYSTICK_SPACEBALL)	+= spaceball.o
 obj-$(CONFIG_JOYSTICK_SPACEORB)		+= spaceorb.o
diff --git a/drivers/input/joystick/psxpad-spi.c b/drivers/input/joystick/psxpad-spi.c
new file mode 100644
index 00000000..2627aecb
--- /dev/null
+++ b/drivers/input/joystick/psxpad-spi.c
@@ -0,0 +1,438 @@ 
+/*
+ * PlayStation 1/2 joypads via SPI interface Driver
+ *
+ * Copyright (C) 2017 Tomohiro Yoshidomi <sylph23k@gmail.com>
+ * Licensed under the GPL-2 or later.
+ *
+ * PlayStation 1/2 joypad's plug (not socket)
+ *  123 456 789
+ * (...|...|...)
+ *
+ * 1: DAT -> MISO (pullup with 1k owm to 3.3V)
+ * 2: CMD -> MOSI
+ * 3: 9V (for motor, if not use N.C.)
+ * 4: GND
+ * 5: 3.3V
+ * 6: Attention -> CS(SS)
+ * 7: SCK -> SCK
+ * 8: N.C.
+ * 9: ACK -> N.C.
+ */
+
+#include <linux/kernel.h>
+#include <linux/device.h>
+#include <linux/input.h>
+#include <linux/input-polldev.h>
+#include <linux/module.h>
+#include <linux/spi/spi.h>
+#include <linux/types.h>
+#include <linux/pm.h>
+#include <linux/pm_runtime.h>
+
+#define REVERSE_BIT(x) ((((x) & 0x80) >> 7) | (((x) & 0x40) >> 5) | \
+	(((x) & 0x20) >> 3) | (((x) & 0x10) >> 1) | (((x) & 0x08) << 1) | \
+	(((x) & 0x04) << 3) | (((x) & 0x02) << 5) | (((x) & 0x01) << 7))
+
+/* PlayStation 1/2 joypad command and response are LSBFIRST. */
+
+/*	0x01, 0x42, 0x00, 0x00, 0x00,
+ *	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ *	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+ */
+static const u8 PSX_CMD_POLL[] = {
+	0x80, 0x42, 0x00, 0x00, 0x00,
+	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+	0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+};
+/*	0x01, 0x43, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00 */
+static const u8 PSX_CMD_ENTER_CFG[] = {
+	0x80, 0xC2, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00
+};
+/*	0x01, 0x43, 0x00, 0x00, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A */
+static const u8 PSX_CMD_EXIT_CFG[] = {
+	0x80, 0xC2, 0x00, 0x00, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A
+};
+/*	0x01, 0x4D, 0x00, 0x00, 0x01, 0xFF, 0xFF, 0xFF, 0xFF */
+static const u8 PSX_CMD_ENABLE_MOTOR[]	= {
+	0x80, 0xB2, 0x00, 0x00, 0x80, 0xFF, 0xFF, 0xFF, 0xFF
+};
+
+struct psxpad {
+	struct spi_device *spi;
+	struct input_polled_dev *pdev;
+	struct input_dev *idev;
+	char phys[0x20];
+	bool motor1enable;
+	bool motor2enable;
+	u8 motor1level;
+	u8 motor2level;
+	u8 sendbuf[0x20] ____cacheline_aligned;
+	u8 response[sizeof(PSX_CMD_POLL)] ____cacheline_aligned;
+};
+
+static int psxpad_command(struct psxpad *pad, const u8 sendcmdlen)
+{
+	struct spi_transfer xfers = {
+		.tx_buf		= pad->sendbuf,
+		.rx_buf		= pad->response,
+		.len		= sendcmdlen,
+	};
+	int err;
+
+	err = spi_sync_transfer(pad->spi, &xfers, 1);
+	if (err) {
+		dev_err(&pad->spi->dev,
+			"%s: failed to SPI xfers mode: %d\n",
+			__func__, err);
+		return err;
+	}
+
+	return 0;
+}
+
+#ifdef CONFIG_JOYSTICK_PSXPAD_SPI_FF
+static void psxpad_setenablemotor(
+	struct psxpad *pad, bool motor1enable, bool motor2enable)
+{
+	int err;
+
+	pad->motor1enable = motor1enable;
+	pad->motor2enable = motor2enable;
+
+	memcpy(pad->sendbuf, PSX_CMD_ENTER_CFG, sizeof(PSX_CMD_ENTER_CFG));
+	err = psxpad_command(pad, sizeof(PSX_CMD_ENTER_CFG));
+	if (err) {
+		dev_err(&pad->spi->dev,
+			"%s: failed to enter config mode: %d\n",
+			__func__, err);
+		return;
+	}
+	memcpy(pad->sendbuf,
+		PSX_CMD_ENABLE_MOTOR, sizeof(PSX_CMD_ENABLE_MOTOR));
+	pad->sendbuf[3] = pad->motor1enable ? 0x00 : 0xFF;
+	pad->sendbuf[4] = pad->motor2enable ? 0x80 : 0xFF;
+	err = psxpad_command(pad, sizeof(PSX_CMD_ENABLE_MOTOR));
+	if (err) {
+		dev_err(&pad->spi->dev,
+			"%s: failed to enable motor mode: %d\n",
+			__func__, err);
+		return;
+	}
+	memcpy(pad->sendbuf, PSX_CMD_EXIT_CFG, sizeof(PSX_CMD_EXIT_CFG));
+	err = psxpad_command(pad, sizeof(PSX_CMD_EXIT_CFG));
+	if (err) {
+		dev_err(&pad->spi->dev,
+			"%s: failed to exit config mode: %d\n",
+			__func__, err);
+		return;
+	}
+}
+
+static void psxpad_set_motor_level(
+	struct psxpad *pad, u8 motor1level, u8 motor2level)
+{
+	pad->motor1level = motor1level ? 0xFF : 0x00;
+	pad->motor2level = REVERSE_BIT(motor2level);
+}
+#else	/* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
+static void psxpad_setenablemotor(
+	struct psxpad *pad, bool motor1enable, bool motor2enable) { }
+
+static void psxpad_set_motor_level(
+	struct psxpad *pad, u8 motor1level, u8 motor2level) { }
+#endif	/* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
+
+static void psxpad_spi_poll_open(struct input_polled_dev *pdev)
+{
+	struct psxpad *pad = pdev->private;
+
+	pm_runtime_get_sync(&pad->spi->dev);
+}
+
+static void psxpad_spi_poll_close(struct input_polled_dev *pdev)
+{
+	struct psxpad *pad = pdev->private;
+
+	pm_runtime_put_sync(&pad->spi->dev);
+}
+
+static void psxpad_spi_poll(struct input_polled_dev *pdev)
+{
+	struct psxpad *pad = pdev->private;
+	int err;
+
+	psxpad_setenablemotor(pad, true, true);
+
+	memcpy(pad->sendbuf, PSX_CMD_POLL, sizeof(PSX_CMD_POLL));
+	pad->sendbuf[3] = pad->motor1enable ? pad->motor1level : 0x00;
+	pad->sendbuf[4] = pad->motor2enable ? pad->motor2level : 0x00;
+	err = psxpad_command(pad, sizeof(PSX_CMD_POLL));
+	if (err) {
+		dev_err(&pad->spi->dev,
+			"%s: failed to poll cmd mode: %d\n",
+			__func__, err);
+		return;
+	}
+
+	switch (pad->response[1]) {
+	case 0xCE:	/* 0x73 : analog 1 */
+		input_report_abs(pad->idev,
+			ABS_X,		REVERSE_BIT(pad->response[7]));
+		input_report_abs(pad->idev,
+			ABS_Y,		REVERSE_BIT(pad->response[8]));
+		input_report_abs(pad->idev,
+			ABS_RX,		REVERSE_BIT(pad->response[5]));
+		input_report_abs(pad->idev,
+			ABS_RY,		REVERSE_BIT(pad->response[6]));
+		input_report_key(pad->idev,
+			BTN_DPAD_UP,	!(pad->response[3] & BIT(3)));
+		input_report_key(pad->idev,
+			BTN_DPAD_DOWN,	!(pad->response[3] & BIT(1)));
+		input_report_key(pad->idev,
+			BTN_DPAD_LEFT,	!(pad->response[3] & BIT(0)));
+		input_report_key(pad->idev,
+			BTN_DPAD_RIGHT,	!(pad->response[3] & BIT(2)));
+		input_report_key(pad->idev,
+			BTN_X,		!(pad->response[4] & BIT(3)));
+		input_report_key(pad->idev,
+			BTN_A,		!(pad->response[4] & BIT(2)));
+		input_report_key(pad->idev,
+			BTN_B,		!(pad->response[4] & BIT(1)));
+		input_report_key(pad->idev,
+			BTN_Y,		!(pad->response[4] & BIT(0)));
+		input_report_key(pad->idev,
+			BTN_TL,		!(pad->response[4] & BIT(5)));
+		input_report_key(pad->idev,
+			BTN_TR,		!(pad->response[4] & BIT(4)));
+		input_report_key(pad->idev,
+			BTN_TL2,	!(pad->response[4] & BIT(7)));
+		input_report_key(pad->idev,
+			BTN_TR2,	!(pad->response[4] & BIT(6)));
+		input_report_key(pad->idev,
+			BTN_THUMBL,	!(pad->response[3] & BIT(6)));
+		input_report_key(pad->idev,
+			BTN_THUMBR,	!(pad->response[3] & BIT(5)));
+		input_report_key(pad->idev,
+			BTN_SELECT,	!(pad->response[3] & BIT(7)));
+		input_report_key(pad->idev,
+			BTN_START,	!(pad->response[3] & BIT(4)));
+		break;
+
+	case 0x82:	/* 0x41 : digital */
+		input_report_abs(pad->idev,
+			ABS_X,		0x80);
+		input_report_abs(pad->idev,
+			ABS_Y,		0x80);
+		input_report_abs(pad->idev,
+			ABS_RX,		0x80);
+		input_report_abs(pad->idev,
+			ABS_RY,		0x80);
+		input_report_key(pad->idev,
+			BTN_DPAD_UP,	!(pad->response[3] & BIT(3)));
+		input_report_key(pad->idev,
+			BTN_DPAD_DOWN,	!(pad->response[3] & BIT(1)));
+		input_report_key(pad->idev,
+			BTN_DPAD_LEFT,	!(pad->response[3] & BIT(0)));
+		input_report_key(pad->idev,
+			BTN_DPAD_RIGHT,	!(pad->response[3] & BIT(2)));
+		input_report_key(pad->idev,
+			BTN_X,		!(pad->response[4] & BIT(3)));
+		input_report_key(pad->idev,
+			BTN_A,		!(pad->response[4] & BIT(2)));
+		input_report_key(pad->idev,
+			BTN_B,		!(pad->response[4] & BIT(1)));
+		input_report_key(pad->idev,
+			BTN_Y,		!(pad->response[4] & BIT(0)));
+		input_report_key(pad->idev,
+			BTN_TL,		!(pad->response[4] & BIT(5)));
+		input_report_key(pad->idev,
+			BTN_TR,		!(pad->response[4] & BIT(4)));
+		input_report_key(pad->idev,
+			BTN_TL2,	!(pad->response[4] & BIT(7)));
+		input_report_key(pad->idev,
+			BTN_TR2,	!(pad->response[4] & BIT(6)));
+		input_report_key(pad->idev,
+			BTN_THUMBL,	false);
+		input_report_key(pad->idev,
+			BTN_THUMBR,	false);
+		input_report_key(pad->idev,
+			BTN_SELECT,	!(pad->response[3] & BIT(7)));
+		input_report_key(pad->idev,
+			BTN_START,	!(pad->response[3] & BIT(4)));
+		break;
+	}
+
+	input_sync(pad->idev);
+}
+
+#ifdef CONFIG_JOYSTICK_PSXPAD_SPI_FF
+static int psxpad_spi_ff(
+	struct input_dev *idev, void *data, struct ff_effect *effect)
+{
+	struct input_polled_dev *pdev = input_get_drvdata(idev);
+	struct psxpad *pad = pdev->private;
+
+	switch (effect->type) {
+	case FF_RUMBLE:
+		psxpad_set_motor_level(pad,
+			(effect->u.rumble.weak_magnitude >> 8) & 0xFFU,
+			(effect->u.rumble.strong_magnitude >> 8) & 0xFFU);
+		break;
+	}
+
+	return 0;
+}
+
+static int psxpad_spi_init_ff(struct psxpad *pad)
+{
+	int err;
+
+	input_set_capability(pad->idev, EV_FF, FF_RUMBLE);
+	err = input_ff_create_memless(pad->idev, NULL, psxpad_spi_ff);
+	if (err) {
+		dev_err(&pad->spi->dev,
+			"%s: failed to ff alloc mode: %d\n",
+			__func__, err);
+	}
+
+	return err;
+}
+#else	/* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
+static inline int psxpad_spi_init_ff(struct psxpad *pad)
+{
+	return 0;
+}
+#endif	/* CONFIG_JOYSTICK_PSXPAD_SPI_FF */
+
+static int psxpad_spi_probe(struct spi_device *spi)
+{
+	struct psxpad *pad;
+	struct input_polled_dev *pdev;
+	struct input_dev *idev;
+	int err;
+
+	pad = devm_kzalloc(&spi->dev, sizeof(struct psxpad), GFP_KERNEL);
+	if (!pad)
+		return -ENOMEM;
+	pdev = input_allocate_polled_device();
+	if (!pdev) {
+		dev_err(&spi->dev,
+			"%s: failed to pdev alloc\n",
+			__func__);
+		return -ENOMEM;
+	}
+
+	/* input poll device settings */
+	pad->pdev = pdev;
+	pad->spi = spi;
+	pad->motor1enable = false;
+	pad->motor2enable = false;
+	pdev->private = pad;
+	pdev->open = psxpad_spi_poll_open;
+	pdev->close = psxpad_spi_poll_close;
+	pdev->poll = psxpad_spi_poll;
+	/* poll interval is about 60fps */
+	pdev->poll_interval = 16;
+	pdev->poll_interval_min = 8;
+	pdev->poll_interval_max = 32;
+
+	/* input device settings */
+	idev = pdev->input;
+	pad->idev = idev;
+	idev->name = "PlayStation 1/2 joypad";
+	snprintf(pad->phys, sizeof(pad->phys), "%s/input", dev_name(&spi->dev));
+	idev->id.bustype = BUS_SPI;
+
+	/* key/value map settings */
+	input_set_abs_params(idev, ABS_X,	0, 255, 0, 0);
+	input_set_abs_params(idev, ABS_Y,	0, 255, 0, 0);
+	input_set_abs_params(idev, ABS_RX,	0, 255, 0, 0);
+	input_set_abs_params(idev, ABS_RY,	0, 255, 0, 0);
+	input_set_capability(idev, EV_KEY,	BTN_DPAD_UP);
+	input_set_capability(idev, EV_KEY,	BTN_DPAD_DOWN);
+	input_set_capability(idev, EV_KEY,	BTN_DPAD_LEFT);
+	input_set_capability(idev, EV_KEY,	BTN_DPAD_RIGHT);
+	input_set_capability(idev, EV_KEY,	BTN_A);
+	input_set_capability(idev, EV_KEY,	BTN_B);
+	input_set_capability(idev, EV_KEY,	BTN_X);
+	input_set_capability(idev, EV_KEY,	BTN_Y);
+	input_set_capability(idev, EV_KEY,	BTN_TL);
+	input_set_capability(idev, EV_KEY,	BTN_TR);
+	input_set_capability(idev, EV_KEY,	BTN_TL2);
+	input_set_capability(idev, EV_KEY,	BTN_TR2);
+	input_set_capability(idev, EV_KEY,	BTN_THUMBL);
+	input_set_capability(idev, EV_KEY,	BTN_THUMBR);
+	input_set_capability(idev, EV_KEY,	BTN_SELECT);
+	input_set_capability(idev, EV_KEY,	BTN_START);
+
+	/* force feedback */
+	err = psxpad_spi_init_ff(pad);
+	if (err) {
+		dev_err(&spi->dev,
+			"%s: failed to init ff mode: %d\n",
+			__func__, err);
+		return err;
+	}
+
+	/* SPI settings */
+	spi->mode = SPI_MODE_3;
+	spi->bits_per_word = 8;
+	/* (PlayStation 1/2 joypad might be possible works 250kHz/500kHz) */
+	spi->master->min_speed_hz = 125000;
+	spi->master->max_speed_hz = 125000;
+	spi_setup(spi);
+
+	/* pad settings */
+	psxpad_set_motor_level(pad, 0, 0);
+
+	/* register input poll device */
+	err = input_register_polled_device(pdev);
+	if (err) {
+		dev_err(&spi->dev,
+			"%s: failed to register input poll device: %d\n",
+			__func__, err);
+		return err;
+	}
+
+	pm_runtime_enable(&spi->dev);
+
+	return 0;
+}
+
+static int __maybe_unused psxpad_spi_suspend(struct device *dev)
+{
+	struct spi_device *spi = to_spi_device(dev);
+	struct psxpad *pad = spi_get_drvdata(spi);
+
+	psxpad_set_motor_level(pad, 0, 0);
+
+	return 0;
+}
+
+static int __maybe_unused psxpad_spi_resume(struct device *dev)
+{
+	return 0;
+}
+
+static SIMPLE_DEV_PM_OPS(psxpad_spi_pm, psxpad_spi_suspend, psxpad_spi_resume);
+
+static const struct spi_device_id psxpad_spi_id[] = {
+	{ "psxpad-spi", 0 },
+	{ }
+};
+MODULE_DEVICE_TABLE(spi, psxpad_spi_id);
+
+static struct spi_driver psxpad_spi_driver = {
+	.driver = {
+		.name = "psxpad-spi",
+		.pm = &psxpad_spi_pm,
+	},
+	.id_table = psxpad_spi_id,
+	.probe   = psxpad_spi_probe,
+};
+
+module_spi_driver(psxpad_spi_driver);
+
+MODULE_AUTHOR("Tomohiro Yoshidomi <sylph23k@gmail.com>");
+MODULE_DESCRIPTION("PlayStation 1/2 joypads via SPI interface Driver");
+MODULE_LICENSE("GPL");