src/jtag/drivers/stlink_usb.c (OpenOCD)

Outline

#include "config.h"

#include <helper/align.h>

#include <helper/binarybuffer.h>

#include <helper/bits.h>

#include <helper/system.h>

#include <helper/time_support.h>

#include <jtag/adapter.h>

#include <jtag/interface.h>

#include <jtag/hla/hla_layout.h>

#include <jtag/hla/hla_transport.h>

#include <jtag/hla/hla_interface.h>

#include <jtag/swim.h>

#include <target/arm_adi_v5.h>

#include <target/target.h>

#include <transport/transport.h>

#include <target/cortex_m.h>

#include <helper/system.h>

#include <arpa/inet.h>

#include <netinet/tcp.h>

#include "libusb_helper.h"

#define USE_LIBUSB_ASYNCIO

#define STLINK_SERIAL_LEN

#define ENDPOINT_IN

#define ENDPOINT_OUT

#define STLINK_WRITE_TIMEOUT

#define STLINK_READ_TIMEOUT

#define STLINK_RX_EP

#define STLINK_TX_EP

#define STLINK_TRACE_EP

#define STLINK_V2_1_TX_EP

#define STLINK_V2_1_TRACE_EP

#define STLINK_SG_SIZE

#define STLINK_DATA_SIZE

#define STLINK_CMD_SIZE_V2

#define STLINK_CMD_SIZE_V1

#define STLINK_V1_PID

#define STLINK_V2_PID

#define STLINK_V2_1_PID

#define STLINK_V2_1_NO_MSD_PID

#define STLINK_V3_USBLOADER_PID

#define STLINK_V3E_PID

#define STLINK_V3S_PID

#define STLINK_V3_2VCP_PID

#define STLINK_V3E_NO_MSD_PID

#define STLINK_V3P_USBLOADER_PID

#define STLINK_V3P_PID

#define STLINK_MAX_RW8

#define STLINKV3_MAX_RW8

#define STLINK_MAX_RW16_32

#define STLINK_SWIM_DATA_SIZE

#define MAX_WAIT_RETRIES

#define STLINK_HLA_AP_NUM

#define STLINK_HLA_CSW

stlink_jtag_api_version

stlink_mode

stlink_usb_version

stlink_usb_priv

stlink_tcp_version

stlink_tcp_priv

stlink_backend

#define MAX_QUEUE_DEPTH

queue_cmd

#define CMD_MEM_AP_2_SIZE

dap_queue

stlink_usb_handle

stlink_usb_open(void *, struct hl_interface_param *)

stlink_usb_close(void *)

stlink_usb_xfer_noerrcheck(void *, const uint8_t *, int)

#define STLINK_SWIM_ERR_OK

#define STLINK_SWIM_BUSY

#define STLINK_DEBUG_ERR_OK

#define STLINK_DEBUG_ERR_FAULT

#define STLINK_SWD_AP_WAIT

#define STLINK_SWD_AP_FAULT

#define STLINK_SWD_AP_ERROR

#define STLINK_SWD_AP_PARITY_ERROR

#define STLINK_JTAG_GET_IDCODE_ERROR

#define STLINK_JTAG_WRITE_ERROR

#define STLINK_JTAG_WRITE_VERIF_ERROR

#define STLINK_SWD_DP_WAIT

#define STLINK_SWD_DP_FAULT

#define STLINK_SWD_DP_ERROR

#define STLINK_SWD_DP_PARITY_ERROR

#define STLINK_SWD_AP_WDATA_ERROR

#define STLINK_SWD_AP_STICKY_ERROR

#define STLINK_SWD_AP_STICKYORUN_ERROR

#define STLINK_BAD_AP_ERROR

#define STLINK_CORE_RUNNING

#define STLINK_CORE_HALTED

#define STLINK_CORE_STAT_UNKNOWN

#define STLINK_GET_VERSION

#define STLINK_DEBUG_COMMAND

#define STLINK_DFU_COMMAND

#define STLINK_SWIM_COMMAND

#define STLINK_GET_CURRENT_MODE

#define STLINK_GET_TARGET_VOLTAGE

#define STLINK_DEV_DFU_MODE

#define STLINK_DEV_MASS_MODE

#define STLINK_DEV_DEBUG_MODE

#define STLINK_DEV_SWIM_MODE

#define STLINK_DEV_BOOTLOADER_MODE

#define STLINK_DEV_UNKNOWN_MODE

#define STLINK_DFU_EXIT

#define STLINK_SWIM_ENTER

#define STLINK_SWIM_EXIT

#define STLINK_SWIM_READ_CAP

#define STLINK_SWIM_SPEED

#define STLINK_SWIM_ENTER_SEQ

#define STLINK_SWIM_GEN_RST

#define STLINK_SWIM_RESET

#define STLINK_SWIM_ASSERT_RESET

#define STLINK_SWIM_DEASSERT_RESET

#define STLINK_SWIM_READSTATUS

#define STLINK_SWIM_WRITEMEM

#define STLINK_SWIM_READMEM

#define STLINK_SWIM_READBUF

#define STLINK_DEBUG_GETSTATUS

#define STLINK_DEBUG_FORCEDEBUG

#define STLINK_DEBUG_APIV1_RESETSYS

#define STLINK_DEBUG_APIV1_READALLREGS

#define STLINK_DEBUG_APIV1_READREG

#define STLINK_DEBUG_APIV1_WRITEREG

#define STLINK_DEBUG_READMEM_32BIT

#define STLINK_DEBUG_WRITEMEM_32BIT

#define STLINK_DEBUG_RUNCORE

#define STLINK_DEBUG_STEPCORE

#define STLINK_DEBUG_APIV1_SETFP

#define STLINK_DEBUG_READMEM_8BIT

#define STLINK_DEBUG_WRITEMEM_8BIT

#define STLINK_DEBUG_APIV1_CLEARFP

#define STLINK_DEBUG_APIV1_WRITEDEBUGREG

#define STLINK_DEBUG_APIV1_SETWATCHPOINT

#define STLINK_DEBUG_ENTER_JTAG_RESET

#define STLINK_DEBUG_ENTER_SWD_NO_RESET

#define STLINK_DEBUG_ENTER_JTAG_NO_RESET

#define STLINK_DEBUG_APIV1_ENTER

#define STLINK_DEBUG_EXIT

#define STLINK_DEBUG_READCOREID

#define STLINK_DEBUG_APIV2_ENTER

#define STLINK_DEBUG_APIV2_READ_IDCODES

#define STLINK_DEBUG_APIV2_RESETSYS

#define STLINK_DEBUG_APIV2_READREG

#define STLINK_DEBUG_APIV2_WRITEREG

#define STLINK_DEBUG_APIV2_WRITEDEBUGREG

#define STLINK_DEBUG_APIV2_READDEBUGREG

#define STLINK_DEBUG_APIV2_READALLREGS

#define STLINK_DEBUG_APIV2_GETLASTRWSTATUS

#define STLINK_DEBUG_APIV2_DRIVE_NRST

#define STLINK_DEBUG_APIV2_GETLASTRWSTATUS2

#define STLINK_DEBUG_APIV2_START_TRACE_RX

#define STLINK_DEBUG_APIV2_STOP_TRACE_RX

#define STLINK_DEBUG_APIV2_GET_TRACE_NB

#define STLINK_DEBUG_APIV2_SWD_SET_FREQ

#define STLINK_DEBUG_APIV2_JTAG_SET_FREQ

#define STLINK_DEBUG_APIV2_READ_DAP_REG

#define STLINK_DEBUG_APIV2_WRITE_DAP_REG

#define STLINK_DEBUG_APIV2_READMEM_16BIT

#define STLINK_DEBUG_APIV2_WRITEMEM_16BIT

#define STLINK_DEBUG_APIV2_INIT_AP

#define STLINK_DEBUG_APIV2_CLOSE_AP_DBG

#define STLINK_DEBUG_WRITEMEM_32BIT_NO_ADDR_INC

#define STLINK_DEBUG_APIV2_RW_MISC_OUT

#define STLINK_DEBUG_APIV2_RW_MISC_IN

#define STLINK_DEBUG_READMEM_32BIT_NO_ADDR_INC

#define STLINK_APIV3_SET_COM_FREQ

#define STLINK_APIV3_GET_COM_FREQ

#define STLINK_APIV3_GET_VERSION_EX

#define STLINK_DEBUG_APIV2_DRIVE_NRST_LOW

#define STLINK_DEBUG_APIV2_DRIVE_NRST_HIGH

#define STLINK_DEBUG_APIV2_DRIVE_NRST_PULSE

#define STLINK_DEBUG_PORT_ACCESS

#define STLINK_TRACE_SIZE

#define STLINK_TRACE_MAX_HZ

#define STLINK_V3_TRACE_MAX_HZ

#define STLINK_V3_MAX_FREQ_NB

#define REQUEST_SENSE

#define REQUEST_SENSE_LENGTH

#define STLINK_TCP_CMD_REFRESH_DEVICE_LIST

#define STLINK_TCP_CMD_GET_NB_DEV

#define STLINK_TCP_CMD_GET_DEV_INFO

#define STLINK_TCP_CMD_OPEN_DEV

#define STLINK_TCP_CMD_CLOSE_DEV

#define STLINK_TCP_CMD_SEND_USB_CMD

#define STLINK_TCP_CMD_GET_SERVER_VERSION

#define STLINK_TCP_CMD_GET_NB_OF_DEV_CLIENTS

#define OPENOCD_STLINK_TCP_API_VERSION

#define STLINK_TCP_REQUEST_WRITE

#define STLINK_TCP_REQUEST_READ

#define STLINK_TCP_REQUEST_READ_SWO

#define STLINK_TCP_SS_SIZE

#define STLINK_TCP_USB_CMD_SIZE

#define STLINK_TCP_SERIAL_SIZE

#define STLINK_TCP_SEND_BUFFER_SIZE

#define STLINK_TCP_RECV_BUFFER_SIZE

#define STLINK_TCP_SS_OK

#define STLINK_TCP_SS_MEMORY_PROBLEM

#define STLINK_TCP_SS_TIMEOUT

#define STLINK_TCP_SS_BAD_PARAMETER

#define STLINK_TCP_SS_OPEN_ERR

#define STLINK_TCP_SS_TRUNCATED_DATA

#define STLINK_TCP_SS_CMD_NOT_AVAILABLE

#define STLINK_TCP_SS_TCP_ERROR

#define STLINK_TCP_SS_TCP_CANT_CONNECT

#define STLINK_TCP_SS_TCP_CLOSE_ERROR

#define STLINK_TCP_SS_TCP_BUSY

#define STLINK_TCP_SS_WIN32_ERROR

#define STLINK_F_HAS_TRACE

#define STLINK_F_HAS_GETLASTRWSTATUS2

#define STLINK_F_HAS_SWD_SET_FREQ

#define STLINK_F_HAS_JTAG_SET_FREQ

#define STLINK_F_QUIRK_JTAG_DP_READ

#define STLINK_F_HAS_DAP_REG

#define STLINK_F_HAS_MEM_16BIT

#define STLINK_F_HAS_AP_INIT

#define STLINK_F_FIX_CLOSE_AP

#define STLINK_F_HAS_DPBANKSEL

#define STLINK_F_HAS_RW8_512BYTES

#define STLINK_F_HAS_TARGET_VOLT

#define STLINK_F_HAS_FPU_REG

#define STLINK_F_HAS_MEM_WR_NO_INC

#define STLINK_F_HAS_MEM_RD_NO_INC

#define STLINK_F_HAS_RW_MISC

#define STLINK_F_HAS_CSW

#define STLINK_REGSEL_IS_FPU

speed_map

stlink_khz_to_speed_map_swd

stlink_khz_to_speed_map_jtag

stlink_usb_block(void *)

sync_transfer_cb(struct libusb_transfer *)

sync_transfer_wait_for_completion(struct libusb_transfer *)

transfer_error_status(const struct libusb_transfer *)

jtag_xfer

jtag_libusb_bulk_transfer_n(struct libusb_device_handle *, struct jtag_xfer *, size_t, int)

stlink_usb_xfer_v1_get_status(void *)

stlink_usb_xfer_rw(void *, int, const uint8_t *, int)

stlink_usb_xfer_v1_get_sense(void *)

stlink_usb_usb_read_trace(void *, const uint8_t *, int)

stlink_usb_usb_xfer_noerrcheck(void *, const uint8_t *, int)

stlink_tcp_send_cmd(void *, int, int, bool)

stlink_tcp_xfer_noerrcheck(void *, const uint8_t *, int)

stlink_tcp_read_trace(void *, const uint8_t *, int)

stlink_usb_error_check(void *)

stlink_usb_xfer_errcheck(void *, const uint8_t *, int)

stlink_cmd_allow_retry(void *, const uint8_t *, int)

stlink_usb_read_trace(void *, const uint8_t *, int)

stlink_usb_set_cbw_transfer_datalength(void *, uint32_t)

stlink_usb_xfer_v1_create_cmd(void *, uint8_t, uint32_t)

stlink_usb_init_buffer(void *, uint8_t, uint32_t)

stlink_usb_version(void *)

stlink_usb_check_voltage(void *, float *)

stlink_usb_set_swdclk(void *, uint16_t)

stlink_usb_set_jtagclk(void *, uint16_t)

stlink_usb_current_mode(void *, uint8_t *)

stlink_usb_mode_enter(void *, enum stlink_mode)

stlink_usb_mode_leave(void *, enum stlink_mode)

stlink_get_mode(enum hl_transports)

stlink_usb_exit_mode(void *)

stlink_usb_init_mode(void *, bool, int)

stlink_swim_status(void *)

stlink_swim_cap(void *, uint8_t *)

stlink_swim_assert_reset(void *, int)

stlink_swim_enter(void *)

stlink_swim_speed(void *, int)

stlink_swim_generate_rst(void *)

stlink_swim_resync(void *)

stlink_swim_writebytes(void *, uint32_t, uint32_t, const uint8_t *)

stlink_swim_readbytes(void *, uint32_t, uint32_t, uint8_t *)

stlink_usb_idcode(void *, uint32_t *)

stlink_usb_v2_read_debug_reg(void *, uint32_t, uint32_t *)

stlink_usb_write_debug_reg(void *, uint32_t, uint32_t)

stlink_usb_trace_read(void *, uint8_t *, size_t *)

stlink_usb_v2_get_status(void *)

stlink_usb_state(void *)

stlink_usb_assert_srst(void *, int)

stlink_usb_trace_disable(void *)

stlink_usb_trace_enable(void *)

stlink_usb_reset(void *)

stlink_usb_run(void *)

stlink_usb_halt(void *)

stlink_usb_step(void *)

stlink_usb_read_regs(void *)

stlink_usb_read_reg(void *, unsigned int, uint32_t *)

stlink_usb_write_reg(void *, unsigned int, uint32_t)

stlink_usb_get_rw_status(void *)

stlink_usb_read_mem8(void *, uint8_t, uint32_t, uint32_t, uint16_t, uint8_t *)

stlink_usb_write_mem8(void *, uint8_t, uint32_t, uint32_t, uint16_t, const uint8_t *)

stlink_usb_read_mem16(void *, uint8_t, uint32_t, uint32_t, uint16_t, uint8_t *)

stlink_usb_write_mem16(void *, uint8_t, uint32_t, uint32_t, uint16_t, const uint8_t *)

stlink_usb_read_mem32(void *, uint8_t, uint32_t, uint32_t, uint16_t, uint8_t *)

stlink_usb_write_mem32(void *, uint8_t, uint32_t, uint32_t, uint16_t, const uint8_t *)

stlink_usb_read_mem32_noaddrinc(void *, uint8_t, uint32_t, uint32_t, uint16_t, uint8_t *)

stlink_usb_write_mem32_noaddrinc(void *, uint8_t, uint32_t, uint32_t, uint16_t, const uint8_t *)

stlink_max_block_size(uint32_t, uint32_t)

stlink_usb_read_ap_mem(void *, uint8_t, uint32_t, uint32_t, uint32_t, uint32_t, uint8_t *)

stlink_usb_read_mem(void *, uint32_t, uint32_t, uint32_t, uint8_t *)

stlink_usb_write_ap_mem(void *, uint8_t, uint32_t, uint32_t, uint32_t, uint32_t, const uint8_t *)

stlink_usb_write_mem(void *, uint32_t, uint32_t, uint32_t, const uint8_t *)

stlink_usb_override_target(const char *)

stlink_speed_swim(void *, int, bool)

stlink_match_speed_map(const struct speed_map *, unsigned int, int, bool)

stlink_speed_swd(void *, int, bool)

stlink_speed_jtag(void *, int, bool)

stlink_dump_speed_map(const struct speed_map *, unsigned int)

stlink_get_com_freq(void *, bool, struct speed_map *)

stlink_set_com_freq(void *, bool, unsigned int)

stlink_speed_v3(void *, bool, int, bool)

stlink_speed(void *, int, bool)

stlink_usb_usb_close(void *)

stlink_tcp_close(void *)

stlink_close(void *)

stlink_usb_get_alternate_serial(struct libusb_device_handle *, struct libusb_device_descriptor *)

stlink_usb_usb_open(void *, struct hl_interface_param *)

stlink_tcp_open(void *, struct hl_interface_param *)

stlink_usb_backend

stlink_tcp_backend

stlink_open(struct hl_interface_param *, enum stlink_mode, void **)

stlink_usb_hl_open(struct hl_interface_param *, void **)

stlink_config_trace(void *, bool, enum tpiu_pin_protocol, uint32_t, unsigned int *, unsigned int, uint16_t *)

stlink_usb_init_access_port(void *, unsigned char)

stlink_usb_close_access_port(void *, unsigned char)

stlink_usb_rw_misc_out(void *, uint32_t, const uint8_t *)

stlink_usb_rw_misc_in(void *, uint32_t, uint8_t *)

stlink_read_dap_register(void *, unsigned short, unsigned short, uint32_t *)

stlink_write_dap_register(void *, unsigned short, unsigned short, uint32_t)

stlink_usb_layout_api

stlink_dap_handle

stlink_dap_param

opened_ap

last_csw_default

stlink_dap_error

stlink_dap_record_error(int)

stlink_dap_get_and_clear_error()

stlink_dap_get_error()

stlink_usb_open_ap(void *, unsigned short)

stlink_dap_open_ap(unsigned short)

stlink_dap_closeall_ap()

stlink_dap_reinit_interface()

stlink_dap_op_connect(struct adiv5_dap *)

stlink_dap_check_reconnect(struct adiv5_dap *)

stlink_dap_op_send_sequence(struct adiv5_dap *, enum swd_special_seq)

stlink_dap_dp_read(struct adiv5_dap *, unsigned int, uint32_t *)

stlink_dap_dp_write(struct adiv5_dap *, unsigned int, uint32_t)

stlink_dap_ap_read(struct adiv5_ap *, unsigned int, uint32_t *)

stlink_dap_ap_write(struct adiv5_ap *, unsigned int, uint32_t)

stlink_dap_op_queue_ap_abort(struct adiv5_dap *, uint8_t *)

#define RW_MISC_CMD_ADDRESS

#define RW_MISC_CMD_WRITE

#define RW_MISC_CMD_READ

#define RW_MISC_CMD_APNUM

stlink_usb_misc_rw_segment(void *, const struct dap_queue *, unsigned int, unsigned int)

stlink_usb_buf_rw_segment(void *, const struct dap_queue *, unsigned int)

#define STLINK_V2_RW_MISC_SIZE

#define STLINK_V3_RW_MISC_SIZE

stlink_usb_count_misc_rw_queue(void *, const struct dap_queue *, unsigned int, unsigned int *)

stlink_usb_count_buf_rw_queue(const struct dap_queue *, unsigned int)

stlink_usb_mem_rw_queue(void *, const struct dap_queue *, unsigned int, unsigned int *)

stlink_dap_run_internal(struct adiv5_dap *)

stlink_dap_run_finalize(struct adiv5_dap *)

stlink_dap_op_queue_run(struct adiv5_dap *)

stlink_dap_op_quit(struct adiv5_dap *)

stlink_dap_op_queue_dp_read(struct adiv5_dap *, unsigned int, uint32_t *)

stlink_dap_op_queue_dp_write(struct adiv5_dap *, unsigned int, uint32_t)

stlink_dap_op_queue_ap_read(struct adiv5_ap *, unsigned int, uint32_t *)

stlink_dap_op_queue_ap_write(struct adiv5_ap *, unsigned int, uint32_t)

stlink_swim_op_srst()

stlink_swim_op_read_mem(uint32_t, uint32_t, uint32_t, uint8_t *)

stlink_swim_op_write_mem(uint32_t, uint32_t, uint32_t, const uint8_t *)

stlink_swim_op_reconnect()

stlink_dap_config_trace(bool, enum tpiu_pin_protocol, uint32_t, unsigned int *, unsigned int, uint16_t *)

stlink_dap_trace_read(uint8_t *, size_t *)

stlink_dap_vid_pid(struct command_invocation *)

stlink_dap_backend_command(struct command_invocation *)

#define BYTES_PER_LINE

stlink_dap_cmd_command(struct command_invocation *)

stlink_dap_subcommand_handlers

stlink_dap_command_handlers

stlink_dap_init()

stlink_dap_quit()

stlink_dap_reset(int, int)

stlink_dap_speed(int)

stlink_dap_khz(int, int *)

stlink_dap_speed_div(int, int *)

stlink_dap_ops

stlink_swim_ops

stlink_dap_transport

stlink_dap_adapter_driver

Files

SourceVuDevelopment ToolsOpenOCDsrc/jtag/drivers/stlink_usb.c

100

101

102

103

104

105

106

107

108

109

110

111

112

113

114

115

116

117

118

119

120

121

122

123

124

125

126

127

128

129

130

131

132

133

134

135

136

137

138

139

140

141

142

143

144

145

146

147

148

149

150

151

152

153

154

155

156

157

158

159

160

161

162

163

164

165

166

167

168

169

170

171

172

173

174

175

176

177

178

179

180

181

182

183

184

185

186

187

188

189

190

191

192

193

194

195

196

197

198

199

200

201

202

203

204

205

206

207

208

209

210

211

212

213

214

215

216

217

218

219

220

221

222

223

224

225

226

227

228

229

230

231

232

233

234

235

236

237

238

239

240

241

242

243

244

245

246

247

248

249

250

251

252

253

254

255

256

257

258

259

260

261

262

263

264

265

266

267

268

269

270

271

272

273

274

275

276

277

278

279

280

281

282

283

284

285

286

287

288

289

290

291

292

293

294

295

296

297

298

299

300

301

302

303

304

305

306

307

308

309

310

311

312

313

314

315

316

317

318

319

320

321

322

323

324

325

326

327

328

329

330

331

332

333

334

335

336

337

338

339

340

341

342

343

344

345

346

347

348

349

350

351

352

353

354

355

356

357

358

359

360

361

362

363

364

365

366

367

368

369

370

371

372

373

374

375

376

377

378

379

380

381

382

383

384

385

386

387

388

389

390

391

392

393

394

395

396

397

398

399

400

401

402

403

404

405

406

407

408

409

410

411

412

413

414

415

416

417

418

419

420

421

422

423

424

425

426

427

428

429

430

431

432

433

434

435

436

437

438

439

440

441

442

443

444

445

446

447

448

449

450

451

452

453

454

455

456

457

458

459

460

461

462

463

464

465

466

467

468

469

470

471

472

473

474

475

476

477

478

479

480

481

482

483

484

485

486

487

488

489

490

491

492

493

494

495

496

497

498

499

500

501

502

503

504

505

506

507

508

509

510

511

512

513

514

515

516

517

518

519

520

521

522

523

524

525

526

527

528

529

530

531

532

533

534

535

536

537

538

539

540

541

542

543

544

545

546

547

548

549

550

551

552

553

554

555

556

557

558

559

560

561

562

563

564

565

566

567

568

569

570

571

572

573

574

575

576

577

578

579

580

581

582

583

584

585

586

587

588

589

590

591

592

593

594

595

596

597

598

599

600

601

602

603

604

605

606

607

608

609

610

611

612

613

614

615

616

617

618

619

620

621

622

623

624

625

626

627

628

629

630

631

632

633

634

635

636

637

638

639

640

641

642

643

644

645

646

647

648

649

650

651

652

653

654

655

656

657

658

659

660

661

662

663

664

665

666

667

668

669

670

671

672

673

674

675

676

677

678

679

680

681

682

683

684

685

686

687

688

689

690

691

692

693

694

695

696

697

698

699

700

701

702

703

704

705

706

707

708

709

710

711

712

713

714

715

716

717

718

719

720

721

722

723

724

725

726

727

728

729

730

731

732

733

734

735

736

737

738

739

740

741

742

743

744

745

746

747

748

749

750

751

752

753

754

755

756

757

758

759

760

761

762

763

764

765

766

767

768

769

770

771

772

773

774

775

776

777

778

779

780

781

782

783

784

785

786

787

788

789

790

791

792

793

794

795

796

797

798

799

800

801

802

803

804

805

806

807

808

809

810

811

812

813

814

815

816

817

818

819

820

821

822

823

824

825

826

827

828

829

830

831

832

833

834

835

836

837

838

839

840

841

842

843

844

845

846

847

848

849

850

851

852

853

854

855

856

857

858

859

860

861

862

863

864

865

866

867

868

869

870

871

872

873

874

875

876

877

878

879

880

881

882

883

884

885

886

887

888

889

890

891

892

893

894

895

896

897

898

899

900

901

902

903

904

905

906

907

908

909

910

911

912

913

914

915

916

917

918

919

920

921

922

923

924

925

926

927

928

929

930

931

932

933

934

935

936

937

938

939

940

941

942

943

944

945

946

947

948

949

950

951

952

953

954

955

956

957

958

959

960

961

962

963

964

965

966

967

968

969

970

971

972

973

974

975

976

977

978

979

980

981

982

983

984

985

986

987

988

989

990

991

992

993

994

995

996

997

998

999

1000

1001

1002

1003

1004

1005

1006

1007

1008

1009

1010

1011

1012

1013

1014

1015

1016

1017

1018

1019

1020

1021

1022

1023

1024

1025

1026

1027

1028

1029

1030

1031

1032

1033

1034

1035

1036

1037

1038

1039

1040

1041

1042

1043

1044

1045

1046

1047

1048

1049

1050

1051

1052

1053

1054

1055

1056

1057

1058

1059

1060

1061

1062

1063

1064

1065

1066

1067

1068

1069

1070

1071

1072

1073

1074

1075

1076

1077

1078

1079

1080

1081

1082

1083

1084

1085

1086

1087

1088

1089

1090

1091

1092

1093

1094

1095

1096

1097

1098

1099

1100

1101

1102

1103

1104

1105

1106

1107

1108

1109

1110

1111

1112

1113

1114

1115

1116

1117

1118

1119

1120

1121

1122

1123

1124

1125

1126

1127

1128

1129

1130

1131

1132

1133

1134

1135

1136

1137

1138

1139

1140

1141

1142

1143

1144

1145

1146

1147

1148

1149

1150

1151

1152

