3 * Martin Krause, TQ-Systems GmbH, martin.krause@tqs.de.
5 * SPDX-License-Identifier: GPL-2.0+
9 * STK52XX specific functions
17 #if defined(CONFIG_CMD_BSP)
19 #if defined(CONFIG_STK52XX) || defined(CONFIG_FO300)
20 #define DEFAULT_VOL 45
21 #define DEFAULT_FREQ 500
22 #define DEFAULT_DURATION 200
29 #define SM501_GPIO_CTRL_LOW 0x00000008UL
30 #define SM501_GPIO_CTRL_HIGH 0x0000000CUL
31 #define SM501_POWER_MODE0_GATE 0x00000040UL
32 #define SM501_POWER_MODE1_GATE 0x00000048UL
33 #define POWER_MODE_GATE_GPIO_PWM_I2C 0x00000040UL
34 #define SM501_GPIO_DATA_LOW 0x00010000UL
35 #define SM501_GPIO_DATA_HIGH 0x00010004UL
36 #define SM501_GPIO_DATA_DIR_LOW 0x00010008UL
37 #define SM501_GPIO_DATA_DIR_HIGH 0x0001000CUL
38 #define SM501_PANEL_DISPLAY_CONTROL 0x00080000UL
40 static int i2s_squarewave(unsigned long duration, unsigned int freq,
41 unsigned int channel);
42 static int i2s_sawtooth(unsigned long duration, unsigned int freq,
43 unsigned int channel);
44 static void spi_init(void);
45 static int spi_transmit(unsigned char data);
46 static void pcm1772_write_reg(unsigned char addr, unsigned char data);
47 static void set_attenuation(unsigned char attenuation);
49 static void spi_init(void)
51 struct mpc5xxx_spi *spi = (struct mpc5xxx_spi*)MPC5XXX_SPI;
52 struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio*)MPC5XXX_GPIO;
54 /* PSC3 as SPI and GPIOs */
55 gpio->port_config &= 0xFFFFF0FF;
56 gpio->port_config |= 0x00000800;
58 * Its important to use the correct order when initializing the
61 spi->ddr = 0x0F; /* set all SPI pins as output */
62 spi->pdr = 0x08; /* set SS high */
63 spi->cr1 = 0x50; /* SPI is master, SS is general purpose output */
64 spi->cr2 = 0x00; /* normal operation */
65 spi->brr = 0xFF; /* baud rate: IPB clock / 2048 */
68 static int spi_transmit(unsigned char data)
70 struct mpc5xxx_spi *spi = (struct mpc5xxx_spi*)MPC5XXX_SPI;
73 /* wait for SPI transmission completed */
74 while (!(spi->sr & 0x80)) {
75 if (spi->sr & 0x40) { /* if write collision occurred */
78 /* do dummy read to clear status register */
80 printf("SPI write collision: dr=0x%x\n", dummy);
87 static void pcm1772_write_reg(unsigned char addr, unsigned char data)
89 struct mpc5xxx_spi *spi = (struct mpc5xxx_spi*)MPC5XXX_SPI;
91 spi->pdr = 0x00; /* Set SS low */
94 /* wait some time to meet MS# hold time of PCM1772 */
96 spi->pdr = 0x08; /* set SS high */
99 static void set_attenuation(unsigned char attenuation)
101 pcm1772_write_reg(0x01, attenuation); /* left channel */
102 debug ("PCM1772 attenuation left set to %d.\n", attenuation);
103 pcm1772_write_reg(0x02, attenuation); /* right channel */
104 debug ("PCM1772 attenuation right set to %d.\n", attenuation);
107 void amplifier_init(void)
109 static int init_done = 0;
111 struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio*)MPC5XXX_GPIO;
113 /* Do this only once, because of the long time delay */
115 /* configure PCM1772 audio format as I2S */
116 pcm1772_write_reg(0x03, 0x01);
117 /* enable audio amplifier */
118 gpio->sint_gpioe |= 0x02; /* PSC3_5 as GPIO */
119 gpio->sint_ode &= ~0x02; /* PSC3_5 is not open Drain */
120 gpio->sint_dvo &= ~0x02; /* PSC3_5 is LOW */
121 gpio->sint_ddr |= 0x02; /* PSC3_5 as output */
123 * wait some time to allow amplifier to recover from shutdown
126 for(i = 0; i < 350; i++)
129 * The used amplifier (LM4867) has a so called "pop and click"
130 * elmination filter. The input signal of the amplifier must
131 * exceed a certain level once after power up to activate the
132 * generation of the output signal. This is achieved by
133 * sending a low frequent (nearly inaudible) sawtooth with a
134 * sufficient signal level.
137 i2s_sawtooth (200, 5, LEFT_RIGHT);
142 static void i2s_init(void)
145 struct mpc5xxx_psc *psc = (struct mpc5xxx_psc*)MPC5XXX_PSC2;;
146 struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio*)MPC5XXX_GPIO;
148 gpio->port_config |= 0x00000070; /* PSC2 ports as Codec with MCLK */
149 psc->command = (PSC_RX_DISABLE | PSC_TX_DISABLE);
150 psc->sicr = 0x22E00000; /* 16 bit data; I2S */
152 *(vu_long *)(CONFIG_SYS_MBAR + 0x22C) = 0x805d; /* PSC2 CDM MCLK config; MCLK
154 *(vu_long *)(CONFIG_SYS_MBAR + 0x214) |= 0x00000040; /* CDM clock enable
156 psc->ccr = 0x1F03; /* 16 bit data width; 5.617MHz MCLK */
157 psc->ctur = 0x0F; /* 16 bit frame width */
159 for (i = 0; i < 128; i++)
160 psc->psc_buffer_32 = 0; /* clear tx fifo */
163 static int i2s_play_wave(unsigned long addr, unsigned long len)
166 unsigned char *wave_file = (uchar *)addr + 44; /* quick'n dirty: skip
168 struct mpc5xxx_psc *psc = (struct mpc5xxx_psc*)MPC5XXX_PSC2;
171 * play wave file in memory; bytes/words are be swapped
173 psc->command = (PSC_RX_ENABLE | PSC_TX_ENABLE);
175 for(i = 0;i < (len / 4); i++) {
176 unsigned char swapped[4];
177 unsigned long *p = (unsigned long*)swapped;
179 swapped[3] = *wave_file++;
180 swapped[2] = *wave_file++;
181 swapped[1] = *wave_file++;
182 swapped[0] = *wave_file++;
184 psc->psc_buffer_32 = *p;
186 while (psc->tfnum > 400) {
191 while (psc->tfnum > 0); /* wait for fifo empty */
193 psc->command = (PSC_RX_DISABLE | PSC_TX_DISABLE);
197 static int i2s_sawtooth(unsigned long duration, unsigned int freq,
198 unsigned int channel)
202 struct mpc5xxx_psc *psc = (struct mpc5xxx_psc*)MPC5XXX_PSC2;
204 psc->command = (PSC_RX_ENABLE | PSC_TX_ENABLE);
207 * Generate sawtooth. Start with middle level up to highest level. Then
208 * go to lowest level and back to middle level.
210 for(j = 0; j < ((duration * freq) / 1000); j++) {
211 for(i = 0; i <= 0x7FFF; i += (0x7FFF/(44100/(freq*4)))) {
213 /* data format: right data left data) */
214 if (channel == LEFT_RIGHT)
216 if (channel == RIGHT)
218 psc->psc_buffer_32 = data;
219 while (psc->tfnum > 400);
221 for(i = 0x7FFF; i >= -0x7FFF; i -= (0xFFFF/(44100/(freq*2)))) {
223 /* data format: right data left data) */
224 if (channel == LEFT_RIGHT)
226 if (channel == RIGHT)
228 psc->psc_buffer_32 = data;
229 while (psc->tfnum > 400);
231 for(i = -0x7FFF; i <= 0; i += (0x7FFF/(44100/(freq*4)))) {
233 /* data format: right data left data) */
234 if (channel == LEFT_RIGHT)
236 if (channel == RIGHT)
238 psc->psc_buffer_32 = data;
239 while (psc->tfnum > 400);
242 while (psc->tfnum > 0); /* wait for fifo empty */
244 psc->command = (PSC_RX_DISABLE | PSC_TX_DISABLE);
249 static int i2s_squarewave(unsigned long duration, unsigned int freq,
250 unsigned int channel)
254 struct mpc5xxx_psc *psc = (struct mpc5xxx_psc*)MPC5XXX_PSC2;
256 psc->command = (PSC_RX_ENABLE | PSC_TX_ENABLE);
259 * Generate sqarewave. Start with high level, duty cycle 1:1.
261 for(j = 0; j < ((duration * freq) / 1000); j++) {
262 for(i = 0; i < (44100/(freq*2)); i ++) {
264 /* data format: right data left data) */
265 if (channel == LEFT_RIGHT)
267 if (channel == RIGHT)
269 psc->psc_buffer_32 = data;
270 while (psc->tfnum > 400);
272 for(i = 0; i < (44100/(freq*2)); i ++) {
274 /* data format: right data left data) */
275 if (channel == LEFT_RIGHT)
277 if (channel == RIGHT)
279 psc->psc_buffer_32 = data;
280 while (psc->tfnum > 400);
283 while (psc->tfnum > 0); /* wait for fifo empty */
285 psc->command = (PSC_RX_DISABLE | PSC_TX_DISABLE);
290 static int cmd_sound(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
292 unsigned long reg, val, duration;
294 unsigned int freq, channel;
295 unsigned char volume;
298 #ifdef CONFIG_STK52XX_REV100
299 printf ("Revision 100 of STK52XX not supported!\n");
306 if ((tmp = getenv ("volume")) != NULL) {
307 volume = simple_strtoul (tmp, NULL, 10);
309 volume = DEFAULT_VOL;
311 set_attenuation(volume);
316 return cmd_usage(cmdtp);
318 if (strncmp(argv[1],"saw",3) == 0) {
319 printf ("Play sawtooth\n");
320 rcode = i2s_sawtooth (DEFAULT_DURATION, DEFAULT_FREQ,
323 } else if (strncmp(argv[1],"squ",3) == 0) {
324 printf ("Play squarewave\n");
325 rcode = i2s_squarewave (DEFAULT_DURATION, DEFAULT_FREQ,
330 return cmd_usage(cmdtp);
332 if (strncmp(argv[1],"saw",3) == 0) {
333 duration = simple_strtoul(argv[2], NULL, 10);
334 printf ("Play sawtooth\n");
335 rcode = i2s_sawtooth (duration, DEFAULT_FREQ,
338 } else if (strncmp(argv[1],"squ",3) == 0) {
339 duration = simple_strtoul(argv[2], NULL, 10);
340 printf ("Play squarewave\n");
341 rcode = i2s_squarewave (duration, DEFAULT_FREQ,
345 return cmd_usage(cmdtp);
347 if (strncmp(argv[1],"saw",3) == 0) {
348 duration = simple_strtoul(argv[2], NULL, 10);
349 freq = (unsigned int)simple_strtoul(argv[3], NULL, 10);
350 printf ("Play sawtooth\n");
351 rcode = i2s_sawtooth (duration, freq,
354 } else if (strncmp(argv[1],"squ",3) == 0) {
355 duration = simple_strtoul(argv[2], NULL, 10);
356 freq = (unsigned int)simple_strtoul(argv[3], NULL, 10);
357 printf ("Play squarewave\n");
358 rcode = i2s_squarewave (duration, freq,
361 } else if (strcmp(argv[1],"pcm1772") == 0) {
362 reg = simple_strtoul(argv[2], NULL, 10);
363 val = simple_strtoul(argv[3], NULL, 10);
364 printf("Set PCM1772 %lu. %lu\n", reg, val);
365 pcm1772_write_reg((uchar)reg, (uchar)val);
368 return cmd_usage(cmdtp);
370 if (strncmp(argv[1],"saw",3) == 0) {
371 duration = simple_strtoul(argv[2], NULL, 10);
372 freq = (unsigned int)simple_strtoul(argv[3], NULL, 10);
373 if (strncmp(argv[4],"l",1) == 0)
375 else if (strncmp(argv[4],"r",1) == 0)
378 channel = LEFT_RIGHT;
379 printf ("Play squarewave\n");
380 rcode = i2s_sawtooth (duration, freq,
383 } else if (strncmp(argv[1],"squ",3) == 0) {
384 duration = simple_strtoul(argv[2], NULL, 10);
385 freq = (unsigned int)simple_strtoul(argv[3], NULL, 10);
386 if (strncmp(argv[4],"l",1) == 0)
388 else if (strncmp(argv[4],"r",1) == 0)
391 channel = LEFT_RIGHT;
392 printf ("Play squarewave\n");
393 rcode = i2s_squarewave (duration, freq,
397 return cmd_usage(cmdtp);
399 printf ("Usage:\nsound cmd [arg1] [arg2] ...\n");
403 static int cmd_wav(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
405 unsigned long length, addr;
406 unsigned char volume;
410 #ifdef CONFIG_STK52XX_REV100
411 printf ("Revision 100 of STK52XX not supported!\n");
421 length = simple_strtoul(argv[2], NULL, 16);
422 addr = simple_strtoul(argv[1], NULL, 16);
426 if ((tmp = getenv ("filesize")) != NULL) {
427 length = simple_strtoul (tmp, NULL, 16);
429 puts ("No filesize provided\n");
432 addr = simple_strtoul(argv[1], NULL, 16);
435 if ((tmp = getenv ("filesize")) != NULL) {
436 length = simple_strtoul (tmp, NULL, 16);
438 puts ("No filesize provided\n");
441 if ((tmp = getenv ("loadaddr")) != NULL) {
442 addr = simple_strtoul (tmp, NULL, 16);
444 puts ("No loadaddr provided\n");
450 printf("Usage:\nwav <addr> <length[s]\n");
455 if ((tmp = getenv ("volume")) != NULL) {
456 volume = simple_strtoul (tmp, NULL, 10);
458 volume = DEFAULT_VOL;
460 set_attenuation(volume);
462 printf("Play wave file at %lX with length %lX\n", addr, length);
463 rcode = i2s_play_wave(addr, length);
468 static int cmd_beep(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
470 unsigned char volume;
471 unsigned int channel;
475 #ifdef CONFIG_STK52XX_REV100
476 printf ("Revision 100 of STK52XX not supported!\n");
486 channel = LEFT_RIGHT;
489 if (strncmp(argv[1],"l",1) == 0)
491 else if (strncmp(argv[1],"r",1) == 0)
494 channel = LEFT_RIGHT;
497 return cmd_usage(cmdtp);
500 if ((tmp = getenv ("volume")) != NULL) {
501 volume = simple_strtoul (tmp, NULL, 10);
503 volume = DEFAULT_VOL;
505 set_attenuation(volume);
510 else if (channel == RIGHT)
513 printf ("left and right ");
514 printf ("channel\n");
516 rcode = i2s_squarewave (DEFAULT_DURATION, DEFAULT_FREQ, channel);
522 #if defined(CONFIG_STK52XX)
525 struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio *)MPC5XXX_GPIO;
526 struct mpc5xxx_gpt_0_7 *gpt = (struct mpc5xxx_gpt_0_7 *)MPC5XXX_GPT;
528 /* configure PSC3 for SPI and GPIO */
529 gpio->port_config &= ~(0x00000F00);
530 gpio->port_config |= 0x00000800;
532 gpio->simple_gpioe &= ~(0x00000F00);
533 gpio->simple_gpioe |= 0x00000F00;
535 gpio->simple_ddr &= ~(0x00000F00);
536 gpio->simple_ddr |= 0x00000F00;
538 /* configure timer 4-7 for simple GPIO output */
539 gpt->gpt4.emsr |= 0x00000024;
540 gpt->gpt5.emsr |= 0x00000024;
541 gpt->gpt6.emsr |= 0x00000024;
542 gpt->gpt7.emsr |= 0x00000024;
544 #ifndef CONFIG_TQM5200S
545 /* enable SM501 GPIO control (in both power modes) */
546 *(vu_long *) (SM501_MMIO_BASE+SM501_POWER_MODE0_GATE) |=
547 POWER_MODE_GATE_GPIO_PWM_I2C;
548 *(vu_long *) (SM501_MMIO_BASE+SM501_POWER_MODE1_GATE) |=
549 POWER_MODE_GATE_GPIO_PWM_I2C;
551 /* configure SM501 gpio pins 24-27 as output */
552 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_CTRL_LOW) &= ~(0xF << 24);
553 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_DIR_LOW) |= (0xF << 24);
555 /* configure SM501 gpio pins 48-51 as output */
556 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_DIR_HIGH) |= (0xF << 16);
557 #endif /* !CONFIG_TQM5200S */
561 * return 1 if led number unknown
564 int do_led(char * const argv[])
566 struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio *)MPC5XXX_GPIO;
567 struct mpc5xxx_gpt_0_7 *gpt = (struct mpc5xxx_gpt_0_7 *)MPC5XXX_GPT;
569 switch (simple_strtoul(argv[2], NULL, 10)) {
572 if (strcmp (argv[3], "on") == 0) {
573 gpio->simple_dvo |= (1 << 8);
575 gpio->simple_dvo &= ~(1 << 8);
580 if (strcmp (argv[3], "on") == 0) {
581 gpio->simple_dvo |= (1 << 9);
583 gpio->simple_dvo &= ~(1 << 9);
588 if (strcmp (argv[3], "on") == 0) {
589 gpio->simple_dvo |= (1 << 10);
591 gpio->simple_dvo &= ~(1 << 10);
596 if (strcmp (argv[3], "on") == 0) {
597 gpio->simple_dvo |= (1 << 11);
599 gpio->simple_dvo &= ~(1 << 11);
604 if (strcmp (argv[3], "on") == 0) {
605 gpt->gpt4.emsr |= (1 << 4);
607 gpt->gpt4.emsr &= ~(1 << 4);
612 if (strcmp (argv[3], "on") == 0) {
613 gpt->gpt5.emsr |= (1 << 4);
615 gpt->gpt5.emsr &= ~(1 << 4);
620 if (strcmp (argv[3], "on") == 0) {
621 gpt->gpt6.emsr |= (1 << 4);
623 gpt->gpt6.emsr &= ~(1 << 4);
628 if (strcmp (argv[3], "on") == 0) {
629 gpt->gpt7.emsr |= (1 << 4);
631 gpt->gpt7.emsr &= ~(1 << 4);
634 #ifndef CONFIG_TQM5200S
636 if (strcmp (argv[3], "on") == 0) {
637 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) |=
640 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) &=
646 if (strcmp (argv[3], "on") == 0) {
647 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) |=
650 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) &=
656 if (strcmp (argv[3], "on") == 0) {
657 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) |=
660 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) &=
666 if (strcmp (argv[3], "on") == 0) {
667 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) |=
670 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_LOW) &=
676 if (strcmp (argv[3], "on") == 0) {
677 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) |=
680 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) &=
686 if (strcmp (argv[3], "on") == 0) {
687 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) |=
690 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) &=
696 if (strcmp (argv[3], "on") == 0) {
697 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) |=
700 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) &=
706 if (strcmp (argv[3], "on") == 0) {
707 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) |=
710 *(vu_long *) (SM501_MMIO_BASE+SM501_GPIO_DATA_HIGH) &=
714 #endif /* !CONFIG_TQM5200S */
716 printf ("%s: invalid led number %s\n", __FUNCTION__, argv[2]);
724 #if defined(CONFIG_STK52XX) || defined(CONFIG_FO300)
726 * return 1 on CAN initialization failure
727 * return 0 if no failure
731 static int init_done = 0;
733 struct mpc5xxx_mscan *can1 =
734 (struct mpc5xxx_mscan *)(CONFIG_SYS_MBAR + 0x0900);
735 struct mpc5xxx_mscan *can2 =
736 (struct mpc5xxx_mscan *)(CONFIG_SYS_MBAR + 0x0980);
738 /* GPIO configuration of the CAN pins is done in TQM5200.h */
742 can1->canctl1 |= 0x80; /* CAN enable */
746 can1->canctl0 |= 0x02; /* sleep mode */
747 /* wait until sleep mode reached */
748 while (!(can1->canctl1 & 0x02)) {
752 printf ("%s: CAN1 initialize error, "
753 "can not enter sleep mode!\n",
759 can1->canctl0 = 0x01; /* enter init mode */
760 /* wait until init mode reached */
761 while (!(can1->canctl1 & 0x01)) {
765 printf ("%s: CAN1 initialize error, "
766 "can not enter init mode!\n",
771 can1->canctl1 = 0x80;
772 can1->canctl1 |= 0x40;
773 can1->canbtr0 = 0x0F;
774 can1->canbtr1 = 0x7F;
775 can1->canidac &= ~(0x30);
776 can1->canidar1 = 0x00;
777 can1->canidar3 = 0x00;
778 can1->canidar5 = 0x00;
779 can1->canidar7 = 0x00;
780 can1->canidmr0 = 0xFF;
781 can1->canidmr1 = 0xFF;
782 can1->canidmr2 = 0xFF;
783 can1->canidmr3 = 0xFF;
784 can1->canidmr4 = 0xFF;
785 can1->canidmr5 = 0xFF;
786 can1->canidmr6 = 0xFF;
787 can1->canidmr7 = 0xFF;
790 can1->canctl0 &= ~(0x01); /* leave init mode */
791 can1->canctl0 &= ~(0x02);
792 /* wait until init and sleep mode left */
793 while ((can1->canctl1 & 0x01) || (can1->canctl1 & 0x02)) {
797 printf ("%s: CAN1 initialize error, "
798 "can not leave init/sleep mode!\n",
805 can2->canctl1 |= 0x80; /* CAN enable */
809 can2->canctl0 |= 0x02; /* sleep mode */
810 /* wait until sleep mode reached */
811 while (!(can2->canctl1 & 0x02)) {
815 printf ("%s: CAN2 initialize error, "
816 "can not enter sleep mode!\n",
822 can2->canctl0 = 0x01; /* enter init mode */
823 /* wait until init mode reached */
824 while (!(can2->canctl1 & 0x01)) {
828 printf ("%s: CAN2 initialize error, "
829 "can not enter init mode!\n",
834 can2->canctl1 = 0x80;
835 can2->canctl1 |= 0x40;
836 can2->canbtr0 = 0x0F;
837 can2->canbtr1 = 0x7F;
838 can2->canidac &= ~(0x30);
839 can2->canidar1 = 0x00;
840 can2->canidar3 = 0x00;
841 can2->canidar5 = 0x00;
842 can2->canidar7 = 0x00;
843 can2->canidmr0 = 0xFF;
844 can2->canidmr1 = 0xFF;
845 can2->canidmr2 = 0xFF;
846 can2->canidmr3 = 0xFF;
847 can2->canidmr4 = 0xFF;
848 can2->canidmr5 = 0xFF;
849 can2->canidmr6 = 0xFF;
850 can2->canidmr7 = 0xFF;
851 can2->canctl0 &= ~(0x01); /* leave init mode */
852 can2->canctl0 &= ~(0x02);
855 /* wait until init mode left */
856 while ((can2->canctl1 & 0x01) || (can2->canctl1 & 0x02)) {
860 printf ("%s: CAN2 initialize error, "
861 "can not leave init/sleep mode!\n",
872 * return 1 on CAN failure
873 * return 0 if no failure
875 int do_can(char * const argv[])
878 struct mpc5xxx_mscan *can1 =
879 (struct mpc5xxx_mscan *)(CONFIG_SYS_MBAR + 0x0900);
880 struct mpc5xxx_mscan *can2 =
881 (struct mpc5xxx_mscan *)(CONFIG_SYS_MBAR + 0x0980);
883 /* send a message on CAN1 */
884 can1->cantbsel = 0x01;
885 can1->cantxfg.idr[0] = 0x55;
886 can1->cantxfg.idr[1] = 0x00;
887 can1->cantxfg.idr[1] &= ~0x8;
888 can1->cantxfg.idr[1] &= ~0x10;
889 can1->cantxfg.dsr[0] = 0xCC;
890 can1->cantxfg.dlr = 1;
891 can1->cantxfg.tbpr = 0;
892 can1->cantflg = 0x01;
895 while ((can1->cantflg & 0x01) == 0) {
898 printf ("%s: CAN1 send timeout, "
899 "can not send message!\n",
908 while (!(can2->canrflg & 0x01)) {
911 printf ("%s: CAN2 receive timeout, "
912 "no message received!\n",
919 if (can2->canrxfg.dsr[0] != 0xCC) {
920 printf ("%s: CAN2 receive error, "
926 /* send a message on CAN2 */
927 can2->cantbsel = 0x01;
928 can2->cantxfg.idr[0] = 0x55;
929 can2->cantxfg.idr[1] = 0x00;
930 can2->cantxfg.idr[1] &= ~0x8;
931 can2->cantxfg.idr[1] &= ~0x10;
932 can2->cantxfg.dsr[0] = 0xCC;
933 can2->cantxfg.dlr = 1;
934 can2->cantxfg.tbpr = 0;
935 can2->cantflg = 0x01;
938 while ((can2->cantflg & 0x01) == 0) {
941 printf ("%s: CAN2 send error, "
942 "can not send message!\n",
951 while (!(can1->canrflg & 0x01)) {
954 printf ("%s: CAN1 receive timeout, "
955 "no message received!\n",
962 if (can1->canrxfg.dsr[0] != 0xCC) {
963 printf ("%s: CAN1 receive error 0x%02x\n",
964 __FUNCTION__, (can1->canrxfg.dsr[0]));
972 * return 1 if rs232 port unknown
973 * return 2 on txd/rxd failure (only rs232 2)
974 * return 3 on rts/cts failure
975 * return 0 if no failure
977 int do_rs232(char * const argv[])
979 int error_status = 0;
980 struct mpc5xxx_gpio *gpio = (struct mpc5xxx_gpio *)MPC5XXX_GPIO;
981 struct mpc5xxx_psc *psc1 = (struct mpc5xxx_psc *)MPC5XXX_PSC1;
983 switch (simple_strtoul(argv[2], NULL, 10)) {
986 /* check RTS <-> CTS loop */
990 /* wait some time before requesting status */
993 /* check status at cts */
994 if ((psc1->ip & 0x01) != 0) {
996 printf ("%s: failure at rs232_1, cts status is %d "
998 __FUNCTION__, (psc1->ip & 0x01));
1004 /* wait some time before requesting status */
1007 /* check status at cts */
1008 if ((psc1->ip & 0x01) != 1) {
1010 printf ("%s: failure at rs232_1, cts status is %d "
1012 __FUNCTION__, (psc1->ip & 0x01));
1018 /* set PSC3_0, PSC3_2 as output and PSC3_1, PSC3_3 as input */
1019 gpio->simple_ddr &= ~(0x00000F00);
1020 gpio->simple_ddr |= 0x00000500;
1022 /* check TXD <-> RXD loop */
1024 gpio->simple_dvo |= (1 << 8);
1026 /* wait some time before requesting status */
1029 if ((gpio->simple_ival & 0x00000200) != 0x00000200) {
1031 printf ("%s: failure at rs232_2, rxd status is %d "
1034 (gpio->simple_ival & 0x00000200) >> 9);
1038 gpio->simple_dvo &= ~(1 << 8);
1040 /* wait some time before requesting status */
1043 if ((gpio->simple_ival & 0x00000200) != 0x00000000) {
1045 printf ("%s: failure at rs232_2, rxd status is %d "
1048 (gpio->simple_ival & 0x00000200) >> 9);
1051 /* check RTS <-> CTS loop */
1053 gpio->simple_dvo |= (1 << 10);
1055 /* wait some time before requesting status */
1058 if ((gpio->simple_ival & 0x00000800) != 0x00000800) {
1060 printf ("%s: failure at rs232_2, cts status is %d "
1063 (gpio->simple_ival & 0x00000800) >> 11);
1067 gpio->simple_dvo &= ~(1 << 10);
1069 /* wait some time before requesting status */
1072 if ((gpio->simple_ival & 0x00000800) != 0x00000000) {
1074 printf ("%s: failure at rs232_2, cts status is %d "
1077 (gpio->simple_ival & 0x00000800) >> 11);
1080 /* set PSC3_0, PSC3_1, PSC3_2 and PSC3_3 as output */
1081 gpio->simple_ddr &= ~(0x00000F00);
1082 gpio->simple_ddr |= 0x00000F00;
1086 printf ("%s: invalid rs232 number %s\n", __FUNCTION__, argv[2]);
1091 return error_status;
1094 #if !defined(CONFIG_FO300) && !defined(CONFIG_TQM5200S)
1095 static void sm501_backlight (unsigned int state)
1097 if (state == BL_ON) {
1098 *(vu_long *)(SM501_MMIO_BASE+SM501_PANEL_DISPLAY_CONTROL) |=
1099 (1 << 26) | (1 << 27);
1100 } else if (state == BL_OFF)
1101 *(vu_long *)(SM501_MMIO_BASE+SM501_PANEL_DISPLAY_CONTROL) &=
1102 ~((1 << 26) | (1 << 27));
1104 #endif /* !CONFIG_FO300 & !CONFIG_TQM5200S */
1106 int cmd_fkt(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
1110 #ifdef CONFIG_STK52XX_REV100
1111 printf ("Revision 100 of STK52XX not supported!\n");
1114 #if defined(CONFIG_STK52XX)
1126 if (strncmp (argv[1], "can", 3) == 0) {
1127 rcode = do_can (argv);
1137 if (strncmp (argv[1], "rs232", 3) == 0) {
1138 rcode = do_rs232 (argv);
1144 #if !defined(CONFIG_FO300) && !defined(CONFIG_TQM5200S)
1145 } else if (strncmp (argv[1], "backlight", 4) == 0) {
1146 if (strncmp (argv[2], "on", 2) == 0) {
1147 sm501_backlight (BL_ON);
1150 else if (strncmp (argv[2], "off", 3) == 0) {
1151 sm501_backlight (BL_OFF);
1154 #endif /* !CONFIG_FO300 & !CONFIG_TQM5200S */
1158 #if defined(CONFIG_STK52XX)
1160 if (strcmp (argv[1], "led") == 0) {
1161 return (do_led (argv));
1170 printf ("Usage:\nfkt cmd [arg1] [arg2] ...\n");
1176 sound , 5, 1, cmd_sound,
1178 "saw [duration] [freq] [channel]\n"
1179 " - generate sawtooth for 'duration' ms with frequency 'freq'\n"
1180 " on left \"l\" or right \"r\" channel\n"
1181 "sound square [duration] [freq] [channel]\n"
1182 " - generate squarewave for 'duration' ms with frequency 'freq'\n"
1183 " on left \"l\" or right \"r\" channel\n"
1188 wav , 3, 1, cmd_wav,
1191 " - play wav file at address 'addr' with length 'bytes'"
1195 beep , 2, 1, cmd_beep,
1198 " - play short beep on \"l\"eft or \"r\"ight channel"
1200 #endif /* CONFIG_STK52XX || CONFIG_FO300 */
1202 #if defined(CONFIG_STK52XX)
1204 fkt , 4, 1, cmd_fkt,
1205 "Function test routines",
1206 "led number on/off\n"
1207 " - 'number's like printed on STK52XX board\n"
1209 " - loopback plug for X83 required\n"
1210 "fkt rs232 number\n"
1211 " - loopback plug(s) for X2 required"
1212 #ifndef CONFIG_TQM5200S
1214 "fkt backlight on/off\n"
1215 " - switch backlight on or off"
1216 #endif /* !CONFIG_TQM5200S */
1218 #elif defined(CONFIG_FO300)
1220 fkt , 3, 1, cmd_fkt,
1221 "Function test routines",
1223 " - loopback plug for X16/X29 required\n"
1224 "fkt rs232 number\n"
1225 " - loopback plug(s) for X21/X22 required"