diff --git a/libuavcan_drivers/stm32/test_stm32f107/src/main.cpp b/libuavcan_drivers/stm32/test_stm32f107/src/main.cpp
index 6daa0e5cab..f936ea8ea8 100644
--- a/libuavcan_drivers/stm32/test_stm32f107/src/main.cpp
+++ b/libuavcan_drivers/stm32/test_stm32f107/src/main.cpp
@@ -118,11 +118,11 @@ int main()
                 frame.dlc = 2;
 
                 const int send_res =
-                    static_cast<uavcan::ICanIface*>(app::can.driver.getIface(0))->send(frame, deadline,
+                    static_cast<uavcan::ICanIface*>(app::can.driver.getIface(i))->send(frame, deadline,
                                                                                        uavcan::CanIOFlagLoopback);
                 printf("send_res=%i errcnt=%lu hwerr=%i\n", send_res,
-                       static_cast<unsigned long>(app::can.driver.getIface(0)->getErrorCount()),
-                       static_cast<int>(app::can.driver.getIface(0)->yieldLastHardwareErrorCode()));
+                       static_cast<unsigned long>(app::can.driver.getIface(i)->getErrorCount()),
+                       static_cast<int>(app::can.driver.getIface(i)->yieldLastHardwareErrorCode()));
             }
 
             if (masks.read & (1 << i))
@@ -133,11 +133,11 @@ int main()
                     uavcan::CanIOFlags flags = 0;
 
                     const int recv_res =
-                        static_cast<uavcan::ICanIface*>(app::can.driver.getIface(0))->receive(rx_frame, rx_frame.ts_mono,
+                        static_cast<uavcan::ICanIface*>(app::can.driver.getIface(i))->receive(rx_frame, rx_frame.ts_mono,
                                                                                               rx_frame.ts_utc, flags);
 
-                    printf("recv_res=%i flg=%u canid=%lu dlc=%u data=[%02x %02x %02x %02x %02x %02x %02x %02x]\n",
-                           recv_res, unsigned(flags), rx_frame.id & uavcan::CanFrame::MaskExtID, int(rx_frame.dlc),
+                    printf("recv_res=%i iface=%u flg=%u canid=%lu dlc=%u data=[%02x %02x %02x %02x %02x %02x %02x %02x]\n",
+                           recv_res, unsigned(i), unsigned(flags), rx_frame.id & uavcan::CanFrame::MaskExtID, int(rx_frame.dlc),
                            int(rx_frame.data[0]), int(rx_frame.data[1]), int(rx_frame.data[2]), int(rx_frame.data[3]),
                            int(rx_frame.data[4]), int(rx_frame.data[5]), int(rx_frame.data[6]), int(rx_frame.data[7]));