diff --git a/available_ros2_types b/available_ros2_types
index 21437f2df..903d4ea59 100644
--- a/available_ros2_types
+++ b/available_ros2_types
@@ -98,6 +98,7 @@ geometry_msgs/Wrench.msg
 geometry_msgs/WrenchStamped.msg
 kaiaai_msgs/KaiaaiTelemetry.msg
 kaiaai_msgs/KaiaaiTelemetry2.msg
+kaiaai_msgs/WifiState.msg
 lifecycle_msgs/ChangeState.srv
 lifecycle_msgs/GetAvailableStates.srv
 lifecycle_msgs/GetAvailableTransitions.srv
diff --git a/built_packages b/built_packages
index a64e7e3a4..4fb95d778 100644
--- a/built_packages
+++ b/built_packages
@@ -7,7 +7,7 @@ https://github.com/ament/googletest.git 0acc5196ddd5364fe24b729185c81746573835dd
 https://github.com/ament/uncrustify_vendor.git ec8f8b4d03483671e8ea2b3039f1015f92b0ef89
 https://github.com/eProsima/Micro-CDR.git ed4fd513a24a53b93d548d342cb7aa0a18716f04
 https://github.com/eProsima/Micro-XRCE-DDS-Client.git 83f129a80770a09aac9e823896ecbf6a0eddf0fc
-https://github.com/kaiaai/kaiaai_msgs 7d3381005dcbe4870c1917be6a79fc03c0c2048f
+https://github.com/kaiaai/kaiaai_msgs db849c413587703c5baecc945ff49dfe4c7c5ae5
 https://github.com/micro-ROS/micro_ros_msgs.git 10be4d005fbc7d8dd60dbb213b65f4171419bfe9
 https://github.com/micro-ROS/micro_ros_utilities 6d025eb716c10f8d4c04a5559ab22c9a50755538
 https://github.com/micro-ROS/rcl e23af13d15fd2a1216154ac66265325c927fc173
diff --git a/src/cortex-m0plus/libmicroros.a b/src/cortex-m0plus/libmicroros.a
index ba303546e..5d6e58c06 100644
Binary files a/src/cortex-m0plus/libmicroros.a and b/src/cortex-m0plus/libmicroros.a differ
diff --git a/src/cortex-m3/libmicroros.a b/src/cortex-m3/libmicroros.a
index 1dea5f579..dbcd3c0ee 100644
Binary files a/src/cortex-m3/libmicroros.a and b/src/cortex-m3/libmicroros.a differ
diff --git a/src/cortex-m4/libmicroros.a b/src/cortex-m4/libmicroros.a
index 173ad7b90..1b8d47138 100644
Binary files a/src/cortex-m4/libmicroros.a and b/src/cortex-m4/libmicroros.a differ
diff --git a/src/cortex-m7/fpv5-d16-softfp/libmicroros.a b/src/cortex-m7/fpv5-d16-softfp/libmicroros.a
index 78bb10060..6b3efeb30 100644
Binary files a/src/cortex-m7/fpv5-d16-softfp/libmicroros.a and b/src/cortex-m7/fpv5-d16-softfp/libmicroros.a differ
diff --git a/src/cortex-m7/fpv5-sp-d16-hardfp/libmicroros.a b/src/cortex-m7/fpv5-sp-d16-hardfp/libmicroros.a
index fd8903365..e9f293698 100644
Binary files a/src/cortex-m7/fpv5-sp-d16-hardfp/libmicroros.a and b/src/cortex-m7/fpv5-sp-d16-hardfp/libmicroros.a differ
diff --git a/src/cortex-m7/fpv5-sp-d16-softfp/libmicroros.a b/src/cortex-m7/fpv5-sp-d16-softfp/libmicroros.a
index 0a716ac3d..c4dc3f2d1 100644
Binary files a/src/cortex-m7/fpv5-sp-d16-softfp/libmicroros.a and b/src/cortex-m7/fpv5-sp-d16-softfp/libmicroros.a differ
diff --git a/src/esp32/libmicroros.a b/src/esp32/libmicroros.a
index 94e444670..1c64059ce 100644
Binary files a/src/esp32/libmicroros.a and b/src/esp32/libmicroros.a differ
diff --git a/src/imxrt1062/fpv5-d16-hard/libmicroros.a b/src/imxrt1062/fpv5-d16-hard/libmicroros.a
index 15ac2a167..54ebc7f91 100644
Binary files a/src/imxrt1062/fpv5-d16-hard/libmicroros.a and b/src/imxrt1062/fpv5-d16-hard/libmicroros.a differ
diff --git a/src/kaiaai_msgs/msg/detail/kaiaai_telemetry2__struct.h b/src/kaiaai_msgs/msg/detail/kaiaai_telemetry2__struct.h
index d53e26851..9cfb12365 100644
--- a/src/kaiaai_msgs/msg/detail/kaiaai_telemetry2__struct.h
+++ b/src/kaiaai_msgs/msg/detail/kaiaai_telemetry2__struct.h
@@ -41,7 +41,7 @@ typedef struct kaiaai_msgs__msg__KaiaaiTelemetry2
   float odom_vel_yaw;
   rosidl_runtime_c__float__Sequence joint_pos;
   rosidl_runtime_c__float__Sequence joint_vel;
