Development of a System to Assist in the Design and Control of Robots