Skip to content

Commit

Permalink
rpi5-gmsl: Support 4 cameras, with video & embedded
Browse files Browse the repository at this point in the history 
Signed-off-by: Tomi Valkeinen <tomi.valkeinen@ideasonboard.com>
  • Loading branch information
@Demon000 @tomba
Demon000 authored and tomba committed Oct 30, 2024
1 parent 96d47b3 commit 8155a60
Showing 1 changed file with 140 additions and 21 deletions.
161 changes: 140 additions & 21 deletions utils/cam-configs/rpi5-gmsl.py
View file
Original file line number Diff line number Diff line change
Expand Up @@ -2,39 +2,56 @@

import v4l2

USE_RAW_10=False
MEDIA_DEVICE_NAME = ('rp1-cfe', 'model')
DESER_NAME = 'max96724 6-0027'

# Pixel

imx219_w = 1920
imx219_h = 1080
imx219_bus_fmt = v4l2.BusFormat.SRGGB10_1X10
imx219_pix_fmt = v4l2.PixelFormats.SRGGB10P
#imx219_bus_fmt = v4l2.BusFormat.SRGGB8_1X8
#imx219_pix_fmt = v4l2.PixelFormats.SRGGB8
imx219_w = 640
imx219_h = 480
if USE_RAW_10:
imx219_bus_fmt = v4l2.BusFormat.SRGGB10_1X10
imx219_pix_fmt = v4l2.PixelFormats.SRGGB10P
else:
imx219_bus_fmt = v4l2.BusFormat.SRGGB8_1X8
imx219_pix_fmt = v4l2.PixelFormats.SRGGB8

mbus_fmt_imx219 = (imx219_w, imx219_h, imx219_bus_fmt)
fmt_pix = (imx219_w, imx219_h, imx219_pix_fmt)

mbus_fmt_des = mbus_fmt_imx219
# Embedded

fmt_pix = (imx219_w, imx219_h, imx219_pix_fmt)
if USE_RAW_10:
imx219_bus_fmt_meta = v4l2.BusFormat.META_10
imx219_pix_fmt_meta = v4l2.MetaFormats.GENERIC_CSI2_10
else:
imx219_bus_fmt_meta = v4l2.BusFormat.META_8
imx219_pix_fmt_meta = v4l2.MetaFormats.GENERIC_8

configurations = {}
mbus_fmt_imx219_meta = (imx219_w, 2, imx219_bus_fmt_meta)
fmt_pix_imx219_meta = (imx219_w, 2, imx219_pix_fmt_meta)

first_imx_i2c_port = 14
configurations = {}

def gen_imx219_pixel(port):
sensor_ent = f'imx219 {port + first_imx_i2c_port}-0010'
ser_ent = 'max96717 13-0040'
des_ent = 'max96724 6-0027'
def gen_imx219_pixel(cameras, port):
sensor_ent = cameras[port][1]
ser_ent = cameras[port][0]
des_ent = DESER_NAME

return {
'media': ('rp1-cfe', 'model'),
'media': MEDIA_DEVICE_NAME,

'subdevs': [
# Camera
{
'entity': sensor_ent,
'pads': [
{ 'pad': (0, 0), 'fmt': mbus_fmt_imx219 },
{ "pad": (1, 0), "fmt": mbus_fmt_imx219 },
{ "pad": (0, 0), "fmt": mbus_fmt_imx219 },
],
"routing": [
{ "src": (1, 0), "dst": (0, 0) },
],
},

Expand All @@ -57,7 +74,7 @@ def gen_imx219_pixel(port):
],
'pads': [
{ 'pad': (port, 0), 'fmt': mbus_fmt_imx219 },
{ 'pad': (6, 0), 'fmt': mbus_fmt_des },
{ 'pad': (6, 0), 'fmt': mbus_fmt_imx219 },
],
},

