Update controller firmware close #19

Also fixed #58
Update toolkit