1153

1154

1155

1156

1157

1158

1159

1160

1161

1162

1163

1164

1165

1166

1167

1168

1169

1170

1171

1172

1173

1174

1175

1176

1177

1178

1179

1180

1181

1182

1183

1184

1185

1186

1187

1188

1189

1190

1191

1192

1193

1194

1195

1196

1197

1198

1199

1200

1201

1202

1203

1204

1205

1206

1207

1208

1209

1210

1211

1212

1213

1214

1215

1216

1217

1218

1219

1220

1221

1222

1223

1224

1225

1226

1227

1228

1229

1230

1231

1232

1233

1234

1235

1236

1237

1238

1239

1240

1241

1242

1243

1244

1245

1246

1247

1248

1249

1250

1251

1252

1253

1254

1255

1256

1257

1258

1259

1260

1261

1262

1263

1264

1265

1266

1267

1268

1269

1270

1271

1272

1273

1274

1275

1276

1277

1278

1279

1280

1281

1282

1283

1284

1285

1286

1287

1288

1289

1290

1291

1292

1293

1294

1295

1296

1297

1298

1299

1300

1301

1302

1303

1304

1305

1306

1307

1308

1309

1310

1311

1312

1313

1314

1315

1316

1317

1318

1319

1320

1321

1322

1323

1324

1325

1326

1327

1328

1329

1330

1331

1332

1333

1334

1335

1336

1337

1338

1339

1340

1341

1342

1343

1344

1345

1346

1347

1348

1349

1350

1351

1352

1353

1354

1355

1356

1357

1358

1359

1360

1361

1362

1363

1364

1365

1366

1367

1368

1369

1370

1371

1372

1373

1374

1375

1376

1377

1378

1379

1380

1381

1382

1383

1384

1385

1386

1387

1388

1389

1390

1391

1392

1393

1394

1395

1396

1397

1398

1399

1400

1401

1402

1403

1404

1405

1406

1407

1408

1409

1410

1411

1412

1413

1414

1415

1416

1417

1418

1419

1420

1421

1422

1423

1424

1425

1426

1427

1428

1429

1430

1431

1432

1433

1434

1435

1436

1437

1438

1439

1440

1441

1442

1443

1444

1445

1446

1447

1448

1449

1450

1451

1452

1453

1454

1455

1456

1457

1458

1459

1460

1461

1462

1463

1464

1465

1466

1467

1468

1469

1470

1471

1472

1473

1474

1475

1476

1477

1478

1479

1480

1481

1482

1483

1484

1485

1486

1487

1488

1489

1490

1491

1492

1493

1494

1495

1496

1497

1498

1499

1500

1501

1502

1503

1504

1505

1506

1507

1508

1509

1510

1511

1512

1513

1514

1515

1516

1517

1518

1519

1520

1521

1522

1523

1524

1525

1526

1527

1528

1529

1530

1531

1532

1533

1534

1535

1536

1537

1538

1539

1540

1541

1542

1543

1544

1545

1546

1547

1548

1549

1550

1551

1552

1553

1554

1555

1556

1557

1558

1559

1560

1561

1562

1563

1564

1565

1566

1567

1568

1569

1570

1571

1572

1573

1574

1575

1576

1577

1578

1579

1580

1581

1582

1583

1584

1585

1586

1587

1588

1589

1590

1591

1592

1593

1594

1595

1596

1597

1598

1599

1600

1601

1602

1603

1604

1605

1606

1607

1608

1609

1610

1611

1612

1613

1614

1615

1616

1617

1618

1619

1620

1621

1622

1623

1624

1625

1626

1627

1628

1629

1630

1631

1632

1633

1634

1635

1636

1637

1638

1639

1640

1641

1642

1643

1644

1645

1646

1647

1648

1649

1650

1651

1652

1653

1654

1655

1656

1657

1658

1659

1660

1661

1662

1663

1664

1665

1666

1667

1668

1669

1670

1671

1672

1673

1674

1675

1676

1677

1678

1679

1680

1681

1682

1683

1684

1685

1686

1687

1688

1689

1690

1691

1692

1693

1694

1695

1696

1697

1698

1699

1700

1701

1702

1703

1704

1705

1706

1707

1708

1709

1710

1711

1712

1713

1714

1715

1716

1717

1718

1719

1720

1721

1722

1723

1724

1725

1726

1727

1728

1729

1730

1731

1732

1733

1734

1735

1736

1737

1738

1739

1740

1741

1742

1743

1744

1745

1746

1747

1748

1749

1750

1751

1752

1753

1754

1755

1756

1757

1758

1759

1760

1761

1762

1763

1764

1765

1766

1767

1768

1769

1770

1771

1772

1773

1774

1775

1776

1777

1778

1779

1780

1781

1782

1783

1784

1785

1786

1787

1788

1789

1790

1791

1792

1793

1794

1795

1796

1797

1798

1799

1800

1801

1802

1803

1804

1805

1806

1807

1808

1809

1810

1811

1812

1813

1814

1815

1816

1817

1818

1819

1820

1821

1822

1823

1824

1825

1826

1827

1828

1829

1830

1831

1832

1833

1834

1835

1836

1837

1838

1839

1840

1841

1842

1843

1844

1845

1846

1847

1848

1849

1850

1851

1852

1853

1854

1855

1856

1857

1858

1859

1860

1861

1862

1863

1864

1865

1866

1867

1868

1869

1870

1871

1872

1873

1874

1875

1876

1877

1878

1879

1880

1881

1882

1883

1884

1885

1886

1887

1888

1889

1890

1891

1892

1893

1894

1895

1896

1897

1898

1899

1900

1901

1902

1903

1904

1905

1906

1907

1908

1909

1910

1911

1912

1913

1914

1915

1916

1917

1918

1919

1920

1921

1922

1923

1924

1925

1926

1927

1928

1929

1930

1931

1932

1933

1934

1935

1936

1937

1938

1939

1940

1941

1942

1943

1944

1945

1946

1947

1948

1949

1950

1951

1952

1953

1954

1955

1956

1957

1958

1959

1960

1961

1962

1963

1964

1965

1966

1967

1968

1969

1970

1971

1972

1973

1974

1975

1976

1977

1978

1979

1980

1981

1982

1983

1984

1985

1986

1987

1988

1989

1990

1991

1992

1993

1994

1995

1996

1997

1998

1999

2000

2001

2002

2003

2004

2005

2006

2007

2008

2009

2010

2011

2012

2013

2014

2015

2016

2017

2018

2019

2020

2021

2022

2023

2024

2025

2026

2027

2028

2029

2030

2031

2032

2033

2034

2035

2036

2037

2038

2039

2040

2041

2042

2043

2044

2045

2046

2047

2048

2049

2050

2051

2052

2053

2054

2055

2056

2057

2058

2059

2060

2061

2062

2063

2064

2065

2066

2067

2068

2069

2070

2071

2072

2073

2074

2075

2076

2077

2078

2079

2080

2081

2082

2083

2084

2085

2086

2087

2088

2089

2090

2091

2092

2093

2094

2095

2096

2097

2098

2099

2100

2101

2102

2103

2104

2105

2106

2107

2108

2109

2110

2111

2112

2113

2114

2115

2116

2117

2118

2119

2120

2121

2122

2123

2124

2125

2126

2127

2128

2129

2130

2131

2132

2133

2134

2135

2136

2137

2138

2139

2140

2141

2142

2143

2144

2145

2146

2147

2148

2149

2150

2151

2152

2153

2154

2155

2156

2157

2158

2159

2160

2161

2162

2163

2164

2165

2166

2167

2168

2169

2170

2171

2172

2173

2174

2175

2176

2177

2178

2179

2180

2181

2182

2183

2184

2185

2186

2187

2188

2189

2190

2191

2192

2193

2194

2195

2196

2197

2198

2199

2200

2201

2202

2203

2204

2205

2206

2207

2208

2209

2210

2211

2212

2213

2214

2215

2216

2217

2218

2219

2220

2221

2222

2223

2224

2225

2226

2227

2228

2229

2230

2231

2232

2233

2234

2235

2236

2237

2238

2239

2240

2241

2242

2243

2244

2245

2246

2247

2248

2249

2250

2251

2252

2253

2254

2255

2256

2257

2258

2259

2260

2261

2262

2263

2264

2265

2266

2267

2268

2269

2270

2271

2272

2273

2274

2275

2276

2277

2278

2279

2280

2281

2282

2283

2284

2285

2286

2287

2288

2289

2290

2291

2292

2293

2294

2295

2296

2297

2298

2299

2300

2301

2302

2303

2304

2305

2306

2307

2308

2309

2310

2311

2312

2313

2314

2315

2316

2317

2318

2319

2320

2321

2322

2323

2324

2325

2326

2327

2328

2329

2330

2331

2332

2333

2334

2335

2336

2337

2338

2339

2340

2341

2342

2343

2344

2345

2346

2347

2348

2349

2350

2351

2352

2353

2354

2355

2356

2357

2358

2359

2360

2361

2362

2363

2364

2365

2366

2367

2368

2369

2370

2371

2372

2373

2374

2375

2376

2377

2378

2379

2380

2381

2382

2383

2384

2385

2386

2387

2388

2389

2390

2391

2392

2393

2394

2395

2396

2397

2398

2399

2400

2401

2402

2403

2404

2405

2406

2407

2408

2409

2410

2411

2412

2413

2414

2415

2416

2417

2418

2419

2420

2421

2422

2423

2424

2425

2426

2427

2428

2429

2430

2431

2432

2433

2434

2435

2436

2437

2438

2439

2440

2441

2442

2443

2444

2445

2446

2447

2448

2449

2450

2451

2452

2453

2454

2455

2456

2457

2458

2459

2460

2461

2462

2463

2464

2465

2466

2467

2468

2469

2470

2471

2472

2473

2474

2475

2476

2477

2478

2479

2480

2481

2482

2483

2484

2485

2486

2487

2488

2489

2490

2491

2492

2493

2494

2495

2496

2497

2498

2499

2500

2501

2502

2503

2504

2505

2506

2507

2508

2509

2510

2511

2512

2513

2514

2515

2516

2517

2518

2519

2520

2521

2522

2523

2524

2525

2526

2527

2528

2529

2530

2531

2532

2533

2534

2535

2536

2537

2538

2539

2540

2541

2542

2543

2544

2545

2546

2547

2548

2549

2550

2551

2552

2553

2554

2555

2556

2557

2558

2559

2560

2561

2562

2563

2564

2565

2566

2567

2568

2569

2570

2571

2572

2573

2574

2575

2576

2577

2578

2579

2580

2581

2582

2583

2584

2585

2586

2587

2588

2589

2590

2591

2592

2593

2594

2595

2596

2597

2598

2599

2600

2601

2602

2603

2604

2605

2606

2607

2608

2609

2610

2611

2612

2613

2614

2615

2616

2617

2618

2619

2620

2621

2622

2623

2624

2625

2626

2627

2628

2629

2630

2631

2632

2633

2634

2635

2636

2637

2638

2639

2640

2641

2642

2643

2644

2645

2646

2647

2648

2649

2650

2651

2652

2653

2654

2655

2656

2657

2658

2659

2660

2661

2662

2663

2664

2665

2666

2667

2668

2669

2670

2671

2672

2673

2674

2675

2676

2677

2678

2679

2680

2681

2682

2683

2684

2685

2686

2687

2688

2689

2690

2691

2692

2693

2694

2695

2696

2697

2698

2699

2700

2701

2702

2703

2704

2705

2706

2707

2708

2709

2710

2711

2712

2713

2714

2715

2716

2717

2718

2719

2720

2721

2722

2723

2724

2725

2726

2727

2728

2729

2730

2731

2732

2733

2734

2735

2736

2737

2738

2739

2740

2741

2742

2743

2744

2745

2746

2747

2748

2749

2750

2751

2752

2753

2754

2755

2756

2757

2758

2759

2760

2761

2762

2763

2764

2765

2766

2767

2768

2769

2770

2771

2772

2773

2774

2775

2776

2777

2778

2779

2780

2781

2782

2783

2784

2785

2786

2787

2788

2789

2790

2791

2792

2793

2794

2795

2796

2797

2798

2799

2800

2801

2802

2803

2804

2805

2806

2807

2808

2809

2810

2811

2812

2813

2814

2815

2816

2817

2818

2819

2820

2821

2822

2823

2824

2825

2826

2827

2828

2829

2830

2831

2832

2833

2834

2835

2836

2837

2838

2839

2840

2841

2842

2843

2844

2845

2846

2847

2848

2849

2850

2851

2852

2853

2854

2855

2856

2857

2858

2859

2860

2861

2862

2863

2864

2865

2866

2867

2868

2869

2870

2871

2872

2873

2874

2875

2876

2877

2878

2879

2880

2881

2882

2883

2884

2885

2886

2887

2888

2889

2890

2891

2892

2893

2894

2895

2896

2897

2898

2899

2900

2901

2902

2903

2904

2905

2906

2907

2908

2909

2910

2911

2912

2913

2914

2915

2916

2917

2918

2919

2920

2921

2922

2923

2924

2925

2926

2927

2928

2929

2930

2931

2932

2933

2934

2935

2936

2937

2938

2939

2940

2941

2942

2943

2944

2945

2946

2947

2948

2949

2950

2951

2952

2953

2954

2955

2956

2957

2958

2959

2960

2961

2962

2963

2964

2965

2966

2967

2968

2969

2970

2971

2972

2973

2974

2975

2976

2977

2978

2979

2980

2981

2982

2983

2984

2985

2986

2987

2988

2989

2990

2991

2992

2993

2994

2995

2996

2997

2998

2999

3000

3001

3002

3003

3004

3005

3006

3007

3008

3009

3010

3011

3012

3013

3014

3015

3016

3017

3018

3019

3020

3021

3022

3023

3024

3025

3026

3027

3028

3029

3030

3031

3032

3033

3034

3035

3036

3037

3038

3039

3040

3041

3042

3043

3044

3045

3046

3047

3048

3049

3050

3051

3052

3053

3054

3055

3056

3057

3058

3059

3060

3061

3062

3063

3064

3065

3066

3067

3068

3069

3070

3071

3072

3073

3074

3075

3076

3077

3078

3079

3080

3081

3082

3083

3084

3085

3086

3087

3088

3089

3090

3091

3092

3093

3094

3095

3096

3097

3098

3099

3100

3101

3102

3103

3104

3105

3106

3107

3108

3109

3110

3111

3112

3113

3114

3115

3116

3117

3118

3119

3120

3121

3122

3123

3124

3125

3126

3127

3128

3129

3130

3131

3132

3133

3134

3135

3136

3137

3138

3139

3140

3141

3142

3143

3144

3145

3146

3147

3148

3149

3150

3151

3152

3153

3154

3155

3156

3157

3158

3159

3160

3161

3162

3163

3164

3165

3166

3167

3168

3169

3170

3171

3172

3173

3174

3175

3176

3177

3178

3179

3180

3181

3182

3183

3184

3185

3186

3187

3188

3189

3190

3191

3192

3193

3194

3195

3196

3197

3198

3199

3200

3201

3202

3203

3204

3205

3206

3207

3208

3209

3210

3211

3212

3213

3214

3215

3216

3217

3218

3219

3220

3221

3222

3223

3224

3225

3226

3227

3228

3229

3230

3231

3232

3233

3234

3235

3236

3237

3238

3239

3240

3241

3242

3243

3244

3245

3246

3247

3248

3249

3250

3251

3252

3253

3254

3255

3256

3257

3258

3259

3260

3261

3262

3263

3264

3265

3266

3267

3268

3269

3270

3271

3272

3273

3274

3275

3276

3277

3278

3279

3280

3281

3282

3283

3284

3285

3286

3287

3288

3289

3290

3291

3292

3293

3294

3295

3296

3297

3298

3299

3300

3301

3302

3303

3304

3305

3306

3307

3308

3309

3310

3311

3312

3313

3314

3315

3316

3317

3318

3319

3320

3321

3322

3323

3324

3325

3326

3327

3328

3329

3330

3331

3332

3333

3334

3335

3336

3337

3338

3339

3340

3341

3342

3343

3344

3345

3346

3347

3348

3349

3350

3351

3352

3353

3354

3355

3356

3357

3358

3359

3360

3361

3362

3363

3364

3365

3366

3367

3368

3369

3370

3371

3372

3373

3374

3375

3376

3377

3378

3379

3380

3381

3382

3383

3384

3385

3386

3387

3388

3389

3390

3391

3392

3393

3394

3395

3396

3397

3398

3399

3400

3401

3402

3403

3404

3405

3406

3407

3408

3409

3410

3411

3412

3413

3414

3415

3416

3417

3418

3419

3420

3421

3422

3423

3424

3425

3426

3427

3428

3429

3430

3431

3432

3433

3434

3435

3436

3437

3438

3439

3440

3441

3442

3443

3444

3445

3446

3447

3448

3449

3450

3451

3452

3453

3454

3455

3456

3457

3458

3459

3460

3461

3462

3463

3464

3465

3466

3467

3468

3469

3470

3471

3472

3473

3474

3475

3476

3477

3478

3479

3480

3481

3482

3483

3484

3485

3486

3487

3488

3489

3490

3491

3492

3493

3494

3495

3496

3497

3498

3499

3500

3501

3502

3503

3504

3505

3506

3507

3508

3509

3510

3511

3512

3513

3514

3515

3516

3517

3518

3519

3520

3521

3522

3523

3524

3525

3526

3527

3528

3529

3530

3531

3532

3533

3534

3535

3536

3537

3538

3539

3540

3541

3542

3543

3544

3545

3546

3547

3548

3549

3550

3551

3552

3553

3554

3555

3556

3557

3558

3559

3560

3561

3562

3563

3564

3565

3566

3567

3568

3569

3570

3571

3572

3573

3574

3575

3576

3577

3578

3579

3580

3581

3582

3583

3584

3585

3586

3587

3588

3589

3590

3591

3592

3593

3594

3595

3596

3597

3598

3599

3600

3601

3602

3603

3604

3605

3606

3607

3608

3609

3610

3611

3612

3613

3614

3615

3616

3617

3618

3619

3620

3621

3622

3623

3624

3625

3626

3627

3628

3629

3630

3631

3632

3633

3634

3635

3636

3637

3638

3639

3640

3641

3642

3643

3644

3645

3646

3647

3648

3649

3650

3651

3652

3653

3654

3655

3656

3657

3658

3659

3660

3661

3662

3663

3664

3665

3666

3667

3668

3669

3670

3671

3672

3673

3674

3675

3676

3677

3678

3679

3680

3681

3682

3683

3684

3685

3686

3687

3688

3689

3690

3691

3692

3693

3694

3695

3696

3697

3698

3699

3700

3701

3702

3703

3704

3705

3706

3707

3708

3709

3710

3711

3712

3713

3714

3715

3716

3717

3718

3719

3720

3721

3722

3723

3724

3725

3726

3727

3728

3729

3730

3731

3732

3733

3734

3735

3736

3737

3738

3739

3740

3741

3742

3743

3744

3745

3746

3747

3748

3749

3750

3751

3752

3753

3754

3755

3756

3757

3758

3759

3760

3761

3762

3763

3764

3765

3766

3767

3768

3769

3770

3771

3772

3773

3774

3775

3776

3777

3778

3779

3780

3781

3782

3783

3784

3785

3786

3787

3788

3789

3790

3791

3792

3793

3794

3795

3796

3797

3798

3799

3800

3801

3802

3803

3804

3805

3806

3807

3808

3809

3810

3811

3812

3813

3814

3815

3816

3817

3818

3819

3820

3821

3822

3823

3824

3825

3826

3827

3828

3829

3830

3831

3832

3833

3834

3835

3836

3837

3838

3839

3840

3841

3842

3843

3844

3845

3846

3847

3848

3849

3850

3851

3852

3853

3854

3855

3856

3857

3858

3859

3860

3861

3862

3863

3864

3865

3866

3867

3868

3869

3870

3871

3872

3873

3874

3875

3876

3877

3878

3879

3880

3881

3882

3883

3884

3885

3886

3887

3888

3889

3890

3891

3892

3893

3894

3895

3896

3897

3898

3899

3900

3901

3902

3903

3904

3905

3906

3907

3908

3909

3910

3911

3912

3913

3914

3915

3916

3917

3918

3919

3920

3921

3922

3923

3924

3925

3926

3927

3928

3929

3930

3931

3932

3933

3934

3935

3936

3937

3938

3939

3940

3941

3942

3943

3944

3945

3946

3947

3948

3949

3950

3951

3952

3953

3954

3955

3956

3957

3958

3959

3960

3961

3962

3963

3964

3965

3966

3967

3968

3969

3970

3971

3972

3973

3974

3975

3976

3977

3978

3979

3980

3981

3982

3983

3984

3985

3986

3987

3988

3989

3990

3991

3992

3993

3994

3995

3996

3997

3998

3999

4000

4001

4002

4003

4004

4005

4006

4007

4008

4009

4010

4011

4012

4013

4014

4015

4016

4017

4018

4019

4020

4021

4022

4023

4024

4025

4026

4027

4028

4029

4030

4031

4032

4033

4034

4035

4036

4037

4038

4039

4040

4041

4042

4043

4044

4045

4046

4047

4048

4049

4050

4051

4052

4053

4054

4055

4056

4057

4058

4059

4060

4061

4062

4063

4064

4065

4066

4067

4068

4069

4070

4071

4072

4073

4074

4075

4076

4077

4078

4079

4080

4081

4082

4083

4084

4085

4086

4087

4088

4089

4090

4091

4092

4093

4094

4095

4096

4097

4098

4099

4100

4101

4102

4103

4104

4105

4106

4107

4108

4109

4110

4111

4112

4113

4114

4115

4116

4117

4118

4119

4120

4121

4122

4123

4124

4125

4126

4127

4128

4129

4130

4131

4132

4133

4134

4135

4136

4137

4138

4139

4140

4141

4142

4143

4144

4145

4146

4147

4148

4149

4150

4151

4152

4153

4154

4155

4156

4157

4158

4159

4160

4161

4162

4163

4164

4165

4166

4167

4168

4169

4170

4171

4172

4173

4174

4175

4176

4177

4178

4179

4180

4181

4182

4183

4184

4185

4186

4187

4188

4189

4190

4191

4192

4193

4194

4195

4196

4197

4198

4199

4200

4201

4202

4203

4204

4205

4206

4207

4208

4209

4210

4211

4212

4213

4214

4215

4216

4217

4218

4219

4220

4221

4222

4223

4224

4225

4226

4227

4228

4229

4230

4231

4232

4233

4234

4235

4236

4237

4238

4239

4240

4241

4242

4243

4244

4245

4246

4247

4248

4249

4250

4251

4252

4253

4254

4255

4256

4257

4258

4259

4260

4261

4262

4263

4264

4265

4266

4267

4268

4269

4270

4271

4272

4273

4274

4275

4276

4277

4278

4279

4280

4281

4282

4283

4284

4285

4286

4287

4288

4289

4290

4291

4292

4293

4294

4295

4296

4297

4298

4299

4300

4301

4302

4303

4304

4305

4306

4307

4308

4309

4310

4311

4312

4313

4314

4315

4316

4317

4318

4319

4320

4321

4322

4323

4324

4325

4326

4327

4328

4329

4330

4331

4332

4333

4334

4335

4336

4337

4338

4339

4340

4341

4342

4343

4344

4345

4346

4347

4348

4349

4350

4351

4352

4353

4354

4355

4356

4357

4358

4359

4360

4361

4362

4363

4364

4365

4366

4367

4368

4369

4370

4371

4372

4373

4374

4375

4376

4377

4378

4379

4380

4381

4382

4383

4384

4385

4386

4387

4388

4389

4390

4391

4392

4393

4394

4395

4396

4397

4398

4399

4400

4401

4402

4403

4404

4405

4406

4407

4408

4409

4410

4411

4412

4413

4414

4415

4416

4417

4418

4419

4420

4421

4422

4423

4424

4425

4426

4427

4428

4429

4430

4431

4432

4433

4434

4435

4436

4437

4438

4439

4440

4441

4442

4443

4444

4445

4446

4447

4448

4449

4450

4451

4452

4453

4454

4455

4456

4457

4458

4459

4460

4461

4462

4463

4464

4465

4466

4467

4468

4469

4470

4471

4472

4473

4474

4475

4476

4477

4478

4479

4480

4481

4482

4483

4484

4485

4486

4487

4488

4489

4490

4491

4492

4493

4494

4495

4496

4497

4498

4499

4500

4501

4502

4503

4504

4505

4506

4507

4508

4509

4510

4511

4512

4513

4514

4515

4516

4517

4518

4519

4520

4521

4522

4523

4524

4525

4526

4527

4528

4529

4530

4531

4532

4533

4534

4535

4536

4537

4538

4539

4540

4541

4542

4543

4544

4545

4546

4547

4548

4549

4550

4551

4552

4553

4554

4555

4556

4557

4558

4559

4560

4561

4562

4563

4564

4565

4566

4567

4568

4569

4570

4571

4572

4573

4574

4575

4576

4577

4578

4579

4580

4581

4582

4583

4584

4585

4586

4587

4588

4589

4590

4591

4592

4593

4594

4595

4596

4597

4598

4599

4600

4601

4602

4603

4604

4605

4606

4607

4608

4609

4610

4611

4612

4613

4614

4615

4616

4617

4618

4619

4620

4621

4622

4623

4624

4625

4626

4627

4628

4629

4630

4631

4632

4633

4634

4635

4636

4637

4638

4639

4640

4641

4642

4643

4644

4645

4646

4647

4648

4649

4650

4651

4652

4653

4654

4655

4656

4657

4658

4659

4660

4661

4662

4663

4664

4665

4666

4667

4668

4669

4670

4671

4672

4673

4674

4675

4676

4677

4678

4679

4680

4681

4682

4683

4684

4685

4686

4687

4688

4689

4690

4691

4692

4693

4694

4695

4696

4697

4698

4699

4700

4701

4702

4703

4704

4705

4706

4707

4708

4709

4710

4711

4712

4713

4714

4715

4716

4717

4718

4719

4720

4721

4722

4723

4724

4725

4726

4727

4728

4729

4730

4731

4732

4733

4734

4735

4736

4737

4738

4739

4740

4741

4742

4743

4744

4745

4746

4747

4748

4749

4750

4751

4752

4753

4754

4755

4756

4757

4758

4759

4760

4761

4762

4763

4764

4765

4766

4767

4768

4769

4770

4771

4772

4773

4774

4775

4776

4777

4778

4779

4780

4781

4782

4783

4784

4785

4786

4787

4788

4789

4790

4791

4792

4793

4794

4795

4796

4797

4798

4799

4800

4801

4802

4803

4804

4805

4806

4807

4808

4809

4810

4811

4812

4813

4814

4815

4816

4817

4818

4819

4820

4821

4822

4823

4824

4825

4826

4827

4828

4829

4830

4831

4832

4833

4834

4835

4836

4837

4838

4839

4840

4841

4842

4843

4844

4845

4846

4847

4848

4849

4850

4851

4852

4853

