1 files changed, 130 insertions, 12 deletions

diff --git a/drivers/misc/modem_if/modem_utils.h b/drivers/misc/modem_if/modem_utils.h
index 60e4820..7225ec2 100644
--- a/drivers/misc/modem_if/modem_utils.h
+++ b/drivers/misc/modem_if/modem_utils.h
@@ -19,14 +19,110 @@
 
 #define IS_CONNECTED(iod, ld) ((iod)->link_types & LINKTYPE((ld)->link_type))
 
+#define MAX_MIF_BUFF_SIZE 0x80000 /* 512kb */
+#define MAX_MIF_SEPA_SIZE 32
+#define MIF_SEPARATOR "IPC_LOGGER(VER1.1)"
+#define MIF_SEPARATOR_DPRAM "DPRAM_LOGGER(VER1.1)"
+#define MAX_IPC_SKB_SIZE 4096
+#define MAX_LOG_SIZE 64
+
+#define MAX_LOG_CNT (MAX_MIF_BUFF_SIZE / MAX_LOG_SIZE)
+#define MIF_ID_SIZE sizeof(enum mif_log_id)
+
+#define MAX_IPC_LOG_SIZE \
+	(MAX_LOG_SIZE - sizeof(enum mif_log_id) \
+	 - sizeof(unsigned long long) - sizeof(size_t))
+#define MAX_IRQ_LOG_SIZE \
+	(MAX_LOG_SIZE - sizeof(enum mif_log_id) \
+	 - sizeof(unsigned long long) - sizeof(struct mif_irq_map))
+#define MAX_COM_LOG_SIZE \
+	(MAX_LOG_SIZE - sizeof(enum mif_log_id) \
+	 - sizeof(unsigned long long))
+#define MAX_TIM_LOG_SIZE \
+	(MAX_LOG_SIZE - sizeof(enum mif_log_id) \
+	 - sizeof(unsigned long long) - sizeof(struct timespec))
+
+enum mif_log_id {
+	MIF_IPC_RL2AP = 1,
+	MIF_IPC_AP2CP,
+	MIF_IPC_CP2AP,
+	MIF_IPC_AP2RL,
+	MIF_IRQ,
+	MIF_COM,
+	MIF_TIME
+};
+
+struct mif_irq_map {
+	u16 magic;
+	u16 access;
+
+	u16 fmt_tx_in;
+	u16 fmt_tx_out;
+	u16 fmt_rx_in;
+	u16 fmt_rx_out;
+
+	u16 raw_tx_in;
+	u16 raw_tx_out;
+	u16 raw_rx_in;
+	u16 raw_rx_out;
+
+	u16 cp2ap;
+};
+
+struct mif_ipc_block {
+	enum mif_log_id id;
+	unsigned long long time;
+	size_t len;
+	char buff[MAX_IPC_LOG_SIZE];
+};
+
+struct mif_irq_block {
+	enum mif_log_id id;
+	unsigned long long time;
+	struct mif_irq_map map;
+	char buff[MAX_IRQ_LOG_SIZE];
+};
+
+struct mif_common_block {
+	enum mif_log_id id;
+	unsigned long long time;
+	char buff[MAX_COM_LOG_SIZE];
+};
+
+struct mif_time_block {
+	enum mif_log_id id;
+	unsigned long long time;
+	struct timespec epoch;
+	char buff[MAX_TIM_LOG_SIZE];
+};
+
+int mif_dump_dpram(struct io_device *);
+int mif_dump_log(struct modem_shared *, struct io_device *);
+
+#define mif_irq_log(msd, map, data, len) \
+	_mif_irq_log(MIF_IRQ, msd, map, data, len)
+#define mif_com_log(msd, format, ...) \
+	_mif_com_log(MIF_COM, msd, pr_fmt(format), ##__VA_ARGS__)
+#define mif_time_log(msd, epoch, data, len) \
+	_mif_time_log(MIF_TIME, msd, epoch, data, len)
+
+void mif_ipc_log(enum mif_log_id,
+	struct modem_shared *, const char *, size_t);
+void _mif_irq_log(enum mif_log_id,
+	struct modem_shared *, struct mif_irq_map, const char *, size_t);
+void _mif_com_log(enum mif_log_id,
+	struct modem_shared *, const char *, ...);
+void _mif_time_log(enum mif_log_id,
+	struct modem_shared *, struct timespec, const char *, size_t);
+
 /** find_linkdev - find a link device
- * @commons:	struct mif_common
+ * @msd:	struct modem_shared *
  */
-static inline struct link_device *find_linkdev(struct mif_common *commons,
+static inline struct link_device *find_linkdev(struct modem_shared *msd,
 		enum modem_link link_type)
 {
 	struct link_device *ld;
-	list_for_each_entry(ld, &commons->link_dev_list, list) {
+	list_for_each_entry(ld, &msd->link_dev_list, list) {
 		if (ld->link_type == link_type)
 			return ld;
 	}
@@ -44,6 +140,9 @@ static inline unsigned int countbits(unsigned int n)
 	return i;
 }
 
+/* print IPC message as hex string with UTC time */
+int pr_ipc(const char *str, const char *data, size_t len);
+
 /* print buffer as hex string */
 int pr_buffer(const char *tag, const char *data, size_t data_len,
 							size_t max_len);
@@ -63,41 +162,43 @@ int link_rx_flowctl_cmd(struct link_device *ld, const char *data, size_t len);
 
 /* get iod from tree functions */
 
-struct io_device *get_iod_with_format(struct mif_common *commons,
+struct io_device *get_iod_with_format(struct modem_shared *msd,
 					enum dev_format format);
-struct io_device *get_iod_with_channel(struct mif_common *commons,
+struct io_device *get_iod_with_channel(struct modem_shared *msd,
 					unsigned channel);
 
 static inline struct io_device *link_get_iod_with_format(
 			struct link_device *ld, enum dev_format format)
 {
-	struct io_device *iod = get_iod_with_format(&ld->mc->commons, format);
+	struct io_device *iod = get_iod_with_format(ld->msd, format);
 	return (iod && IS_CONNECTED(iod, ld)) ? iod : NULL;
 }
 
 static inline struct io_device *link_get_iod_with_channel(
 			struct link_device *ld, unsigned channel)
 {
-	struct io_device *iod = get_iod_with_channel(&ld->mc->commons, channel);
+	struct io_device *iod = get_iod_with_channel(ld->msd, channel);
 	return (iod && IS_CONNECTED(iod, ld)) ? iod : NULL;
 }
 
 /* insert iod to tree functions */
-struct io_device *insert_iod_with_format(struct mif_common *commons,
+struct io_device *insert_iod_with_format(struct modem_shared *msd,
 			enum dev_format format, struct io_device *iod);
-struct io_device *insert_iod_with_channel(struct mif_common *commons,
+struct io_device *insert_iod_with_channel(struct modem_shared *msd,
 			unsigned channel, struct io_device *iod);
 
 /* iodev for each */
 typedef void (*action_fn)(struct io_device *iod, void *args);
-void iodevs_for_each(struct mif_common *commons, action_fn action, void *args);
+void iodevs_for_each(struct modem_shared *msd, action_fn action, void *args);
 
 /* netif wake/stop queue of iod */
 void iodev_netif_wake(struct io_device *iod, void *args);
 void iodev_netif_stop(struct io_device *iod, void *args);
 
 /* change tx_link of raw devices */
-void rawdevs_set_tx_link(struct mif_common *commons, enum modem_link link_type);
+void rawdevs_set_tx_link(struct modem_shared *msd, enum modem_link link_type);
+
+__be32 ipv4str_to_be32(const char *ipv4str, size_t count);
 
 void mif_add_timer(struct timer_list *timer, unsigned long expire,
 		void (*function)(unsigned long), unsigned long data);
@@ -181,6 +282,23 @@ void print_sipc5_link_fmt_frame(const u8 *psrc);
 -------------------------------------------------------------------------*/
 #define UDP_HDR_SIZE	8
 
-void print_ip4_packet(u8 *ip_pkt);
+void print_ip4_packet(u8 *ip_pkt, bool tx);
+bool is_dns_packet(u8 *ip_pkt);
+bool is_syn_packet(u8 *ip_pkt);
+
+int memcmp16_to_io(const void __iomem *to, void *from, int size);
+int mif_test_dpram(char *dp_name, u8 __iomem *start, u32 size);
+
+static const inline char *get_dev_name(int dev)
+{
+	if (dev == IPC_FMT)
+		return "FMT";
+	else if (dev == IPC_RAW)
+		return "RAW";
+	else if (dev == IPC_RFS)
+		return "RFS";
+	else
+		return "NONE";
+}
 
 #endif/*__MODEM_UTILS_H__*/