FBL100 Servo and Motor

Use this commit to update the branch.