-  int8_t wifi_rssi;
+  int8_t wifi_rssi_dbm;
   uint16_t battery_mv;
   rosidl_runtime_c__uint16__Sequence distance_mm;
   rosidl_runtime_c__boolean__Sequence bumper;
diff --git a/src/kaiaai_msgs/msg/detail/wifi_state__functions.h b/src/kaiaai_msgs/msg/detail/wifi_state__functions.h
new file mode 100644
index 000000000..c7297ae37
--- /dev/null
+++ b/src/kaiaai_msgs/msg/detail/wifi_state__functions.h
@@ -0,0 +1,177 @@
+// generated from rosidl_generator_c/resource/idl__functions.h.em
+// with input from kaiaai_msgs:msg/WifiState.idl
+// generated code does not contain a copyright notice
+
+#ifndef KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__FUNCTIONS_H_
+#define KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__FUNCTIONS_H_
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <stdbool.h>
+#include <stdlib.h>
+
+#include "rosidl_runtime_c/visibility_control.h"
+#include "kaiaai_msgs/msg/rosidl_generator_c__visibility_control.h"
+
+#include "kaiaai_msgs/msg/detail/wifi_state__struct.h"
+
+/// Initialize msg/WifiState message.
+/**
+ * If the init function is called twice for the same message without
+ * calling fini inbetween previously allocated memory will be leaked.
+ * \param[in,out] msg The previously allocated message pointer.
+ * Fields without a default value will not be initialized by this function.
+ * You might want to call memset(msg, 0, sizeof(
+ * kaiaai_msgs__msg__WifiState
+ * )) before or use
+ * kaiaai_msgs__msg__WifiState__create()
+ * to allocate and initialize the message.
+ * \return true if initialization was successful, otherwise false
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+bool
+kaiaai_msgs__msg__WifiState__init(kaiaai_msgs__msg__WifiState * msg);
+
+/// Finalize msg/WifiState message.
+/**
+ * \param[in,out] msg The allocated message pointer.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+void
+kaiaai_msgs__msg__WifiState__fini(kaiaai_msgs__msg__WifiState * msg);
+
+/// Create msg/WifiState message.
+/**
+ * It allocates the memory for the message, sets the memory to zero, and
+ * calls
+ * kaiaai_msgs__msg__WifiState__init().
+ * \return The pointer to the initialized message if successful,
+ * otherwise NULL
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+kaiaai_msgs__msg__WifiState *
+kaiaai_msgs__msg__WifiState__create();
+
+/// Destroy msg/WifiState message.
+/**
+ * It calls
+ * kaiaai_msgs__msg__WifiState__fini()
+ * and frees the memory of the message.
+ * \param[in,out] msg The allocated message pointer.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+void
+kaiaai_msgs__msg__WifiState__destroy(kaiaai_msgs__msg__WifiState * msg);
+
+/// Check for msg/WifiState message equality.
+/**
+ * \param[in] lhs The message on the left hand size of the equality operator.
+ * \param[in] rhs The message on the right hand size of the equality operator.
+ * \return true if messages are equal, otherwise false.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+bool
+kaiaai_msgs__msg__WifiState__are_equal(const kaiaai_msgs__msg__WifiState * lhs, const kaiaai_msgs__msg__WifiState * rhs);
+
+/// Copy a msg/WifiState message.
+/**
+ * This functions performs a deep copy, as opposed to the shallow copy that
+ * plain assignment yields.
+ *
+ * \param[in] input The source message pointer.
+ * \param[out] output The target message pointer, which must
+ *   have been initialized before calling this function.
+ * \return true if successful, or false if either pointer is null
+ *   or memory allocation fails.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+bool
+kaiaai_msgs__msg__WifiState__copy(
+  const kaiaai_msgs__msg__WifiState * input,
+  kaiaai_msgs__msg__WifiState * output);
+
+/// Initialize array of msg/WifiState messages.
+/**
+ * It allocates the memory for the number of elements and calls
+ * kaiaai_msgs__msg__WifiState__init()
+ * for each element of the array.
+ * \param[in,out] array The allocated array pointer.
+ * \param[in] size The size / capacity of the array.
+ * \return true if initialization was successful, otherwise false
+ * If the array pointer is valid and the size is zero it is guaranteed
+ # to return true.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+bool
+kaiaai_msgs__msg__WifiState__Sequence__init(kaiaai_msgs__msg__WifiState__Sequence * array, size_t size);
+
+/// Finalize array of msg/WifiState messages.
+/**
+ * It calls
+ * kaiaai_msgs__msg__WifiState__fini()
+ * for each element of the array and frees the memory for the number of
+ * elements.
+ * \param[in,out] array The initialized array pointer.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+void
+kaiaai_msgs__msg__WifiState__Sequence__fini(kaiaai_msgs__msg__WifiState__Sequence * array);
+
+/// Create array of msg/WifiState messages.
+/**
+ * It allocates the memory for the array and calls
+ * kaiaai_msgs__msg__WifiState__Sequence__init().
+ * \param[in] size The size / capacity of the array.
+ * \return The pointer to the initialized array if successful, otherwise NULL
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+kaiaai_msgs__msg__WifiState__Sequence *
+kaiaai_msgs__msg__WifiState__Sequence__create(size_t size);
+
+/// Destroy array of msg/WifiState messages.
+/**
+ * It calls
+ * kaiaai_msgs__msg__WifiState__Sequence__fini()
+ * on the array,
+ * and frees the memory of the array.
+ * \param[in,out] array The initialized array pointer.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+void
+kaiaai_msgs__msg__WifiState__Sequence__destroy(kaiaai_msgs__msg__WifiState__Sequence * array);
+
+/// Check for msg/WifiState message array equality.
+/**
+ * \param[in] lhs The message array on the left hand size of the equality operator.
+ * \param[in] rhs The message array on the right hand size of the equality operator.
+ * \return true if message arrays are equal in size and content, otherwise false.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+bool
+kaiaai_msgs__msg__WifiState__Sequence__are_equal(const kaiaai_msgs__msg__WifiState__Sequence * lhs, const kaiaai_msgs__msg__WifiState__Sequence * rhs);
+
+/// Copy an array of msg/WifiState messages.
+/**
+ * This functions performs a deep copy, as opposed to the shallow copy that
+ * plain assignment yields.
+ *
+ * \param[in] input The source array pointer.
+ * \param[out] output The target array pointer, which must
+ *   have been initialized before calling this function.
+ * \return true if successful, or false if either pointer
+ *   is null or memory allocation fails.
+ */
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+bool
+kaiaai_msgs__msg__WifiState__Sequence__copy(
+  const kaiaai_msgs__msg__WifiState__Sequence * input,
+  kaiaai_msgs__msg__WifiState__Sequence * output);
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif  // KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__FUNCTIONS_H_
diff --git a/src/kaiaai_msgs/msg/detail/wifi_state__rosidl_typesupport_introspection_c.h b/src/kaiaai_msgs/msg/detail/wifi_state__rosidl_typesupport_introspection_c.h
new file mode 100644
index 000000000..48d24b224
--- /dev/null
+++ b/src/kaiaai_msgs/msg/detail/wifi_state__rosidl_typesupport_introspection_c.h
@@ -0,0 +1,26 @@
+// generated from rosidl_typesupport_introspection_c/resource/idl__rosidl_typesupport_introspection_c.h.em
+// with input from kaiaai_msgs:msg/WifiState.idl
+// generated code does not contain a copyright notice
+
+#ifndef KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__ROSIDL_TYPESUPPORT_INTROSPECTION_C_H_
+#define KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__ROSIDL_TYPESUPPORT_INTROSPECTION_C_H_
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+
+#include "rosidl_runtime_c/message_type_support_struct.h"
+#include "rosidl_typesupport_interface/macros.h"
+#include "kaiaai_msgs/msg/rosidl_typesupport_introspection_c__visibility_control.h"
+
+ROSIDL_TYPESUPPORT_INTROSPECTION_C_PUBLIC_kaiaai_msgs
+const rosidl_message_type_support_t *
+ROSIDL_TYPESUPPORT_INTERFACE__MESSAGE_SYMBOL_NAME(rosidl_typesupport_introspection_c, kaiaai_msgs, msg, WifiState)();
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif  // KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__ROSIDL_TYPESUPPORT_INTROSPECTION_C_H_
diff --git a/src/kaiaai_msgs/msg/detail/wifi_state__rosidl_typesupport_microxrcedds_c.h b/src/kaiaai_msgs/msg/detail/wifi_state__rosidl_typesupport_microxrcedds_c.h
new file mode 100644
index 000000000..b0a953ef1
--- /dev/null
+++ b/src/kaiaai_msgs/msg/detail/wifi_state__rosidl_typesupport_microxrcedds_c.h
@@ -0,0 +1,39 @@
+// generated from rosidl_typesupport_microxrcedds_c/resource/idl__rosidl_typesupport_c.h.em
+// with input from kaiaai_msgs:msg/WifiState.idl
+// generated code does not contain a copyright notice
+#ifndef KAIAAI_MSGS__MSG__WIFI_STATE__ROSIDL_TYPESUPPORT_MICROXRCEDDS_C_H_
+#define KAIAAI_MSGS__MSG__WIFI_STATE__ROSIDL_TYPESUPPORT_MICROXRCEDDS_C_H_
+
+
+#include <stddef.h>
+#include <stdbool.h>
+#include <stdint.h>
+#include "rosidl_runtime_c/message_type_support_struct.h"
+#include "rosidl_typesupport_interface/macros.h"
+#include "kaiaai_msgs/msg/rosidl_typesupport_microxrcedds_c__visibility_control.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+ROSIDL_TYPESUPPORT_MICROXRCEDDS_C_PUBLIC_kaiaai_msgs
+size_t get_serialized_size_kaiaai_msgs__msg__WifiState(
+  const void * untyped_ros_message,
+  size_t current_alignment);
+
+ROSIDL_TYPESUPPORT_MICROXRCEDDS_C_PUBLIC_kaiaai_msgs
+size_t max_serialized_size_kaiaai_msgs__msg__WifiState(
+  bool * full_bounded,
+  size_t current_alignment);
+
+ROSIDL_TYPESUPPORT_MICROXRCEDDS_C_PUBLIC_kaiaai_msgs
+const rosidl_message_type_support_t *
+  ROSIDL_TYPESUPPORT_INTERFACE__MESSAGE_SYMBOL_NAME(rosidl_typesupport_microxrcedds_c, kaiaai_msgs, msg, WifiState)();
+
+#ifdef __cplusplus
+}
+#endif
+
+
+#endif  // KAIAAI_MSGS__MSG__WIFI_STATE__ROSIDL_TYPESUPPORT_MICROXRCEDDS_C_H_
diff --git a/src/kaiaai_msgs/msg/detail/wifi_state__struct.h b/src/kaiaai_msgs/msg/detail/wifi_state__struct.h
new file mode 100644
index 000000000..2e015a6c1
--- /dev/null
+++ b/src/kaiaai_msgs/msg/detail/wifi_state__struct.h
@@ -0,0 +1,45 @@
+// generated from rosidl_generator_c/resource/idl__struct.h.em
+// with input from kaiaai_msgs:msg/WifiState.idl
+// generated code does not contain a copyright notice
+
+#ifndef KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__STRUCT_H_
+#define KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__STRUCT_H_
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include <stdbool.h>
+#include <stddef.h>
+#include <stdint.h>
+
+
+// Constants defined in the message
+
+// Include directives for member types
+// Member 'stamp'
+#include "builtin_interfaces/msg/detail/time__struct.h"
+
+/// Struct defined in msg/WifiState in the package kaiaai_msgs.
+typedef struct kaiaai_msgs__msg__WifiState
+{
+  builtin_interfaces__msg__Time stamp;
+  float rssi_dbm;
+} kaiaai_msgs__msg__WifiState;
+
+// Struct for a sequence of kaiaai_msgs__msg__WifiState.
+typedef struct kaiaai_msgs__msg__WifiState__Sequence
+{
+  kaiaai_msgs__msg__WifiState * data;
+  /// The number of valid items in data
+  size_t size;
+  /// The number of allocated items in data
+  size_t capacity;
+} kaiaai_msgs__msg__WifiState__Sequence;
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif  // KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__STRUCT_H_
diff --git a/src/kaiaai_msgs/msg/detail/wifi_state__type_support.h b/src/kaiaai_msgs/msg/detail/wifi_state__type_support.h
new file mode 100644
index 000000000..ced8a6375
--- /dev/null
+++ b/src/kaiaai_msgs/msg/detail/wifi_state__type_support.h
@@ -0,0 +1,33 @@
+// generated from rosidl_generator_c/resource/idl__type_support.h.em
+// with input from kaiaai_msgs:msg/WifiState.idl
+// generated code does not contain a copyright notice
+
+#ifndef KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__TYPE_SUPPORT_H_
+#define KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__TYPE_SUPPORT_H_
+
+#include "rosidl_typesupport_interface/macros.h"
+
+#include "kaiaai_msgs/msg/rosidl_generator_c__visibility_control.h"
+
+#ifdef __cplusplus
+extern "C"
+{
+#endif
+
+#include "rosidl_runtime_c/message_type_support_struct.h"
+
+// Forward declare the get type support functions for this type.
+ROSIDL_GENERATOR_C_PUBLIC_kaiaai_msgs
+const rosidl_message_type_support_t *
+ROSIDL_TYPESUPPORT_INTERFACE__MESSAGE_SYMBOL_NAME(
+  rosidl_typesupport_c,
+  kaiaai_msgs,
+  msg,
+  WifiState
+)();
+
+#ifdef __cplusplus
+}
+#endif
+
+#endif  // KAIAAI_MSGS__MSG__DETAIL__WIFI_STATE__TYPE_SUPPORT_H_
diff --git a/src/kaiaai_msgs/msg/wifi_state.h b/src/kaiaai_msgs/msg/wifi_state.h
new file mode 100644
index 000000000..20a700ef2
--- /dev/null
+++ b/src/kaiaai_msgs/msg/wifi_state.h
@@ -0,0 +1,12 @@
+// generated from rosidl_generator_c/resource/idl.h.em
+// with input from kaiaai_msgs:msg/WifiState.idl
+// generated code does not contain a copyright notice
+
+#ifndef KAIAAI_MSGS__MSG__WIFI_STATE_H_
+#define KAIAAI_MSGS__MSG__WIFI_STATE_H_
+
+#include "kaiaai_msgs/msg/detail/wifi_state__struct.h"
+#include "kaiaai_msgs/msg/detail/wifi_state__functions.h"
+#include "kaiaai_msgs/msg/detail/wifi_state__type_support.h"
+
+#endif  // KAIAAI_MSGS__MSG__WIFI_STATE_H_
diff --git a/src/mk20dx256/libmicroros.a b/src/mk20dx256/libmicroros.a
index 88aaad461..2390fb183 100644
Binary files a/src/mk20dx256/libmicroros.a and b/src/mk20dx256/libmicroros.a differ
diff --git a/src/mk64fx512/fpv4-sp-d16-hard/libmicroros.a b/src/mk64fx512/fpv4-sp-d16-hard/libmicroros.a
index fdb1b8980..50526bb29 100644
Binary files a/src/mk64fx512/fpv4-sp-d16-hard/libmicroros.a and b/src/mk64fx512/fpv4-sp-d16-hard/libmicroros.a differ
diff --git a/src/mk66fx1m0/fpv4-sp-d16-hard/libmicroros.a b/src/mk66fx1m0/fpv4-sp-d16-hard/libmicroros.a
index fdb1b8980..50526bb29 100644
Binary files a/src/mk66fx1m0/fpv4-sp-d16-hard/libmicroros.a and b/src/mk66fx1m0/fpv4-sp-d16-hard/libmicroros.a differ