Adding initialization code. Still need firmware Update logic