WIP on npendulum
Error in differential drive ex.