Send and Dump commands check whether CAN is initialized

diff --git a/commands/cmd_can.c b/commands/cmd_can.c
index e800c2ae56a45fb9c4f31365a996a35a5b73c121..bb4adea96a16ca50a0c8a217874e40df9528b58c 100644 (file)
--- a/commands/cmd_can.c
+++ b/commands/cmd_can.c
@@ -208,6 +208,8 @@ int cmd_do_test_can_loopback(cmd_io_t *cmd_io, const struct cmd_des *des, char *
 }
 
 
+static int can_inited = 0;
+
 static struct rpp_can_ctrl_config ctrl_config[] = {
        {
                .baudrate = 500000
@@ -281,7 +283,8 @@ int cmd_do_can_init(cmd_io_t *cmd_io, const struct cmd_des *des, char *param[])
 
 
 
-    return rpp_can_init(&can_config);
+    can_inited = (rpp_can_init(&can_config) == SUCCESS ? 1 : 0);
+    return (can_inited ? 0 : 1);
 }
 
 
@@ -293,6 +296,11 @@ int cmd_do_can_send(cmd_io_t *cmd_io, const struct cmd_des *des, char *param[])
        struct rpp_can_pdu pdu;
        char *p;
 
+       if (!can_inited)
+       {
+               rpp_sci_printf("WARNING: CAN is not initialized\n");
+       }
+
        p = param[1];
        ret = sscanf(p, "%i %i%n", &controller_id, &pdu.id, &l);
        if (ret < 2)
@@ -340,6 +348,11 @@ int cmd_do_can_dump(cmd_io_t *cmd_io, const struct cmd_des *des, char *param[])
 
        uint32_t i;
 
+       if (!can_inited)
+       {
+               rpp_sci_printf("WARNING: CAN is not initialized\n");
+       }
+
        if (!(sscanf(param[1], "%u", &controller_id) == 1))
        {
                rpp_sci_printf("Unable to parse controller ID\n");