Configurable modal

model can be configured in constructor
fixed textmode and init

fixed textmode and init
additional demo

additional demo
some fixes (motors, servo)

some fixes (motors, servo)