cmd_bc3450.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827
  1. /*
  2. * (C) Copyright 2005
  3. * Stefan Strobl, GERSYS GmbH, stefan.strobl@gersys.de
  4. *
  5. * (C) Copyright 2005
  6. * Martin Krause, TQ-Systems GmbH, martin.krause@tqs.de.
  7. *
  8. * See file CREDITS for list of people who contributed to this
  9. * project.
  10. *
  11. * This program is free software; you can redistribute it and/or
  12. * modify it under the terms of the GNU General Public License as
  13. * published by the Free Software Foundation; either version 2 of
  14. * the License, or (at your option) any later version.
  15. *
  16. * This program is distributed in the hope that it will be useful,
  17. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  19. * GNU General Public License for more details.
  20. *
  21. * You should have received a copy of the GNU General Public License
  22. * along with this program; if not, write to the Free Software
  23. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  24. * MA 02111-1307 USA
  25. */
  26. #include <common.h>
  27. #include <command.h>
  28. /*
  29. * BC3450 specific commands
  30. */
  31. #if defined(CONFIG_CMD_BSP)
  32. #undef DEBUG
  33. #ifdef DEBUG
  34. # define dprintf(fmt,args...) printf(fmt, ##args)
  35. #else
  36. # define dprintf(fmt,args...)
  37. #endif
  38. /*
  39. * Definitions for DS1620 chip
  40. */
  41. #define THERM_START_CONVERT 0xee
  42. #define THERM_RESET 0xaf
  43. #define THERM_READ_CONFIG 0xac
  44. #define THERM_READ_TEMP 0xaa
  45. #define THERM_READ_TL 0xa2
  46. #define THERM_READ_TH 0xa1
  47. #define THERM_WRITE_CONFIG 0x0c
  48. #define THERM_WRITE_TL 0x02
  49. #define THERM_WRITE_TH 0x01
  50. #define CFG_CPU 2
  51. #define CFG_1SHOT 1
  52. #define CFG_STANDALONE 0
  53. struct therm {
  54. int hi;
  55. int lo;
  56. };
  57. /*
  58. * SM501 Register
  59. */
  60. #define SM501_GPIO_CTRL_LOW 0x00000008UL /* gpio pins 0..31 */
  61. #define SM501_GPIO_CTRL_HIGH 0x0000000CUL /* gpio pins 32..63 */
  62. #define SM501_POWER_MODE0_GATE 0x00000040UL
  63. #define SM501_POWER_MODE1_GATE 0x00000048UL
  64. #define POWER_MODE_GATE_GPIO_PWM_I2C 0x00000040UL
  65. #define SM501_GPIO_DATA_LOW 0x00010000UL
  66. #define SM501_GPIO_DATA_HIGH 0x00010004UL
  67. #define SM501_GPIO_DATA_DIR_LOW 0x00010008UL
  68. #define SM501_GPIO_DATA_DIR_HIGH 0x0001000CUL
  69. #define SM501_PANEL_DISPLAY_CONTROL 0x00080000UL
  70. #define SM501_CRT_DISPLAY_CONTROL 0x00080200UL
  71. /* SM501 CRT Display Control Bits */
  72. #define SM501_CDC_SEL (1 << 9)
  73. #define SM501_CDC_TE (1 << 8)
  74. #define SM501_CDC_E (1 << 2)
  75. /* SM501 Panel Display Control Bits */
  76. #define SM501_PDC_FPEN (1 << 27)
  77. #define SM501_PDC_BIAS (1 << 26)
  78. #define SM501_PDC_DATA (1 << 25)
  79. #define SM501_PDC_VDDEN (1 << 24)
  80. /* SM501 GPIO Data LOW Bits */
  81. #define SM501_GPIO24 0x01000000
  82. #define SM501_GPIO25 0x02000000
  83. #define SM501_GPIO26 0x04000000
  84. #define SM501_GPIO27 0x08000000
  85. #define SM501_GPIO28 0x10000000
  86. #define SM501_GPIO29 0x20000000
  87. #define SM501_GPIO30 0x40000000
  88. #define SM501_GPIO31 0x80000000
  89. /* SM501 GPIO Data HIGH Bits */
  90. #define SM501_GPIO46 0x00004000
  91. #define SM501_GPIO47 0x00008000
  92. #define SM501_GPIO48 0x00010000
  93. #define SM501_GPIO49 0x00020000
  94. #define SM501_GPIO50 0x00040000
  95. #define SM501_GPIO51 0x00080000
  96. /* BC3450 GPIOs @ SM501 Data LOW */
  97. #define DIP (SM501_GPIO24 | SM501_GPIO25 | SM501_GPIO26 | SM501_GPIO27)
  98. #define DS1620_DQ SM501_GPIO29 /* I/O */
  99. #define DS1620_CLK SM501_GPIO30 /* High active O/P */
  100. #define DS1620_RES SM501_GPIO31 /* Low active O/P */
  101. /* BC3450 GPIOs @ SM501 Data HIGH */
  102. #define BUZZER SM501_GPIO47 /* Low active O/P */
  103. #define DS1620_TLOW SM501_GPIO48 /* High active I/P */
  104. #define PWR_OFF SM501_GPIO49 /* Low active O/P */
  105. #define FP_DATA_TRI SM501_GPIO50 /* High active O/P */
  106. /*
  107. * Initialise GPIO on SM501
  108. *
  109. * This function may be called from several other functions.
  110. * Yet, the initialisation sequence is executed only the first
  111. * time the function is called.
  112. */
  113. int sm501_gpio_init (void)
  114. {
  115. static int init_done = 0;
  116. if (init_done) {
  117. /* dprintf("sm501_gpio_init: nothing to be done.\n"); */
  118. return 1;
  119. }
  120. /* enable SM501 GPIO control (in both power modes) */
  121. *(vu_long *) (SM501_MMIO_BASE + SM501_POWER_MODE0_GATE) |=
  122. POWER_MODE_GATE_GPIO_PWM_I2C;
  123. *(vu_long *) (SM501_MMIO_BASE + SM501_POWER_MODE1_GATE) |=
  124. POWER_MODE_GATE_GPIO_PWM_I2C;
  125. /* set up default O/Ps */
  126. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &=
  127. ~(DS1620_RES | DS1620_CLK);
  128. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |= DS1620_DQ;
  129. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) &=
  130. ~(FP_DATA_TRI);
  131. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) |=
  132. (BUZZER | PWR_OFF);
  133. /* configure directions for SM501 GPIO pins */
  134. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_CTRL_LOW) &= ~(0xFF << 24);
  135. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_CTRL_HIGH) &=
  136. ~(0x3F << 14);
  137. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) &=
  138. ~(DIP | DS1620_DQ);
  139. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) |=
  140. (DS1620_RES | DS1620_CLK);
  141. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_HIGH) &=
  142. ~DS1620_TLOW;
  143. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_HIGH) |=
  144. (PWR_OFF | BUZZER | FP_DATA_TRI);
  145. init_done = 1;
  146. /* dprintf("sm501_gpio_init: done.\n"); */
  147. return 0;
  148. }
  149. /*
  150. * dip - read Config Inputs
  151. *
  152. * read and prints the dip switch
  153. * and/or external config inputs (4bits) 0...0x0F
  154. */
  155. int cmd_dip (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  156. {
  157. vu_long rc = 0;
  158. sm501_gpio_init ();
  159. /* read dip switch */
  160. rc = *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW);
  161. rc = ~rc;
  162. rc &= DIP;
  163. rc = (int) (rc >> 24);
  164. /* plausibility check */
  165. if (rc > 0x0F)
  166. return -1;
  167. printf ("0x%x\n", rc);
  168. return 0;
  169. }
  170. U_BOOT_CMD (dip, 1, 1, cmd_dip,
  171. "dip - read dip switch and config inputs\n",
  172. "\n"
  173. " - prints the state of the dip switch and/or\n"
  174. " external configuration inputs as hex value.\n"
  175. " - \"Config 1\" is the LSB\n");
  176. /*
  177. * buz - turns Buzzer on/off
  178. */
  179. #ifdef CONFIG_BC3450_BUZZER
  180. static int cmd_buz (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  181. {
  182. if (argc != 2) {
  183. printf ("Usage:\nspecify one argument: \"on\" or \"off\"\n");
  184. return 1;
  185. }
  186. sm501_gpio_init ();
  187. if (strncmp (argv[1], "on", 2) == 0) {
  188. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) &=
  189. ~(BUZZER);
  190. return 0;
  191. } else if (strncmp (argv[1], "off", 3) == 0) {
  192. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) |=
  193. BUZZER;
  194. return 0;
  195. }
  196. printf ("Usage:\nspecify one argument: \"on\" or \"off\"\n");
  197. return 1;
  198. }
  199. U_BOOT_CMD (buz, 2, 1, cmd_buz,
  200. "buz - turns buzzer on/off\n",
  201. "\n" "buz <on/off>\n" " - turns the buzzer on or off\n");
  202. #endif /* CONFIG_BC3450_BUZZER */
  203. /*
  204. * fp - front panel commands
  205. */
  206. static int cmd_fp (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  207. {
  208. sm501_gpio_init ();
  209. if (strncmp (argv[1], "on", 2) == 0) {
  210. /* turn on VDD first */
  211. *(vu_long *) (SM501_MMIO_BASE +
  212. SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_VDDEN;
  213. udelay (1000);
  214. /* then put data on */
  215. *(vu_long *) (SM501_MMIO_BASE +
  216. SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_DATA;
  217. /* wait some time and enable backlight */
  218. udelay (1000);
  219. *(vu_long *) (SM501_MMIO_BASE +
  220. SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_BIAS;
  221. udelay (1000);
  222. *(vu_long *) (SM501_MMIO_BASE +
  223. SM501_PANEL_DISPLAY_CONTROL) |= SM501_PDC_FPEN;
  224. return 0;
  225. } else if (strncmp (argv[1], "off", 3) == 0) {
  226. /* turn off the backlight first */
  227. *(vu_long *) (SM501_MMIO_BASE +
  228. SM501_PANEL_DISPLAY_CONTROL) &= ~SM501_PDC_FPEN;
  229. udelay (1000);
  230. *(vu_long *) (SM501_MMIO_BASE +
  231. SM501_PANEL_DISPLAY_CONTROL) &= ~SM501_PDC_BIAS;
  232. udelay (200000);
  233. /* wait some time, then remove data */
  234. *(vu_long *) (SM501_MMIO_BASE +
  235. SM501_PANEL_DISPLAY_CONTROL) &= ~SM501_PDC_DATA;
  236. udelay (1000);
  237. /* and remove VDD last */
  238. *(vu_long *) (SM501_MMIO_BASE +
  239. SM501_PANEL_DISPLAY_CONTROL) &=
  240. ~SM501_PDC_VDDEN;
  241. return 0;
  242. } else if (strncmp (argv[1], "bl", 2) == 0) {
  243. /* turn on/off backlight only */
  244. if (strncmp (argv[2], "on", 2) == 0) {
  245. *(vu_long *) (SM501_MMIO_BASE +
  246. SM501_PANEL_DISPLAY_CONTROL) |=
  247. SM501_PDC_BIAS;
  248. udelay (1000);
  249. *(vu_long *) (SM501_MMIO_BASE +
  250. SM501_PANEL_DISPLAY_CONTROL) |=
  251. SM501_PDC_FPEN;
  252. return 0;
  253. } else if (strncmp (argv[2], "off", 3) == 0) {
  254. *(vu_long *) (SM501_MMIO_BASE +
  255. SM501_PANEL_DISPLAY_CONTROL) &=
  256. ~SM501_PDC_FPEN;
  257. udelay (1000);
  258. *(vu_long *) (SM501_MMIO_BASE +
  259. SM501_PANEL_DISPLAY_CONTROL) &=
  260. ~SM501_PDC_BIAS;
  261. return 0;
  262. }
  263. }
  264. #ifdef CONFIG_BC3450_CRT
  265. else if (strncmp (argv[1], "crt", 3) == 0) {
  266. /* enables/disables the crt output (debug only) */
  267. if (strncmp (argv[2], "on", 2) == 0) {
  268. *(vu_long *) (SM501_MMIO_BASE +
  269. SM501_CRT_DISPLAY_CONTROL) |=
  270. (SM501_CDC_TE | SM501_CDC_E);
  271. *(vu_long *) (SM501_MMIO_BASE +
  272. SM501_CRT_DISPLAY_CONTROL) &=
  273. ~SM501_CDC_SEL;
  274. return 0;
  275. } else if (strncmp (argv[2], "off", 3) == 0) {
  276. *(vu_long *) (SM501_MMIO_BASE +
  277. SM501_CRT_DISPLAY_CONTROL) &=
  278. ~(SM501_CDC_TE | SM501_CDC_E);
  279. *(vu_long *) (SM501_MMIO_BASE +
  280. SM501_CRT_DISPLAY_CONTROL) |=
  281. SM501_CDC_SEL;
  282. return 0;
  283. }
  284. }
  285. #endif /* CONFIG_BC3450_CRT */
  286. printf ("Usage:%s\n", cmdtp->help);
  287. return 1;
  288. }
  289. U_BOOT_CMD (fp, 3, 1, cmd_fp,
  290. "fp - front panes access functions\n",
  291. "\n"
  292. "fp bl <on/off>\n"
  293. " - turns the CCFL backlight of the display on/off\n"
  294. "fp <on/off>\n" " - turns the whole display on/off\n"
  295. #ifdef CONFIG_BC3450_CRT
  296. "fp crt <on/off>\n"
  297. " - enables/disables the crt output (debug only)\n"
  298. #endif /* CONFIG_BC3450_CRT */
  299. );
  300. /*
  301. * temp - DS1620 thermometer
  302. */
  303. /* GERSYS BC3450 specific functions */
  304. static inline void bc_ds1620_set_clk (int clk)
  305. {
  306. if (clk)
  307. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |=
  308. DS1620_CLK;
  309. else
  310. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &=
  311. ~DS1620_CLK;
  312. }
  313. static inline void bc_ds1620_set_data (int dat)
  314. {
  315. if (dat)
  316. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |=
  317. DS1620_DQ;
  318. else
  319. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &=
  320. ~DS1620_DQ;
  321. }
  322. static inline int bc_ds1620_get_data (void)
  323. {
  324. vu_long rc;
  325. rc = *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW);
  326. rc &= DS1620_DQ;
  327. if (rc != 0)
  328. rc = 1;
  329. return (int) rc;
  330. }
  331. static inline void bc_ds1620_set_data_dir (int dir)
  332. {
  333. if (dir) /* in */
  334. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) &= ~DS1620_DQ;
  335. else /* out */
  336. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_DIR_LOW) |= DS1620_DQ;
  337. }
  338. static inline void bc_ds1620_set_reset (int res)
  339. {
  340. if (res)
  341. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) |= DS1620_RES;
  342. else
  343. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_LOW) &= ~DS1620_RES;
  344. }
  345. /* hardware independent functions */
  346. static void ds1620_send_bits (int nr, int value)
  347. {
  348. int i;
  349. for (i = 0; i < nr; i++) {
  350. bc_ds1620_set_data (value & 1);
  351. bc_ds1620_set_clk (0);
  352. udelay (1);
  353. bc_ds1620_set_clk (1);
  354. udelay (1);
  355. value >>= 1;
  356. }
  357. }
  358. static unsigned int ds1620_recv_bits (int nr)
  359. {
  360. unsigned int value = 0, mask = 1;
  361. int i;
  362. bc_ds1620_set_data (0);
  363. for (i = 0; i < nr; i++) {
  364. bc_ds1620_set_clk (0);
  365. udelay (1);
  366. if (bc_ds1620_get_data ())
  367. value |= mask;
  368. mask <<= 1;
  369. bc_ds1620_set_clk (1);
  370. udelay (1);
  371. }
  372. return value;
  373. }
  374. static void ds1620_out (int cmd, int bits, int value)
  375. {
  376. bc_ds1620_set_clk (1);
  377. bc_ds1620_set_data_dir (0);
  378. bc_ds1620_set_reset (0);
  379. udelay (1);
  380. bc_ds1620_set_reset (1);
  381. udelay (1);
  382. ds1620_send_bits (8, cmd);
  383. if (bits)
  384. ds1620_send_bits (bits, value);
  385. udelay (1);
  386. /* go stand alone */
  387. bc_ds1620_set_data_dir (1);
  388. bc_ds1620_set_reset (0);
  389. bc_ds1620_set_clk (0);
  390. udelay (10000);
  391. }
  392. static unsigned int ds1620_in (int cmd, int bits)
  393. {
  394. unsigned int value;
  395. bc_ds1620_set_clk (1);
  396. bc_ds1620_set_data_dir (0);
  397. bc_ds1620_set_reset (0);
  398. udelay (1);
  399. bc_ds1620_set_reset (1);
  400. udelay (1);
  401. ds1620_send_bits (8, cmd);
  402. bc_ds1620_set_data_dir (1);
  403. value = ds1620_recv_bits (bits);
  404. /* go stand alone */
  405. bc_ds1620_set_data_dir (1);
  406. bc_ds1620_set_reset (0);
  407. bc_ds1620_set_clk (0);
  408. return value;
  409. }
  410. static int cvt_9_to_int (unsigned int val)
  411. {
  412. if (val & 0x100)
  413. val |= 0xfffffe00;
  414. return val;
  415. }
  416. /* set thermostate thresholds */
  417. static void ds1620_write_state (struct therm *therm)
  418. {
  419. ds1620_out (THERM_WRITE_TL, 9, therm->lo);
  420. ds1620_out (THERM_WRITE_TH, 9, therm->hi);
  421. ds1620_out (THERM_START_CONVERT, 0, 0);
  422. }
  423. static int cmd_temp (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  424. {
  425. int i;
  426. struct therm therm;
  427. sm501_gpio_init ();
  428. /* print temperature */
  429. if (argc == 1) {
  430. i = cvt_9_to_int (ds1620_in (THERM_READ_TEMP, 9));
  431. printf ("%d.%d C\n", i >> 1, i & 1 ? 5 : 0);
  432. return 0;
  433. }
  434. /* set to default operation */
  435. if (strncmp (argv[1], "set", 3) == 0) {
  436. if (strncmp (argv[2], "default", 3) == 0) {
  437. therm.hi = +88;
  438. therm.lo = -20;
  439. therm.hi <<= 1;
  440. therm.lo <<= 1;
  441. ds1620_write_state (&therm);
  442. ds1620_out (THERM_WRITE_CONFIG, 8, CFG_STANDALONE);
  443. return 0;
  444. }
  445. }
  446. printf ("Usage:%s\n", cmdtp->help);
  447. return 1;
  448. }
  449. U_BOOT_CMD (temp, 3, 1, cmd_temp,
  450. "temp - print current temperature\n",
  451. "\n" "temp\n" " - print current temperature\n");
  452. #ifdef CONFIG_BC3450_CAN
  453. /*
  454. * Initialise CAN interface
  455. *
  456. * return 1 on CAN initialization failure
  457. * return 0 if no failure
  458. */
  459. int can_init (void)
  460. {
  461. static int init_done = 0;
  462. int i;
  463. struct mpc5xxx_mscan *can1 =
  464. (struct mpc5xxx_mscan *) (CFG_MBAR + 0x0900);
  465. struct mpc5xxx_mscan *can2 =
  466. (struct mpc5xxx_mscan *) (CFG_MBAR + 0x0980);
  467. /* GPIO configuration of the CAN pins is done in BC3450.h */
  468. if (!init_done) {
  469. /* init CAN 1 */
  470. can1->canctl1 |= 0x80; /* CAN enable */
  471. udelay (100);
  472. i = 0;
  473. can1->canctl0 |= 0x02; /* sleep mode */
  474. /* wait until sleep mode reached */
  475. while (!(can1->canctl1 & 0x02)) {
  476. udelay (10);
  477. i++;
  478. if (i == 10) {
  479. printf ("%s: CAN1 initialize error, "
  480. "can not enter sleep mode!\n",
  481. __FUNCTION__);
  482. return 1;
  483. }
  484. }
  485. i = 0;
  486. can1->canctl0 = 0x01; /* enter init mode */
  487. /* wait until init mode reached */
  488. while (!(can1->canctl1 & 0x01)) {
  489. udelay (10);
  490. i++;
  491. if (i == 10) {
  492. printf ("%s: CAN1 initialize error, "
  493. "can not enter init mode!\n",
  494. __FUNCTION__);
  495. return 1;
  496. }
  497. }
  498. can1->canctl1 = 0x80;
  499. can1->canctl1 |= 0x40;
  500. can1->canbtr0 = 0x0F;
  501. can1->canbtr1 = 0x7F;
  502. can1->canidac &= ~(0x30);
  503. can1->canidar1 = 0x00;
  504. can1->canidar3 = 0x00;
  505. can1->canidar5 = 0x00;
  506. can1->canidar7 = 0x00;
  507. can1->canidmr0 = 0xFF;
  508. can1->canidmr1 = 0xFF;
  509. can1->canidmr2 = 0xFF;
  510. can1->canidmr3 = 0xFF;
  511. can1->canidmr4 = 0xFF;
  512. can1->canidmr5 = 0xFF;
  513. can1->canidmr6 = 0xFF;
  514. can1->canidmr7 = 0xFF;
  515. i = 0;
  516. can1->canctl0 &= ~(0x01); /* leave init mode */
  517. can1->canctl0 &= ~(0x02);
  518. /* wait until init and sleep mode left */
  519. while ((can1->canctl1 & 0x01) || (can1->canctl1 & 0x02)) {
  520. udelay (10);
  521. i++;
  522. if (i == 10) {
  523. printf ("%s: CAN1 initialize error, "
  524. "can not leave init/sleep mode!\n",
  525. __FUNCTION__);
  526. return 1;
  527. }
  528. }
  529. /* init CAN 2 */
  530. can2->canctl1 |= 0x80; /* CAN enable */
  531. udelay (100);
  532. i = 0;
  533. can2->canctl0 |= 0x02; /* sleep mode */
  534. /* wait until sleep mode reached */
  535. while (!(can2->canctl1 & 0x02)) {
  536. udelay (10);
  537. i++;
  538. if (i == 10) {
  539. printf ("%s: CAN2 initialize error, "
  540. "can not enter sleep mode!\n",
  541. __FUNCTION__);
  542. return 1;
  543. }
  544. }
  545. i = 0;
  546. can2->canctl0 = 0x01; /* enter init mode */
  547. /* wait until init mode reached */
  548. while (!(can2->canctl1 & 0x01)) {
  549. udelay (10);
  550. i++;
  551. if (i == 10) {
  552. printf ("%s: CAN2 initialize error, "
  553. "can not enter init mode!\n",
  554. __FUNCTION__);
  555. return 1;
  556. }
  557. }
  558. can2->canctl1 = 0x80;
  559. can2->canctl1 |= 0x40;
  560. can2->canbtr0 = 0x0F;
  561. can2->canbtr1 = 0x7F;
  562. can2->canidac &= ~(0x30);
  563. can2->canidar1 = 0x00;
  564. can2->canidar3 = 0x00;
  565. can2->canidar5 = 0x00;
  566. can2->canidar7 = 0x00;
  567. can2->canidmr0 = 0xFF;
  568. can2->canidmr1 = 0xFF;
  569. can2->canidmr2 = 0xFF;
  570. can2->canidmr3 = 0xFF;
  571. can2->canidmr4 = 0xFF;
  572. can2->canidmr5 = 0xFF;
  573. can2->canidmr6 = 0xFF;
  574. can2->canidmr7 = 0xFF;
  575. can2->canctl0 &= ~(0x01); /* leave init mode */
  576. can2->canctl0 &= ~(0x02);
  577. i = 0;
  578. /* wait until init mode left */
  579. while ((can2->canctl1 & 0x01) || (can2->canctl1 & 0x02)) {
  580. udelay (10);
  581. i++;
  582. if (i == 10) {
  583. printf ("%s: CAN2 initialize error, "
  584. "can not leave init/sleep mode!\n",
  585. __FUNCTION__);
  586. return 1;
  587. }
  588. }
  589. init_done = 1;
  590. }
  591. return 0;
  592. }
  593. /*
  594. * Do CAN test
  595. * by sending message between CAN1 and CAN2
  596. *
  597. * return 1 on CAN failure
  598. * return 0 if no failure
  599. */
  600. int do_can (char *argv[])
  601. {
  602. int i;
  603. struct mpc5xxx_mscan *can1 =
  604. (struct mpc5xxx_mscan *) (CFG_MBAR + 0x0900);
  605. struct mpc5xxx_mscan *can2 =
  606. (struct mpc5xxx_mscan *) (CFG_MBAR + 0x0980);
  607. /* send a message on CAN1 */
  608. can1->cantbsel = 0x01;
  609. can1->cantxfg.idr[0] = 0x55;
  610. can1->cantxfg.idr[1] = 0x00;
  611. can1->cantxfg.idr[1] &= ~0x8;
  612. can1->cantxfg.idr[1] &= ~0x10;
  613. can1->cantxfg.dsr[0] = 0xCC;
  614. can1->cantxfg.dlr = 1;
  615. can1->cantxfg.tbpr = 0;
  616. can1->cantflg = 0x01;
  617. i = 0;
  618. while ((can1->cantflg & 0x01) == 0) {
  619. i++;
  620. if (i == 10) {
  621. printf ("%s: CAN1 send timeout, "
  622. "can not send message!\n", __FUNCTION__);
  623. return 1;
  624. }
  625. udelay (1000);
  626. }
  627. udelay (1000);
  628. i = 0;
  629. while (!(can2->canrflg & 0x01)) {
  630. i++;
  631. if (i == 10) {
  632. printf ("%s: CAN2 receive timeout, "
  633. "no message received!\n", __FUNCTION__);
  634. return 1;
  635. }
  636. udelay (1000);
  637. }
  638. if (can2->canrxfg.dsr[0] != 0xCC) {
  639. printf ("%s: CAN2 receive error, "
  640. "data mismatch!\n", __FUNCTION__);
  641. return 1;
  642. }
  643. /* send a message on CAN2 */
  644. can2->cantbsel = 0x01;
  645. can2->cantxfg.idr[0] = 0x55;
  646. can2->cantxfg.idr[1] = 0x00;
  647. can2->cantxfg.idr[1] &= ~0x8;
  648. can2->cantxfg.idr[1] &= ~0x10;
  649. can2->cantxfg.dsr[0] = 0xCC;
  650. can2->cantxfg.dlr = 1;
  651. can2->cantxfg.tbpr = 0;
  652. can2->cantflg = 0x01;
  653. i = 0;
  654. while ((can2->cantflg & 0x01) == 0) {
  655. i++;
  656. if (i == 10) {
  657. printf ("%s: CAN2 send error, "
  658. "can not send message!\n", __FUNCTION__);
  659. return 1;
  660. }
  661. udelay (1000);
  662. }
  663. udelay (1000);
  664. i = 0;
  665. while (!(can1->canrflg & 0x01)) {
  666. i++;
  667. if (i == 10) {
  668. printf ("%s: CAN1 receive timeout, "
  669. "no message received!\n", __FUNCTION__);
  670. return 1;
  671. }
  672. udelay (1000);
  673. }
  674. if (can1->canrxfg.dsr[0] != 0xCC) {
  675. printf ("%s: CAN1 receive error 0x%02x\n",
  676. __FUNCTION__, (can1->canrxfg.dsr[0]));
  677. return 1;
  678. }
  679. return 0;
  680. }
  681. #endif /* CONFIG_BC3450_CAN */
  682. /*
  683. * test - BC3450 HW test routines
  684. */
  685. int cmd_test (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  686. {
  687. #ifdef CONFIG_BC3450_CAN
  688. int rcode;
  689. can_init ();
  690. #endif /* CONFIG_BC3450_CAN */
  691. sm501_gpio_init ();
  692. if (argc != 2) {
  693. printf ("Usage:%s\n", cmdtp->help);
  694. return 1;
  695. }
  696. if (strncmp (argv[1], "unit-off", 8) == 0) {
  697. printf ("waiting 2 seconds...\n");
  698. udelay (2000000);
  699. *(vu_long *) (SM501_MMIO_BASE + SM501_GPIO_DATA_HIGH) &=
  700. ~PWR_OFF;
  701. return 0;
  702. }
  703. #ifdef CONFIG_BC3450_CAN
  704. else if (strncmp (argv[1], "can", 2) == 0) {
  705. rcode = do_can (argv);
  706. if (simple_strtoul (argv[2], NULL, 10) == 2) {
  707. if (rcode == 0)
  708. printf ("OK\n");
  709. else
  710. printf ("Error\n");
  711. }
  712. return rcode;
  713. }
  714. #endif /* CONFIG_BC3450_CAN */
  715. printf ("Usage:%s\n", cmdtp->help);
  716. return 1;
  717. }
  718. U_BOOT_CMD (test, 2, 1, cmd_test, "test - unit test routines\n", "\n"
  719. #ifdef CONFIG_BC3450_CAN
  720. "test can\n"
  721. " - connect CAN1 (X8) with CAN2 (X9) for this test\n"
  722. #endif /* CONFIG_BC3450_CAN */
  723. "test unit-off\n"
  724. " - turns off the BC3450 unit\n"
  725. " WARNING: Unsaved environment variables will be lost!\n");
  726. #endif