Expand All @@ -68,8 +85,8 @@ def gen_imx219_pixel(port):
{ 'src': (0, port), 'dst': (1 + port, 0) },
],
'pads': [
{ 'pad': (0, port), 'fmt': mbus_fmt_des },
{ 'pad': (1 + port, 0), 'fmt': mbus_fmt_des },
{ 'pad': (0, port), 'fmt': mbus_fmt_imx219 },
{ 'pad': (1 + port, 0), 'fmt': mbus_fmt_imx219 },
],
},
],
Expand All @@ -84,13 +101,115 @@ def gen_imx219_pixel(port):

'links': [
{ 'src': (sensor_ent, 0), 'dst': (ser_ent, 0) },
{ 'src': (ser_ent, 1), 'dst': (des_ent, 0) },
{ 'src': (ser_ent, 1), 'dst': (des_ent, port) },
{ 'src': (des_ent, 6), 'dst': ('csi2', 0) },
{ 'src': ('csi2', 1 + port), 'dst': (f'rp1-cfe-csi2-ch{port}', 0) },
],
}

configurations['cam0'] = gen_imx219_pixel(0)
def gen_imx219_meta(cameras, port):
sensor_ent = cameras[port][1]
ser_ent = cameras[port][0]
des_ent = DESER_NAME

return {
'media': MEDIA_DEVICE_NAME,

'subdevs': [
# Camera
{
'entity': sensor_ent,
'pads': [
{ "pad": (2, 0), "fmt": mbus_fmt_imx219_meta },
{ "pad": (0, 1), "fmt": mbus_fmt_imx219_meta },
],
"routing": [
{ "src": (2, 0), "dst": (0, 1) },
],
},

# Serializer
{
'entity': ser_ent,
'routing': [
{ 'src': (0, 1), 'dst': (1, 1) },
],
'pads': [
{ 'pad': (0, 1), 'fmt': mbus_fmt_imx219_meta },
{ 'pad': (1, 1), 'fmt': mbus_fmt_imx219_meta },
],
},
# Deserializer
{
'entity': des_ent,
'routing': [
{ 'src': (port, 1), 'dst': (6, port + 4) },
],
'pads': [
{ 'pad': (port, 1), 'fmt': mbus_fmt_imx219_meta },
{ 'pad': (6, port + 4), 'fmt': mbus_fmt_imx219_meta },
],
},

# CSI-2 RX
{
'entity': 'csi2',
'routing': [
{ 'src': (0, port + 4), 'dst': (1 + port + 2, 0) },
],
'pads': [
{ 'pad': (0, port + 4), 'fmt': mbus_fmt_imx219_meta },
{ 'pad': (1 + port + 2, 0), 'fmt': mbus_fmt_imx219_meta },
],
},
],

'devices': [
{
'entity': f'rp1-cfe-csi2-ch{port + 2}',
'fmt': fmt_pix_imx219_meta,
'embedded': True,
"display": False,
},
],

'links': [
{ 'src': (sensor_ent, 0), 'dst': (ser_ent, 0) },
{ 'src': (ser_ent, 1), 'dst': (des_ent, port) },
{ 'src': (des_ent, 6), 'dst': ('csi2', 0) },
{ 'src': ('csi2', 1 + port + 2), 'dst': (f'rp1-cfe-csi2-ch{port + 2}', 0) },
],
}

# Find serializers and sensors connected to the deserializer
def find_devices(mdev_name, deser_name):
md = v4l2.MediaDevice(*mdev_name)
assert md
deser = md.find_entity(deser_name)
assert deser

cameras = {}

for p in [p for p in deser.pads if p.index < 4]:
if len(p.links) == 0:
continue

assert len(p.links) == 1

ser = p.links[0].source.entity
sensor = ser.pads[0].links[0].source.entity

cameras[p.index] = (ser.name, sensor.name)

return cameras

def get_configs():
cameras = find_devices(MEDIA_DEVICE_NAME, DESER_NAME)

num_cameras = len(cameras)

for i in range(num_cameras):
configurations[f'cam{i}'] = gen_imx219_pixel(cameras, i)
configurations[f'cam{i}-meta'] = gen_imx219_meta(cameras, i)

return (configurations, ['cam0'])

0 comments on commit 8155a60

Please sign in to comment.