4854

4855

4856

4857

4858

4859

4860

4861

4862

4863

4864

4865

4866

4867

4868

4869

4870

4871

4872

4873

4874

4875

4876

4877

4878

4879

4880

4881

4882

4883

4884

4885

4886

4887

4888

4889

4890

4891

4892

4893

4894

4895

4896

4897

4898

4899

4900

4901

4902

4903

4904

4905

4906

4907

4908

4909

4910

4911

4912

4913

4914

4915

4916

4917

4918

4919

4920

4921

4922

4923

4924

4925

4926

4927

4928

4929

4930

4931

4932

4933

4934

4935

4936

4937

4938

4939

4940

4941

4942

4943

4944

4945

4946

4947

4948

4949

4950

4951

4952

4953

4954

4955

4956

4957

4958

4959

4960

4961

4962

4963

4964

4965

4966

4967

4968

4969

4970

4971

4972

4973

4974

4975

4976

4977

4978

4979

4980

4981

4982

4983

4984

4985

4986

4987

4988

4989

4990

4991

4992

4993

4994

4995

4996

4997

4998

4999

5000

5001

5002

5003

5004

5005

5006

5007

5008

5009

5010

5011

5012

5013

5014

5015

5016

5017

5018

5019

5020

5021

5022

5023

5024

5025

5026

5027

5028

5029

5030

5031

5032

5033

5034

5035

5036

5037

5038

5039

5040

5041

5042

5043

5044

5045

5046

5047

5048

5049

5050

5051

5052

5053

5054

5055

5056

5057

5058

5059

5060

5061

5062

5063

5064

5065

5066

5067

5068

5069

5070

5071

5072

5073

5074

5075

5076

5077

5078

5079

5080

5081

5082

5083

5084

5085

5086

5087

5088

5089

5090

5091

5092

5093

5094

5095

5096

5097

5098

5099

5100

5101

5102

5103

5104

5105

5106

5107

5108

5109

5110

5111

5112

5113

5114

5115

5116

5117

5118

5119

5120

5121

5122

5123

5124

5125

5126

5127

5128

5129

5130

5131

5132

5133

5134

5135

5136

5137

5138

5139

5140

5141

5142

5143

5144

5145

5146

5147

5148

5149

5150

5151

5152

5153

5154

5155

5156

5157

5158

5159

5160

5161

5162

5163

5164

5165

5166

5167

5168

5169

5170

5171

5172

5173

5174

5175

5176

5177

5178

5179

5180

5181

5182

5183

5184

5185

5186

5187

5188

5189

5190

5191

5192

5193

5194

5195

5196

5197

5198

5199

5200

5201

5202

5203

5204

5205

5206

5207

5208

5209

5210

5211

5212

5213

5214

5215

5216

5217

5218

5219

5220

5221

5222

5223

5224

5225

5226

5227

5228

5229

5230

5231

5232

5233

5234

5235

5236

5237

5238

5239

5240

