[aesl] Fixed mess when merging Dany changes + make sure current is back to 0 when stopping motors