diff --git a/src/usbd_gs_can.c b/src/usbd_gs_can.c
index 72de2d5e..cac0a8d6 100644
--- a/src/usbd_gs_can.c
+++ b/src/usbd_gs_can.c
@@ -221,6 +221,9 @@ static const struct gs_device_bt_const USBD_GS_CAN_btconst = {
 		GS_CAN_FEATURE_HW_TIMESTAMP |
 		GS_CAN_FEATURE_IDENTIFY |
 		GS_CAN_FEATURE_PAD_PKTS_TO_MAX_PKT_SIZE
+#ifdef CONFIG_CANFD
+		| GS_CAN_MODE_FD
+#endif
 #ifdef TERM_Pin
 		| GS_CAN_FEATURE_TERMINATION
 #endif