// SPDX-License-Identifier: GPL-2.0-or-later /*************************************************************************** * Copyright (C) 2020 by Tarek Bochkati * * Tarek Bochkati <tarek.bouchkati@gmail.com> * * * * SWIM contributions by Ake Rehnman * * Copyright (C) 2017 Ake Rehnman * * ake.rehnman(at)gmail.com * * * * Copyright (C) 2011-2012 by Mathias Kuester * * Mathias Kuester <kesmtp@freenet.de> * * * * Copyright (C) 2012 by Spencer Oliver * * spen@spen-soft.co.uk * * * * This code is based on https://github.com/texane/stlink * ***************************************************************************/ #ifdef HAVE_CONFIG_H #include "config.h" #endif /* project specific includes */ #include <helper/align.h> #include <helper/binarybuffer.h> #include <helper/bits.h> #include <helper/system.h> #include <helper/time_support.h> #include <jtag/adapter.h> #include <jtag/interface.h> #include <jtag/hla/hla_layout.h> #include <jtag/hla/hla_transport.h> #include <jtag/hla/hla_interface.h> #include <jtag/swim.h> #include <target/arm_adi_v5.h> #include <target/target.h> #include <transport/transport.h> #include <target/cortex_m.h> #include <helper/system.h> #ifdef HAVE_ARPA_INET_H #include <arpa/inet.h> #endif #ifdef HAVE_NETINET_TCP_H #include <netinet/tcp.h> #endif #include "libusb_helper.h" #ifdef HAVE_LIBUSB1 #define USE_LIBUSB_ASYNCIO #endif #define STLINK_SERIAL_LEN 24 #define ENDPOINT_IN 0x80 #define ENDPOINT_OUT 0x00 #define STLINK_WRITE_TIMEOUT (LIBUSB_TIMEOUT_MS) #define STLINK_READ_TIMEOUT (LIBUSB_TIMEOUT_MS) #define STLINK_RX_EP (1|ENDPOINT_IN) #define STLINK_TX_EP (2|ENDPOINT_OUT) #define STLINK_TRACE_EP (3|ENDPOINT_IN) #define STLINK_V2_1_TX_EP (1|ENDPOINT_OUT) #define STLINK_V2_1_TRACE_EP (2|ENDPOINT_IN) #define STLINK_SG_SIZE (31) #define STLINK_DATA_SIZE (6144) #define STLINK_CMD_SIZE_V2 (16) #define STLINK_CMD_SIZE_V1 (10) #define STLINK_V1_PID (0x3744) #define STLINK_V2_PID (0x3748) #define STLINK_V2_1_PID (0x374B) #define STLINK_V2_1_NO_MSD_PID (0x3752) #define STLINK_V3_USBLOADER_PID (0x374D) #define STLINK_V3E_PID (0x374E) #define STLINK_V3S_PID (0x374F) #define STLINK_V3_2VCP_PID (0x3753) #define STLINK_V3E_NO_MSD_PID (0x3754) #define STLINK_V3P_USBLOADER_PID (0x3755) #define STLINK_V3P_PID (0x3757) /* * ST-Link/V1, ST-Link/V2 and ST-Link/V2.1 are full-speed USB devices and * this limits the bulk packet size and the 8bit read/writes to max 64 bytes. * STLINK-V3 is a high speed USB 2.0 and the limit is 512 bytes from FW V3J6. * * For 16 and 32bit read/writes stlink handles USB packet split and the limit * is the internal buffer size of 6144 bytes. * TODO: override ADIv5 layer's tar_autoincr_block that limits the transfer * to 1024 or 4096 bytes */ #define STLINK_MAX_RW8 (64) #define STLINKV3_MAX_RW8 (512) #define STLINK_MAX_RW16_32 STLINK_DATA_SIZE #define STLINK_SWIM_DATA_SIZE STLINK_DATA_SIZE /* "WAIT" responses will be retried (with exponential backoff) at * most this many times before failing to caller. */ #define MAX_WAIT_RETRIES 8 /* HLA is currently limited at AP#0 and no control on CSW */ #define STLINK_HLA_AP_NUM 0 #define STLINK_HLA_CSW 0 enum stlink_jtag_api_version { STLINK_JTAG_API_V1 = 1, STLINK_JTAG_API_V2, STLINK_JTAG_API_V3, }; enum stlink_mode { STLINK_MODE_UNKNOWN = 0, STLINK_MODE_DFU, STLINK_MODE_MASS, STLINK_MODE_DEBUG_JTAG, STLINK_MODE_DEBUG_SWD, STLINK_MODE_DEBUG_SWIM }; /** */ struct stlink_usb_version { /** */ int stlink; /** */ int jtag; /** */ int swim; /** jtag api version supported */ enum stlink_jtag_api_version jtag_api; /** one bit for each feature supported. See macros STLINK_F_* */ uint32_t flags; }; struct stlink_usb_priv { /** */ struct libusb_device_handle *fd; /** */ struct libusb_transfer *trans; }; struct stlink_tcp_version { uint32_t api; uint32_t major; uint32_t minor; uint32_t build; }; struct stlink_tcp_priv { /** */ int fd; /** */ bool connected; /** */ uint32_t device_id; /** */ uint32_t connect_id; /** */ uint8_t *send_buf; /** */ uint8_t *recv_buf; /** */ struct stlink_tcp_version version; }; struct stlink_backend { /** */ int (*open)(void *handle, struct hl_interface_param *param); /** */ int (*close)(void *handle); /** */ int (*xfer_noerrcheck)(void *handle, const uint8_t *buf, int size); /** */ int (*read_trace)(void *handle, const uint8_t *buf, int size); }; /* TODO: make queue size dynamic */ /* TODO: don't allocate queue for HLA */ #define MAX_QUEUE_DEPTH (4096) enum queue_cmd { CMD_DP_READ = 1, CMD_DP_WRITE, CMD_AP_READ, CMD_AP_WRITE, /* * encode the bytes size in the enum's value. This makes easy to extract it * with a simple logic AND, by using the macro CMD_MEM_AP_2_SIZE() below */ CMD_MEM_AP_READ8 = 0x10 + 1, CMD_MEM_AP_READ16 = 0x10 + 2, CMD_MEM_AP_READ32 = 0x10 + 4, CMD_MEM_AP_WRITE8 = 0x20 + 1, CMD_MEM_AP_WRITE16 = 0x20 + 2, CMD_MEM_AP_WRITE32 = 0x20 + 4, }; #define CMD_MEM_AP_2_SIZE(cmd) ((cmd) & 7) struct dap_queue { enum queue_cmd cmd; union { struct dp_r { unsigned int reg; struct adiv5_dap *dap; uint32_t *p_data; } dp_r; struct dp_w { unsigned int reg; struct adiv5_dap *dap; uint32_t data; } dp_w; struct ap_r { unsigned int reg; struct adiv5_ap *ap; uint32_t *p_data; } ap_r; struct ap_w { unsigned int reg; struct adiv5_ap *ap; uint32_t data; bool changes_csw_default; } ap_w; struct mem_ap { uint32_t addr; struct adiv5_ap *ap; union { uint32_t *p_data; uint32_t data; }; uint32_t csw; } mem_ap; }; }; /** */ struct stlink_usb_handle { /** */ struct stlink_backend *backend; /** */ union { struct stlink_usb_priv usb_backend_priv; struct stlink_tcp_priv tcp_backend_priv; }; /** */ uint8_t rx_ep; /** */ uint8_t tx_ep; /** */ uint8_t trace_ep; /** */ uint8_t *cmdbuf; /** */ uint8_t cmdidx; /** */ uint8_t direction; /** */ uint8_t *databuf; /** */ uint32_t max_mem_packet; /** */ enum stlink_mode st_mode; /** */ struct stlink_usb_version version; /** */ uint16_t vid; /** */ uint16_t pid; /** */ struct { /** whether SWO tracing is enabled or not */ bool enabled; /** trace module source clock */ uint32_t source_hz; } trace; /** reconnect is needed next time we try to query the * status */ bool reconnect_pending; /** queue of dap_direct operations */ struct dap_queue queue[MAX_QUEUE_DEPTH]; /** first element available in the queue */ unsigned int queue_index; }; /** */ static inline int stlink_usb_open(void *handle, struct hl_interface_param *param) { struct stlink_usb_handle *h = handle; return h->backend->open(handle, param); } /** */ static inline int stlink_usb_close(void *handle) { struct stlink_usb_handle *h = handle; return h->backend->close(handle); } /** */ static inline int stlink_usb_xfer_noerrcheck(void *handle, const uint8_t *buf, int size) { struct stlink_usb_handle *h = handle; return h->backend->xfer_noerrcheck(handle, buf, size); } #define STLINK_SWIM_ERR_OK 0x00 #define STLINK_SWIM_BUSY 0x01 #define STLINK_DEBUG_ERR_OK 0x80 #define STLINK_DEBUG_ERR_FAULT 0x81 #define STLINK_SWD_AP_WAIT 0x10 #define STLINK_SWD_AP_FAULT 0x11 #define STLINK_SWD_AP_ERROR 0x12 #define STLINK_SWD_AP_PARITY_ERROR 0x13 #define STLINK_JTAG_GET_IDCODE_ERROR 0x09 #define STLINK_JTAG_WRITE_ERROR 0x0c #define STLINK_JTAG_WRITE_VERIF_ERROR 0x0d #define STLINK_SWD_DP_WAIT 0x14 #define STLINK_SWD_DP_FAULT 0x15 #define STLINK_SWD_DP_ERROR 0x16 #define STLINK_SWD_DP_PARITY_ERROR 0x17 #define STLINK_SWD_AP_WDATA_ERROR 0x18 #define STLINK_SWD_AP_STICKY_ERROR 0x19 #define STLINK_SWD_AP_STICKYORUN_ERROR 0x1a #define STLINK_BAD_AP_ERROR 0x1d #define STLINK_CORE_RUNNING 0x80 #define STLINK_CORE_HALTED 0x81 #define STLINK_CORE_STAT_UNKNOWN -1 #define STLINK_GET_VERSION 0xF1 #define STLINK_DEBUG_COMMAND 0xF2 #define STLINK_DFU_COMMAND 0xF3 #define STLINK_SWIM_COMMAND 0xF4 #define STLINK_GET_CURRENT_MODE 0xF5 #define STLINK_GET_TARGET_VOLTAGE 0xF7 #define STLINK_DEV_DFU_MODE 0x00 #define STLINK_DEV_MASS_MODE 0x01 #define STLINK_DEV_DEBUG_MODE 0x02 #define STLINK_DEV_SWIM_MODE 0x03 #define STLINK_DEV_BOOTLOADER_MODE 0x04 #define STLINK_DEV_UNKNOWN_MODE -1 #define STLINK_DFU_EXIT 0x07 /* STLINK_SWIM_ENTER_SEQ 1.3ms low then 750Hz then 1.5kHz STLINK_SWIM_GEN_RST STM8 DM pulls reset pin low 50us STLINK_SWIM_SPEED uint8_t (0=low|1=high) STLINK_SWIM_WRITEMEM uint16_t length uint32_t address STLINK_SWIM_RESET send synchronization seq (16us low, response 64 clocks low) */ #define STLINK_SWIM_ENTER 0x00 #define STLINK_SWIM_EXIT 0x01 #define STLINK_SWIM_READ_CAP 0x02 #define STLINK_SWIM_SPEED 0x03 #define STLINK_SWIM_ENTER_SEQ 0x04 #define STLINK_SWIM_GEN_RST 0x05 #define STLINK_SWIM_RESET 0x06 #define STLINK_SWIM_ASSERT_RESET 0x07 #define STLINK_SWIM_DEASSERT_RESET 0x08 #define STLINK_SWIM_READSTATUS 0x09 #define STLINK_SWIM_WRITEMEM 0x0a #define STLINK_SWIM_READMEM 0x0b #define STLINK_SWIM_READBUF 0x0c #define STLINK_DEBUG_GETSTATUS 0x01 #define STLINK_DEBUG_FORCEDEBUG 0x02 #define STLINK_DEBUG_APIV1_RESETSYS 0x03 #define STLINK_DEBUG_APIV1_READALLREGS 0x04 #define STLINK_DEBUG_APIV1_READREG 0x05 #define STLINK_DEBUG_APIV1_WRITEREG 0x06 #define STLINK_DEBUG_READMEM_32BIT 0x07 #define STLINK_DEBUG_WRITEMEM_32BIT 0x08 #define STLINK_DEBUG_RUNCORE 0x09 #define STLINK_DEBUG_STEPCORE 0x0a #define STLINK_DEBUG_APIV1_SETFP 0x0b #define STLINK_DEBUG_READMEM_8BIT 0x0c #define STLINK_DEBUG_WRITEMEM_8BIT 0x0d #define STLINK_DEBUG_APIV1_CLEARFP 0x0e #define STLINK_DEBUG_APIV1_WRITEDEBUGREG 0x0f #define STLINK_DEBUG_APIV1_SETWATCHPOINT 0x10 #define STLINK_DEBUG_ENTER_JTAG_RESET 0x00 #define STLINK_DEBUG_ENTER_SWD_NO_RESET 0xa3 #define STLINK_DEBUG_ENTER_JTAG_NO_RESET 0xa4 #define STLINK_DEBUG_APIV1_ENTER 0x20 #define STLINK_DEBUG_EXIT 0x21 #define STLINK_DEBUG_READCOREID 0x22 #define STLINK_DEBUG_APIV2_ENTER 0x30 #define STLINK_DEBUG_APIV2_READ_IDCODES 0x31 #define STLINK_DEBUG_APIV2_RESETSYS 0x32 #define STLINK_DEBUG_APIV2_READREG 0x33 #define STLINK_DEBUG_APIV2_WRITEREG 0x34 #define STLINK_DEBUG_APIV2_WRITEDEBUGREG 0x35 #define STLINK_DEBUG_APIV2_READDEBUGREG 0x36 #define STLINK_DEBUG_APIV2_READALLREGS 0x3A #define STLINK_DEBUG_APIV2_GETLASTRWSTATUS 0x3B #define STLINK_DEBUG_APIV2_DRIVE_NRST 0x3C #define STLINK_DEBUG_APIV2_GETLASTRWSTATUS2 0x3E #define STLINK_DEBUG_APIV2_START_TRACE_RX 0x40 #define STLINK_DEBUG_APIV2_STOP_TRACE_RX 0x41 #define STLINK_DEBUG_APIV2_GET_TRACE_NB 0x42 #define STLINK_DEBUG_APIV2_SWD_SET_FREQ 0x43 #define STLINK_DEBUG_APIV2_JTAG_SET_FREQ 0x44 #define STLINK_DEBUG_APIV2_READ_DAP_REG 0x45 #define STLINK_DEBUG_APIV2_WRITE_DAP_REG 0x46 #define STLINK_DEBUG_APIV2_READMEM_16BIT 0x47 #define STLINK_DEBUG_APIV2_WRITEMEM_16BIT 0x48 #define STLINK_DEBUG_APIV2_INIT_AP 0x4B #define STLINK_DEBUG_APIV2_CLOSE_AP_DBG 0x4C #define STLINK_DEBUG_WRITEMEM_32BIT_NO_ADDR_INC 0x50 #define STLINK_DEBUG_APIV2_RW_MISC_OUT 0x51 #define STLINK_DEBUG_APIV2_RW_MISC_IN 0x52 #define STLINK_DEBUG_READMEM_32BIT_NO_ADDR_INC 0x54 #define STLINK_APIV3_SET_COM_FREQ 0x61 #define STLINK_APIV3_GET_COM_FREQ 0x62 #define STLINK_APIV3_GET_VERSION_EX 0xFB #define STLINK_DEBUG_APIV2_DRIVE_NRST_LOW 0x00 #define STLINK_DEBUG_APIV2_DRIVE_NRST_HIGH 0x01 #define STLINK_DEBUG_APIV2_DRIVE_NRST_PULSE 0x02 #define STLINK_DEBUG_PORT_ACCESS 0xffff #define STLINK_TRACE_SIZE 4096 #define STLINK_TRACE_MAX_HZ 2250000 #define STLINK_V3_TRACE_MAX_HZ 24000000 #define STLINK_V3_MAX_FREQ_NB 10 #define REQUEST_SENSE 0x03 #define REQUEST_SENSE_LENGTH 18 /* STLINK TCP commands */ #define STLINK_TCP_CMD_REFRESH_DEVICE_LIST 0x00 #define STLINK_TCP_CMD_GET_NB_DEV 0x01 #define STLINK_TCP_CMD_GET_DEV_INFO 0x02 #define STLINK_TCP_CMD_OPEN_DEV 0x03 #define STLINK_TCP_CMD_CLOSE_DEV 0x04 #define STLINK_TCP_CMD_SEND_USB_CMD 0x05 #define STLINK_TCP_CMD_GET_SERVER_VERSION 0x06 #define STLINK_TCP_CMD_GET_NB_OF_DEV_CLIENTS 0x07 /* STLINK TCP constants */ #define OPENOCD_STLINK_TCP_API_VERSION 1 #define STLINK_TCP_REQUEST_WRITE 0 #define STLINK_TCP_REQUEST_READ 1 #define STLINK_TCP_REQUEST_READ_SWO 3 #define STLINK_TCP_SS_SIZE 4 #define STLINK_TCP_USB_CMD_SIZE 32 #define STLINK_TCP_SERIAL_SIZE 32 #define STLINK_TCP_SEND_BUFFER_SIZE 10240 #define STLINK_TCP_RECV_BUFFER_SIZE 10240 /* STLINK TCP command status */ #define STLINK_TCP_SS_OK 0x00000001 #define STLINK_TCP_SS_MEMORY_PROBLEM 0x00001000 #define STLINK_TCP_SS_TIMEOUT 0x00001001 #define STLINK_TCP_SS_BAD_PARAMETER 0x00001002 #define STLINK_TCP_SS_OPEN_ERR 0x00001003 #define STLINK_TCP_SS_TRUNCATED_DATA 0x00001052 #define STLINK_TCP_SS_CMD_NOT_AVAILABLE 0x00001053 #define STLINK_TCP_SS_TCP_ERROR 0x00002001 #define STLINK_TCP_SS_TCP_CANT_CONNECT 0x00002002 #define STLINK_TCP_SS_TCP_CLOSE_ERROR 0x00002003 #define STLINK_TCP_SS_TCP_BUSY 0x00002004 #define STLINK_TCP_SS_WIN32_ERROR 0x00010000 /* * Map the relevant features, quirks and workaround for specific firmware * version of stlink */ #define STLINK_F_HAS_TRACE BIT(0) /* v2>=j13 || v3 */ #define STLINK_F_HAS_GETLASTRWSTATUS2 BIT(1) /* v2>=j15 || v3 */ #define STLINK_F_HAS_SWD_SET_FREQ BIT(2) /* v2>=j22 */ #define STLINK_F_HAS_JTAG_SET_FREQ BIT(3) /* v2>=j24 */ #define STLINK_F_QUIRK_JTAG_DP_READ BIT(4) /* v2>=j24 && v2<j32 */ #define STLINK_F_HAS_DAP_REG BIT(5) /* v2>=j24 || v3 */ #define STLINK_F_HAS_MEM_16BIT BIT(6) /* v2>=j26 || v3 */ #define STLINK_F_HAS_AP_INIT BIT(7) /* v2>=j28 || v3 */ #define STLINK_F_FIX_CLOSE_AP BIT(8) /* v2>=j29 || v3 */ #define STLINK_F_HAS_DPBANKSEL BIT(9) /* v2>=j32 || v3>=j2 */ #define STLINK_F_HAS_RW8_512BYTES BIT(10) /* v3>=j6 */ /* aliases */ #define STLINK_F_HAS_TARGET_VOLT STLINK_F_HAS_TRACE #define STLINK_F_HAS_FPU_REG STLINK_F_HAS_GETLASTRWSTATUS2 #define STLINK_F_HAS_MEM_WR_NO_INC STLINK_F_HAS_MEM_16BIT #define STLINK_F_HAS_MEM_RD_NO_INC STLINK_F_HAS_DPBANKSEL #define STLINK_F_HAS_RW_MISC STLINK_F_HAS_DPBANKSEL #define STLINK_F_HAS_CSW STLINK_F_HAS_DPBANKSEL #define STLINK_REGSEL_IS_FPU(x) ((x) > 0x1F) struct speed_map { int speed; int speed_divisor; }; /* SWD clock speed */ static const struct speed_map stlink_khz_to_speed_map_swd[] = { {4000, 0}, {1800, 1}, /* default */ {1200, 2}, {950, 3}, {480, 7}, {240, 15}, {125, 31}, {100, 40}, {50, 79}, {25, 158}, {15, 265}, {5, 798} }; /* JTAG clock speed */ static const struct speed_map stlink_khz_to_speed_map_jtag[] = { {9000, 4}, {4500, 8}, {2250, 16}, {1125, 32}, /* default */ {562, 64}, {281, 128}, {140, 256} }; static void stlink_usb_init_buffer(void *handle, uint8_t direction, uint32_t size); static int stlink_swim_status(void *handle); static void stlink_dump_speed_map(const struct speed_map *map, unsigned int map_size); static int stlink_get_com_freq(void *handle, bool is_jtag, struct speed_map *map); static int stlink_speed(void *handle, int khz, bool query); static int stlink_usb_open_ap(void *handle, unsigned short apsel); /** */ static unsigned int stlink_usb_block(void *handle) { struct stlink_usb_handle *h = handle; assert(handle); if (h->version.flags & STLINK_F_HAS_RW8_512BYTES) return STLINKV3_MAX_RW8; else return STLINK_MAX_RW8; } #ifdef USE_LIBUSB_ASYNCIO static LIBUSB_CALL void sync_transfer_cb(struct libusb_transfer *transfer) { int *completed = transfer->user_data; *completed = 1; /* caller interprets result and frees transfer */ } static void sync_transfer_wait_for_completion(struct libusb_transfer *transfer) { int r, *completed = transfer->user_data; while (!*completed) { r = jtag_libusb_handle_events_completed(completed); if (r < 0) { if (r == LIBUSB_ERROR_INTERRUPTED) continue; libusb_cancel_transfer(transfer); continue; } } } static int transfer_error_status(const struct libusb_transfer *transfer) { int r = 0; switch (transfer->status) { case LIBUSB_TRANSFER_COMPLETED: r = 0; break; case LIBUSB_TRANSFER_TIMED_OUT: r = LIBUSB_ERROR_TIMEOUT; break; case LIBUSB_TRANSFER_STALL: r = LIBUSB_ERROR_PIPE; break; case LIBUSB_TRANSFER_OVERFLOW: r = LIBUSB_ERROR_OVERFLOW; break; case LIBUSB_TRANSFER_NO_DEVICE: r = LIBUSB_ERROR_NO_DEVICE; break; case LIBUSB_TRANSFER_ERROR: case LIBUSB_TRANSFER_CANCELLED: r = LIBUSB_ERROR_IO; break; default: r = LIBUSB_ERROR_OTHER; break; } return r; } struct jtag_xfer { int ep; uint8_t *buf; size_t size; /* Internal */ int retval; int completed; size_t transfer_size; struct libusb_transfer *transfer; }; static int jtag_libusb_bulk_transfer_n( struct libusb_device_handle *dev_handle, struct jtag_xfer *transfers, size_t n_transfers, int timeout) { int retval = 0; int returnval = ERROR_OK; for (size_t i = 0; i < n_transfers; ++i) { transfers[i].retval = 0; transfers[i].completed = 0; transfers[i].transfer_size = 0; transfers[i].transfer = libusb_alloc_transfer(0); if (!transfers[i].transfer) { for (size_t j = 0; j < i; ++j) libusb_free_transfer(transfers[j].transfer); LOG_DEBUG("ERROR, failed to alloc usb transfers"); for (size_t k = 0; k < n_transfers; ++k) transfers[k].retval = LIBUSB_ERROR_NO_MEM; return ERROR_FAIL; } } for (size_t i = 0; i < n_transfers; ++i) { libusb_fill_bulk_transfer( transfers[i].transfer, dev_handle, transfers[i].ep, transfers[i].buf, transfers[i].size, sync_transfer_cb, &transfers[i].completed, timeout); transfers[i].transfer->type = LIBUSB_TRANSFER_TYPE_BULK; retval = libusb_submit_transfer(transfers[i].transfer); if (retval < 0) { LOG_DEBUG("ERROR, failed to submit transfer %zu, error %d", i, retval); /* Probably no point continuing to submit transfers once a submission fails. * As a result, tag all remaining transfers as errors. */ for (size_t j = i; j < n_transfers; ++j) transfers[j].retval = retval; returnval = ERROR_FAIL; break; } } /* Wait for every submitted USB transfer to complete. */ for (size_t i = 0; i < n_transfers; ++i) { if (transfers[i].retval == 0) { sync_transfer_wait_for_completion(transfers[i].transfer); retval = transfer_error_status(transfers[i].transfer); if (retval) { returnval = ERROR_FAIL; transfers[i].retval = retval; LOG_DEBUG("ERROR, transfer %zu failed, error %d", i, retval); } else { /* Assuming actual_length is only valid if there is no transfer error. */ transfers[i].transfer_size = transfers[i].transfer->actual_length; } } libusb_free_transfer(transfers[i].transfer); transfers[i].transfer = NULL; } return returnval; } #endif /** */ static int stlink_usb_xfer_v1_get_status(void *handle) { struct stlink_usb_handle *h = handle; int tr, ret; assert(handle); /* read status */ memset(h->cmdbuf, 0, STLINK_SG_SIZE); ret = jtag_libusb_bulk_read(h->usb_backend_priv.fd, h->rx_ep, (char *)h->cmdbuf, 13, STLINK_READ_TIMEOUT, &tr); if (ret || tr != 13) return ERROR_FAIL; uint32_t t1; t1 = buf_get_u32(h->cmdbuf, 0, 32); /* check for USBS */ if (t1 != 0x53425355) return ERROR_FAIL; /* * CSW status: * 0 success * 1 command failure * 2 phase error */ if (h->cmdbuf[12] != 0) return ERROR_FAIL; return ERROR_OK; } #ifdef USE_LIBUSB_ASYNCIO static int stlink_usb_xfer_rw(void *handle, int cmdsize, const uint8_t *buf, int size) { struct stlink_usb_handle *h = handle; assert(handle); size_t n_transfers = 0; struct jtag_xfer transfers[2]; memset(transfers, 0, sizeof(transfers)); transfers[0].ep = h->tx_ep; transfers[0].buf = h->cmdbuf; transfers[0].size = cmdsize; ++n_transfers; if (h->direction == h->tx_ep && size) { transfers[1].ep = h->tx_ep; transfers[1].buf = (uint8_t *)buf; transfers[1].size = size; ++n_transfers; } else if (h->direction == h->rx_ep && size) { transfers[1].ep = h->rx_ep; transfers[1].buf = (uint8_t *)buf; transfers[1].size = size; ++n_transfers; } return jtag_libusb_bulk_transfer_n( h->usb_backend_priv.fd, transfers, n_transfers, STLINK_WRITE_TIMEOUT); } #else static int stlink_usb_xfer_rw(void *handle, int cmdsize, const uint8_t *buf, int size) { struct stlink_usb_handle *h = handle; int tr, ret; assert(handle); ret = jtag_libusb_bulk_write(h->usb_backend_priv.fd, h->tx_ep, (char *)h->cmdbuf, cmdsize, STLINK_WRITE_TIMEOUT, &tr); if (ret || tr != cmdsize) return ERROR_FAIL; if (h->direction == h->tx_ep && size) { ret = jtag_libusb_bulk_write(h->usb_backend_priv.fd, h->tx_ep, (char *)buf, size, STLINK_WRITE_TIMEOUT, &tr); if (ret || tr != size) { LOG_DEBUG("bulk write failed"); return ERROR_FAIL; } } else if (h->direction == h->rx_ep && size) { ret = jtag_libusb_bulk_read(h->usb_backend_priv.fd, h->rx_ep, (char *)buf, size, STLINK_READ_TIMEOUT, &tr); if (ret || tr != size) { LOG_DEBUG("bulk read failed"); return ERROR_FAIL; } } return ERROR_OK; } #endif /** */ static int stlink_usb_xfer_v1_get_sense(void *handle) { int res; struct stlink_usb_handle *h = handle; assert(handle); stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = REQUEST_SENSE; h->cmdbuf[h->cmdidx++] = 0; h->cmdbuf[h->cmdidx++] = 0; h->cmdbuf[h->cmdidx++] = 0; h->cmdbuf[h->cmdidx++] = REQUEST_SENSE_LENGTH; res = stlink_usb_xfer_rw(handle, REQUEST_SENSE_LENGTH, h->databuf, 16); if (res != ERROR_OK) return res; if (stlink_usb_xfer_v1_get_status(handle) != ERROR_OK) return ERROR_FAIL; return ERROR_OK; } /** */ static int stlink_usb_usb_read_trace(void *handle, const uint8_t *buf, int size) { struct stlink_usb_handle *h = handle; int tr, ret; ret = jtag_libusb_bulk_read(h->usb_backend_priv.fd, h->trace_ep, (char *)buf, size, STLINK_READ_TIMEOUT, &tr); if (ret || tr != size) { LOG_ERROR("bulk trace read failed"); return ERROR_FAIL; } return ERROR_OK; } /* transfers block in cmdbuf <size> indicates number of bytes in the following data phase. Ignore the (eventual) error code in the received packet. */ static int stlink_usb_usb_xfer_noerrcheck(void *handle, const uint8_t *buf, int size) { int err, cmdsize = STLINK_CMD_SIZE_V2; struct stlink_usb_handle *h = handle; assert(handle); if (h->version.stlink == 1) { cmdsize = STLINK_SG_SIZE; /* put length in bCBWCBLength */ h->cmdbuf[14] = h->cmdidx-15; } err = stlink_usb_xfer_rw(handle, cmdsize, buf, size); if (err != ERROR_OK) return err; if (h->version.stlink == 1) { if (stlink_usb_xfer_v1_get_status(handle) != ERROR_OK) { /* check csw status */ if (h->cmdbuf[12] == 1) { LOG_DEBUG("get sense"); if (stlink_usb_xfer_v1_get_sense(handle) != ERROR_OK) return ERROR_FAIL; } return ERROR_FAIL; } } return ERROR_OK; } static int stlink_tcp_send_cmd(void *handle, int send_size, int recv_size, bool check_tcp_status) { struct stlink_usb_handle *h = handle; assert(handle); /* send the TCP command */ int sent_size = send(h->tcp_backend_priv.fd, (void *)h->tcp_backend_priv.send_buf, send_size, 0); if (sent_size != send_size) { LOG_ERROR("failed to send USB CMD"); if (sent_size == -1) LOG_DEBUG("socket send error: %s (errno %d)", strerror(errno), errno); else LOG_DEBUG("sent size %d (expected %d)", sent_size, send_size); return ERROR_FAIL; } /* read the TCP response */ int retval = ERROR_OK; int remaining_bytes = recv_size; uint8_t *recv_buf = h->tcp_backend_priv.recv_buf; const int64_t timeout = timeval_ms() + 1000; /* 1 second */ while (remaining_bytes > 0) { if (timeval_ms() > timeout) { LOG_DEBUG("received size %d (expected %d)", recv_size - remaining_bytes, recv_size); retval = ERROR_TIMEOUT_REACHED; break; } keep_alive(); int received = recv(h->tcp_backend_priv.fd, (void *)recv_buf, remaining_bytes, 0); if (received == -1) { LOG_DEBUG("socket recv error: %s (errno %d)", strerror(errno), errno); retval = ERROR_FAIL; break; } recv_buf += received; remaining_bytes -= received; } if (retval != ERROR_OK) { LOG_ERROR("failed to receive USB CMD response"); return retval; } if (check_tcp_status) { uint32_t tcp_ss = le_to_h_u32(h->tcp_backend_priv.recv_buf); if (tcp_ss != STLINK_TCP_SS_OK) { if (tcp_ss == STLINK_TCP_SS_TCP_BUSY) { LOG_DEBUG("TCP busy"); return ERROR_WAIT; } LOG_ERROR("TCP error status 0x%X", tcp_ss); return ERROR_FAIL; } } return ERROR_OK; } /** */ static int stlink_tcp_xfer_noerrcheck(void *handle, const uint8_t *buf, int size) { struct stlink_usb_handle *h = handle; int send_size = STLINK_TCP_USB_CMD_SIZE; int recv_size = STLINK_TCP_SS_SIZE; assert(handle); /* prepare the TCP command */ h->tcp_backend_priv.send_buf[0] = STLINK_TCP_CMD_SEND_USB_CMD; memset(&h->tcp_backend_priv.send_buf[1], 0, 3); /* reserved for alignment and future use, must be zero */ h_u32_to_le(&h->tcp_backend_priv.send_buf[4], h->tcp_backend_priv.connect_id); /* tcp_backend_priv.send_buf[8..23] already contains the constructed stlink command */ h->tcp_backend_priv.send_buf[24] = h->direction; memset(&h->tcp_backend_priv.send_buf[25], 0, 3); /* reserved for alignment and future use, must be zero */ h_u32_to_le(&h->tcp_backend_priv.send_buf[28], size); /* * if the xfer is a write request (tx_ep) * > then buf content will be copied * into &cmdbuf[32]. * else : the xfer is a read or trace read request (rx_ep or trace_ep) * > the buf content will be filled from &databuf[4]. * * note : if h->direction is trace_ep, h->cmdbuf is zeros. */ if (h->direction == h->tx_ep) { /* STLINK_TCP_REQUEST_WRITE */ send_size += size; if (send_size > STLINK_TCP_SEND_BUFFER_SIZE) { LOG_ERROR("STLINK_TCP command buffer overflow"); return ERROR_FAIL; } memcpy(&h->tcp_backend_priv.send_buf[32], buf, size); } else { /* STLINK_TCP_REQUEST_READ or STLINK_TCP_REQUEST_READ_SWO */ recv_size += size; if (recv_size > STLINK_TCP_RECV_BUFFER_SIZE) { LOG_ERROR("STLINK_TCP data buffer overflow"); return ERROR_FAIL; } } int ret = stlink_tcp_send_cmd(h, send_size, recv_size, true); if (ret != ERROR_OK) return ret; if (h->direction != h->tx_ep) { /* the read data is located in tcp_backend_priv.recv_buf[4] */ /* most of the case it will be copying the data from tcp_backend_priv.recv_buf[4] * to handle->cmd_buff which are the same, so let's avoid unnecessary copying */ if (buf != &h->tcp_backend_priv.recv_buf[4]) memcpy((uint8_t *)buf, &h->tcp_backend_priv.recv_buf[4], size); } return ERROR_OK; } /** */ static int stlink_tcp_read_trace(void *handle, const uint8_t *buf, int size) { struct stlink_usb_handle *h = handle; stlink_usb_init_buffer(h, h->trace_ep, 0); return stlink_tcp_xfer_noerrcheck(handle, buf, size); } /** Converts an STLINK status code held in the first byte of a response to an openocd error, logs any error/wait status as debug output. */ static int stlink_usb_error_check(void *handle) { struct stlink_usb_handle *h = handle; assert(handle); if (h->st_mode == STLINK_MODE_DEBUG_SWIM) { switch (h->databuf[0]) { case STLINK_SWIM_ERR_OK: return ERROR_OK; case STLINK_SWIM_BUSY: return ERROR_WAIT; default: LOG_DEBUG("unknown/unexpected STLINK status code 0x%x", h->databuf[0]); return ERROR_FAIL; } } /* TODO: no error checking yet on api V1 */ if (h->version.jtag_api == STLINK_JTAG_API_V1) h->databuf[0] = STLINK_DEBUG_ERR_OK; switch (h->databuf[0]) { case STLINK_DEBUG_ERR_OK: return ERROR_OK; case STLINK_DEBUG_ERR_FAULT: LOG_DEBUG("SWD fault response (0x%x)", STLINK_DEBUG_ERR_FAULT); return ERROR_FAIL; case STLINK_SWD_AP_WAIT: LOG_DEBUG("wait status SWD_AP_WAIT (0x%x)", STLINK_SWD_AP_WAIT); return ERROR_WAIT; case STLINK_SWD_DP_WAIT: LOG_DEBUG("wait status SWD_DP_WAIT (0x%x)", STLINK_SWD_DP_WAIT); return ERROR_WAIT; case STLINK_JTAG_GET_IDCODE_ERROR: LOG_DEBUG("STLINK_JTAG_GET_IDCODE_ERROR"); return ERROR_FAIL; case STLINK_JTAG_WRITE_ERROR: LOG_DEBUG("Write error"); return ERROR_FAIL; case STLINK_JTAG_WRITE_VERIF_ERROR: LOG_DEBUG("Write verify error, ignoring"); return ERROR_OK; case STLINK_SWD_AP_FAULT: /* git://git.ac6.fr/openocd commit 657e3e885b9ee10 * returns ERROR_OK with the comment: * Change in error status when reading outside RAM. * This fix allows CDT plugin to visualize memory. */ LOG_DEBUG("STLINK_SWD_AP_FAULT"); return ERROR_FAIL; case STLINK_SWD_AP_ERROR: LOG_DEBUG("STLINK_SWD_AP_ERROR"); return ERROR_FAIL; case STLINK_SWD_AP_PARITY_ERROR: LOG_DEBUG("STLINK_SWD_AP_PARITY_ERROR"); return ERROR_FAIL; case STLINK_SWD_DP_FAULT: LOG_DEBUG("STLINK_SWD_DP_FAULT"); return ERROR_FAIL; case STLINK_SWD_DP_ERROR: LOG_DEBUG("STLINK_SWD_DP_ERROR"); return ERROR_FAIL; case STLINK_SWD_DP_PARITY_ERROR: LOG_DEBUG("STLINK_SWD_DP_PARITY_ERROR"); return ERROR_FAIL; case STLINK_SWD_AP_WDATA_ERROR: LOG_DEBUG("STLINK_SWD_AP_WDATA_ERROR"); return ERROR_FAIL; case STLINK_SWD_AP_STICKY_ERROR: LOG_DEBUG("STLINK_SWD_AP_STICKY_ERROR"); return ERROR_FAIL; case STLINK_SWD_AP_STICKYORUN_ERROR: LOG_DEBUG("STLINK_SWD_AP_STICKYORUN_ERROR"); return ERROR_FAIL; case STLINK_BAD_AP_ERROR: LOG_DEBUG("STLINK_BAD_AP_ERROR"); return ERROR_FAIL; default: LOG_DEBUG("unknown/unexpected STLINK status code 0x%x", h->databuf[0]); return ERROR_FAIL; } } /* * Wrapper around stlink_usb_xfer_noerrcheck() * to check the error code in the received packet */ static int stlink_usb_xfer_errcheck(void *handle, const uint8_t *buf, int size) { int retval; assert(size > 0); retval = stlink_usb_xfer_noerrcheck(handle, buf, size); if (retval != ERROR_OK) return retval; return stlink_usb_error_check(handle); } /** Issue an STLINK command via USB transfer, with retries on any wait status responses. Works for commands where the STLINK_DEBUG status is returned in the first byte of the response packet. For SWIM a SWIM_READSTATUS is requested instead. Returns an openocd result code. */ static int stlink_cmd_allow_retry(void *handle, const uint8_t *buf, int size) { int retries = 0; int res; struct stlink_usb_handle *h = handle; while (1) { if ((h->st_mode != STLINK_MODE_DEBUG_SWIM) || !retries) { res = stlink_usb_xfer_noerrcheck(handle, buf, size); if (res != ERROR_OK) return res; } if (h->st_mode == STLINK_MODE_DEBUG_SWIM) { res = stlink_swim_status(handle); if (res != ERROR_OK) return res; } res = stlink_usb_error_check(handle); if (res == ERROR_WAIT && retries < MAX_WAIT_RETRIES) { unsigned int delay_us = (1<<retries++) * 1000; LOG_DEBUG("stlink_cmd_allow_retry ERROR_WAIT, retry %d, delaying %u microseconds", retries, delay_us); usleep(delay_us); continue; } return res; } } /** */ static int stlink_usb_read_trace(void *handle, const uint8_t *buf, int size) { struct stlink_usb_handle *h = handle; assert(handle); assert(h->version.flags & STLINK_F_HAS_TRACE); return h->backend->read_trace(handle, buf, size); } /* this function writes transfer length in the right place in the cb */ static void stlink_usb_set_cbw_transfer_datalength(void *handle, uint32_t size) { struct stlink_usb_handle *h = handle; buf_set_u32(h->cmdbuf+8, 0, 32, size); } static void stlink_usb_xfer_v1_create_cmd(void *handle, uint8_t direction, uint32_t size) { struct stlink_usb_handle *h = handle; /* fill the send buffer */ strcpy((char *)h->cmdbuf, "USBC"); h->cmdidx += 4; /* csw tag not used */ buf_set_u32(h->cmdbuf+h->cmdidx, 0, 32, 0); h->cmdidx += 4; /* cbw data transfer length (in the following data phase in or out) */ buf_set_u32(h->cmdbuf+h->cmdidx, 0, 32, size); h->cmdidx += 4; /* cbw flags */ h->cmdbuf[h->cmdidx++] = (direction == h->rx_ep ? ENDPOINT_IN : ENDPOINT_OUT); h->cmdbuf[h->cmdidx++] = 0; /* lun */ /* cdb clength (is filled in at xfer) */ h->cmdbuf[h->cmdidx++] = 0; } /** */ static void stlink_usb_init_buffer(void *handle, uint8_t direction, uint32_t size) { struct stlink_usb_handle *h = handle; h->direction = direction; h->cmdidx = 0; memset(h->cmdbuf, 0, STLINK_SG_SIZE); memset(h->databuf, 0, STLINK_DATA_SIZE); if (h->version.stlink == 1) stlink_usb_xfer_v1_create_cmd(handle, direction, size); } /** */ static int stlink_usb_version(void *handle) { int res; uint32_t flags; uint16_t version; uint8_t v, x, y, jtag, swim, msd, bridge = 0; char v_str[5 * (1 + 3) + 1]; /* VvJjMmBbSs */ char *p; struct stlink_usb_handle *h = handle; assert(handle); stlink_usb_init_buffer(handle, h->rx_ep, 6); h->cmdbuf[h->cmdidx++] = STLINK_GET_VERSION; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 6); if (res != ERROR_OK) return res; version = be_to_h_u16(h->databuf); v = (version >> 12) & 0x0f; x = (version >> 6) & 0x3f; y = version & 0x3f; h->vid = le_to_h_u16(h->databuf + 2); h->pid = le_to_h_u16(h->databuf + 4); switch (h->pid) { case STLINK_V2_1_PID: case STLINK_V2_1_NO_MSD_PID: if ((x <= 22 && y == 7) || (x >= 25 && y >= 7 && y <= 12)) { /* MxSy : STM8 V2.1 - SWIM only */ msd = x; swim = y; jtag = 0; } else { /* JxMy : STM32 V2.1 - JTAG/SWD only */ jtag = x; msd = y; swim = 0; } break; default: jtag = x; swim = y; msd = 0; break; } /* STLINK-V3 & STLINK-V3P require a specific command */ if (v >= 3 && x == 0 && y == 0) { stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = STLINK_APIV3_GET_VERSION_EX; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 12); if (res != ERROR_OK) return res; v = h->databuf[0]; swim = h->databuf[1]; jtag = h->databuf[2]; msd = h->databuf[3]; bridge = h->databuf[4]; h->vid = le_to_h_u16(h->databuf + 8); h->pid = le_to_h_u16(h->databuf + 10); } h->version.stlink = v; h->version.jtag = jtag; h->version.swim = swim; flags = 0; switch (h->version.stlink) { case 1: /* ST-LINK/V1 from J11 switch to api-v2 (and support SWD) */ if (h->version.jtag >= 11) h->version.jtag_api = STLINK_JTAG_API_V2; else h->version.jtag_api = STLINK_JTAG_API_V1; break; case 2: /* all ST-LINK/V2 and ST-Link/V2.1 use api-v2 */ h->version.jtag_api = STLINK_JTAG_API_V2; /* API for trace from J13 */ /* API for target voltage from J13 */ if (h->version.jtag >= 13) flags |= STLINK_F_HAS_TRACE; /* preferred API to get last R/W status from J15 */ if (h->version.jtag >= 15) flags |= STLINK_F_HAS_GETLASTRWSTATUS2; /* API to set SWD frequency from J22 */ if (h->version.jtag >= 22) flags |= STLINK_F_HAS_SWD_SET_FREQ; /* API to set JTAG frequency from J24 */ /* API to access DAP registers from J24 */ if (h->version.jtag >= 24) { flags |= STLINK_F_HAS_JTAG_SET_FREQ; flags |= STLINK_F_HAS_DAP_REG; } /* Quirk for read DP in JTAG mode (V2 only) from J24, fixed in J32 */ if (h->version.jtag >= 24 && h->version.jtag < 32) flags |= STLINK_F_QUIRK_JTAG_DP_READ; /* API to read/write memory at 16 bit from J26 */ /* API to write memory without address increment from J26 */ if (h->version.jtag >= 26) flags |= STLINK_F_HAS_MEM_16BIT; /* API required to init AP before any AP access from J28 */ if (h->version.jtag >= 28) flags |= STLINK_F_HAS_AP_INIT; /* API required to return proper error code on close AP from J29 */ if (h->version.jtag >= 29) flags |= STLINK_F_FIX_CLOSE_AP; /* Banked regs (DPv1 & DPv2) support from V2J32 */ /* API to read memory without address increment from V2J32 */ /* Memory R/W supports CSW from V2J32 */ if (h->version.jtag >= 32) flags |= STLINK_F_HAS_DPBANKSEL; break; case 3: /* all STLINK-V3 use api-v3 */ h->version.jtag_api = STLINK_JTAG_API_V3; /* STLINK-V3 is a superset of ST-LINK/V2 */ /* API for trace */ /* API for target voltage */ flags |= STLINK_F_HAS_TRACE; /* preferred API to get last R/W status */ flags |= STLINK_F_HAS_GETLASTRWSTATUS2; /* API to access DAP registers */ flags |= STLINK_F_HAS_DAP_REG; /* API to read/write memory at 16 bit */ /* API to write memory without address increment */ flags |= STLINK_F_HAS_MEM_16BIT; /* API required to init AP before any AP access */ flags |= STLINK_F_HAS_AP_INIT; /* API required to return proper error code on close AP */ flags |= STLINK_F_FIX_CLOSE_AP; /* Banked regs (DPv1 & DPv2) support from V3J2 */ /* API to read memory without address increment from V3J2 */ /* Memory R/W supports CSW from V3J2 */ if (h->version.jtag >= 2) flags |= STLINK_F_HAS_DPBANKSEL; /* 8bit read/write max packet size 512 bytes from V3J6 */ if (h->version.jtag >= 6) flags |= STLINK_F_HAS_RW8_512BYTES; break; case 4: /* STLINK-V3P use api-v3 */ h->version.jtag_api = STLINK_JTAG_API_V3; /* STLINK-V3P is a superset of ST-LINK/V3 */ /* API for trace */ /* API for target voltage */ flags |= STLINK_F_HAS_TRACE; /* preferred API to get last R/W status */ flags |= STLINK_F_HAS_GETLASTRWSTATUS2; /* API to access DAP registers */ flags |= STLINK_F_HAS_DAP_REG; /* API to read/write memory at 16 bit */ /* API to write memory without address increment */ flags |= STLINK_F_HAS_MEM_16BIT; /* API required to init AP before any AP access */ flags |= STLINK_F_HAS_AP_INIT; /* API required to return proper error code on close AP */ flags |= STLINK_F_FIX_CLOSE_AP; /* Banked regs (DPv1 & DPv2) support */ /* API to read memory without address increment */ /* Memory R/W supports CSW */ flags |= STLINK_F_HAS_DPBANKSEL; /* 8bit read/write max packet size 512 bytes */ flags |= STLINK_F_HAS_RW8_512BYTES; break; default: break; } h->version.flags = flags; p = v_str; p += sprintf(p, "V%d", v); if (jtag || !msd) p += sprintf(p, "J%d", jtag); if (msd) p += sprintf(p, "M%d", msd); if (bridge) p += sprintf(p, "B%d", bridge); if (swim || !msd) sprintf(p, "S%d", swim); LOG_INFO("STLINK %s (API v%d) VID:PID %04X:%04X", v_str, h->version.jtag_api, h->vid, h->pid); return ERROR_OK; } static int stlink_usb_check_voltage(void *handle, float *target_voltage) { struct stlink_usb_handle *h = handle; uint32_t adc_results[2]; /* no error message, simply quit with error */ if (!(h->version.flags & STLINK_F_HAS_TARGET_VOLT)) return ERROR_COMMAND_NOTFOUND; stlink_usb_init_buffer(handle, h->rx_ep, 8); h->cmdbuf[h->cmdidx++] = STLINK_GET_TARGET_VOLTAGE; int result = stlink_usb_xfer_noerrcheck(handle, h->databuf, 8); if (result != ERROR_OK) return result; /* convert result */ adc_results[0] = le_to_h_u32(h->databuf); adc_results[1] = le_to_h_u32(h->databuf + 4); *target_voltage = 0; if (adc_results[0]) *target_voltage = 2 * ((float)adc_results[1]) * (float)(1.2 / adc_results[0]); LOG_INFO("Target voltage: %f", (double)*target_voltage); return ERROR_OK; } static int stlink_usb_set_swdclk(void *handle, uint16_t clk_divisor) { struct stlink_usb_handle *h = handle; assert(handle); if (!(h->version.flags & STLINK_F_HAS_SWD_SET_FREQ)) return ERROR_COMMAND_NOTFOUND; stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_SWD_SET_FREQ; h_u16_to_le(h->cmdbuf+h->cmdidx, clk_divisor); h->cmdidx += 2; int result = stlink_cmd_allow_retry(handle, h->databuf, 2); if (result != ERROR_OK) return result; return ERROR_OK; } static int stlink_usb_set_jtagclk(void *handle, uint16_t clk_divisor) { struct stlink_usb_handle *h = handle; assert(handle); if (!(h->version.flags & STLINK_F_HAS_JTAG_SET_FREQ)) return ERROR_COMMAND_NOTFOUND; stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_JTAG_SET_FREQ; h_u16_to_le(h->cmdbuf+h->cmdidx, clk_divisor); h->cmdidx += 2; int result = stlink_cmd_allow_retry(handle, h->databuf, 2); if (result != ERROR_OK) return result; return ERROR_OK; } /** */ static int stlink_usb_current_mode(void *handle, uint8_t *mode) { int res; struct stlink_usb_handle *h = handle; assert(handle); stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_GET_CURRENT_MODE; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 2); if (res != ERROR_OK) return res; *mode = h->databuf[0]; return ERROR_OK; } /** */ static int stlink_usb_mode_enter(void *handle, enum stlink_mode type) { int rx_size = 0; struct stlink_usb_handle *h = handle; assert(handle); /* on api V2 we are able the read the latest command * status * TODO: we need the test on api V1 too */ if (h->version.jtag_api != STLINK_JTAG_API_V1) rx_size = 2; stlink_usb_init_buffer(handle, h->rx_ep, rx_size); switch (type) { case STLINK_MODE_DEBUG_JTAG: h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV1_ENTER; else h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_ENTER; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_ENTER_JTAG_NO_RESET; break; case STLINK_MODE_DEBUG_SWD: h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV1_ENTER; else h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_ENTER; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_ENTER_SWD_NO_RESET; break; case STLINK_MODE_DEBUG_SWIM: h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_ENTER; /* swim enter does not return any response or status */ return stlink_usb_xfer_noerrcheck(handle, h->databuf, 0); case STLINK_MODE_DFU: case STLINK_MODE_MASS: default: return ERROR_FAIL; } return stlink_cmd_allow_retry(handle, h->databuf, rx_size); } /** */ static int stlink_usb_mode_leave(void *handle, enum stlink_mode type) { int res; struct stlink_usb_handle *h = handle; assert(handle); /* command with no reply, use a valid endpoint but zero size */ stlink_usb_init_buffer(handle, h->rx_ep, 0); switch (type) { case STLINK_MODE_DEBUG_JTAG: case STLINK_MODE_DEBUG_SWD: h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_EXIT; break; case STLINK_MODE_DEBUG_SWIM: h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_EXIT; break; case STLINK_MODE_DFU: h->cmdbuf[h->cmdidx++] = STLINK_DFU_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DFU_EXIT; break; case STLINK_MODE_MASS: default: return ERROR_FAIL; } res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 0); if (res != ERROR_OK) return res; return ERROR_OK; } static int stlink_usb_assert_srst(void *handle, int srst); static enum stlink_mode stlink_get_mode(enum hl_transports t) { switch (t) { case HL_TRANSPORT_SWD: return STLINK_MODE_DEBUG_SWD; case HL_TRANSPORT_JTAG: return STLINK_MODE_DEBUG_JTAG; default: return STLINK_MODE_UNKNOWN; } } /** */ static int stlink_usb_exit_mode(void *handle) { int res; uint8_t mode; enum stlink_mode emode; assert(handle); res = stlink_usb_current_mode(handle, &mode); if (res != ERROR_OK) return res; LOG_DEBUG("MODE: 0x%02X", mode); /* try to exit current mode */ switch (mode) { case STLINK_DEV_DFU_MODE: emode = STLINK_MODE_DFU; break; case STLINK_DEV_DEBUG_MODE: emode = STLINK_MODE_DEBUG_SWD; break; case STLINK_DEV_SWIM_MODE: emode = STLINK_MODE_DEBUG_SWIM; break; case STLINK_DEV_BOOTLOADER_MODE: case STLINK_DEV_MASS_MODE: default: emode = STLINK_MODE_UNKNOWN; break; } if (emode != STLINK_MODE_UNKNOWN) return stlink_usb_mode_leave(handle, emode); return ERROR_OK; } /** */ static int stlink_usb_init_mode(void *handle, bool connect_under_reset, int initial_interface_speed) { int res; uint8_t mode; enum stlink_mode emode; struct stlink_usb_handle *h = handle; assert(handle); res = stlink_usb_exit_mode(handle); if (res != ERROR_OK) return res; res = stlink_usb_current_mode(handle, &mode); if (res != ERROR_OK) return res; /* we check the target voltage here as an aid to debugging connection problems. * the stlink requires the target Vdd to be connected for reliable debugging. * this cmd is supported in all modes except DFU */ if (mode != STLINK_DEV_DFU_MODE) { float target_voltage; /* check target voltage (if supported) */ res = stlink_usb_check_voltage(h, &target_voltage); if (res != ERROR_OK) { if (res != ERROR_COMMAND_NOTFOUND) LOG_ERROR("voltage check failed"); /* attempt to continue as it is not a catastrophic failure */ } else { /* check for a sensible target voltage, operating range is 1.65-5.5v * according to datasheet */ if (target_voltage < 1.5) LOG_ERROR("target voltage may be too low for reliable debugging"); } } LOG_DEBUG("MODE: 0x%02X", mode); /* set selected mode */ emode = h->st_mode; if (emode == STLINK_MODE_UNKNOWN) { LOG_ERROR("selected mode (transport) not supported"); return ERROR_FAIL; } /* set the speed before entering the mode, as the chip discovery phase should be done at this speed too */ if (emode == STLINK_MODE_DEBUG_JTAG) { if (h->version.flags & STLINK_F_HAS_JTAG_SET_FREQ) { stlink_dump_speed_map(stlink_khz_to_speed_map_jtag, ARRAY_SIZE(stlink_khz_to_speed_map_jtag)); stlink_speed(h, initial_interface_speed, false); } } else if (emode == STLINK_MODE_DEBUG_SWD) { if (h->version.flags & STLINK_F_HAS_SWD_SET_FREQ) { stlink_dump_speed_map(stlink_khz_to_speed_map_swd, ARRAY_SIZE(stlink_khz_to_speed_map_swd)); stlink_speed(h, initial_interface_speed, false); } } if (h->version.jtag_api == STLINK_JTAG_API_V3 && (emode == STLINK_MODE_DEBUG_JTAG || emode == STLINK_MODE_DEBUG_SWD)) { struct speed_map map[STLINK_V3_MAX_FREQ_NB]; stlink_get_com_freq(h, (emode == STLINK_MODE_DEBUG_JTAG), map); stlink_dump_speed_map(map, ARRAY_SIZE(map)); stlink_speed(h, initial_interface_speed, false); } /* preliminary SRST assert: * We want SRST is asserted before activating debug signals (mode_enter). * As the required mode has not been set, the adapter may not know what pin to use. * Tested firmware STLINK v2 JTAG v29 API v2 SWIM v0 uses T_NRST pin by default * Tested firmware STLINK v2 JTAG v27 API v2 SWIM v6 uses T_NRST pin by default * after power on, SWIM_RST stays unchanged */ if (connect_under_reset && emode != STLINK_MODE_DEBUG_SWIM) stlink_usb_assert_srst(handle, 0); /* do not check the return status here, we will proceed and enter the desired mode below and try asserting srst again. */ res = stlink_usb_mode_enter(handle, emode); if (res != ERROR_OK) return res; /* assert SRST again: a little bit late but now the adapter knows for sure what pin to use */ if (connect_under_reset) { res = stlink_usb_assert_srst(handle, 0); if (res != ERROR_OK) return res; } res = stlink_usb_current_mode(handle, &mode); if (res != ERROR_OK) return res; LOG_DEBUG("MODE: 0x%02X", mode); return ERROR_OK; } /* request status from last swim request */ static int stlink_swim_status(void *handle) { struct stlink_usb_handle *h = handle; int res; stlink_usb_init_buffer(handle, h->rx_ep, 4); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_READSTATUS; /* error is checked by the caller */ res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 4); if (res != ERROR_OK) return res; return ERROR_OK; } /* the purpose of this function is unknown... capabilities? anyway for swim v6 it returns 0001020600000000 */ __attribute__((unused)) static int stlink_swim_cap(void *handle, uint8_t *cap) { struct stlink_usb_handle *h = handle; int res; stlink_usb_init_buffer(handle, h->rx_ep, 8); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_READ_CAP; h->cmdbuf[h->cmdidx++] = 0x01; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 8); if (res != ERROR_OK) return res; memcpy(cap, h->databuf, 8); return ERROR_OK; } /* debug dongle assert/deassert sreset line */ static int stlink_swim_assert_reset(void *handle, int reset) { struct stlink_usb_handle *h = handle; int res; stlink_usb_init_buffer(handle, h->rx_ep, 0); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; if (!reset) h->cmdbuf[h->cmdidx++] = STLINK_SWIM_ASSERT_RESET; else h->cmdbuf[h->cmdidx++] = STLINK_SWIM_DEASSERT_RESET; res = stlink_cmd_allow_retry(handle, h->databuf, 0); if (res != ERROR_OK) return res; return ERROR_OK; } /* send swim enter seq 1.3ms low then 750Hz then 1.5kHz */ static int stlink_swim_enter(void *handle) { struct stlink_usb_handle *h = handle; int res; stlink_usb_init_buffer(handle, h->rx_ep, 0); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_ENTER_SEQ; res = stlink_cmd_allow_retry(handle, h->databuf, 0); if (res != ERROR_OK) return res; return ERROR_OK; } /* switch high/low speed swim */ static int stlink_swim_speed(void *handle, int speed) { struct stlink_usb_handle *h = handle; int res; stlink_usb_init_buffer(handle, h->rx_ep, 0); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_SPEED; if (speed) h->cmdbuf[h->cmdidx++] = 1; else h->cmdbuf[h->cmdidx++] = 0; res = stlink_cmd_allow_retry(handle, h->databuf, 0); if (res != ERROR_OK) return res; return ERROR_OK; } /* initiate srst from swim. nrst is pulled low for 50us. */ static int stlink_swim_generate_rst(void *handle) { struct stlink_usb_handle *h = handle; int res; stlink_usb_init_buffer(handle, h->rx_ep, 0); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_GEN_RST; res = stlink_cmd_allow_retry(handle, h->databuf, 0); if (res != ERROR_OK) return res; return ERROR_OK; } /* send resynchronize sequence swim is pulled low for 16us reply is 64 clks low */ static int stlink_swim_resync(void *handle) { struct stlink_usb_handle *h = handle; int res; stlink_usb_init_buffer(handle, h->rx_ep, 0); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_RESET; res = stlink_cmd_allow_retry(handle, h->databuf, 0); if (res != ERROR_OK) return res; return ERROR_OK; } static int stlink_swim_writebytes(void *handle, uint32_t addr, uint32_t len, const uint8_t *data) { struct stlink_usb_handle *h = handle; int res; unsigned int i; unsigned int datalen = 0; int cmdsize = STLINK_CMD_SIZE_V2; if (len > STLINK_SWIM_DATA_SIZE) return ERROR_FAIL; if (h->version.stlink == 1) cmdsize = STLINK_SG_SIZE; stlink_usb_init_buffer(handle, h->tx_ep, 0); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_WRITEMEM; h_u16_to_be(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h_u32_to_be(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; for (i = 0; i < len; i++) { if (h->cmdidx == cmdsize) h->databuf[datalen++] = *(data++); else h->cmdbuf[h->cmdidx++] = *(data++); } if (h->version.stlink == 1) stlink_usb_set_cbw_transfer_datalength(handle, datalen); res = stlink_cmd_allow_retry(handle, h->databuf, datalen); if (res != ERROR_OK) return res; return ERROR_OK; } static int stlink_swim_readbytes(void *handle, uint32_t addr, uint32_t len, uint8_t *data) { struct stlink_usb_handle *h = handle; int res; if (len > STLINK_SWIM_DATA_SIZE) return ERROR_FAIL; stlink_usb_init_buffer(handle, h->rx_ep, 0); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_READMEM; h_u16_to_be(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h_u32_to_be(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; res = stlink_cmd_allow_retry(handle, h->databuf, 0); if (res != ERROR_OK) return res; stlink_usb_init_buffer(handle, h->rx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_SWIM_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_SWIM_READBUF; res = stlink_usb_xfer_noerrcheck(handle, data, len); if (res != ERROR_OK) return res; return ERROR_OK; } /** */ static int stlink_usb_idcode(void *handle, uint32_t *idcode) { int res, offset; struct stlink_usb_handle *h = handle; assert(handle); /* there is no swim read core id cmd */ if (h->st_mode == STLINK_MODE_DEBUG_SWIM) { *idcode = 0; return ERROR_OK; } stlink_usb_init_buffer(handle, h->rx_ep, 12); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) { h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_READCOREID; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 4); offset = 0; } else { h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_READ_IDCODES; res = stlink_usb_xfer_errcheck(handle, h->databuf, 12); offset = 4; } if (res != ERROR_OK) return res; *idcode = le_to_h_u32(h->databuf + offset); LOG_DEBUG("IDCODE: 0x%08" PRIX32, *idcode); return ERROR_OK; } static int stlink_usb_v2_read_debug_reg(void *handle, uint32_t addr, uint32_t *val) { struct stlink_usb_handle *h = handle; int res; assert(handle); stlink_usb_init_buffer(handle, h->rx_ep, 8); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_READDEBUGREG; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; res = stlink_cmd_allow_retry(handle, h->databuf, 8); if (res != ERROR_OK) return res; *val = le_to_h_u32(h->databuf + 4); return ERROR_OK; } static int stlink_usb_write_debug_reg(void *handle, uint32_t addr, uint32_t val) { struct stlink_usb_handle *h = handle; assert(handle); stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV1_WRITEDEBUGREG; else h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_WRITEDEBUGREG; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; h_u32_to_le(h->cmdbuf+h->cmdidx, val); h->cmdidx += 4; return stlink_cmd_allow_retry(handle, h->databuf, 2); } /** */ static int stlink_usb_trace_read(void *handle, uint8_t *buf, size_t *size) { struct stlink_usb_handle *h = handle; assert(handle); if (h->trace.enabled && (h->version.flags & STLINK_F_HAS_TRACE)) { int res; stlink_usb_init_buffer(handle, h->rx_ep, 10); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_GET_TRACE_NB; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 2); if (res != ERROR_OK) return res; size_t bytes_avail = le_to_h_u16(h->databuf); *size = bytes_avail < *size ? bytes_avail : *size; if (*size > 0) { res = stlink_usb_read_trace(handle, buf, *size); if (res != ERROR_OK) return res; return ERROR_OK; } } *size = 0; return ERROR_OK; } static enum target_state stlink_usb_v2_get_status(void *handle) { int result; uint32_t status; result = stlink_usb_v2_read_debug_reg(handle, DCB_DHCSR, &status); if (result != ERROR_OK) return TARGET_UNKNOWN; if (status & S_HALT) return TARGET_HALTED; else if (status & S_RESET_ST) return TARGET_RESET; return TARGET_RUNNING; } /** */ static enum target_state stlink_usb_state(void *handle) { int res; struct stlink_usb_handle *h = handle; assert(handle); if (h->reconnect_pending) { LOG_INFO("Previous state query failed, trying to reconnect"); res = stlink_usb_mode_enter(handle, h->st_mode); if (res != ERROR_OK) return TARGET_UNKNOWN; h->reconnect_pending = false; } if (h->version.jtag_api != STLINK_JTAG_API_V1) { res = stlink_usb_v2_get_status(handle); if (res == TARGET_UNKNOWN) h->reconnect_pending = true; return res; } stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_GETSTATUS; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 2); if (res != ERROR_OK) return TARGET_UNKNOWN; if (h->databuf[0] == STLINK_CORE_RUNNING) return TARGET_RUNNING; if (h->databuf[0] == STLINK_CORE_HALTED) return TARGET_HALTED; h->reconnect_pending = true; return TARGET_UNKNOWN; } static int stlink_usb_assert_srst(void *handle, int srst) { struct stlink_usb_handle *h = handle; assert(handle); if (h->st_mode == STLINK_MODE_DEBUG_SWIM) return stlink_swim_assert_reset(handle, srst); if (h->version.stlink == 1) return ERROR_COMMAND_NOTFOUND; stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_DRIVE_NRST; h->cmdbuf[h->cmdidx++] = srst; return stlink_cmd_allow_retry(handle, h->databuf, 2); } /** */ static void stlink_usb_trace_disable(void *handle) { int res = ERROR_OK; struct stlink_usb_handle *h = handle; assert(handle); assert(h->version.flags & STLINK_F_HAS_TRACE); LOG_DEBUG("Tracing: disable"); stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_STOP_TRACE_RX; res = stlink_usb_xfer_errcheck(handle, h->databuf, 2); if (res == ERROR_OK) h->trace.enabled = false; } /** */ static int stlink_usb_trace_enable(void *handle) { int res; struct stlink_usb_handle *h = handle; assert(handle); if (h->version.flags & STLINK_F_HAS_TRACE) { stlink_usb_init_buffer(handle, h->rx_ep, 10); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_START_TRACE_RX; h_u16_to_le(h->cmdbuf+h->cmdidx, (uint16_t)STLINK_TRACE_SIZE); h->cmdidx += 2; h_u32_to_le(h->cmdbuf+h->cmdidx, h->trace.source_hz); h->cmdidx += 4; res = stlink_usb_xfer_errcheck(handle, h->databuf, 2); if (res == ERROR_OK) { h->trace.enabled = true; LOG_DEBUG("Tracing: recording at %" PRIu32 "Hz", h->trace.source_hz); } } else { LOG_ERROR("Tracing is not supported by this version."); res = ERROR_FAIL; } return res; } /** */ static int stlink_usb_reset(void *handle) { struct stlink_usb_handle *h = handle; int retval; assert(handle); stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV1_RESETSYS; else h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_RESETSYS; retval = stlink_cmd_allow_retry(handle, h->databuf, 2); if (retval != ERROR_OK) return retval; if (h->trace.enabled) { stlink_usb_trace_disable(h); return stlink_usb_trace_enable(h); } return ERROR_OK; } /** */ static int stlink_usb_run(void *handle) { int res; struct stlink_usb_handle *h = handle; assert(handle); if (h->version.jtag_api != STLINK_JTAG_API_V1) { res = stlink_usb_write_debug_reg(handle, DCB_DHCSR, DBGKEY|C_DEBUGEN); return res; } stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_RUNCORE; return stlink_cmd_allow_retry(handle, h->databuf, 2); } /** */ static int stlink_usb_halt(void *handle) { int res; struct stlink_usb_handle *h = handle; assert(handle); if (h->version.jtag_api != STLINK_JTAG_API_V1) { res = stlink_usb_write_debug_reg(handle, DCB_DHCSR, DBGKEY|C_HALT|C_DEBUGEN); return res; } stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_FORCEDEBUG; return stlink_cmd_allow_retry(handle, h->databuf, 2); } /** */ static int stlink_usb_step(void *handle) { struct stlink_usb_handle *h = handle; assert(handle); if (h->version.jtag_api != STLINK_JTAG_API_V1) { /* TODO: this emulates the v1 api, it should really use a similar auto mask isr * that the Cortex-M3 currently does. */ stlink_usb_write_debug_reg(handle, DCB_DHCSR, DBGKEY|C_HALT|C_MASKINTS|C_DEBUGEN); stlink_usb_write_debug_reg(handle, DCB_DHCSR, DBGKEY|C_STEP|C_MASKINTS|C_DEBUGEN); return stlink_usb_write_debug_reg(handle, DCB_DHCSR, DBGKEY|C_HALT|C_DEBUGEN); } stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_STEPCORE; return stlink_cmd_allow_retry(handle, h->databuf, 2); } /** */ static int stlink_usb_read_regs(void *handle) { int res; struct stlink_usb_handle *h = handle; assert(handle); stlink_usb_init_buffer(handle, h->rx_ep, 88); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) { h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV1_READALLREGS; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 84); /* regs data from offset 0 */ } else { h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_READALLREGS; res = stlink_usb_xfer_errcheck(handle, h->databuf, 88); /* status at offset 0, regs data from offset 4 */ } return res; } /** */ static int stlink_usb_read_reg(void *handle, unsigned int regsel, uint32_t *val) { int res; struct stlink_usb_handle *h = handle; assert(handle); if (STLINK_REGSEL_IS_FPU(regsel) && !(h->version.flags & STLINK_F_HAS_FPU_REG)) { res = stlink_usb_write_debug_reg(h, DCB_DCRSR, regsel & 0x7f); if (res != ERROR_OK) return res; /* FIXME: poll DHCSR.S_REGRDY before read DCRDR */ return stlink_usb_v2_read_debug_reg(h, DCB_DCRDR, val); } stlink_usb_init_buffer(handle, h->rx_ep, h->version.jtag_api == STLINK_JTAG_API_V1 ? 4 : 8); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV1_READREG; else h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_READREG; h->cmdbuf[h->cmdidx++] = regsel; if (h->version.jtag_api == STLINK_JTAG_API_V1) { res = stlink_usb_xfer_noerrcheck(handle, h->databuf, 4); if (res != ERROR_OK) return res; *val = le_to_h_u32(h->databuf); return ERROR_OK; } else { res = stlink_cmd_allow_retry(handle, h->databuf, 8); if (res != ERROR_OK) return res; *val = le_to_h_u32(h->databuf + 4); return ERROR_OK; } } /** */ static int stlink_usb_write_reg(void *handle, unsigned int regsel, uint32_t val) { struct stlink_usb_handle *h = handle; assert(handle); if (STLINK_REGSEL_IS_FPU(regsel) && !(h->version.flags & STLINK_F_HAS_FPU_REG)) { int res = stlink_usb_write_debug_reg(h, DCB_DCRDR, val); if (res != ERROR_OK) return res; return stlink_usb_write_debug_reg(h, DCB_DCRSR, DCRSR_WNR | (regsel & 0x7f)); /* FIXME: poll DHCSR.S_REGRDY after write DCRSR */ } stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.jtag_api == STLINK_JTAG_API_V1) h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV1_WRITEREG; else h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_WRITEREG; h->cmdbuf[h->cmdidx++] = regsel; h_u32_to_le(h->cmdbuf+h->cmdidx, val); h->cmdidx += 4; return stlink_cmd_allow_retry(handle, h->databuf, 2); } static int stlink_usb_get_rw_status(void *handle) { struct stlink_usb_handle *h = handle; assert(handle); if (h->version.jtag_api == STLINK_JTAG_API_V1) return ERROR_OK; stlink_usb_init_buffer(handle, h->rx_ep, 2); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; if (h->version.flags & STLINK_F_HAS_GETLASTRWSTATUS2) { h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_GETLASTRWSTATUS2; return stlink_usb_xfer_errcheck(handle, h->databuf, 12); } else { h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_GETLASTRWSTATUS; return stlink_usb_xfer_errcheck(handle, h->databuf, 2); } } /** */ static int stlink_usb_read_mem8(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, uint8_t *buffer) { int res; uint16_t read_len = len; struct stlink_usb_handle *h = handle; assert(handle); if ((ap_num != 0 || csw != 0) && !(h->version.flags & STLINK_F_HAS_CSW)) return ERROR_COMMAND_NOTFOUND; /* max 8 bit read/write is 64 bytes or 512 bytes for v3 */ if (len > stlink_usb_block(h)) { LOG_DEBUG("max buffer (%d) length exceeded", stlink_usb_block(h)); return ERROR_FAIL; } stlink_usb_init_buffer(handle, h->rx_ep, read_len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_READMEM_8BIT; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; /* we need to fix read length for single bytes */ if (read_len == 1) read_len++; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, read_len); if (res != ERROR_OK) return res; memcpy(buffer, h->databuf, len); return stlink_usb_get_rw_status(handle); } /** */ static int stlink_usb_write_mem8(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, const uint8_t *buffer) { int res; struct stlink_usb_handle *h = handle; assert(handle); if ((ap_num != 0 || csw != 0) && !(h->version.flags & STLINK_F_HAS_CSW)) return ERROR_COMMAND_NOTFOUND; /* max 8 bit read/write is 64 bytes or 512 bytes for v3 */ if (len > stlink_usb_block(h)) { LOG_DEBUG("max buffer length (%d) exceeded", stlink_usb_block(h)); return ERROR_FAIL; } stlink_usb_init_buffer(handle, h->tx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_WRITEMEM_8BIT; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; res = stlink_usb_xfer_noerrcheck(handle, buffer, len); if (res != ERROR_OK) return res; return stlink_usb_get_rw_status(handle); } /** */ static int stlink_usb_read_mem16(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, uint8_t *buffer) { int res; struct stlink_usb_handle *h = handle; assert(handle); if (!(h->version.flags & STLINK_F_HAS_MEM_16BIT)) return ERROR_COMMAND_NOTFOUND; if ((ap_num != 0 || csw != 0) && !(h->version.flags & STLINK_F_HAS_CSW)) return ERROR_COMMAND_NOTFOUND; if (len > STLINK_MAX_RW16_32) { LOG_DEBUG("max buffer (%d) length exceeded", STLINK_MAX_RW16_32); return ERROR_FAIL; } /* data must be a multiple of 2 and half-word aligned */ if (len % 2 || addr % 2) { LOG_DEBUG("Invalid data alignment"); return ERROR_TARGET_UNALIGNED_ACCESS; } stlink_usb_init_buffer(handle, h->rx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_READMEM_16BIT; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, len); if (res != ERROR_OK) return res; memcpy(buffer, h->databuf, len); return stlink_usb_get_rw_status(handle); } /** */ static int stlink_usb_write_mem16(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, const uint8_t *buffer) { int res; struct stlink_usb_handle *h = handle; assert(handle); if (!(h->version.flags & STLINK_F_HAS_MEM_16BIT)) return ERROR_COMMAND_NOTFOUND; if ((ap_num != 0 || csw != 0) && !(h->version.flags & STLINK_F_HAS_CSW)) return ERROR_COMMAND_NOTFOUND; if (len > STLINK_MAX_RW16_32) { LOG_DEBUG("max buffer (%d) length exceeded", STLINK_MAX_RW16_32); return ERROR_FAIL; } /* data must be a multiple of 2 and half-word aligned */ if (len % 2 || addr % 2) { LOG_DEBUG("Invalid data alignment"); return ERROR_TARGET_UNALIGNED_ACCESS; } stlink_usb_init_buffer(handle, h->tx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_WRITEMEM_16BIT; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; res = stlink_usb_xfer_noerrcheck(handle, buffer, len); if (res != ERROR_OK) return res; return stlink_usb_get_rw_status(handle); } /** */ static int stlink_usb_read_mem32(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, uint8_t *buffer) { int res; struct stlink_usb_handle *h = handle; assert(handle); if ((ap_num != 0 || csw != 0) && !(h->version.flags & STLINK_F_HAS_CSW)) return ERROR_COMMAND_NOTFOUND; if (len > STLINK_MAX_RW16_32) { LOG_DEBUG("max buffer (%d) length exceeded", STLINK_MAX_RW16_32); return ERROR_FAIL; } /* data must be a multiple of 4 and word aligned */ if (len % 4 || addr % 4) { LOG_DEBUG("Invalid data alignment"); return ERROR_TARGET_UNALIGNED_ACCESS; } stlink_usb_init_buffer(handle, h->rx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_READMEM_32BIT; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; res = stlink_usb_xfer_noerrcheck(handle, h->databuf, len); if (res != ERROR_OK) return res; memcpy(buffer, h->databuf, len); return stlink_usb_get_rw_status(handle); } /** */ static int stlink_usb_write_mem32(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, const uint8_t *buffer) { int res; struct stlink_usb_handle *h = handle; assert(handle); if ((ap_num != 0 || csw != 0) && !(h->version.flags & STLINK_F_HAS_CSW)) return ERROR_COMMAND_NOTFOUND; if (len > STLINK_MAX_RW16_32) { LOG_DEBUG("max buffer (%d) length exceeded", STLINK_MAX_RW16_32); return ERROR_FAIL; } /* data must be a multiple of 4 and word aligned */ if (len % 4 || addr % 4) { LOG_DEBUG("Invalid data alignment"); return ERROR_TARGET_UNALIGNED_ACCESS; } stlink_usb_init_buffer(handle, h->tx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_WRITEMEM_32BIT; h_u32_to_le(h->cmdbuf+h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf+h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; res = stlink_usb_xfer_noerrcheck(handle, buffer, len); if (res != ERROR_OK) return res; return stlink_usb_get_rw_status(handle); } static int stlink_usb_read_mem32_noaddrinc(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, uint8_t *buffer) { struct stlink_usb_handle *h = handle; assert(handle != NULL); if (!(h->version.flags & STLINK_F_HAS_MEM_RD_NO_INC)) return ERROR_COMMAND_NOTFOUND; if (len > STLINK_MAX_RW16_32) { LOG_DEBUG("max buffer (%d) length exceeded", STLINK_MAX_RW16_32); return ERROR_FAIL; } /* data must be a multiple of 4 and word aligned */ if (len % 4 || addr % 4) { LOG_DEBUG("Invalid data alignment"); return ERROR_TARGET_UNALIGNED_ACCESS; } stlink_usb_init_buffer(handle, h->rx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_READMEM_32BIT_NO_ADDR_INC; h_u32_to_le(h->cmdbuf + h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf + h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; int retval = stlink_usb_xfer_noerrcheck(handle, h->databuf, len); if (retval != ERROR_OK) return retval; memcpy(buffer, h->databuf, len); return stlink_usb_get_rw_status(handle); } static int stlink_usb_write_mem32_noaddrinc(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint16_t len, const uint8_t *buffer) { struct stlink_usb_handle *h = handle; assert(handle != NULL); if (!(h->version.flags & STLINK_F_HAS_MEM_WR_NO_INC)) return ERROR_COMMAND_NOTFOUND; if (len > STLINK_MAX_RW16_32) { LOG_DEBUG("max buffer (%d) length exceeded", STLINK_MAX_RW16_32); return ERROR_FAIL; } /* data must be a multiple of 4 and word aligned */ if (len % 4 || addr % 4) { LOG_DEBUG("Invalid data alignment"); return ERROR_TARGET_UNALIGNED_ACCESS; } stlink_usb_init_buffer(handle, h->tx_ep, len); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_WRITEMEM_32BIT_NO_ADDR_INC; h_u32_to_le(h->cmdbuf + h->cmdidx, addr); h->cmdidx += 4; h_u16_to_le(h->cmdbuf + h->cmdidx, len); h->cmdidx += 2; h->cmdbuf[h->cmdidx++] = ap_num; h_u24_to_le(h->cmdbuf + h->cmdidx, csw >> 8); h->cmdidx += 3; int retval = stlink_usb_xfer_noerrcheck(handle, buffer, len); if (retval != ERROR_OK) return retval; return stlink_usb_get_rw_status(handle); } static uint32_t stlink_max_block_size(uint32_t tar_autoincr_block, uint32_t address) { uint32_t max_tar_block = (tar_autoincr_block - ((tar_autoincr_block - 1) & address)); if (max_tar_block == 0) max_tar_block = 4; return max_tar_block; } static int stlink_usb_read_ap_mem(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint32_t size, uint32_t count, uint8_t *buffer) { int retval = ERROR_OK; uint32_t bytes_remaining; int retries = 0; struct stlink_usb_handle *h = handle; /* calculate byte count */ count *= size; /* switch to 8 bit if stlink does not support 16 bit memory read */ if (size == 2 && !(h->version.flags & STLINK_F_HAS_MEM_16BIT)) size = 1; while (count) { bytes_remaining = (size != 1) ? stlink_max_block_size(h->max_mem_packet, addr) : stlink_usb_block(h); if (count < bytes_remaining) bytes_remaining = count; /* * all stlink support 8/32bit memory read/writes and only from * stlink V2J26 there is support for 16 bit memory read/write. * Honour 32 bit and, if possible, 16 bit too. Otherwise, handle * as 8bit access. */ if (size != 1) { /* When in jtag mode the stlink uses the auto-increment functionality. * However it expects us to pass the data correctly, this includes * alignment and any page boundaries. We already do this as part of the * adi_v5 implementation, but the stlink is a hla adapter and so this * needs implementing manually. * currently this only affects jtag mode, according to ST they do single * access in SWD mode - but this may change and so we do it for both modes */ /* we first need to check for any unaligned bytes */ if (addr & (size - 1)) { uint32_t head_bytes = size - (addr & (size - 1)); retval = stlink_usb_read_mem8(handle, ap_num, csw, addr, head_bytes, buffer); if (retval == ERROR_WAIT && retries < MAX_WAIT_RETRIES) { usleep((1 << retries++) * 1000); continue; } if (retval != ERROR_OK) return retval; buffer += head_bytes; addr += head_bytes; count -= head_bytes; bytes_remaining -= head_bytes; } if (bytes_remaining & (size - 1)) retval = stlink_usb_read_ap_mem(handle, ap_num, csw, addr, 1, bytes_remaining, buffer); else if (size == 2) retval = stlink_usb_read_mem16(handle, ap_num, csw, addr, bytes_remaining, buffer); else retval = stlink_usb_read_mem32(handle, ap_num, csw, addr, bytes_remaining, buffer); } else { retval = stlink_usb_read_mem8(handle, ap_num, csw, addr, bytes_remaining, buffer); } if (retval == ERROR_WAIT && retries < MAX_WAIT_RETRIES) { usleep((1 << retries++) * 1000); continue; } if (retval != ERROR_OK) return retval; buffer += bytes_remaining; addr += bytes_remaining; count -= bytes_remaining; } return retval; } static int stlink_usb_read_mem(void *handle, uint32_t addr, uint32_t size, uint32_t count, uint8_t *buffer) { return stlink_usb_read_ap_mem(handle, STLINK_HLA_AP_NUM, STLINK_HLA_CSW, addr, size, count, buffer); } static int stlink_usb_write_ap_mem(void *handle, uint8_t ap_num, uint32_t csw, uint32_t addr, uint32_t size, uint32_t count, const uint8_t *buffer) { int retval = ERROR_OK; uint32_t bytes_remaining; int retries = 0; struct stlink_usb_handle *h = handle; /* calculate byte count */ count *= size; /* switch to 8 bit if stlink does not support 16 bit memory read */ if (size == 2 && !(h->version.flags & STLINK_F_HAS_MEM_16BIT)) size = 1; while (count) { bytes_remaining = (size != 1) ? stlink_max_block_size(h->max_mem_packet, addr) : stlink_usb_block(h); if (count < bytes_remaining) bytes_remaining = count; /* * all stlink support 8/32bit memory read/writes and only from * stlink V2J26 there is support for 16 bit memory read/write. * Honour 32 bit and, if possible, 16 bit too. Otherwise, handle * as 8bit access. */ if (size != 1) { /* When in jtag mode the stlink uses the auto-increment functionality. * However it expects us to pass the data correctly, this includes * alignment and any page boundaries. We already do this as part of the * adi_v5 implementation, but the stlink is a hla adapter and so this * needs implementing manually. * currently this only affects jtag mode, according to ST they do single * access in SWD mode - but this may change and so we do it for both modes */ /* we first need to check for any unaligned bytes */ if (addr & (size - 1)) { uint32_t head_bytes = size - (addr & (size - 1)); retval = stlink_usb_write_mem8(handle, ap_num, csw, addr, head_bytes, buffer); if (retval == ERROR_WAIT && retries < MAX_WAIT_RETRIES) { usleep((1<<retries++) * 1000); continue; } if (retval != ERROR_OK) return retval; buffer += head_bytes; addr += head_bytes; count -= head_bytes; bytes_remaining -= head_bytes; } if (bytes_remaining & (size - 1)) retval = stlink_usb_write_ap_mem(handle, ap_num, csw, addr, 1, bytes_remaining, buffer); else if (size == 2) retval = stlink_usb_write_mem16(handle, ap_num, csw, addr, bytes_remaining, buffer); else retval = stlink_usb_write_mem32(handle, ap_num, csw, addr, bytes_remaining, buffer); } else retval = stlink_usb_write_mem8(handle, ap_num, csw, addr, bytes_remaining, buffer); if (retval == ERROR_WAIT && retries < MAX_WAIT_RETRIES) { usleep((1<<retries++) * 1000); continue; } if (retval != ERROR_OK) return retval; buffer += bytes_remaining; addr += bytes_remaining; count -= bytes_remaining; } return retval; } static int stlink_usb_write_mem(void *handle, uint32_t addr, uint32_t size, uint32_t count, const uint8_t *buffer) { return stlink_usb_write_ap_mem(handle, STLINK_HLA_AP_NUM, STLINK_HLA_CSW, addr, size, count, buffer); } /** */ static int stlink_usb_override_target(const char *targetname) { return !strcmp(targetname, "cortex_m"); } static int stlink_speed_swim(void *handle, int khz, bool query) { int retval; /* we only have low and high speed... before changing speed the SWIM_CSR HS bit must be updated */ if (!query) { retval = stlink_swim_speed(handle, (khz < SWIM_FREQ_HIGH) ? 0 : 1); if (retval != ERROR_OK) LOG_ERROR("Unable to set adapter speed"); } return (khz < SWIM_FREQ_HIGH) ? SWIM_FREQ_LOW : SWIM_FREQ_HIGH; } static int stlink_match_speed_map(const struct speed_map *map, unsigned int map_size, int khz, bool query) { unsigned int i; int speed_index = -1; int speed_diff = INT_MAX; int last_valid_speed = -1; bool match = true; for (i = 0; i < map_size; i++) { if (!map[i].speed) continue; last_valid_speed = i; if (khz == map[i].speed) { speed_index = i; break; } else { int current_diff = khz - map[i].speed; /* get abs value for comparison */ current_diff = (current_diff > 0) ? current_diff : -current_diff; if ((current_diff < speed_diff) && khz >= map[i].speed) { speed_diff = current_diff; speed_index = i; } } } if (speed_index == -1) { /* this will only be here if we cannot match the slow speed. * use the slowest speed we support.*/ speed_index = last_valid_speed; match = false; } else if (i == map_size) match = false; if (!match && query) { LOG_INFO("Unable to match requested speed %d kHz, using %d kHz", khz, map[speed_index].speed); } return speed_index; } static int stlink_speed_swd(void *handle, int khz, bool query) { int speed_index; struct stlink_usb_handle *h = handle; /* old firmware cannot change it */ if (!(h->version.flags & STLINK_F_HAS_SWD_SET_FREQ)) return khz; speed_index = stlink_match_speed_map(stlink_khz_to_speed_map_swd, ARRAY_SIZE(stlink_khz_to_speed_map_swd), khz, query); if (!query) { int result = stlink_usb_set_swdclk(h, stlink_khz_to_speed_map_swd[speed_index].speed_divisor); if (result != ERROR_OK) { LOG_ERROR("Unable to set adapter speed"); return khz; } } return stlink_khz_to_speed_map_swd[speed_index].speed; } static int stlink_speed_jtag(void *handle, int khz, bool query) { int speed_index; struct stlink_usb_handle *h = handle; /* old firmware cannot change it */ if (!(h->version.flags & STLINK_F_HAS_JTAG_SET_FREQ)) return khz; speed_index = stlink_match_speed_map(stlink_khz_to_speed_map_jtag, ARRAY_SIZE(stlink_khz_to_speed_map_jtag), khz, query); if (!query) { int result = stlink_usb_set_jtagclk(h, stlink_khz_to_speed_map_jtag[speed_index].speed_divisor); if (result != ERROR_OK) { LOG_ERROR("Unable to set adapter speed"); return khz; } } return stlink_khz_to_speed_map_jtag[speed_index].speed; } static void stlink_dump_speed_map(const struct speed_map *map, unsigned int map_size) { unsigned int i; LOG_DEBUG("Supported clock speeds are:"); for (i = 0; i < map_size; i++) if (map[i].speed) LOG_DEBUG("%d kHz", map[i].speed); } static int stlink_get_com_freq(void *handle, bool is_jtag, struct speed_map *map) { struct stlink_usb_handle *h = handle; int i; if (h->version.jtag_api != STLINK_JTAG_API_V3) { LOG_ERROR("Unknown command"); return 0; } stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_APIV3_GET_COM_FREQ; h->cmdbuf[h->cmdidx++] = is_jtag ? 1 : 0; int res = stlink_usb_xfer_errcheck(handle, h->databuf, 52); int size = h->databuf[8]; if (size > STLINK_V3_MAX_FREQ_NB) size = STLINK_V3_MAX_FREQ_NB; for (i = 0; i < size; i++) { map[i].speed = le_to_h_u32(&h->databuf[12 + 4 * i]); map[i].speed_divisor = i; } /* set to zero all the next entries */ for (i = size; i < STLINK_V3_MAX_FREQ_NB; i++) map[i].speed = 0; return res; } static int stlink_set_com_freq(void *handle, bool is_jtag, unsigned int frequency) { struct stlink_usb_handle *h = handle; if (h->version.jtag_api != STLINK_JTAG_API_V3) { LOG_ERROR("Unknown command"); return 0; } stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_APIV3_SET_COM_FREQ; h->cmdbuf[h->cmdidx++] = is_jtag ? 1 : 0; h->cmdbuf[h->cmdidx++] = 0; h_u32_to_le(&h->cmdbuf[4], frequency); return stlink_usb_xfer_errcheck(handle, h->databuf, 8); } static int stlink_speed_v3(void *handle, bool is_jtag, int khz, bool query) { struct stlink_usb_handle *h = handle; int speed_index; struct speed_map map[STLINK_V3_MAX_FREQ_NB]; stlink_get_com_freq(h, is_jtag, map); speed_index = stlink_match_speed_map(map, ARRAY_SIZE(map), khz, query); if (!query) { int result = stlink_set_com_freq(h, is_jtag, map[speed_index].speed); if (result != ERROR_OK) { LOG_ERROR("Unable to set adapter speed"); return khz; } } return map[speed_index].speed; } static int stlink_speed(void *handle, int khz, bool query) { struct stlink_usb_handle *h = handle; if (!handle) return khz; switch (h->st_mode) { case STLINK_MODE_DEBUG_SWIM: return stlink_speed_swim(handle, khz, query); case STLINK_MODE_DEBUG_SWD: if (h->version.jtag_api == STLINK_JTAG_API_V3) return stlink_speed_v3(handle, false, khz, query); else return stlink_speed_swd(handle, khz, query); break; case STLINK_MODE_DEBUG_JTAG: if (h->version.jtag_api == STLINK_JTAG_API_V3) return stlink_speed_v3(handle, true, khz, query); else return stlink_speed_jtag(handle, khz, query); break; default: break; } return khz; } /** */ static int stlink_usb_usb_close(void *handle) { struct stlink_usb_handle *h = handle; if (!h) return ERROR_OK; if (h->usb_backend_priv.fd) { stlink_usb_exit_mode(h); /* do not check return code, it prevent us from closing jtag_libusb */ jtag_libusb_close(h->usb_backend_priv.fd); } free(h->cmdbuf); free(h->databuf); return ERROR_OK; } /** */ static int stlink_tcp_close(void *handle) { struct stlink_usb_handle *h = handle; if (!h) return ERROR_OK; int ret = ERROR_OK; if (h->tcp_backend_priv.connected) { if (h->tcp_backend_priv.connect_id) { stlink_usb_exit_mode(h); /* close the stlink */ h->tcp_backend_priv.send_buf[0] = STLINK_TCP_CMD_CLOSE_DEV; memset(&h->tcp_backend_priv.send_buf[1], 0, 4); /* reserved */ h_u32_to_le(&h->tcp_backend_priv.send_buf[4], h->tcp_backend_priv.connect_id); ret = stlink_tcp_send_cmd(h, 8, 4, true); if (ret != ERROR_OK) LOG_ERROR("cannot close the STLINK"); } if (close_socket(h->tcp_backend_priv.fd) != 0) LOG_ERROR("error closing the socket, errno: %s", strerror(errno)); } free(h->tcp_backend_priv.send_buf); free(h->tcp_backend_priv.recv_buf); return ret; } /** */ static int stlink_close(void *handle) { if (handle) { struct stlink_usb_handle *h = handle; stlink_usb_close(handle); free(h); } return ERROR_OK; } /* Compute ST-Link serial number from the device descriptor * this function will help to work-around a bug in old ST-Link/V2 DFU * the buggy DFU returns an incorrect serial in the USB descriptor * example for the following serial "57FF72067265575742132067" * - the correct descriptor serial is: * 0x32, 0x03, 0x35, 0x00, 0x37, 0x00, 0x46, 0x00, 0x46, 0x00, 0x37, 0x00, 0x32, 0x00 ... * this contains the length (0x32 = 50), the type (0x3 = DT_STRING) and the serial in unicode format * the serial part is: 0x0035, 0x0037, 0x0046, 0x0046, 0x0037, 0x0032 ... >> 57FF72 ... * this format could be read correctly by 'libusb_get_string_descriptor_ascii' * so this case is managed by libusb_helper::string_descriptor_equal * - the buggy DFU is not doing any unicode conversion and returns a raw serial data in the descriptor * 0x1a, 0x03, 0x57, 0x00, 0xFF, 0x00, 0x72, 0x00 ... * >> 57 FF 72 ... * based on the length (0x1a = 26) we could easily decide if we have to fixup the serial * and then we have just to convert the raw data into printable characters using sprintf */ static char *stlink_usb_get_alternate_serial(struct libusb_device_handle *device, struct libusb_device_descriptor *dev_desc) { int usb_retval; unsigned char desc_serial[(STLINK_SERIAL_LEN + 1) * 2]; if (dev_desc->iSerialNumber == 0) return NULL; /* get the LANGID from String Descriptor Zero */ usb_retval = libusb_get_string_descriptor(device, 0, 0, desc_serial, sizeof(desc_serial)); if (usb_retval < LIBUSB_SUCCESS) { LOG_ERROR("libusb_get_string_descriptor() failed: %s(%d)", libusb_error_name(usb_retval), usb_retval); return NULL; } else if (usb_retval < 4) { /* the size should be least 4 bytes to contain a minimum of 1 supported LANGID */ LOG_ERROR("could not get the LANGID"); return NULL; } uint32_t langid = desc_serial[2] | (desc_serial[3] << 8); /* get the serial */ usb_retval = libusb_get_string_descriptor(device, dev_desc->iSerialNumber, langid, desc_serial, sizeof(desc_serial)); unsigned char len = desc_serial[0]; if (usb_retval < LIBUSB_SUCCESS) { LOG_ERROR("libusb_get_string_descriptor() failed: %s(%d)", libusb_error_name(usb_retval), usb_retval); return NULL; } else if (desc_serial[1] != LIBUSB_DT_STRING || len > usb_retval) { LOG_ERROR("invalid string in ST-LINK USB serial descriptor"); return NULL; } if (len == ((STLINK_SERIAL_LEN + 1) * 2)) { /* good ST-Link adapter, this case is managed by * libusb::libusb_get_string_descriptor_ascii */ return NULL; } else if (len != ((STLINK_SERIAL_LEN / 2 + 1) * 2)) { LOG_ERROR("unexpected serial length (%d) in descriptor", len); return NULL; } /* else (len == 26) => buggy ST-Link */ char *alternate_serial = malloc((STLINK_SERIAL_LEN + 1) * sizeof(char)); if (!alternate_serial) return NULL; for (unsigned int i = 0; i < STLINK_SERIAL_LEN; i += 2) sprintf(alternate_serial + i, "%02X", desc_serial[i + 2]); alternate_serial[STLINK_SERIAL_LEN] = '\0'; return alternate_serial; } /** */ static int stlink_usb_usb_open(void *handle, struct hl_interface_param *param) { struct stlink_usb_handle *h = handle; int err, retry_count = 1; h->cmdbuf = malloc(STLINK_SG_SIZE); h->databuf = malloc(STLINK_DATA_SIZE); if (!h->cmdbuf || !h->databuf) return ERROR_FAIL; /* On certain host USB configurations(e.g. MacBook Air) STLINKv2 dongle seems to have its FW in a funky state if, after plugging it in, you try to use openocd with it more then once (by launching and closing openocd). In cases like that initial attempt to read the FW info via stlink_usb_version will fail and the device has to be reset in order to become operational. */ do { if (jtag_libusb_open(param->vid, param->pid, NULL, &h->usb_backend_priv.fd, stlink_usb_get_alternate_serial) != ERROR_OK) { LOG_ERROR("open failed"); return ERROR_FAIL; } jtag_libusb_set_configuration(h->usb_backend_priv.fd, 0); if (libusb_claim_interface(h->usb_backend_priv.fd, 0) != ERROR_OK) { LOG_DEBUG("claim interface failed"); return ERROR_FAIL; } /* RX EP is common for all versions */ h->rx_ep = STLINK_RX_EP; uint16_t pid; if (jtag_libusb_get_pid(libusb_get_device(h->usb_backend_priv.fd), &pid) != ERROR_OK) { LOG_DEBUG("libusb_get_pid failed"); return ERROR_FAIL; } /* wrap version for first read */ switch (pid) { case STLINK_V1_PID: h->version.stlink = 1; h->tx_ep = STLINK_TX_EP; break; case STLINK_V3_USBLOADER_PID: case STLINK_V3E_PID: case STLINK_V3S_PID: case STLINK_V3_2VCP_PID: case STLINK_V3E_NO_MSD_PID: case STLINK_V3P_USBLOADER_PID: case STLINK_V3P_PID: h->version.stlink = 3; h->tx_ep = STLINK_V2_1_TX_EP; h->trace_ep = STLINK_V2_1_TRACE_EP; break; case STLINK_V2_1_PID: case STLINK_V2_1_NO_MSD_PID: h->version.stlink = 2; h->tx_ep = STLINK_V2_1_TX_EP; h->trace_ep = STLINK_V2_1_TRACE_EP; break; default: /* fall through - we assume V2 to be the default version*/ case STLINK_V2_PID: h->version.stlink = 2; h->tx_ep = STLINK_TX_EP; h->trace_ep = STLINK_TRACE_EP; break; } /* get the device version */ err = stlink_usb_version(h); if (err == ERROR_OK) { break; } else if (h->version.stlink == 1 || retry_count == 0) { LOG_ERROR("read version failed"); return ERROR_FAIL; } else { err = libusb_release_interface(h->usb_backend_priv.fd, 0); if (err != ERROR_OK) { LOG_ERROR("release interface failed"); return ERROR_FAIL; } err = libusb_reset_device(h->usb_backend_priv.fd); if (err != ERROR_OK) { LOG_ERROR("reset device failed"); return ERROR_FAIL; } jtag_libusb_close(h->usb_backend_priv.fd); /* Give the device one second to settle down and reenumerate. */ usleep(1 * 1000 * 1000); retry_count--; } } while (1); return ERROR_OK; } /** */ static int stlink_tcp_open(void *handle, struct hl_interface_param *param) { struct stlink_usb_handle *h = handle; int ret; /* SWIM is not supported using stlink-server */ if (h->st_mode == STLINK_MODE_DEBUG_SWIM) { LOG_ERROR("stlink-server does not support SWIM mode"); return ERROR_FAIL; } h->tcp_backend_priv.send_buf = malloc(STLINK_TCP_SEND_BUFFER_SIZE); h->tcp_backend_priv.recv_buf = malloc(STLINK_TCP_RECV_BUFFER_SIZE); if (!h->tcp_backend_priv.send_buf || !h->tcp_backend_priv.recv_buf) return ERROR_FAIL; h->cmdbuf = &h->tcp_backend_priv.send_buf[8]; h->databuf = &h->tcp_backend_priv.recv_buf[4]; /* configure directions */ h->rx_ep = STLINK_TCP_REQUEST_READ; h->tx_ep = STLINK_TCP_REQUEST_WRITE; h->trace_ep = STLINK_TCP_REQUEST_READ_SWO; h->tcp_backend_priv.fd = socket(AF_INET, SOCK_STREAM, IPPROTO_TCP); h->tcp_backend_priv.connected = false; h->tcp_backend_priv.device_id = 0; h->tcp_backend_priv.connect_id = 0; if (h->tcp_backend_priv.fd == -1) { LOG_ERROR("error creating the socket, errno: %s", strerror(errno)); return ERROR_FAIL; } struct sockaddr_in serv; memset(&serv, 0, sizeof(struct sockaddr_in)); serv.sin_family = AF_INET; serv.sin_port = htons(param->stlink_tcp_port); serv.sin_addr.s_addr = inet_addr("127.0.0.1"); LOG_DEBUG("socket : %x", h->tcp_backend_priv.fd); int optval = 1; if (setsockopt(h->tcp_backend_priv.fd, IPPROTO_TCP, TCP_NODELAY, (const void *)&optval, sizeof(int)) == -1) { LOG_ERROR("cannot set sock option 'TCP_NODELAY', errno: %s", strerror(errno)); return ERROR_FAIL; } optval = STLINK_TCP_RECV_BUFFER_SIZE; if (setsockopt(h->tcp_backend_priv.fd, SOL_SOCKET, SO_RCVBUF, (const void *)&optval, sizeof(int)) == -1) { LOG_ERROR("cannot set sock option 'SO_RCVBUF', errno: %s", strerror(errno)); return ERROR_FAIL; } optval = STLINK_TCP_SEND_BUFFER_SIZE; if (setsockopt(h->tcp_backend_priv.fd, SOL_SOCKET, SO_SNDBUF, (const void *)&optval, sizeof(int)) == -1) { LOG_ERROR("cannot set sock option 'SO_SNDBUF', errno: %s", strerror(errno)); return ERROR_FAIL; } if (connect(h->tcp_backend_priv.fd, (const struct sockaddr *)&serv, sizeof(serv)) == -1) { LOG_ERROR("cannot connect to stlink server, errno: %s", strerror(errno)); return ERROR_FAIL; } h->tcp_backend_priv.connected = true; LOG_INFO("connected to stlink-server"); /* print stlink-server version */ h->tcp_backend_priv.send_buf[0] = STLINK_TCP_CMD_GET_SERVER_VERSION; h->tcp_backend_priv.send_buf[1] = OPENOCD_STLINK_TCP_API_VERSION; memset(&h->tcp_backend_priv.send_buf[2], 0, 2); /* reserved */ ret = stlink_tcp_send_cmd(h, 4, 16, false); if (ret != ERROR_OK) { LOG_ERROR("cannot get the stlink-server version"); return ERROR_FAIL; } h->tcp_backend_priv.version.api = le_to_h_u32(&h->tcp_backend_priv.recv_buf[0]); h->tcp_backend_priv.version.major = le_to_h_u32(&h->tcp_backend_priv.recv_buf[4]); h->tcp_backend_priv.version.minor = le_to_h_u32(&h->tcp_backend_priv.recv_buf[8]); h->tcp_backend_priv.version.build = le_to_h_u32(&h->tcp_backend_priv.recv_buf[12]); LOG_INFO("stlink-server API v%d, version %d.%d.%d", h->tcp_backend_priv.version.api, h->tcp_backend_priv.version.major, h->tcp_backend_priv.version.minor, h->tcp_backend_priv.version.build); /* in stlink-server API v1 sending more than 1428 bytes will cause stlink-server * to crash in windows: select a safe default value (1K) */ if (h->tcp_backend_priv.version.api < 2) h->max_mem_packet = (1 << 10); /* refresh stlink list (re-enumerate) */ h->tcp_backend_priv.send_buf[0] = STLINK_TCP_CMD_REFRESH_DEVICE_LIST; h->tcp_backend_priv.send_buf[1] = 0; /* don't clear the list, just refresh it */ ret = stlink_tcp_send_cmd(h, 2, 4, true); if (ret != ERROR_OK) return ret; /* get the number of connected stlinks */ h->tcp_backend_priv.send_buf[0] = STLINK_TCP_CMD_GET_NB_DEV; ret = stlink_tcp_send_cmd(h, 1, 4, false); if (ret != ERROR_OK) return ret; uint32_t connected_stlinks = le_to_h_u32(h->tcp_backend_priv.recv_buf); if (connected_stlinks == 0) { LOG_ERROR("no ST-LINK detected"); return ERROR_FAIL; } LOG_DEBUG("%d ST-LINK detected", connected_stlinks); if (connected_stlinks > 255) { LOG_WARNING("STLink server cannot handle more than 255 ST-LINK connected"); connected_stlinks = 255; } /* list all connected ST-Link and seek for the requested vid:pid and serial */ char serial[STLINK_TCP_SERIAL_SIZE + 1] = {0}; uint8_t stlink_used; bool stlink_id_matched = false; const char *adapter_serial = adapter_get_required_serial(); bool stlink_serial_matched = !adapter_serial; for (uint32_t stlink_id = 0; stlink_id < connected_stlinks; stlink_id++) { /* get the stlink info */ h->tcp_backend_priv.send_buf[0] = STLINK_TCP_CMD_GET_DEV_INFO; h->tcp_backend_priv.send_buf[1] = (uint8_t)stlink_id; memset(&h->tcp_backend_priv.send_buf[2], 0, 2); /* reserved */ h_u32_to_le(&h->tcp_backend_priv.send_buf[4], 41); /* size of TDeviceInfo2 */ ret = stlink_tcp_send_cmd(h, 8, 45, true); if (ret != ERROR_OK) return ret; h->tcp_backend_priv.device_id = le_to_h_u32(&h->tcp_backend_priv.recv_buf[4]); memcpy(serial, &h->tcp_backend_priv.recv_buf[8], STLINK_TCP_SERIAL_SIZE); h->vid = le_to_h_u16(&h->tcp_backend_priv.recv_buf[40]); h->pid = le_to_h_u16(&h->tcp_backend_priv.recv_buf[42]); stlink_used = h->tcp_backend_priv.recv_buf[44]; /* check the vid:pid */ for (int i = 0; param->vid[i]; i++) { if (param->vid[i] == h->vid && param->pid[i] == h->pid) { stlink_id_matched = true; break; } } if (!stlink_id_matched) continue; /* check the serial if specified */ if (adapter_serial) { /* ST-Link server fixes the buggy serial returned by old ST-Link DFU * for further details refer to stlink_usb_get_alternate_serial * so if the user passes the buggy serial, we need to fix it before * comparing with the serial returned by ST-Link server */ if (strlen(adapter_serial) == STLINK_SERIAL_LEN / 2) { char fixed_serial[STLINK_SERIAL_LEN + 1]; for (unsigned int i = 0; i < STLINK_SERIAL_LEN; i += 2) sprintf(fixed_serial + i, "%02X", adapter_serial[i / 2]); fixed_serial[STLINK_SERIAL_LEN] = '\0'; stlink_serial_matched = strcmp(fixed_serial, serial) == 0; } else { stlink_serial_matched = strcmp(adapter_serial, serial) == 0; } } if (!stlink_serial_matched) LOG_DEBUG("Device serial number '%s' doesn't match requested serial '%s'", serial, adapter_serial); else /* exit the search loop if there is match */ break; } if (!stlink_id_matched) { LOG_ERROR("ST-LINK open failed (vid/pid mismatch)"); return ERROR_FAIL; } if (!stlink_serial_matched) { LOG_ERROR("ST-LINK open failed (serial mismatch)"); return ERROR_FAIL; } /* check if device is 'exclusively' used by another application */ if (stlink_used) { LOG_ERROR("the selected device is already used"); return ERROR_FAIL; } LOG_DEBUG("transport: vid: 0x%04x pid: 0x%04x serial: %s", h->vid, h->pid, serial); /* now let's open the stlink */ h->tcp_backend_priv.send_buf[0] = STLINK_TCP_CMD_OPEN_DEV; memset(&h->tcp_backend_priv.send_buf[1], 0, 4); /* reserved */ h_u32_to_le(&h->tcp_backend_priv.send_buf[4], h->tcp_backend_priv.device_id); ret = stlink_tcp_send_cmd(h, 8, 8, true); if (ret != ERROR_OK) return ret; h->tcp_backend_priv.connect_id = le_to_h_u32(&h->tcp_backend_priv.recv_buf[4]); /* get stlink version */ return stlink_usb_version(h); } static struct stlink_backend stlink_usb_backend = { .open = stlink_usb_usb_open, .close = stlink_usb_usb_close, .xfer_noerrcheck = stlink_usb_usb_xfer_noerrcheck, .read_trace = stlink_usb_usb_read_trace, }; static struct stlink_backend stlink_tcp_backend = { .open = stlink_tcp_open, .close = stlink_tcp_close, .xfer_noerrcheck = stlink_tcp_xfer_noerrcheck, .read_trace = stlink_tcp_read_trace, }; static int stlink_open(struct hl_interface_param *param, enum stlink_mode mode, void **fd) { struct stlink_usb_handle *h; LOG_DEBUG("stlink_open"); h = calloc(1, sizeof(struct stlink_usb_handle)); if (!h) { LOG_DEBUG("malloc failed"); return ERROR_FAIL; } h->st_mode = mode; for (unsigned i = 0; param->vid[i]; i++) { LOG_DEBUG("transport: %d vid: 0x%04x pid: 0x%04x serial: %s", h->st_mode, param->vid[i], param->pid[i], adapter_get_required_serial() ? adapter_get_required_serial() : ""); } if (param->use_stlink_tcp) h->backend = &stlink_tcp_backend; else h->backend = &stlink_usb_backend; if (stlink_usb_open(h, param) != ERROR_OK) goto error_open; /* check if mode is supported */ int err = ERROR_OK; switch (h->st_mode) { case STLINK_MODE_DEBUG_SWD: if (h->version.jtag_api == STLINK_JTAG_API_V1) err = ERROR_FAIL; /* fall-through */ case STLINK_MODE_DEBUG_JTAG: if (h->version.jtag == 0) err = ERROR_FAIL; break; case STLINK_MODE_DEBUG_SWIM: if (h->version.swim == 0) err = ERROR_FAIL; break; default: err = ERROR_FAIL; break; } if (err != ERROR_OK) { LOG_ERROR("mode (transport) not supported by device"); goto error_open; } /* initialize the debug hardware */ err = stlink_usb_init_mode(h, param->connect_under_reset, param->initial_interface_speed); if (err != ERROR_OK) { LOG_ERROR("init mode failed (unable to connect to the target)"); goto error_open; } if (h->st_mode == STLINK_MODE_DEBUG_SWIM) { err = stlink_swim_enter(h); if (err != ERROR_OK) { LOG_ERROR("stlink_swim_enter_failed (unable to connect to the target)"); goto error_open; } *fd = h; h->max_mem_packet = STLINK_SWIM_DATA_SIZE; return ERROR_OK; } /* set max_mem_packet if it was not set by the low-level interface */ if (h->max_mem_packet == 0) { /* get cpuid, so we can determine the max page size * start with a safe default */ h->max_mem_packet = (1 << 10); uint8_t buffer[4]; stlink_usb_open_ap(h, STLINK_HLA_AP_NUM); err = stlink_usb_read_mem32(h, STLINK_HLA_AP_NUM, STLINK_HLA_CSW, CPUID, 4, buffer); if (err == ERROR_OK) { uint32_t cpuid = le_to_h_u32(buffer); int i = (cpuid >> 4) & 0xf; if (i == 4 || i == 3) { /* Cortex-M3/M4 has 4096 bytes autoincrement range */ h->max_mem_packet = (1 << 12); } } LOG_DEBUG("Using TAR autoincrement: %" PRIu32, h->max_mem_packet); } *fd = h; return ERROR_OK; error_open: stlink_close(h); return ERROR_FAIL; } static int stlink_usb_hl_open(struct hl_interface_param *param, void **fd) { return stlink_open(param, stlink_get_mode(param->transport), fd); } static int stlink_config_trace(void *handle, bool enabled, enum tpiu_pin_protocol pin_protocol, uint32_t port_size, unsigned int *trace_freq, unsigned int traceclkin_freq, uint16_t *prescaler) { struct stlink_usb_handle *h = handle; if (!(h->version.flags & STLINK_F_HAS_TRACE)) { LOG_ERROR("The attached ST-LINK version doesn't support trace"); return ERROR_FAIL; } if (!enabled) { stlink_usb_trace_disable(h); return ERROR_OK; } assert(trace_freq); assert(prescaler); if (pin_protocol != TPIU_PIN_PROTOCOL_ASYNC_UART) { LOG_ERROR("The attached ST-LINK version doesn't support this trace mode"); return ERROR_FAIL; } unsigned int max_trace_freq = (h->version.stlink >= 3) ? STLINK_V3_TRACE_MAX_HZ : STLINK_TRACE_MAX_HZ; /* Only concern ourselves with the frequency if the STlink is processing it. */ if (*trace_freq > max_trace_freq) { LOG_ERROR("ST-LINK doesn't support SWO frequency higher than %u", max_trace_freq); return ERROR_FAIL; } if (!*trace_freq) *trace_freq = max_trace_freq; unsigned int presc = (traceclkin_freq + *trace_freq / 2) / *trace_freq; if (presc == 0 || presc > TPIU_ACPR_MAX_SWOSCALER + 1) { LOG_ERROR("SWO frequency is not suitable. Please choose a different " "frequency."); return ERROR_FAIL; } /* Probe's UART speed must be within 3% of the TPIU's SWO baud rate. */ unsigned int max_deviation = (traceclkin_freq * 3) / 100; if (presc * *trace_freq < traceclkin_freq - max_deviation || presc * *trace_freq > traceclkin_freq + max_deviation) { LOG_ERROR("SWO frequency is not suitable. Please choose a different " "frequency."); return ERROR_FAIL; } *prescaler = presc; stlink_usb_trace_disable(h); h->trace.source_hz = *trace_freq; return stlink_usb_trace_enable(h); } /** */ static int stlink_usb_init_access_port(void *handle, unsigned char ap_num) { struct stlink_usb_handle *h = handle; assert(handle); if (!(h->version.flags & STLINK_F_HAS_AP_INIT)) return ERROR_COMMAND_NOTFOUND; LOG_DEBUG_IO("init ap_num = %d", ap_num); stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_INIT_AP; h->cmdbuf[h->cmdidx++] = ap_num; return stlink_usb_xfer_errcheck(handle, h->databuf, 2); } /** */ static int stlink_usb_close_access_port(void *handle, unsigned char ap_num) { struct stlink_usb_handle *h = handle; assert(handle); if (!(h->version.flags & STLINK_F_HAS_AP_INIT)) return ERROR_COMMAND_NOTFOUND; LOG_DEBUG_IO("close ap_num = %d", ap_num); stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_CLOSE_AP_DBG; h->cmdbuf[h->cmdidx++] = ap_num; /* ignore incorrectly returned error on bogus FW */ if (h->version.flags & STLINK_F_FIX_CLOSE_AP) return stlink_usb_xfer_errcheck(handle, h->databuf, 2); else return stlink_usb_xfer_noerrcheck(handle, h->databuf, 2); } static int stlink_usb_rw_misc_out(void *handle, uint32_t items, const uint8_t *buffer) { struct stlink_usb_handle *h = handle; unsigned int buflen = ALIGN_UP(items, 4) + 4 * items; LOG_DEBUG_IO("%s(%" PRIu32 ")", __func__, items); assert(handle != NULL); if (!(h->version.flags & STLINK_F_HAS_RW_MISC)) return ERROR_COMMAND_NOTFOUND; stlink_usb_init_buffer(handle, h->tx_ep, buflen); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_RW_MISC_OUT; h_u32_to_le(&h->cmdbuf[2], items); return stlink_usb_xfer_noerrcheck(handle, buffer, buflen); } static int stlink_usb_rw_misc_in(void *handle, uint32_t items, uint8_t *buffer) { struct stlink_usb_handle *h = handle; unsigned int buflen = 2 * 4 * items; LOG_DEBUG_IO("%s(%" PRIu32 ")", __func__, items); assert(handle != NULL); if (!(h->version.flags & STLINK_F_HAS_RW_MISC)) return ERROR_COMMAND_NOTFOUND; stlink_usb_init_buffer(handle, h->rx_ep, buflen); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_RW_MISC_IN; int res = stlink_usb_xfer_noerrcheck(handle, h->databuf, buflen); if (res != ERROR_OK) return res; memcpy(buffer, h->databuf, buflen); return ERROR_OK; } /** */ static int stlink_read_dap_register(void *handle, unsigned short dap_port, unsigned short addr, uint32_t *val) { struct stlink_usb_handle *h = handle; int retval; assert(handle); if (!(h->version.flags & STLINK_F_HAS_DAP_REG)) return ERROR_COMMAND_NOTFOUND; stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_READ_DAP_REG; h_u16_to_le(&h->cmdbuf[2], dap_port); h_u16_to_le(&h->cmdbuf[4], addr); retval = stlink_usb_xfer_errcheck(handle, h->databuf, 8); *val = le_to_h_u32(h->databuf + 4); LOG_DEBUG_IO("dap_port_read = %d, addr = 0x%x, value = 0x%" PRIx32, dap_port, addr, *val); return retval; } /** */ static int stlink_write_dap_register(void *handle, unsigned short dap_port, unsigned short addr, uint32_t val) { struct stlink_usb_handle *h = handle; assert(handle); if (!(h->version.flags & STLINK_F_HAS_DAP_REG)) return ERROR_COMMAND_NOTFOUND; LOG_DEBUG_IO("dap_write port = %d, addr = 0x%x, value = 0x%" PRIx32, dap_port, addr, val); stlink_usb_init_buffer(handle, h->rx_ep, 16); h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_COMMAND; h->cmdbuf[h->cmdidx++] = STLINK_DEBUG_APIV2_WRITE_DAP_REG; h_u16_to_le(&h->cmdbuf[2], dap_port); h_u16_to_le(&h->cmdbuf[4], addr); h_u32_to_le(&h->cmdbuf[6], val); return stlink_usb_xfer_errcheck(handle, h->databuf, 2); } /** */ struct hl_layout_api stlink_usb_layout_api = { /** */ .open = stlink_usb_hl_open, /** */ .close = stlink_close, /** */ .idcode = stlink_usb_idcode, /** */ .state = stlink_usb_state, /** */ .reset = stlink_usb_reset, /** */ .assert_srst = stlink_usb_assert_srst, /** */ .run = stlink_usb_run, /** */ .halt = stlink_usb_halt, /** */ .step = stlink_usb_step, /** */ .read_regs = stlink_usb_read_regs, /** */ .read_reg = stlink_usb_read_reg, /** */ .write_reg = stlink_usb_write_reg, /** */ .read_mem = stlink_usb_read_mem, /** */ .write_mem = stlink_usb_write_mem, /** */ .write_debug_reg = stlink_usb_write_debug_reg, /** */ .override_target = stlink_usb_override_target, /** */ .speed = stlink_speed, /** */ .config_trace = stlink_config_trace, /** */ .poll_trace = stlink_usb_trace_read, }; /***************************************************************************** * DAP direct interface */ static struct stlink_usb_handle *stlink_dap_handle; static struct hl_interface_param stlink_dap_param; static DECLARE_BITMAP(opened_ap, DP_APSEL_MAX + 1); static uint32_t last_csw_default[DP_APSEL_MAX + 1]; static int stlink_dap_error = ERROR_OK; /** */ static int stlink_dap_record_error(int error) { if (stlink_dap_error == ERROR_OK) stlink_dap_error = error; return ERROR_OK; } /** */ static int stlink_dap_get_and_clear_error(void) { int retval = stlink_dap_error; stlink_dap_error = ERROR_OK; return retval; } static int stlink_dap_get_error(void) { return stlink_dap_error; } static int stlink_usb_open_ap(void *handle, unsigned short apsel) { struct stlink_usb_handle *h = handle; int retval; /* nothing to do on old versions */ if (!(h->version.flags & STLINK_F_HAS_AP_INIT)) return ERROR_OK; if (apsel > DP_APSEL_MAX) return ERROR_FAIL; if (test_bit(apsel, opened_ap)) return ERROR_OK; retval = stlink_usb_init_access_port(h, apsel); if (retval != ERROR_OK) return retval; LOG_DEBUG("AP %d enabled", apsel); set_bit(apsel, opened_ap); last_csw_default[apsel] = 0; return ERROR_OK; } static int stlink_dap_open_ap(unsigned short apsel) { return stlink_usb_open_ap(stlink_dap_handle, apsel); } /** */ static int stlink_dap_closeall_ap(void) { int retval, apsel; /* nothing to do on old versions */ if (!(stlink_dap_handle->version.flags & STLINK_F_HAS_AP_INIT)) return ERROR_OK; for (apsel = 0; apsel <= DP_APSEL_MAX; apsel++) { if (!test_bit(apsel, opened_ap)) continue; retval = stlink_usb_close_access_port(stlink_dap_handle, apsel); if (retval != ERROR_OK) return retval; clear_bit(apsel, opened_ap); } return ERROR_OK; } /** */ static int stlink_dap_reinit_interface(void) { int retval; /* * On JTAG only, it should be enough to call stlink_usb_reset(). But on * some firmware version it does not work as expected, and there is no * equivalent for SWD. * At least for now, to reset the interface quit from JTAG/SWD mode then * select the mode again. */ if (!stlink_dap_handle->reconnect_pending) { stlink_dap_handle->reconnect_pending = true; stlink_usb_mode_leave(stlink_dap_handle, stlink_dap_handle->st_mode); } retval = stlink_usb_mode_enter(stlink_dap_handle, stlink_dap_handle->st_mode); if (retval != ERROR_OK) return retval; stlink_dap_handle->reconnect_pending = false; /* on new FW, calling mode-leave closes all the opened AP; reopen them! */ if (stlink_dap_handle->version.flags & STLINK_F_HAS_AP_INIT) for (unsigned int apsel = 0; apsel <= DP_APSEL_MAX; apsel++) if (test_bit(apsel, opened_ap)) { clear_bit(apsel, opened_ap); stlink_dap_open_ap(apsel); } return ERROR_OK; } /** */ static int stlink_dap_op_connect(struct adiv5_dap *dap) { uint32_t idcode; int retval; LOG_INFO("stlink_dap_op_connect(%sconnect)", dap->do_reconnect ? "re" : ""); /* Check if we should reset srst already when connecting, but not if reconnecting. */ if (!dap->do_reconnect) { enum reset_types jtag_reset_config = jtag_get_reset_config(); if (jtag_reset_config & RESET_CNCT_UNDER_SRST) { if (jtag_reset_config & RESET_SRST_NO_GATING) adapter_assert_reset(); else LOG_WARNING("\'srst_nogate\' reset_config option is required"); } } dap->do_reconnect = false; dap_invalidate_cache(dap); for (unsigned int i = 0; i <= DP_APSEL_MAX; i++) last_csw_default[i] = 0; retval = dap_dp_init(dap); if (retval != ERROR_OK) { dap->do_reconnect = true; return retval; } retval = stlink_usb_idcode(stlink_dap_handle, &idcode); if (retval == ERROR_OK) LOG_INFO("%s %#8.8" PRIx32, (stlink_dap_handle->st_mode == STLINK_MODE_DEBUG_JTAG) ? "JTAG IDCODE" : "SWD DPIDR", idcode); else dap->do_reconnect = true; return retval; } /** */ static int stlink_dap_check_reconnect(struct adiv5_dap *dap) { int retval; if (!dap->do_reconnect) return ERROR_OK; retval = stlink_dap_reinit_interface(); if (retval != ERROR_OK) return retval; return stlink_dap_op_connect(dap); } /** */ static int stlink_dap_op_send_sequence(struct adiv5_dap *dap, enum swd_special_seq seq) { /* Ignore the request */ return ERROR_OK; } /** */ static int stlink_dap_dp_read(struct adiv5_dap *dap, unsigned int reg, uint32_t *data) { uint32_t dummy; int retval; if (!(stlink_dap_handle->version.flags & STLINK_F_HAS_DPBANKSEL)) if (reg & 0x000000F0) { LOG_ERROR("Banked DP registers not supported in current STLink FW"); return ERROR_COMMAND_NOTFOUND; } data = data ? data : &dummy; if (stlink_dap_handle->version.flags & STLINK_F_QUIRK_JTAG_DP_READ && stlink_dap_handle->st_mode == STLINK_MODE_DEBUG_JTAG) { /* Quirk required in JTAG. Read RDBUFF to get the data */ retval = stlink_read_dap_register(stlink_dap_handle, STLINK_DEBUG_PORT_ACCESS, reg, &dummy); if (retval == ERROR_OK) retval = stlink_read_dap_register(stlink_dap_handle, STLINK_DEBUG_PORT_ACCESS, DP_RDBUFF, data); } else { retval = stlink_read_dap_register(stlink_dap_handle, STLINK_DEBUG_PORT_ACCESS, reg, data); } return retval; } /** */ static int stlink_dap_dp_write(struct adiv5_dap *dap, unsigned int reg, uint32_t data) { int retval; if (!(stlink_dap_handle->version.flags & STLINK_F_HAS_DPBANKSEL)) if (reg & 0x000000F0) { LOG_ERROR("Banked DP registers not supported in current STLink FW"); return ERROR_COMMAND_NOTFOUND; } if (reg == DP_SELECT && (data & DP_SELECT_DPBANK) != 0) { /* ignored if STLINK_F_HAS_DPBANKSEL, not properly managed otherwise */ LOG_DEBUG("Ignoring DPBANKSEL while write SELECT"); data &= ~DP_SELECT_DPBANK; } /* ST-Link does not like that we set CORUNDETECT */ if (reg == DP_CTRL_STAT) data &= ~CORUNDETECT; retval = stlink_write_dap_register(stlink_dap_handle, STLINK_DEBUG_PORT_ACCESS, reg, data); return retval; } /** */ static int stlink_dap_ap_read(struct adiv5_ap *ap, unsigned int reg, uint32_t *data) { struct adiv5_dap *dap = ap->dap; uint32_t dummy; int retval; if (is_adiv6(dap)) { static bool error_flagged; if (!error_flagged) LOG_ERROR("ADIv6 dap not supported by stlink dap-direct mode"); error_flagged = true; return ERROR_FAIL; } if (reg != ADIV5_AP_REG_IDR) { retval = stlink_dap_open_ap(ap->ap_num); if (retval != ERROR_OK) return retval; } data = data ? data : &dummy; retval = stlink_read_dap_register(stlink_dap_handle, ap->ap_num, reg, data); dap->stlink_flush_ap_write = false; return retval; } /** */ static int stlink_dap_ap_write(struct adiv5_ap *ap, unsigned int reg, uint32_t data) { struct adiv5_dap *dap = ap->dap; int retval; if (is_adiv6(dap)) { static bool error_flagged; if (!error_flagged) LOG_ERROR("ADIv6 dap not supported by stlink dap-direct mode"); error_flagged = true; return ERROR_FAIL; } retval = stlink_dap_open_ap(ap->ap_num); if (retval != ERROR_OK) return retval; retval = stlink_write_dap_register(stlink_dap_handle, ap->ap_num, reg, data); dap->stlink_flush_ap_write = true; return retval; } /** */ static int stlink_dap_op_queue_ap_abort(struct adiv5_dap *dap, uint8_t *ack) { LOG_WARNING("stlink_dap_op_queue_ap_abort()"); return ERROR_OK; } #define RW_MISC_CMD_ADDRESS 1 #define RW_MISC_CMD_WRITE 2 #define RW_MISC_CMD_READ 3 #define RW_MISC_CMD_APNUM 5 static int stlink_usb_misc_rw_segment(void *handle, const struct dap_queue *q, unsigned int len, unsigned int items) { uint8_t buf[2 * 4 * items]; LOG_DEBUG("Queue: %u commands in %u items", len, items); uint32_t ap_num = DP_APSEL_INVALID; unsigned int cmd_index = 0; unsigned int val_index = ALIGN_UP(items, 4); for (unsigned int i = 0; i < len; i++) { if (ap_num != q[i].mem_ap.ap->ap_num) { ap_num = q[i].mem_ap.ap->ap_num; buf[cmd_index++] = RW_MISC_CMD_APNUM; h_u32_to_le(&buf[val_index], ap_num); val_index += 4; } switch (q[i].cmd) { case CMD_MEM_AP_READ32: buf[cmd_index++] = RW_MISC_CMD_READ; h_u32_to_le(&buf[val_index], q[i].mem_ap.addr); val_index += 4; break; case CMD_MEM_AP_WRITE32: buf[cmd_index++] = RW_MISC_CMD_ADDRESS; h_u32_to_le(&buf[val_index], q[i].mem_ap.addr); val_index += 4; buf[cmd_index++] = RW_MISC_CMD_WRITE; h_u32_to_le(&buf[val_index], q[i].mem_ap.data); val_index += 4; break; default: /* Not supposed to happen */ return ERROR_FAIL; } } /* pad after last command */ while (!IS_ALIGNED(cmd_index, 4)) buf[cmd_index++] = 0; int retval = stlink_usb_rw_misc_out(handle, items, buf); if (retval != ERROR_OK) return retval; retval = stlink_usb_rw_misc_in(handle, items, buf); if (retval != ERROR_OK) return retval; ap_num = DP_APSEL_INVALID; val_index = 0; unsigned int err_index = 4 * items; for (unsigned int i = 0; i < len; i++) { uint32_t errcode = le_to_h_u32(&buf[err_index]); if (errcode != STLINK_DEBUG_ERR_OK) { LOG_ERROR("unknown/unexpected STLINK status code 0x%x", errcode); return ERROR_FAIL; } if (ap_num != q[i].mem_ap.ap->ap_num) { ap_num = q[i].mem_ap.ap->ap_num; err_index += 4; val_index += 4; errcode = le_to_h_u32(&buf[err_index]); if (errcode != STLINK_DEBUG_ERR_OK) { LOG_ERROR("unknown/unexpected STLINK status code 0x%x", errcode); return ERROR_FAIL; } } if (q[i].cmd == CMD_MEM_AP_READ32) { *q[i].mem_ap.p_data = le_to_h_u32(&buf[val_index]); } else { /* q[i]->cmd == CMD_MEM_AP_WRITE32 */ err_index += 4; val_index += 4; errcode = le_to_h_u32(&buf[err_index]); if (errcode != STLINK_DEBUG_ERR_OK) { LOG_ERROR("unknown/unexpected STLINK status code 0x%x", errcode); return ERROR_FAIL; } } err_index += 4; val_index += 4; } return ERROR_OK; } static int stlink_usb_buf_rw_segment(void *handle, const struct dap_queue *q, unsigned int count) { uint32_t bufsize = count * CMD_MEM_AP_2_SIZE(q[0].cmd); uint8_t buf[bufsize]; uint8_t ap_num = q[0].mem_ap.ap->ap_num; uint32_t addr = q[0].mem_ap.addr; uint32_t csw = q[0].mem_ap.csw; int retval = stlink_dap_open_ap(ap_num); if (retval != ERROR_OK) return retval; switch (q[0].cmd) { case CMD_MEM_AP_WRITE8: for (unsigned int i = 0; i < count; i++) buf[i] = q[i].mem_ap.data >> 8 * (q[i].mem_ap.addr & 3); return stlink_usb_write_mem8(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); case CMD_MEM_AP_WRITE16: for (unsigned int i = 0; i < count; i++) h_u16_to_le(&buf[2 * i], q[i].mem_ap.data >> 8 * (q[i].mem_ap.addr & 2)); return stlink_usb_write_mem16(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); case CMD_MEM_AP_WRITE32: for (unsigned int i = 0; i < count; i++) h_u32_to_le(&buf[4 * i], q[i].mem_ap.data); if (count > 1 && q[0].mem_ap.addr == q[1].mem_ap.addr) return stlink_usb_write_mem32_noaddrinc(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); else return stlink_usb_write_mem32(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); case CMD_MEM_AP_READ8: retval = stlink_usb_read_mem8(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); if (retval == ERROR_OK) for (unsigned int i = 0; i < count; i++) *q[i].mem_ap.p_data = buf[i] << 8 * (q[i].mem_ap.addr & 3); return retval; case CMD_MEM_AP_READ16: retval = stlink_usb_read_mem16(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); if (retval == ERROR_OK) for (unsigned int i = 0; i < count; i++) *q[i].mem_ap.p_data = le_to_h_u16(&buf[2 * i]) << 8 * (q[i].mem_ap.addr & 2); return retval; case CMD_MEM_AP_READ32: if (count > 1 && q[0].mem_ap.addr == q[1].mem_ap.addr) retval = stlink_usb_read_mem32_noaddrinc(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); else retval = stlink_usb_read_mem32(stlink_dap_handle, ap_num, csw, addr, bufsize, buf); if (retval == ERROR_OK) for (unsigned int i = 0; i < count; i++) *q[i].mem_ap.p_data = le_to_h_u32(&buf[4 * i]); return retval; default: return ERROR_FAIL; }; } /* TODO: recover these values with cmd STLINK_DEBUG_APIV2_RW_MISC_GET_MAX (0x53) */ #define STLINK_V2_RW_MISC_SIZE (64) #define STLINK_V3_RW_MISC_SIZE (1227) static int stlink_usb_count_misc_rw_queue(void *handle, const struct dap_queue *q, unsigned int len, unsigned int *pkt_items) { struct stlink_usb_handle *h = handle; unsigned int i, items = 0; uint32_t ap_num = DP_APSEL_INVALID; unsigned int misc_max_items = (h->version.stlink == 2) ? STLINK_V2_RW_MISC_SIZE : STLINK_V3_RW_MISC_SIZE; if (!(h->version.flags & STLINK_F_HAS_RW_MISC)) return 0; /* * Before stlink-server API v3, RW_MISC sequence doesn't lock the st-link, * so are not safe in shared mode. * Don't use it with TCP backend to prevent any issue in case of sharing. * This further degrades the performance, on top of TCP server overhead. */ if (h->backend == &stlink_tcp_backend && h->tcp_backend_priv.version.api < 3) return 0; for (i = 0; i < len; i++) { if (q[i].cmd != CMD_MEM_AP_READ32 && q[i].cmd != CMD_MEM_AP_WRITE32) break; unsigned int count = 1; if (ap_num != q[i].mem_ap.ap->ap_num) { count++; ap_num = q[i].mem_ap.ap->ap_num; } if (q[i].cmd == CMD_MEM_AP_WRITE32) count++; if (items + count > misc_max_items) break; items += count; } *pkt_items = items; return i; } static int stlink_usb_count_buf_rw_queue(const struct dap_queue *q, unsigned int len) { uint32_t incr = CMD_MEM_AP_2_SIZE(q[0].cmd); unsigned int len_max; if (incr == 1) len_max = stlink_usb_block(stlink_dap_handle); else len_max = STLINK_MAX_RW16_32 / incr; /* check for no address increment, 32 bits only */ if (len > 1 && incr == 4 && q[0].mem_ap.addr == q[1].mem_ap.addr) incr = 0; if (len > len_max) len = len_max; for (unsigned int i = 1; i < len; i++) if (q[i].cmd != q[0].cmd || q[i].mem_ap.ap != q[0].mem_ap.ap || q[i].mem_ap.csw != q[0].mem_ap.csw || q[i].mem_ap.addr != q[i - 1].mem_ap.addr + incr) return i; return len; } static int stlink_usb_mem_rw_queue(void *handle, const struct dap_queue *q, unsigned int len, unsigned int *skip) { unsigned int count, misc_items = 0; int retval; unsigned int count_misc = stlink_usb_count_misc_rw_queue(handle, q, len, &misc_items); unsigned int count_buf = stlink_usb_count_buf_rw_queue(q, len); if (count_misc > count_buf) { count = count_misc; retval = stlink_usb_misc_rw_segment(handle, q, count, misc_items); } else { count = count_buf; retval = stlink_usb_buf_rw_segment(handle, q, count_buf); } if (retval != ERROR_OK) return retval; *skip = count; return ERROR_OK; } static void stlink_dap_run_internal(struct adiv5_dap *dap) { int retval = stlink_dap_check_reconnect(dap); if (retval != ERROR_OK) { stlink_dap_handle->queue_index = 0; stlink_dap_record_error(retval); return; } unsigned int i = stlink_dap_handle->queue_index; struct dap_queue *q = &stlink_dap_handle->queue[0]; while (i && stlink_dap_get_error() == ERROR_OK) { unsigned int skip = 1; switch (q->cmd) { case CMD_DP_READ: retval = stlink_dap_dp_read(q->dp_r.dap, q->dp_r.reg, q->dp_r.p_data); break; case CMD_DP_WRITE: retval = stlink_dap_dp_write(q->dp_w.dap, q->dp_w.reg, q->dp_w.data); break; case CMD_AP_READ: retval = stlink_dap_ap_read(q->ap_r.ap, q->ap_r.reg, q->ap_r.p_data); break; case CMD_AP_WRITE: /* ignore increment packed, not supported */ if (q->ap_w.reg == ADIV5_MEM_AP_REG_CSW) q->ap_w.data &= ~CSW_ADDRINC_PACKED; retval = stlink_dap_ap_write(q->ap_w.ap, q->ap_w.reg, q->ap_w.data); break; case CMD_MEM_AP_READ8: case CMD_MEM_AP_READ16: case CMD_MEM_AP_READ32: case CMD_MEM_AP_WRITE8: case CMD_MEM_AP_WRITE16: case CMD_MEM_AP_WRITE32: retval = stlink_usb_mem_rw_queue(stlink_dap_handle, q, i, &skip); break; default: LOG_ERROR("ST-Link: Unknown queue command %d", q->cmd); retval = ERROR_FAIL; break; } stlink_dap_record_error(retval); q += skip; i -= skip; } stlink_dap_handle->queue_index = 0; } /** */ static int stlink_dap_run_finalize(struct adiv5_dap *dap) { uint32_t ctrlstat, pwrmask; int retval, saved_retval; /* Here no LOG_DEBUG. This is called continuously! */ /* * ST-Link returns immediately after a DAP write, without waiting for it * to complete. * Run a dummy read to DP_RDBUFF, as suggested in * http://infocenter.arm.com/help/topic/com.arm.doc.faqs/ka16363.html */ if (dap->stlink_flush_ap_write) { dap->stlink_flush_ap_write = false; retval = stlink_dap_dp_read(dap, DP_RDBUFF, NULL); if (retval != ERROR_OK) { dap->do_reconnect = true; return retval; } } saved_retval = stlink_dap_get_and_clear_error(); retval = stlink_dap_dp_read(dap, DP_CTRL_STAT, &ctrlstat); if (retval != ERROR_OK) { LOG_ERROR("Fail reading CTRL/STAT register. Force reconnect"); dap->do_reconnect = true; return retval; } if (ctrlstat & SSTICKYERR) { if (stlink_dap_handle->st_mode == STLINK_MODE_DEBUG_JTAG) retval = stlink_dap_dp_write(dap, DP_CTRL_STAT, ctrlstat & (dap->dp_ctrl_stat | SSTICKYERR)); else retval = stlink_dap_dp_write(dap, DP_ABORT, STKERRCLR); if (retval != ERROR_OK) { dap->do_reconnect = true; return retval; } } /* check for power lost */ pwrmask = dap->dp_ctrl_stat & (CDBGPWRUPREQ | CSYSPWRUPREQ); if ((ctrlstat & pwrmask) != pwrmask) dap->do_reconnect = true; return saved_retval; } static int stlink_dap_op_queue_run(struct adiv5_dap *dap) { stlink_dap_run_internal(dap); return stlink_dap_run_finalize(dap); } /** */ static void stlink_dap_op_quit(struct adiv5_dap *dap) { int retval; retval = stlink_dap_closeall_ap(); if (retval != ERROR_OK) LOG_ERROR("Error closing APs"); } static int stlink_dap_op_queue_dp_read(struct adiv5_dap *dap, unsigned int reg, uint32_t *data) { if (stlink_dap_get_error() != ERROR_OK) return ERROR_OK; unsigned int i = stlink_dap_handle->queue_index++; struct dap_queue *q = &stlink_dap_handle->queue[i]; q->cmd = CMD_DP_READ; q->dp_r.reg = reg; q->dp_r.dap = dap; q->dp_r.p_data = data; if (i == MAX_QUEUE_DEPTH - 1) stlink_dap_run_internal(dap); return ERROR_OK; } static int stlink_dap_op_queue_dp_write(struct adiv5_dap *dap, unsigned int reg, uint32_t data) { if (stlink_dap_get_error() != ERROR_OK) return ERROR_OK; unsigned int i = stlink_dap_handle->queue_index++; struct dap_queue *q = &stlink_dap_handle->queue[i]; q->cmd = CMD_DP_WRITE; q->dp_w.reg = reg; q->dp_w.dap = dap; q->dp_w.data = data; if (i == MAX_QUEUE_DEPTH - 1) stlink_dap_run_internal(dap); return ERROR_OK; } static int stlink_dap_op_queue_ap_read(struct adiv5_ap *ap, unsigned int reg, uint32_t *data) { if (stlink_dap_get_error() != ERROR_OK) return ERROR_OK; unsigned int i = stlink_dap_handle->queue_index++; struct dap_queue *q = &stlink_dap_handle->queue[i]; /* test STLINK_F_HAS_CSW implicitly tests STLINK_F_HAS_MEM_16BIT, STLINK_F_HAS_MEM_RD_NO_INC * and STLINK_F_HAS_RW_MISC */ if ((stlink_dap_handle->version.flags & STLINK_F_HAS_CSW) && (reg == ADIV5_MEM_AP_REG_DRW || reg == ADIV5_MEM_AP_REG_BD0 || reg == ADIV5_MEM_AP_REG_BD1 || reg == ADIV5_MEM_AP_REG_BD2 || reg == ADIV5_MEM_AP_REG_BD3)) { /* de-queue previous write-TAR */ struct dap_queue *prev_q = q - 1; if (i && prev_q->cmd == CMD_AP_WRITE && prev_q->ap_w.ap == ap && prev_q->ap_w.reg == ADIV5_MEM_AP_REG_TAR) { stlink_dap_handle->queue_index = i; i--; q = prev_q; prev_q--; } /* de-queue previous write-CSW if it didn't changed ap->csw_default */ if (i && prev_q->cmd == CMD_AP_WRITE && prev_q->ap_w.ap == ap && prev_q->ap_w.reg == ADIV5_MEM_AP_REG_CSW && !prev_q->ap_w.changes_csw_default) { stlink_dap_handle->queue_index = i; q = prev_q; } switch (ap->csw_value & CSW_SIZE_MASK) { case CSW_8BIT: q->cmd = CMD_MEM_AP_READ8; break; case CSW_16BIT: q->cmd = CMD_MEM_AP_READ16; break; case CSW_32BIT: q->cmd = CMD_MEM_AP_READ32; break; default: LOG_ERROR("ST-Link: Unsupported CSW size %d", ap->csw_value & CSW_SIZE_MASK); stlink_dap_record_error(ERROR_FAIL); return ERROR_FAIL; } q->mem_ap.addr = (reg == ADIV5_MEM_AP_REG_DRW) ? ap->tar_value : ((ap->tar_value & ~0x0f) | (reg & 0x0c)); q->mem_ap.ap = ap; q->mem_ap.p_data = data; q->mem_ap.csw = ap->csw_default; /* force TAR and CSW update */ ap->tar_valid = false; ap->csw_value = 0; } else { q->cmd = CMD_AP_READ; q->ap_r.reg = reg; q->ap_r.ap = ap; q->ap_r.p_data = data; } if (i == MAX_QUEUE_DEPTH - 1) stlink_dap_run_internal(ap->dap); return ERROR_OK; } static int stlink_dap_op_queue_ap_write(struct adiv5_ap *ap, unsigned int reg, uint32_t data) { if (stlink_dap_get_error() != ERROR_OK) return ERROR_OK; unsigned int i = stlink_dap_handle->queue_index++; struct dap_queue *q = &stlink_dap_handle->queue[i]; /* test STLINK_F_HAS_CSW implicitly tests STLINK_F_HAS_MEM_16BIT, STLINK_F_HAS_MEM_WR_NO_INC * and STLINK_F_HAS_RW_MISC */ if ((stlink_dap_handle->version.flags & STLINK_F_HAS_CSW) && (reg == ADIV5_MEM_AP_REG_DRW || reg == ADIV5_MEM_AP_REG_BD0 || reg == ADIV5_MEM_AP_REG_BD1 || reg == ADIV5_MEM_AP_REG_BD2 || reg == ADIV5_MEM_AP_REG_BD3)) { /* de-queue previous write-TAR */ struct dap_queue *prev_q = q - 1; if (i && prev_q->cmd == CMD_AP_WRITE && prev_q->ap_w.ap == ap && prev_q->ap_w.reg == ADIV5_MEM_AP_REG_TAR) { stlink_dap_handle->queue_index = i; i--; q = prev_q; prev_q--; } /* de-queue previous write-CSW if it didn't changed ap->csw_default */ if (i && prev_q->cmd == CMD_AP_WRITE && prev_q->ap_w.ap == ap && prev_q->ap_w.reg == ADIV5_MEM_AP_REG_CSW && !prev_q->ap_w.changes_csw_default) { stlink_dap_handle->queue_index = i; q = prev_q; } switch (ap->csw_value & CSW_SIZE_MASK) { case CSW_8BIT: q->cmd = CMD_MEM_AP_WRITE8; break; case CSW_16BIT: q->cmd = CMD_MEM_AP_WRITE16; break; case CSW_32BIT: q->cmd = CMD_MEM_AP_WRITE32; break; default: LOG_ERROR("ST-Link: Unsupported CSW size %d", ap->csw_value & CSW_SIZE_MASK); stlink_dap_record_error(ERROR_FAIL); return ERROR_FAIL; } q->mem_ap.addr = (reg == ADIV5_MEM_AP_REG_DRW) ? ap->tar_value : ((ap->tar_value & ~0x0f) | (reg & 0x0c)); q->mem_ap.ap = ap; q->mem_ap.data = data; q->mem_ap.csw = ap->csw_default; /* force TAR and CSW update */ ap->tar_valid = false; ap->csw_value = 0; } else { q->cmd = CMD_AP_WRITE; q->ap_w.reg = reg; q->ap_w.ap = ap; q->ap_w.data = data; uint8_t ap_num = ap->ap_num; if (reg == ADIV5_MEM_AP_REG_CSW && ap->csw_default != last_csw_default[ap_num]) { q->ap_w.changes_csw_default = true; last_csw_default[ap_num] = ap->csw_default; } else { q->ap_w.changes_csw_default = false; } } if (i == MAX_QUEUE_DEPTH - 1) stlink_dap_run_internal(ap->dap); return ERROR_OK; } static int stlink_swim_op_srst(void) { return stlink_swim_generate_rst(stlink_dap_handle); } static int stlink_swim_op_read_mem(uint32_t addr, uint32_t size, uint32_t count, uint8_t *buffer) { int retval; uint32_t bytes_remaining; LOG_DEBUG_IO("read at 0x%08" PRIx32 " len %" PRIu32 "*0x%08" PRIx32, addr, size, count); count *= size; while (count) { bytes_remaining = (count > STLINK_SWIM_DATA_SIZE) ? STLINK_SWIM_DATA_SIZE : count; retval = stlink_swim_readbytes(stlink_dap_handle, addr, bytes_remaining, buffer); if (retval != ERROR_OK) return retval; buffer += bytes_remaining; addr += bytes_remaining; count -= bytes_remaining; } return ERROR_OK; } static int stlink_swim_op_write_mem(uint32_t addr, uint32_t size, uint32_t count, const uint8_t *buffer) { int retval; uint32_t bytes_remaining; LOG_DEBUG_IO("write at 0x%08" PRIx32 " len %" PRIu32 "*0x%08" PRIx32, addr, size, count); count *= size; while (count) { bytes_remaining = (count > STLINK_SWIM_DATA_SIZE) ? STLINK_SWIM_DATA_SIZE : count; retval = stlink_swim_writebytes(stlink_dap_handle, addr, bytes_remaining, buffer); if (retval != ERROR_OK) return retval; buffer += bytes_remaining; addr += bytes_remaining; count -= bytes_remaining; } return ERROR_OK; } static int stlink_swim_op_reconnect(void) { int retval; retval = stlink_usb_mode_enter(stlink_dap_handle, STLINK_MODE_DEBUG_SWIM); if (retval != ERROR_OK) return retval; return stlink_swim_resync(stlink_dap_handle); } static int stlink_dap_config_trace(bool enabled, enum tpiu_pin_protocol pin_protocol, uint32_t port_size, unsigned int *trace_freq, unsigned int traceclkin_freq, uint16_t *prescaler) { return stlink_config_trace(stlink_dap_handle, enabled, pin_protocol, port_size, trace_freq, traceclkin_freq, prescaler); } static int stlink_dap_trace_read(uint8_t *buf, size_t *size) { return stlink_usb_trace_read(stlink_dap_handle, buf, size); } /** */ COMMAND_HANDLER(stlink_dap_vid_pid) { unsigned int i, max_usb_ids = HLA_MAX_USB_IDS; if (CMD_ARGC > max_usb_ids * 2) { LOG_WARNING("ignoring extra IDs in vid_pid " "(maximum is %d pairs)", max_usb_ids); CMD_ARGC = max_usb_ids * 2; } if (CMD_ARGC < 2 || (CMD_ARGC & 1)) { LOG_WARNING("incomplete vid_pid configuration directive"); return ERROR_COMMAND_SYNTAX_ERROR; } for (i = 0; i < CMD_ARGC; i += 2) { COMMAND_PARSE_NUMBER(u16, CMD_ARGV[i], stlink_dap_param.vid[i / 2]); COMMAND_PARSE_NUMBER(u16, CMD_ARGV[i + 1], stlink_dap_param.pid[i / 2]); } /* null termination */ stlink_dap_param.vid[i / 2] = stlink_dap_param.pid[i / 2] = 0; return ERROR_OK; } /** */ COMMAND_HANDLER(stlink_dap_backend_command) { /* default values */ bool use_stlink_tcp = false; uint16_t stlink_tcp_port = 7184; if (CMD_ARGC == 0 || CMD_ARGC > 2) return ERROR_COMMAND_SYNTAX_ERROR; else if (strcmp(CMD_ARGV[0], "usb") == 0) { if (CMD_ARGC > 1) return ERROR_COMMAND_SYNTAX_ERROR; /* else use_stlink_tcp = false (already the case ) */ } else if (strcmp(CMD_ARGV[0], "tcp") == 0) { use_stlink_tcp = true; if (CMD_ARGC == 2) COMMAND_PARSE_NUMBER(u16, CMD_ARGV[1], stlink_tcp_port); } else return ERROR_COMMAND_SYNTAX_ERROR; stlink_dap_param.use_stlink_tcp = use_stlink_tcp; stlink_dap_param.stlink_tcp_port = stlink_tcp_port; return ERROR_OK; } #define BYTES_PER_LINE 16 COMMAND_HANDLER(stlink_dap_cmd_command) { unsigned int rx_n, tx_n; struct stlink_usb_handle *h = stlink_dap_handle; if (CMD_ARGC < 2) return ERROR_COMMAND_SYNTAX_ERROR; COMMAND_PARSE_NUMBER(uint, CMD_ARGV[0], rx_n); tx_n = CMD_ARGC - 1; if (tx_n > STLINK_SG_SIZE || rx_n > STLINK_DATA_SIZE) { LOG_ERROR("max %x byte sent and %d received", STLINK_SG_SIZE, STLINK_DATA_SIZE); return ERROR_COMMAND_SYNTAX_ERROR; } stlink_usb_init_buffer(h, h->rx_ep, rx_n); for (unsigned int i = 0; i < tx_n; i++) { uint8_t byte; COMMAND_PARSE_NUMBER(u8, CMD_ARGV[i + 1], byte); h->cmdbuf[h->cmdidx++] = byte; } int retval = stlink_usb_xfer_noerrcheck(h, h->databuf, rx_n); if (retval != ERROR_OK) { LOG_ERROR("Error %d", retval); return retval; } for (unsigned int i = 0; i < rx_n; i++) command_print_sameline(CMD, "0x%02x%c", h->databuf[i], ((i == (rx_n - 1)) || ((i % BYTES_PER_LINE) == (BYTES_PER_LINE - 1))) ? '\n' : ' '); return ERROR_OK; } /** */ static const struct command_registration stlink_dap_subcommand_handlers[] = { { .name = "vid_pid", .handler = stlink_dap_vid_pid, .mode = COMMAND_CONFIG, .help = "USB VID and PID of the adapter", .usage = "(vid pid)+", }, { .name = "backend", .handler = &stlink_dap_backend_command, .mode = COMMAND_CONFIG, .help = "select which ST-Link backend to use", .usage = "usb | tcp [port]", }, { .name = "cmd", .handler = stlink_dap_cmd_command, .mode = COMMAND_EXEC, .help = "send arbitrary command", .usage = "rx_n (tx_byte)+", }, COMMAND_REGISTRATION_DONE }; /** */ static const struct command_registration stlink_dap_command_handlers[] = { { .name = "st-link", .mode = COMMAND_ANY, .help = "perform st-link management", .chain = stlink_dap_subcommand_handlers, .usage = "", }, COMMAND_REGISTRATION_DONE }; /** */ static int stlink_dap_init(void) { enum reset_types jtag_reset_config = jtag_get_reset_config(); enum stlink_mode mode; int retval; LOG_DEBUG("stlink_dap_init()"); if (jtag_reset_config & RESET_CNCT_UNDER_SRST) { if (jtag_reset_config & RESET_SRST_NO_GATING) stlink_dap_param.connect_under_reset = true; else LOG_WARNING("\'srst_nogate\' reset_config option is required"); } if (transport_is_dapdirect_swd()) mode = STLINK_MODE_DEBUG_SWD; else if (transport_is_dapdirect_jtag()) mode = STLINK_MODE_DEBUG_JTAG; else if (transport_is_swim()) mode = STLINK_MODE_DEBUG_SWIM; else { LOG_ERROR("Unsupported transport"); return ERROR_FAIL; } retval = stlink_open(&stlink_dap_param, mode, (void **)&stlink_dap_handle); if (retval != ERROR_OK) return retval; if ((mode != STLINK_MODE_DEBUG_SWIM) && !(stlink_dap_handle->version.flags & STLINK_F_HAS_DAP_REG)) { LOG_ERROR("ST-Link version does not support DAP direct transport"); return ERROR_FAIL; } return ERROR_OK; } /** */ static int stlink_dap_quit(void) { LOG_DEBUG("stlink_dap_quit()"); return stlink_close(stlink_dap_handle); } /** */ static int stlink_dap_reset(int req_trst, int req_srst) { LOG_DEBUG("stlink_dap_reset(%d)", req_srst); return stlink_usb_assert_srst(stlink_dap_handle, req_srst ? STLINK_DEBUG_APIV2_DRIVE_NRST_LOW : STLINK_DEBUG_APIV2_DRIVE_NRST_HIGH); } /** */ static int stlink_dap_speed(int speed) { if (speed == 0) { LOG_ERROR("RTCK not supported. Set nonzero adapter_khz."); return ERROR_JTAG_NOT_IMPLEMENTED; } stlink_dap_param.initial_interface_speed = speed; stlink_speed(stlink_dap_handle, speed, false); return ERROR_OK; } /** */ static int stlink_dap_khz(int khz, int *jtag_speed) { if (khz == 0) { LOG_ERROR("RCLK not supported"); return ERROR_FAIL; } *jtag_speed = stlink_speed(stlink_dap_handle, khz, true); return ERROR_OK; } /** */ static int stlink_dap_speed_div(int speed, int *khz) { *khz = speed; return ERROR_OK; } static const struct dap_ops stlink_dap_ops = { .connect = stlink_dap_op_connect, .send_sequence = stlink_dap_op_send_sequence, .queue_dp_read = stlink_dap_op_queue_dp_read, .queue_dp_write = stlink_dap_op_queue_dp_write, .queue_ap_read = stlink_dap_op_queue_ap_read, .queue_ap_write = stlink_dap_op_queue_ap_write, .queue_ap_abort = stlink_dap_op_queue_ap_abort, .run = stlink_dap_op_queue_run, .sync = NULL, /* optional */ .quit = stlink_dap_op_quit, /* optional */ }; static const struct swim_driver stlink_swim_ops = { .srst = stlink_swim_op_srst, .read_mem = stlink_swim_op_read_mem, .write_mem = stlink_swim_op_write_mem, .reconnect = stlink_swim_op_reconnect, }; static const char *const stlink_dap_transport[] = { "dapdirect_swd", "dapdirect_jtag", "swim", NULL }; struct adapter_driver stlink_dap_adapter_driver = { .name = "st-link", .transports = stlink_dap_transport, .commands = stlink_dap_command_handlers, .init = stlink_dap_init, .quit = stlink_dap_quit, .reset = stlink_dap_reset, .speed = stlink_dap_speed, .khz = stlink_dap_khz, .speed_div = stlink_dap_speed_div, .config_trace = stlink_dap_config_trace, .poll_trace = stlink_dap_trace_read, .dap_jtag_ops = &stlink_dap_ops, .dap_swd_ops = &stlink_dap_ops, .swim_ops = &stlink_swim_ops, };

Details

Click anywhere in the source to view detailed information here...