Hello, i am an electrical and electronics engineer with experience in control, robotics and embedded systems. I am using Matlab for professional work for over 8 years. I have deep experience in robotics which makes me expert in transformations and their geometries. Your task can be finished in three steps. If you like, i can start your project soon and we can discuss the related milestones. Can you please provide more details in chat ?