For example I can simulate a mobile platform robot in Simulink. I can use a model including its physical dimensions and rigid body dynamics. And there will be a path defined as a sequence of waypoints. The control algorithm will interpolate between them to generate appropriate signals to the wheel motors. The control algorithm will be kind of hierarchical including low level motor dynamics compensation and high level trajectory following algorithm.
I have a rich experience of develuping IMU and other tracking devices.
Also I have a degree in robotics.
The problem is not clear from the description. What exactly the algorithm should do?
We can discuss the details in the chat. Please send detailed description of the task.
I am a Software Developer with 4 years of experience. I have experience with C++ and Python, and also Game Development, wich make me familiar with the pyshics and algorithms for pathfinding.