spi working, counter seems to

driver/counter.c

@@ -7,19 +7,22 @@
 #include <linux/gpio/consumer.h>
 #include <linux/spi/spi.h>
 
-/* Meta Information */
+#include "ls7366r.h"
+
+
 MODULE_LICENSE("GPL");
 MODULE_AUTHOR("Wolfgang Hottgenroth");
 MODULE_DESCRIPTION("A simple LKM to parse the device tree for a specific device and its properties");
 
-/* Declate the probe and remove functions */
+/* leds stuff */
 static int dt_leds_probe(struct platform_device *pdev);
 static void dt_leds_remove(struct platform_device *pdev);
 
 static struct of_device_id leds_driver_ids[] = {
   {
     .compatible = "hottis,leds",
-  }, { /* sentinel */ }
+  }, 
+  {},
 };
 MODULE_DEVICE_TABLE(of, leds_driver_ids);
 
@@ -32,41 +35,9 @@ static struct platform_driver leds_driver = {
   },
 };
 
-/* GPIO variable */
 static struct gpio_desc *red_led = NULL;
 static struct gpio_desc *blue_led = NULL;
 
-
-/* spi stuff */
-static int dt_ls7366r_probe(struct spi_device *client);
-static void dt_ls7366r_remove(struct spi_device *client);
-
-static struct of_device_id ls7366r_driver_ids[] = {
-  {
-    .compatible = "hottis,ls7366r",
-  }, {}
-};
-MODULE_DEVICE_TABLE(of, ls7366r_driver_ids);
-
-static struct spi_device_id ls7366r[] = {
-  { "ls7366r", 0 },
-  {},
-};
-MODULE_DEVICE_TABLE(spi, ls7366r);
-
-static struct spi_driver ls7366r_driver = {
-  .probe = dt_ls7366r_probe,
-  .remove = dt_ls7366r_remove,
-  .id_table = ls7366r,
-  .driver = {
-    .name = "ls7366r_device_driver",
-    .of_match_table = ls7366r_driver_ids,
-  },
-};
-
-/**
- * @brief This function is called on loading the driver 
- */
 static int dt_leds_probe(struct platform_device *pdev) {
   struct device *dev = &pdev->dev;
 
@@ -97,15 +68,95 @@ static int dt_leds_probe(struct platform_device *pdev) {
   return 0;
 }
 
-/**
- * @brief This function is called on unloading the driver 
- */
 static void dt_leds_remove(struct platform_device *pdev) {
   printk("counter - leds removing\n");
   gpiod_put(red_led);
   gpiod_put(blue_led);
 }
 
+
+/* spi stuff */
+static int dt_ls7366r_probe(struct spi_device *client);
+static void dt_ls7366r_remove(struct spi_device *client);
+
+/*    LS7366R functions */
+static int writeCmd(struct spi_device *client, u8 c) {
+  u8 buf[1];
+  buf[0] = c;
+  return spi_write(client, buf, 1);
+}
+
+static int writeCmdData(struct spi_device *client, u8 c, u8 d) {
+  u8 buf[2];
+  buf[0] = c;
+  buf[1] = d;
+  return spi_write(client, buf, 2);
+}
+
+static int read32(struct spi_device *client, u8 c, u32 *r) {
+  u8 tx_buf[5];
+  tx_buf[0] = c;
+  u8 rx_buf[5];
+  struct spi_transfer t = {
+    .tx_buf = tx_buf,
+    .rx_buf = rx_buf,
+    .len = 5,
+  };
+  int ret = spi_sync_transfer(client, &t, 1);
+  if (ret < 0) {
+    printk("counter - Error! spi_sync_transfer failed in read32\n");
+    return ret;
+  }
+  printk("counter - Info! rx_buf: %02x %02x %02x %02x %02x\n", rx_buf[0], rx_buf[1], rx_buf[2], rx_buf[3], rx_buf[4]);
+  *r = ((u32)rx_buf[1] << 24) | ((u32)rx_buf[2] << 16) | ((u32)rx_buf[3] << 8) | ((u32)rx_buf[4]);
+  return 0;
+}
+
+static int read8(struct spi_device *client, u8 c, u8 *r) {
+  u8 tx_buf[2];
+  tx_buf[0] = c;
+  u8 rx_buf[2];
+  struct spi_transfer t = {
+    .tx_buf = tx_buf,
+    .rx_buf = rx_buf,
+    .len = 2,
+  };
+  int ret = spi_sync_transfer(client, &t, 1);
+  if (ret < 0) {
+    printk("counter - Error! spi_sync_transfer failed in read8\n");
+    return ret;
+  }
+  printk("counter - Info! rx_buf: %02x %02x\n", rx_buf[0], rx_buf[1]);
+  *r = rx_buf[1];
+  return 0;
+}
+
+
+
+
+static struct of_device_id ls7366r_driver_ids[] = {
+  {
+    .compatible = "hottis,ls7366r",
+  }, {}
+};
+MODULE_DEVICE_TABLE(of, ls7366r_driver_ids);
+
+static struct spi_device_id ls7366r[] = {
+  { "ls7366r", 0 },
+  {},
+};
+MODULE_DEVICE_TABLE(spi, ls7366r);
+
+static struct spi_driver ls7366r_driver = {
+  .probe = dt_ls7366r_probe,
+  .remove = dt_ls7366r_remove,
+  .id_table = ls7366r,
+  .driver = {
+    .name = "ls7366r_device_driver",
+    .of_match_table = ls7366r_driver_ids,
+  },
+};
+
 static int dt_ls7366r_probe(struct spi_device *client) {
   printk("counter - ls7366r probing\n");
   
@@ -115,18 +166,48 @@ static int dt_ls7366r_probe(struct spi_device *client) {
     return ret;
   }
 
+  ret = writeCmd(client, CMD_CLR | REG_STR);
+  if (ret < 0) {
+    printk("counter - Error! writeCmd 1 failed in probe\n");
+    return ret;
+  }
+  ret = writeCmd(client, CMD_CLR | REG_CNTR);
+  if (ret < 0) {
+    printk("counter - Error! writeCmd 2 failed in probe\n");
+    return ret;
+  }
+  ret = writeCmdData(client, CMD_WR | REG_MDR0, MDR0_ILO);
+  if (ret < 0) {
+    printk("counter - Error! writeCmdData failed in probe\n");
+    return ret;
+  }
+
+  u8 x;
+  ret = read8(client, CMD_RD | REG_MDR0, &x);
+  if (ret < 0) {
+    printk("counter - Error! read8 failed in probe\n");
+    return ret;
+  }
+  printk("counter - Info! x = %02x\n", x);
+
+  u32 y;
+  ret = read32(client, CMD_RD | REG_OTR, &y);
+  if (ret < 0) {
+    printk("counter - Error! read32 failed in probe\n");
+    return ret;
+  }
+  printk("counter - Info! y = %d\n", y);
+
+
   return 0;
 }
 
-
 static void dt_ls7366r_remove(struct spi_device *client) {
   printk("counter - ls7366r removing\n");
 }
 
 
-/**
- * @brief This function is called, when the module is loaded into the kernel
- */
+/* module loading and unloading */
 static int __init my_init(void) {
   printk("counter - Loading the leds driver...\n");
   if(platform_driver_register(&leds_driver)) {
@@ -146,9 +227,6 @@ static int __init my_init(void) {
   return 0;
 }
 
-/**
- * @brief This function is called, when the module is removed from the kernel
- */
 static void __exit my_exit(void) {
   printk("counter - red led off\n");
   gpiod_set_value(red_led, 0);