Using DroneKit to tag video frames with telemetry data

We are working with ArduCopter, DroneKit, Raspberry Pi 4, and OV5647 camera. We need to tag video frames with telemetry including position, altitude, pitch, roll, and yaw. This seems like a pretty common task, so I was hoping someone might point us in a good direction or provide an example.