fix gyro input bug

Gyro was still hard wired to analog input 1, fix gyro init function

Signed-off-by: James Pearman <jbpearman@mac.com>