static void pwm_width(struct mpc52xx_gpt *gpt, u16 width)
{
- gpt->pwm = (width<<16) | MPC52xx_GPT_PWM_OP;
+ out_be32(&gpt->pwm, (width<<16) | MPC52xx_GPT_PWM_OP);
}
static void __devinit pwm_init(struct mpc52xx_gpt *gpt)
{
- gpt->count = (1<<16) | PWM_PERIOD;
+ out_be32(&gpt->count, (1<<16) | PWM_PERIOD);
pwm_width(gpt, 0);
- gpt->mode = MPC52xx_GPT_MODE_PWM;
+ out_be32(&gpt->mode, MPC52xx_GPT_MODE_PWM);
}
static void pwm_done(struct mpc52xx_gpt *gpt)
{
- gpt->mode = 0;
- gpt->count = 0;
+ out_be32(&gpt->mode, 0);
+ out_be32(&gpt->count, 0);
pwm_width(gpt, 0);
}
{
pwm_init(m->pwmf);
pwm_init(m->pwmb);
- motorek_action(m, +45);
+/* motorek_action(m, +45); */
+ pwm_width(m->pwmb, 500);
+ pwm_width(m->pwmf, 500);
return 0;
}
if (err)
return err;
+ printk(KERN_NOTICE "Motorek initialized\n");
+
return 0;
}
struct motorek *m;
m = platform_get_drvdata(dev);
+ printk(KERN_NOTICE "Removing motorek\n");
+
motorek_done(m);
return 0;
}