Perception, Planning and Control for Mobile Robots

Denavit Hartenberg parameters and Forward kinematics