From d87c1acea88efdee4cfbec230cdcc5bef7b74084 Mon Sep 17 00:00:00 2001
From: Kimplul <kimi.h.kuparinen@gmail.com>
Date: Mon, 21 Sep 2020 17:12:54 +0300
Subject: Added initialization interrupts

Also made some small changes to autocentering, although it is still
mainly handled by whichever game/process is handling it.
---
 hid-tmt300rs.c | 119 +++++++++++++++++++++++++++++++++++++++++++++++++++++++--
 1 file changed, 116 insertions(+), 3 deletions(-)

(limited to 'hid-tmt300rs.c')

diff --git a/hid-tmt300rs.c b/hid-tmt300rs.c
index ebb5538..40aa646 100644
--- a/hid-tmt300rs.c
+++ b/hid-tmt300rs.c
@@ -665,6 +665,8 @@ static int t300rs_upload_ramp(struct t300rs_device_entry *t300rs, struct t300rs_
     send_buffer[22] = ramp.end_level > ramp.start_level ? 0x04 : 0x05;
     send_buffer[23] = 0x4f;
 
+    hid_info(t300rs->hdev, "uploading ramp effect with dir %i", send_buffer[22]);
+
     send_buffer[24] = le_duration & 0xff;
     send_buffer[25] = le_duration >> 8;
 
@@ -850,7 +852,7 @@ static int t300rs_upload_periodic(struct t300rs_device_entry *t300rs, struct t30
     le_offset = cpu_to_le16(effect.replay.delay);
     le_duration = cpu_to_le16(duration);
     
-        send_buffer[0] = 0x60;
+    send_buffer[0] = 0x60;
     send_buffer[2] = effect.id + 1;
     send_buffer[3] = 0x6b;
     
@@ -1120,6 +1122,16 @@ static void t300rs_set_autocenter(struct input_dev *dev, u16 value){
     u16 le_value = cpu_to_le16(value);
     int ret, trans;
 
+    send_buffer[0] = 0x60;
+    send_buffer[1] = 0x08;
+    send_buffer[2] = 0x04;
+    send_buffer[3] = 0x01;
+    
+    ret = t300rs_send_int(dev, send_buffer, &trans);
+    if(ret){
+        hid_err(hdev, "failed setting autocenter");
+    }
+
     send_buffer[0] = 0x60;
     send_buffer[1] = 0x08;
     send_buffer[2] = 0x03;
@@ -1163,7 +1175,7 @@ static int t300rs_open(struct input_dev *dev){
     struct hid_device *hdev = input_get_drvdata(dev);
     u8 *send_buffer = kzalloc(T300RS_BUFFER_LENGTH, GFP_ATOMIC);
     int ret, trans;
-
+    
     t300rs = t300rs_get_device(hdev);
 
     send_buffer[0] = 0x60;
@@ -1229,6 +1241,105 @@ err:
     return;
 }
 
+void t300rs_init_interrupts(struct t300rs_device_entry *t300rs){
+    int ret, trans;
+    u8 *send_buffer = kzalloc(T300RS_BUFFER_LENGTH, GFP_ATOMIC);
+
+    send_buffer[0] = 0x42;
+    send_buffer[1] = 0x01;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+
+    send_buffer[0] = 0x0a;
+    send_buffer[1] = 0x04;
+    send_buffer[2] = 0x90;
+    send_buffer[3] = 0x03;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+
+    send_buffer[0] = 0x0a;
+    send_buffer[1] = 0x04;
+    send_buffer[2] = 0x00;
+    send_buffer[3] = 0x0c;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+
+    send_buffer[0] = 0x0a;
+    send_buffer[1] = 0x04;
+    send_buffer[2] = 0x12;
+    send_buffer[3] = 0x10;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+
+    send_buffer[0] = 0x0a;
+    send_buffer[1] = 0x04;
+    send_buffer[2] = 0x00;
+    send_buffer[3] = 0x06;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+
+    send_buffer[0] = 0x0a;
+    send_buffer[1] = 0x04;
+    send_buffer[2] = 0x03;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+
+    send_buffer[0] = 0x0a;
+    send_buffer[1] = 0x04;
+    send_buffer[2] = 0x03;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+
+    send_buffer[0] = 0x0a;
+    send_buffer[1] = 0x04;
+    send_buffer[2] = 0x03;
+
+    ret = t300rs_send_int(t300rs->input_dev, send_buffer, &trans);
+    if(ret){
+        hid_err(t300rs->hdev, "failed sending interrupts\n");
+        goto err;
+    }
+    memset(send_buffer, 0, T300RS_BUFFER_LENGTH);
+err:
+    kfree(send_buffer);
+    return;
+}
+
 int t300rs_init(struct hid_device *hdev, const signed short *ff_bits){
     struct t300rs_device_entry *t300rs;
     struct t300rs_data *drv_data;
@@ -1241,7 +1352,7 @@ int t300rs_init(struct hid_device *hdev, const signed short *ff_bits){
     struct usb_device *usbdev = interface_to_usbdev(usbif);
     struct hid_report *report;
     struct ff_device *ff;
-    char range[10] = "1080"; /* max */
+    char range[10] = "900"; /* max */
     int i, ret;
 
     drv_data = hid_get_drvdata(hdev);
@@ -1365,6 +1476,8 @@ int t300rs_init(struct hid_device *hdev, const signed short *ff_bits){
     t300rs_range_store(dev, &dev_attr_range, range, 10);
     t300rs_set_gain(input_dev, 0xffff);
 
+    t300rs_init_interrupts(t300rs);
+
     hid_info(hdev, "force feedback for T300RS\n");
     return 0;
 
-- 
cgit v1.3