Add infrastucture to allow internal timestamps from the M_CAN to be
configured and retrieved.
Signed-off-by: Torin Cooper-Bennun <torin@xxxxxxxxxxxxxxxxxx>
---
drivers/net/can/m_can/m_can.c | 31 +++++++++++++++++++++++++++++++
1 file changed, 31 insertions(+)
diff --git a/drivers/net/can/m_can/m_can.c b/drivers/net/can/m_can/m_can.c
index 0c8d36bc668c..ea79cf0640a8 100644
--- a/drivers/net/can/m_can/m_can.c
+++ b/drivers/net/can/m_can/m_can.c
@@ -148,6 +148,19 @@ enum m_can_reg {
#define NBTP_NTSEG2_SHIFT 0
#define NBTP_NTSEG2_MASK (0x7f << NBTP_NTSEG2_SHIFT)
+/* Timestamp Counter Configuration Register (TSCC) */
+#define TSCC_TCP_SHIFT 16
+#define TSCC_TCP_MASK (0xf << TSCC_TCP_SHIFT)
+#define TSCC_TSS_SHIFT 0
+#define TSCC_TSS_MASK (0x3 << TSCC_TSS_SHIFT)
+#define TSCC_TSS_DISABLE (0x0 << TSCC_TSS_SHIFT)
+#define TSCC_TSS_INTERNAL (0x1 << TSCC_TSS_SHIFT)
+#define TSCC_TSS_EXTERNAL (0x2 << TSCC_TSS_SHIFT)
+
+/* Timestamp Counter Value Register (TSCV) */
+#define TSCV_TSC_SHIFT 0
+#define TSCV_TSC_MASK (0xffff << TSCV_TSC_SHIFT)
+
/* Error Counter Register(ECR) */
#define ECR_RP BIT(15)
#define ECR_REC_SHIFT 8
@@ -302,6 +315,8 @@ enum m_can_reg {
#define RX_BUF_ANMF BIT(31)
#define RX_BUF_FDF BIT(21)
#define RX_BUF_BRS BIT(20)
+#define RX_BUF_RXTS_SHIFT 0
+#define RX_BUF_RXTS_MASK (0xffff << RX_BUF_RXTS_SHIFT)
/* Tx Buffer Element */
/* T0 */
@@ -319,6 +334,8 @@ enum m_can_reg {
/* E1 */
#define TX_EVENT_MM_SHIFT TX_BUF_MM_SHIFT
#define TX_EVENT_MM_MASK (0xff << TX_EVENT_MM_SHIFT)
+#define TX_EVENT_TXTS_SHIFT 0
+#define TX_EVENT_TXTS_MASK (0xffff << TX_EVENT_TXTS_SHIFT)
static inline u32 m_can_read(struct m_can_classdev *cdev, enum m_can_reg reg)
{
@@ -413,6 +430,20 @@ static inline void m_can_disable_all_interrupts(struct m_can_classdev *cdev)
m_can_write(cdev, M_CAN_ILE, 0x0);
}
+/* Retrieve internal timestamp counter from TSCV.TSC, and shift it to 32-bit
+ * width.
+ */
+static u32 m_can_get_timestamp(struct m_can_classdev *cdev)
+{
+ u32 tscv;
+ u32 tsc;
+
+ tscv = m_can_read(cdev, M_CAN_TSCV);
+ tsc = (tscv & TSCV_TSC_MASK) >> TSCV_TSC_SHIFT;
+
+ return (tsc << 16);
+}
+
static void m_can_clean(struct net_device *net)
{
struct m_can_classdev *cdev = netdev_priv(net);
--
2.30.1
